- toggleScalingMode = new DigitalButton(
- new DigitalInput(Constants.OI.SCALING_BUTTON_PORT));
-
- passPortcullis.whenPressed(new PassPortcullis());
- passChevalDeFrise.whenPressed(new PassChevalDeFrise());
- passDrawbridge.whenPressed(new PassDrawBridge());
- passSallyPort.whenPressed(new PassSallyPort());
-
- lowerChevalDeFrise.whenPressed(new MoveIntakeArmToAngle(
- IntakeArm.potAngles[0], IntakeArm.moveIntakeArmSpeed));
- moveToIntakeBoulder.whenPressed(new MoveIntakeArmToAngle(
- IntakeArm.potAngles[1], IntakeArm.moveIntakeArmSpeed));
- poiseAboveChevalDeFrise.whenPressed(new MoveIntakeArmToAngle(
- IntakeArm.potAngles[2], IntakeArm.moveIntakeArmSpeed));
- moveIntakeArmInsideRobot.whenPressed(new MoveIntakeArmToAngle(
- IntakeArm.potAngles[3], IntakeArm.moveIntakeArmSpeed));
-
- if (toggleScalingMode.get()) {
- if (!isScalingMode) {
- isScalingMode = true;
- if (!isCompactRobot) {
- Scheduler.getInstance().add(new CompactRobot());
- isCompactRobot = true;
- }
- } else if (isScalingMode) {
- isScalingMode = false;
- Scheduler.getInstance().add(new CompactRobot());
- }
- }
+ toggleScaling = new DigitalButton(
+ new DigitalInput(Constants.OI.TOGGLE_SCALING_PORT));
+ toggleScaling.whenPressed(new ToggleScaling());