changes drive angle calculation

This commit is contained in:
Brendan Haines 2015-05-16 19:30:22 -06:00
parent e1266a62b8
commit 37719b4889

View File

@ -84,7 +84,7 @@ public:
double elev = InterLink->getElev();
double rudd = InterLink->getRudd();
double driveAngle = atan2( -aile, -elev );
double driveAngle = atan2( -aile, elev );
SmartDashboard::PutNumber( "Drive Angle", driveAngle );
double driveSpeed = sqrt( aile*aile + elev*elev );