coastCANTalons = new JoystickButton(rightJoystick,
Constants.OI.COAST_CANTALONS_PORT);
coastCANTalons.whenPressed(new CoastCANTalons());
-
}
public static OI getOI() {
+++ /dev/null
-package org.usfirst.frc.team3501.robot.commands.driving;
-
-import org.usfirst.frc.team3501.robot.Constants;
-import org.usfirst.frc.team3501.robot.Robot;
-import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
-import edu.wpi.first.wpilibj.command.Command;
-
-public class ToggleDrivePiston extends Command {
- private DriveTrain driveTrain = Robot.getDriveTrain();
-
- /**
- * See JavaDoc comment in class for details
- *
- * @param motorVal
- * value range from -1 to 1
- */
- public ToggleDrivePiston() {
- requires(driveTrain);
- }
-
- // Called just before this Command runs the first time
- @Override
- protected void initialize() {
- }
-
- // Called repeatedly when this Command is scheduled to run
- @Override
- protected void execute() {
- if (DriveTrain.getDriveTrain()
- .getLeftGearPistonValue() == Constants.DriveTrain.HIGH_GEAR) {
- DriveTrain.getDriveTrain().setLowGear();
- } else {
- DriveTrain.getDriveTrain().setHighGear();
- }
-
- // check to make sure that both pistons are set to the same gear. Otherwise,
- // the code must be changed
- }
-
- // Called once after isFinished returns true
- @Override
- protected void end() {
- }
-
- // Called when another command which requires one or more of the same
- // subsystems is scheduled to run
- @Override
- protected void interrupted() {
- end();
- }
-
- @Override
- protected boolean isFinished() {
- return false;
-
- }
-
-}
Value rightGearPistonValue = driveTrain.getRightGearPistonValue();
if (leftGearPistonValue == Constants.DriveTrain.LOW_GEAR) {
- driveTrain.setHighGear();
+ driveTrain.setHighGear(driveTrain.getLeftPiston());
} else {
- driveTrain.setLowGear();
+ driveTrain.setLowGear(driveTrain.getLeftPiston());
+ }
+
+ if (rightGearPistonValue == Constants.DriveTrain.LOW_GEAR) {
+ driveTrain.setHighGear(driveTrain.getRightPiston());
+ } else {
+ driveTrain.setLowGear(driveTrain.getRightPiston());
}
}
return rightGearPiston.get();
}
+ public DoubleSolenoid getLeftPiston() {
+ return this.leftGearPiston;
+ }
+
+ public DoubleSolenoid getRightPiston() {
+ return this.rightGearPiston;
+ }
+
/*
* Changes the ball shift gear assembly to high
*/
- public void setHighGear() {
- changeGear(Constants.DriveTrain.HIGH_GEAR);
+ public void setHighGear(DoubleSolenoid p) {
+ changeGear(Constants.DriveTrain.HIGH_GEAR, p);
}
/*
* Changes the ball shift gear assembly to low
*/
- public void setLowGear() {
- changeGear(Constants.DriveTrain.LOW_GEAR);
+ public void setLowGear(DoubleSolenoid p) {
+ changeGear(Constants.DriveTrain.LOW_GEAR, p);
}
/*
* Changes the gear to a DoubleSolenoid.Value
*/
- private void changeGear(DoubleSolenoid.Value gear) {
- leftGearPiston.set(gear);
- rightGearPiston.set(gear);
+ private void changeGear(DoubleSolenoid.Value gear, DoubleSolenoid piston) {
+ piston.set(gear);
}
@Override