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=ca5f90d78262065dad305b8e5c7255f01bb4249f;hb=7ba6bc91b8cf7205e05cdb974dc80fdd668ebe59;hpb=d175e83e2bd58c3c0956ca1c28a88ccd5046f656 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 ca5f90d..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,60 +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 runs the fly wheel continuously when OI button managing fly - * wheel is pressed. The command will run the fly wheel motor 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, with * button.whileHeld(...). * - * @author Shaina + * @author Shaina & Chris */ public class RunFlyWheelContinuous extends Command { - private double motorVal; - - /** - * See JavaDoc comment in class for details - * - * @param motorVal - * value range from -1 to 1 - */ - public RunFlyWheelContinuous(double motorVal) { - this.motorVal = motorVal; + private Shooter shooter = Robot.getShooter(); + + private PIDController wheelController; + + public RunFlyWheelContinuous() { } - // Called just before this Command runs the first time @Override protected void initialize() { - Robot.getShooter().setFlyWheelMotorVal(motorVal); + 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(); } - }