X-Git-Url: http://challenge-bot.com/repos/?p=3501%2F2017steamworks;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fclimber%2FToggleWinch.java;h=0db401cd0239a8312da7905886c91a9fa008e365;hp=918481c37e2377a76ba5b5c2bca1f8a159b02a07;hb=f74d236db406193b851bff99e4daec7b7abf35e7;hpb=8275a069e1891bd27156dcd947a897519c42a3a3 diff --git a/src/org/usfirst/frc/team3501/robot/commands/climber/ToggleWinch.java b/src/org/usfirst/frc/team3501/robot/commands/climber/ToggleWinch.java index 918481c..0db401c 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/climber/ToggleWinch.java +++ b/src/org/usfirst/frc/team3501/robot/commands/climber/ToggleWinch.java @@ -16,6 +16,7 @@ public class ToggleWinch extends Command { @Override protected void initialize() { + System.out.println("toggled"); } @Override @@ -23,9 +24,11 @@ public class ToggleWinch extends Command { if (climber.shouldBeClimbing) { climber.setCANTalonsBrakeMode(climber.COAST_MODE); climber.setMotorValues(climbingSpeed); + System.out.println("climbing"); } else { climber.setCANTalonsBrakeMode(climber.BRAKE_MODE); + System.out.println("braked"); /* Not sure if should have */ climber.stop(); end(); @@ -40,6 +43,7 @@ public class ToggleWinch extends Command { @Override protected void end() { climber.shouldBeClimbing = !climber.shouldBeClimbing; + System.out.println("ended"); } @Override