Commit | Line | Data |
---|---|---|
e7bf265c RR |
1 | package org.usfirst.frc.team3501.robot.commands.climber; |
2 | ||
3 | import org.usfirst.frc.team3501.robot.Robot; | |
4 | import org.usfirst.frc.team3501.robot.subsystems.DriveTrain; | |
5 | ||
6 | import edu.wpi.first.wpilibj.command.Command; | |
7 | ||
8 | /** | |
9 | * | |
10 | */ | |
11 | public class TestToggleWinch extends Command { | |
12 | DriveTrain driveTrain = Robot.getDriveTrain(); | |
13 | boolean isRunning = driveTrain.shouldBeClimbing; | |
14 | ||
15 | public TestToggleWinch() { | |
16 | requires(driveTrain); | |
17 | } | |
18 | ||
19 | @Override | |
20 | protected void initialize() { | |
21 | ||
22 | } | |
23 | ||
24 | @Override | |
25 | protected void execute() { | |
26 | if (driveTrain.shouldBeClimbing) { | |
27 | driveTrain.shouldBeClimbing = false; | |
28 | System.out.println("Ending Toggle Winch"); | |
29 | } else { | |
30 | driveTrain.shouldBeClimbing = true; | |
31 | System.out.println("Running Toggle Winch"); | |
32 | } | |
33 | ||
34 | } | |
35 | ||
36 | @Override | |
37 | protected boolean isFinished() { | |
38 | return true; | |
39 | } | |
40 | ||
41 | @Override | |
42 | protected void end() { | |
43 | ||
44 | } | |
45 | ||
46 | @Override | |
47 | protected void interrupted() { | |
48 | end(); | |
49 | } | |
50 | } |