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 e3c0dccac09eca69514a244f9a498ecd2a8b6223..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
@@ -28,11 +28,18 @@ public class ToggleDriveGear extends Command {
   @Override
   protected void execute() {
     Value rightPistonValue = driveTrain.getRightDriveTrainPiston();
+    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