From: Taran Nathan Date: Sun, 3 May 2026 23:14:23 +0000 (-0500) Subject: add right dynamic X-Git-Url: https://git.taranathan.com/?a=commitdiff_plain;h=9033b14437cb2a8b4de2e67aa241014365664f61;p=FRC2026.git add right dynamic --- diff --git a/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java b/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java index 8216f71..ae84a9a 100644 --- a/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java +++ b/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java @@ -295,4 +295,33 @@ public class ChoreoPathCommandBuilder { return routine; } + + public AutoRoutine rightSuperShuttling(AutoFactory factory) { + AutoRoutine routine = factory.newRoutine("rightSuperShuttling"); + + AutoTrajectory shuttlingTrajectory = routine.trajectory("superShuttling").mirrorY(); + + routine.active().onTrue(Commands.sequence( + shuttlingTrajectory.resetOdometry(), + new InstantCommand(() -> { + intake.extend(); + intake.spinStart(); + }), + shuttlingTrajectory.cmd())); + + shuttlingTrajectory.done().onTrue(Commands.sequence( + new InstantCommand(() -> { + hood.forceHoodDown(false); + }), + new RunSpindexerWithStop(spindexer, turret, hood, intake).raceWith(new IntakeMovementCommand(intake)), + new InstantCommand(() -> { + intake.extend(); + intake.spinStart(); + hood.forceHoodDown(true); + }), + shuttlingTrajectory.cmd())); + + return routine; + + } }