@@ -837,24 +837,24 @@ private void driverControls() {
837837 driveAButton .onTrue (climbCommands );
838838
839839 driveXButton .onTrue (trapCommands );
840- driveController
841- .b ()
842- .onTrue (
843- new InstantCommand (() -> pivot .setShootState (SHOOT_STATE .AMP ))
844- .andThen (new ScoreAmp (elevator , pivot , shooter , drive )));
840+ // driveController
841+ // .b()
842+ // .onTrue(
843+ // new InstantCommand(() -> pivot.setShootState(SHOOT_STATE.AMP))
844+ // .andThen(new ScoreAmp(elevator, pivot, shooter, drive)));
845845
846- driveController
847- .b ()
848- .onFalse (
849- new InstantCommand (() -> pivot .setShootState (SHOOT_STATE .AIMBOT ))
850- .andThen (
851- new SequentialCommandGroup (
852- new SetAmpBarTarget (5 , 3 , elevator ),
853- new InstantCommand (() -> shooter .turnOffFan ()),
854- new SetElevatorTarget (0 , 0.5 , elevator ),
855- new InstantCommand (() -> elevator .setConstraints (30 , 85 )),
856- new InstantCommand (() -> shooter .stopFlywheels (), shooter ),
857- new SetPivotTarget (Constants .PivotConstants .STOW_SETPOINT_DEG , pivot ))));
846+ // driveController
847+ // .b()
848+ // .onFalse(
849+ // new InstantCommand(() -> pivot.setShootState(SHOOT_STATE.AIMBOT))
850+ // .andThen(
851+ // new SequentialCommandGroup(
852+ // new SetAmpBarTarget(5, 3, elevator),
853+ // new InstantCommand(() -> shooter.turnOffFan()),
854+ // new SetElevatorTarget(0, 0.5, elevator),
855+ // new InstantCommand(() -> elevator.setConstraints(30, 85)),
856+ // new InstantCommand(() -> shooter.stopFlywheels(), shooter),
857+ // new SetPivotTarget(Constants.PivotConstants.STOW_SETPOINT_DEG, pivot))));
858858 // driveController
859859 // .rightBumper()
860860 // .whileTrue(
@@ -911,6 +911,7 @@ private void manipControls() {
911911 new InstantCommand (() -> pivot .setShootState (SHOOT_STATE .AIMBOT ))
912912 .andThen (
913913 new SequentialCommandGroup (
914+ new SetAmpBarTarget (5 , 3 , elevator ),
914915 new InstantCommand (() -> shooter .turnOffFan ()),
915916 new SetElevatorTarget (0 , 0.5 , elevator ),
916917 new InstantCommand (() -> elevator .setConstraints (30 , 85 )),
0 commit comments