added negative signs to fix reversed driving

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / driving / JoystickDrive.java

diff --git a/src/org/usfirst/frc/team3501/robot/commands/driving/JoystickDrive.java b/src/org/usfirst/frc/team3501/robot/commands/driving/JoystickDrive.java
index 861432f5a975d08dfd4d2cd6cd7e48a33c1f6900..579942f5796f67ec8c43910052a8c30c0eba1313 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/commands/driving/JoystickDrive.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/driving/JoystickDrive.java
@@ -20,11 +20,10 @@ public class JoystickDrive extends Command {
 
   @Override
   protected void execute() {
-    double k = (Robot.driveTrain.isFlipped() ? -1 : 1);
-    // IDK why but the joystick gives positive values for pulling backwards
-    double left = -Robot.oi.leftJoystick.getY();
-    double right = -Robot.oi.rightJoystick.getY();
-    Robot.driveTrain.drive(left * k, right * k);
+    double thrust = Robot.oi.leftJoystick.getY();
+    double twist = Robot.oi.leftJoystick.getTwist();
+
+    Robot.driveTrain.joystickDrive(-thrust, -twist);
   }
 
   @Override