}),
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()));