diff --git a/src/Robot.cpp b/src/Robot.cpp index e3b099c..509ff70 100644 --- a/src/Robot.cpp +++ b/src/Robot.cpp @@ -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 );