X-Git-Url: http://challenge-bot.com/repos/?p=3501%2F2017steamworks;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fshooter%2FRunFlyWheelContinuous.java;h=86c31f7eecd523ebc2a274a6b4d1d58bb74d45ed;hp=646dc56d41be28562bffee314fdc4c0da8ab1535;hb=7ba6bc91b8cf7205e05cdb974dc80fdd668ebe59;hpb=89a76b334a8120e5a5000a5eab6b76f7f4ae31c0 diff --git a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunFlyWheelContinuous.java b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunFlyWheelContinuous.java index 646dc56..86c31f7 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunFlyWheelContinuous.java +++ b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunFlyWheelContinuous.java @@ -1,49 +1,53 @@ package org.usfirst.frc.team3501.robot.commands.shooter; +import org.usfirst.frc.team3501.robot.Robot; +import org.usfirst.frc.team3501.robot.subsystems.Shooter; +import org.usfirst.frc.team3501.robot.utils.PIDController; + import edu.wpi.first.wpilibj.command.Command; /** - * This command will run the fly wheel motor continuously until the button - * triggering it is released. + * This command runs the fly wheel continuously at a set speed using a PID + * Controller when OI button managing fly wheel is pressed. The command will run + * the fly wheel motor until the button triggering it is released. + * + * Should only be run from the operator interface. * - * pre-condition: This command must be run by a button in OI. + * pre-condition: This command must be run by a button in OI, with + * button.whileHeld(...). * - * @param motorVal - * [-1,1] - * @author shaina + * @author Shaina & Chris */ public class RunFlyWheelContinuous extends Command { - private double motorVal; + private Shooter shooter = Robot.getShooter(); - public RunFlyWheelContinuous(double motorVal) { - this.motorVal = motorVal; + private PIDController wheelController; + + public RunFlyWheelContinuous() { } - // Called just before this Command runs the first time @Override protected void initialize() { + shooter.initializePIDController(); } - // Called repeatedly when this Command is scheduled to run @Override protected void execute() { + shooter.setFlyWheelMotorVal(shooter.calculateShooterSpeed()); } - // Called once after isFinished returns true @Override - protected void end() { + protected boolean isFinished() { + return false; } - // Called when another command which requires one or more of the same - // subsystems is scheduled to run @Override - protected void interrupted() { - end(); + protected void end() { + this.shooter.stopFlyWheel(); } @Override - protected boolean isFinished() { - return false; + protected void interrupted() { + end(); } - }