add end() in interrupted in scaler methods and make sure constants go in the right...
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / scaler / ClampBar.java
1 package org.usfirst.frc.team3501.robot.commands.scaler;
2
3 import org.usfirst.frc.team3501.robot.Constants;
4 import org.usfirst.frc.team3501.robot.Robot;
5
6 import edu.wpi.first.wpilibj.command.Command;
7
8 public class ClampBar extends Command {
9 private double speed = 0;
10
11 public ClampBar(double speed) {
12 this.speed = speed;
13 }
14
15 @Override
16 protected void initialize() {
17 setTimeout(Constants.Scaler.SECONDS_TO_CLAMP);
18 Robot.scaler.runWinch(this.speed);
19 }
20
21 @Override
22 protected void execute() {
23 }
24
25 @Override
26 protected boolean isFinished() {
27 return isTimedOut();
28 }
29
30 @Override
31 protected void end() {
32 Robot.scaler.runWinch(0);
33 }
34
35 @Override
36 protected void interrupted() {
37 end();
38 }
39 }