brendanhaines/mecanum
1
0
Fork 0
mirror of https://github.com/brendanhaines/mecanum.git synced 2024-12-26 10:58:00 -07:00
Code Issues Packages Projects Releases Wiki Activity

changes drive angle calculation

Browse Source
This commit is contained in:
Brendan Haines 2015-05-16 19:30:22 -06:00
parent e1266a62b8
commit 37719b4889
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/Robot.cpp
View File

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