From 3de4778047e36634184334107d6f468dd139745e Mon Sep 17 00:00:00 2001 From: Brendan Date: Sat, 16 May 2015 20:09:15 -0600 Subject: [PATCH] sets knob as speed adjustment --- src/Robot.cpp | 8 ++++++-- 1 file changed, 6 insertions(+), 2 deletions(-) diff --git a/src/Robot.cpp b/src/Robot.cpp index 001e0fd..4207138 100644 --- a/src/Robot.cpp +++ b/src/Robot.cpp @@ -6,9 +6,9 @@ ///// USER PARAMETERS ///// // Tuning Parameters -#define throScale 1 +double throScale = 1; #define ruddScale 1 -#define aileScale 2 +#define aileScale 1 #define elevScale 1 // Wiring Parameters @@ -83,10 +83,14 @@ public: void TeleopPeriodic() { + double ch6 = InterLink->getCh6(); double aile = InterLink->getAile(); double elev = InterLink->getElev(); double rudd = InterLink->getRudd(); SmartDashboard::PutNumber( "Rudder", rudd ); + SmartDashboard::PutNumber( "Throttle", ch6 ); + + throScale = ch6 + 1; double driveAngle = atan2( -aile*aileScale, elev*elevScale ); SmartDashboard::PutNumber( "Drive Angle", driveAngle );