1 package org
.usfirst
.frc
.team3501
.robot
.commands
.climber
;
3 import org
.usfirst
.frc
.team3501
.robot
.Robot
;
4 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.DriveTrain
;
6 import edu
.wpi
.first
.wpilibj
.command
.Command
;
11 public class TestToggleWinch
extends Command
{
12 DriveTrain driveTrain
= Robot
.getDriveTrain();
13 boolean isRunning
= driveTrain
.shouldBeClimbing
;
15 public TestToggleWinch() {
20 protected void initialize() {
25 protected void execute() {
26 if (driveTrain
.shouldBeClimbing
) {
27 driveTrain
.shouldBeClimbing
= false;
28 System
.out
.println("Ending Toggle Winch");
30 driveTrain
.shouldBeClimbing
= true;
31 System
.out
.println("Running Toggle Winch");
37 protected boolean isFinished() {
42 protected void end() {
47 protected void interrupted() {