PathGroupLoader.loadPathGroups();
// Load the auto command
try {
- String leftSideAuto = "Left(No SOTM) - Under Trench";
- String rightSideAuto = "Right(2) - Under Trench";
+ //String leftSideAuto = "Left(No SOTM) - Under Trench";
+ //String rightSideAuto = "Right(2) - Under Trench";
String testing = "Straight Test";
PathPlannerAuto.getPathGroupFromAutoFile(testing);
auto = new PathPlannerAuto(testing);
NamedCommands.registerCommand("Start Intake Seizure", new InstantCommand(()-> intakeMovement.schedule()));
NamedCommands.registerCommand("Stop Intake Seizure", new InstantCommand(()-> intakeMovement.cancel()));
-
}
if (turret != null && drive != null && hood != null && shooter != null && spindexer != null){
public class RunSpindexer extends Command {
private Spindexer spindexer;
- public RunSpindexer(Spindexer spindexer){
+ private Turret turret;
+ private boolean spindexerOn;
+ public RunSpindexer(Spindexer spindexer, Turret turret){
this.spindexer = spindexer;
-
+ this.turret = turret;
+ this.spindexerOn = false;
addRequirements(spindexer);
}
@Override
public void execute() {
- if (turret.atSetpoint()){
+ if (turret.atSetpoint()) {
spindexer.maxSpindexer();
- } else{
- spindexer.stopSpindexer();
+ } else {
+ spindexer.stopSpindexer();
}
}
}
}
- public static FieldZone getWorkingZone(Translation2d drivepose) {
- double x = drivepose.getX();
- double y = drivepose.getY();
- Alliance alliance = Robot.getAlliance();
-
-
- }
-
/**
*
* @return Whether Y coordinate is in the upper half (left side on blue alliance)
controller.get(PS5Button.LEFT_TRIGGER).onTrue(new InstantCommand(() -> {
if (spindexerBoolean) {
spindexer.maxSpindexer();
- intakeBoolean = false;
+ spindexerBoolean = false;
} else {
spindexer.stopSpindexer();
- intakeBoolean = true;
+ spindexerBoolean = true;
}
}));
}