competition fixes

[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / commands / driving / ToggleDriveGear.java

diff --git a/src/org/usfirst/frc/team3501/robot/commands/driving/ToggleDriveGear.java b/src/org/usfirst/frc/team3501/robot/commands/driving/ToggleDriveGear.java
index ee15ec8a5415c7dcc68b952649edf7600e93b060..281f3242c1b67df9533dfd59ff94524a7944c995 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/commands/driving/ToggleDriveGear.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/driving/ToggleDriveGear.java
@@ -27,13 +27,19 @@ public class ToggleDriveGear extends Command {
 
   @Override
   protected void execute() {
-    Value leftPistonValue = driveTrain.getLeftDriveTrainPiston();
     Value rightPistonValue = driveTrain.getRightDriveTrainPiston();
-    if (leftPistonValue == Constants.DriveTrain.REVERSE_PISTON_VALUE) {
+    System.out.println("I think i'm at " + rightPistonValue);
+    if (rightPistonValue == Constants.DriveTrain.REVERSE_PISTON_VALUE) {
       driveTrain.setHighGear();
     } else {
       driveTrain.setLowGear();
     }
+    // boolean leftPistonValue = driveTrain.getLeftDriveTrainPiston();
+    // if (leftPistonValue == Constants.DriveTrain.RETRACT_VALUE) {
+    // driveTrain.setHighGear();
+    // } else {
+    // driveTrain.setLowGear();
+    // }
   }
 
   @Override