NamedCommands.registerCommand("Extend Intake", new InstantCommand(() -> {
intake.extend();
- System.out.println(
- "============================================================================================================================extending");
}));
NamedCommands.registerCommand("Retract Intake", new InstantCommand(() -> intake.retract()));
NamedCommands.registerCommand("Intermediate Extend", new InstantCommand(() -> intake.intermediateExtend()));
if (turret != null && drive != null && hood != null && shooter != null && spindexer != null) {
Command runSpindexer = new RunSpindexer(spindexer, turret);
NamedCommands.registerCommand("Auto shoot", new AutoShootCommand(turret, drive, hood, shooter, spindexer));
- NamedCommands.registerCommand("Auto shoot", new AutoShootCommand(turret, drive, hood, shooter, spindexer));
-
- NamedCommands.registerCommand("Start Spindexer", new InstantCommand(() -> CommandScheduler.getInstance().schedule(runSpindexer)));
+ NamedCommands.registerCommand("Start Spindexer",
+ new InstantCommand(() -> CommandScheduler.getInstance().schedule(runSpindexer)));
NamedCommands.registerCommand("Stop Spindexer", new InstantCommand(() -> runSpindexer.cancel()));
}
FieldConstants.getHubTranslation().minus(new Translation3d(drivepose.getTranslation())),
8.0); // Random initial goalState to prevent it being null
// Jerry Debug
- System.out.println("The current goal state (including the exit vel):" + goalState);
+ // System.out.println("The current goal state (including the exit vel):" + goalState);
addRequirements(turret);
}
if (jam_debouncer.calculate(jammed)) {
reversing = true;
reversing_debouncer.calculate(reversing);
- System.out.println("Reversing the spindexer for Anti-Jam");
+ // System.out.println("Reversing the spindexer for Anti-Jam");
}
if (!reversing) {
spindexer.maxSpindexer();