Skip to content

Commit a27dbc5

Browse files
a is yeet
1 parent 8f6729a commit a27dbc5

1 file changed

Lines changed: 14 additions & 0 deletions

File tree

src/main/java/frc/robot/RobotContainer.java

Lines changed: 14 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -600,6 +600,20 @@ private void demoControls() {
600600
new InstantCommand(() -> led.setState(LED_STATE.BLUE))
601601
.andThen(new InstantCommand(() -> shooter.stopFlywheels()))
602602
.andThen(new SetPivotTarget(Constants.PivotConstants.STOW_SETPOINT_DEG, pivot)));
603+
604+
driveController
605+
.a()
606+
.onTrue(
607+
new SequentialCommandGroup(
608+
new InstantCommand(() -> pivot.setShootState(SHOOT_STATE.PIVOT_PRESET)),
609+
new SetPivotTarget(45, pivot),
610+
new InstantCommand(() -> shooter.setFlywheelRPMs(5600, 6000))));
611+
driveController
612+
.a()
613+
.onFalse(
614+
new InstantCommand(() -> led.setState(LED_STATE.BLUE))
615+
.andThen(new InstantCommand(() -> shooter.stopFlywheels()))
616+
.andThen(new SetPivotTarget(Constants.PivotConstants.STOW_SETPOINT_DEG, pivot)));
603617

604618
driveController.back().onTrue(new SetPivotTarget(95, pivot));
605619
}

0 commit comments

Comments
 (0)