From 9033b14437cb2a8b4de2e67aa241014365664f61 Mon Sep 17 00:00:00 2001 From: Taran Nathan Date: Sun, 3 May 2026 18:14:23 -0500 Subject: [PATCH] add right dynamic --- .../auto_comm/ChoreoPathCommandBuilder.java | 29 +++++++++++++++++++ 1 file changed, 29 insertions(+) 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; + + } } -- 2.39.5