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
.Climber
;
6 import edu
.wpi
.first
.wpilibj
.command
.Command
;
8 public class ToggleWinch
extends Command
{
9 Climber climber
= Robot
.getClimber();
10 private double climbingSpeed
;
12 public ToggleWinch() {
14 climbingSpeed
= climber
.CLIMBER_SPEED
;
18 protected void initialize() {
22 protected void execute() {
23 if (climber
.shouldBeClimbing
) {
24 climber
.setCANTalonsBrakeMode(climber
.COAST_MODE
);
25 climber
.setMotorValues(climbingSpeed
);
27 climber
.setCANTalonsBrakeMode(climber
.BRAKE_MODE
);
29 /* Not sure if should have */
36 protected boolean isFinished() {
41 protected void end() {
42 climber
.shouldBeClimbing
= !climber
.shouldBeClimbing
;
46 protected void interrupted() {