File tree Expand file tree Collapse file tree
Expand file tree Collapse file tree Original file line number Diff line number Diff 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 }
You can’t perform that action at this time.
0 commit comments