X-Git-Url: http://challenge-bot.com/repos/?p=3501%2F2017steamworks;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fdriving%2FToggleDriveGear.java;h=281f3242c1b67df9533dfd59ff94524a7944c995;hp=e3c0dccac09eca69514a244f9a498ecd2a8b6223;hb=150f450f2b4f9e6094d71007507a7b877e05328a;hpb=9ca89e45fa84b2ec93bc6adf60c7dde1e0a7defb 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 e3c0dcc..281f324 100644 --- 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