]> git.taranathan.com Git - FRC2026.git/commitdiff
add dynamic to super shuttling
authorTaran Nathan <moogoesmeow123@gmail.com>
Sun, 3 May 2026 23:11:35 +0000 (18:11 -0500)
committerTaran Nathan <moogoesmeow123@gmail.com>
Sun, 3 May 2026 23:53:03 +0000 (18:53 -0500)
src/main/java/frc/robot/commands/auto_comm/ChoreoPathCommandBuilder.java

index 9485c0249579e3b329e2a4221aecbca3ab02c33c..8216f71ca0c349c7996696f290a160f37d71f4de 100644 (file)
@@ -280,20 +280,15 @@ public class ChoreoPathCommandBuilder {
         }),
         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(),
+    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()));