mirror of
https://github.com/brendanhaines/mecanum.git
synced 2025-08-01 13:21:53 -06:00
changes drive angle calculation
This commit is contained in:
@@ -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 );
|
||||
|
Reference in New Issue
Block a user