1 package org
.usfirst
.frc
.team3501
.robot
.commands
.driving
;
3 import org
.usfirst
.frc
.team3501
.robot
.Constants
;
4 import org
.usfirst
.frc
.team3501
.robot
.Robot
;
5 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.DriveTrain
;
7 import edu
.wpi
.first
.wpilibj
.DoubleSolenoid
.Value
;
8 import edu
.wpi
.first
.wpilibj
.command
.Command
;
11 * This command toggles the gear(low or high).
13 * post-condition: if the drivetrain is running at high gear, it will be made to
14 * run at low gear, and vice versa
16 public class ToggleGear
extends Command
{
17 DriveTrain driveTrain
= Robot
.getDriveTrain();
24 protected void initialize() {
29 protected void execute() {
30 Value leftGearPistonValue
= driveTrain
.getLeftGearPistonValue();
31 Value rightGearPistonValue
= driveTrain
.getRightGearPistonValue();
32 if (leftGearPistonValue
== Constants
.DriveTrain
.LOW_GEAR
) {
33 driveTrain
.setHighGear();
35 driveTrain
.setLowGear();
40 protected boolean isFinished() {
45 protected void end() {
49 protected void interrupted() {