mirror of
https://github.com/brendanhaines/mecanum.git
synced 2024-12-25 18:38:12 -07:00
changes drive angle calculation
This commit is contained in:
parent
e1266a62b8
commit
37719b4889
|
@ -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 );
|
||||
|
|
Loading…
Reference in New Issue
Block a user