From f0cbaa4b26a40214e80a2743e963d3fd74368f4d Mon Sep 17 00:00:00 2001 From: Taran Nathan Date: Sun, 3 May 2026 18:09:35 -0500 Subject: [PATCH] super shuttling code super shuttling right --- .../auto_comm/ChoreoPathCommandBuilder.java | 35 ++++++++++++++++++- 1 file changed, 34 insertions(+), 1 deletion(-) 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 ae39311..9485c02 100644 --- a/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java +++ b/src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java @@ -111,7 +111,6 @@ public class ChoreoPathCommandBuilder { } - public AutoRoutine leftConservative(AutoFactory factory) { AutoRoutine routine = factory.newRoutine("leftConservative"); @@ -267,4 +266,38 @@ public class ChoreoPathCommandBuilder { return routine; } + + public AutoRoutine leftSuperShuttling(AutoFactory factory) { + AutoRoutine routine = factory.newRoutine("leftSuperShuttling"); + + AutoTrajectory shuttlingTrajectory = routine.trajectory("superShuttling"); + + routine.active().onTrue(Commands.sequence( + shuttlingTrajectory.resetOdometry(), + new InstantCommand(() -> { + intake.extend(); + intake.spinStart(); + }), + shuttlingTrajectory.cmd())); + + 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())); + + return routine; + + } } -- 2.39.5