X-Git-Url: http://challenge-bot.com/repos/?p=3501%2F2017steamworks;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fshooter%2FRunIndexWheelContinuous.java;h=95940130f11aac8c50ebc54dc29af5d2d13dcf76;hp=d2d386ab040422c72ac3a7863dcc7d8262022f67;hb=cb8e86cb498c12dcf4e2b7a5916fc6f4926b77cf;hpb=b70398a7d5ac5f4ce64156d84227ccb4828c0615 diff --git a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java index d2d386a..9594013 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java +++ b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java @@ -1,5 +1,6 @@ package org.usfirst.frc.team3501.robot.commands.shooter; +import org.usfirst.frc.team3501.robot.Constants; import org.usfirst.frc.team3501.robot.Robot; import org.usfirst.frc.team3501.robot.subsystems.Shooter; @@ -33,6 +34,14 @@ public class RunIndexWheelContinuous extends Command { @Override protected void execute() { + if (timeSinceInitialized() % 0.5 <= 0.02) { + if (Shooter.getShooter().getPistonValue() == Constants.Shooter.LOW_GEAR) { + Shooter.getShooter().setHighGear(); + } else { + Shooter.getShooter().setLowGear(); + } + } + double shooterSpeed = shooter.getShooterRPM(); double targetShooterSpeed = shooter.getTargetShootingSpeed(); double threshold = shooter.getRPMThreshold(); @@ -53,7 +62,6 @@ public class RunIndexWheelContinuous extends Command { @Override protected boolean isFinished() { return false; - } }