X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fshooter%2FRunIndexWheelContinuous.java;h=1bf1309583fd06a0e5553ce95a2f1ac800d34094;hb=82fa994f28297c05b15018003f4d0094d303f280;hp=815577e24d63cfde14158f23d4d66400b75a636e;hpb=f56e6ebf87134eccc3b8bb0e1d2529bd6cb061dd;p=3501%2F2017steamworks 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 815577e..1bf1309 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() % 1 == 0) { + 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();