From 37719b4889c11d08ca7796e95f9e4cb9975e54c9 Mon Sep 17 00:00:00 2001 From: Brendan Date: Sat, 16 May 2015 19:30:22 -0600 Subject: [PATCH] changes drive angle calculation --- src/Robot.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) 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 );