elevator retract on drive RT

Author: davidchen20

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

@@ -803,6 +803,7 @@ private void driverControls() {
         new InstantCommand(() -> shooter.stopFeeders(), shooter)
             .andThen(new InstantCommand(() -> led.setState(LED_STATE.BLUE)))
             .andThen(new SetPivotTarget(Constants.PivotConstants.STOW_SETPOINT_DEG, pivot))
+            .andThen(new SetElevatorTarget(Constants.ElevatorConstants.RETRACT_SETPOINT_INCH, Constants.ElevatorConstants.THRESHOLD, elevator))
             .andThen(new WaitCommand(0.5))
             .andThen(new InstantCommand(shooter::stopFlywheels))
             .andThen(new InstantCommand(() -> shooter.turnOffFan(), shooter)));