Commit | Line | Data |
---|---|---|
7a25a687 E |
1 | package org.usfirst.frc3501.RiceCatRobot.commands; |
2 | ||
17f99e2c | 3 | import org.usfirst.frc3501.RiceCatRobot.Robot; |
7a25a687 E |
4 | |
5 | import edu.wpi.first.wpilibj.command.Command; | |
6 | ||
7 | public class MoveArmToLevel1 extends Command { | |
17f99e2c | 8 | |
7a25a687 E |
9 | double slowSpeed = 0.2; |
10 | ||
11 | public MoveArmToLevel1() { | |
17f99e2c | 12 | Robot.arm.setArmSpeeds(slowSpeed); |
7a25a687 E |
13 | } |
14 | ||
15 | protected void initialize() { | |
17f99e2c | 16 | Robot.arm.initializeCounters(); |
7a25a687 E |
17 | } |
18 | ||
19 | protected void execute() { | |
20 | } | |
21 | ||
22 | protected boolean isFinished() { | |
17f99e2c | 23 | return Robot.arm.isSwitch1Hit(); |
7a25a687 E |
24 | } |
25 | ||
26 | protected void end() { | |
27 | System.out.println("Robot arm has reached level 1"); | |
28 | } | |
29 | ||
30 | protected void interrupted() { | |
31 | end(); | |
32 | } | |
33 | } |