Commit | Line | Data |
---|---|---|
9738295a SG |
1 | package org.usfirst.frc.team3501.robot.commands.climber; |
2 | ||
6a363924 SG |
3 | import org.usfirst.frc.team3501.robot.Robot; |
4 | ||
43980ce1 | 5 | import edu.wpi.first.wpilibj.Timer; |
9738295a SG |
6 | import edu.wpi.first.wpilibj.command.Command; |
7 | ||
8 | /** | |
e2e9a7a7 SG |
9 | * This command runs the winch at a specified speed and time in seconds when the |
10 | * button triggering it is pressed. | |
11 | * | |
12 | * pre-condition: This command is run by a button in OI. The robot must be | |
13 | * attached to the rope. | |
14 | * | |
15 | * post-condition: Winch motor set to a specified speed for a specified time. | |
9738295a | 16 | * |
de8c65d3 SG |
17 | * @param motorVal |
18 | * value range is from -1 to 1 | |
19 | * @param time | |
20 | * in seconds | |
9738295a SG |
21 | * @author shivanighanta |
22 | * | |
23 | */ | |
ad877a7e | 24 | |
9738295a | 25 | public class RunWinch extends Command { |
6a363924 | 26 | Timer timer; |
9738295a SG |
27 | private double time; |
28 | private double motorVal; | |
29 | ||
ad877a7e SG |
30 | /** |
31 | * | |
32 | * @author shivanighanta | |
33 | * | |
34 | */ | |
9738295a | 35 | public RunWinch(double time, double motorVal) { |
6a363924 | 36 | requires(Robot.getClimber()); |
9738295a SG |
37 | this.time = time; |
38 | this.motorVal = motorVal; | |
39 | } | |
40 | ||
41 | @Override | |
42 | protected void initialize() { | |
6a363924 | 43 | timer.start(); |
cf086549 | 44 | Robot.getClimber().setMotorValue(motorVal); |
9738295a SG |
45 | } |
46 | ||
47 | @Override | |
48 | protected void execute() { | |
49 | ||
50 | } | |
51 | ||
52 | @Override | |
53 | protected boolean isFinished() { | |
6a363924 | 54 | return timer.get() >= time; |
9738295a SG |
55 | } |
56 | ||
57 | @Override | |
58 | protected void end() { | |
6a363924 | 59 | Robot.getClimber().stop(); |
9738295a SG |
60 | } |
61 | ||
62 | @Override | |
63 | protected void interrupted() { | |
6a363924 | 64 | end(); |
9738295a SG |
65 | } |
66 | } |