import edu.wpi.first.wpilibj2.command.ParallelCommandGroup;
import frc.robot.commands.DoNothing;
import frc.robot.commands.LogCommand;
-import frc.robot.commands.Music;
import frc.robot.commands.auto_comm.DynamicAutoBuilder;
import frc.robot.commands.drive_comm.DefaultDriveCommand;
import frc.robot.commands.gpm.IntakeMovementCommand;
hood.forceHoodDown(false);
}));
}
+
+ NamedCommands.registerCommand("After Depot", new InstantCommand());
+ NamedCommands.registerCommand("Constraints Zone", new InstantCommand());
+ NamedCommands.registerCommand("Depot", new InstantCommand());
+ NamedCommands.registerCommand("Reset Spindexer", new InstantCommand());
}
public void addAuto(String name) {
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.constants.Constants;
-import frc.robot.subsystems.spindexer.Spindexer;
import frc.robot.util.Elastic;
import frc.robot.util.HubActive;
import frc.robot.util.Elastic.Notification;
@Override
public void execute() {
+ if (Constants.DISABLE_LOGGING) {
+ return;
+ }
+
boolean current = HubActive.isHubActive();
Logger.recordOutput("HubActive", current);
package frc.robot.commands.auto_comm;
-import edu.wpi.first.math.geometry.Translation2d;
-import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj2.command.*;
-import frc.robot.commands.gpm.IntakeCommand;
-import frc.robot.commands.gpm.RunSpindexer;
import frc.robot.commands.gpm.RunSpindexerWithStop;
import frc.robot.subsystems.Intake.Intake;
-import frc.robot.subsystems.PowerControl.BreakerConstants;
-import frc.robot.subsystems.PowerControl.EMABreaker;
import frc.robot.subsystems.drivetrain.Drivetrain;
import frc.robot.subsystems.hood.Hood;
import frc.robot.subsystems.spindexer.Spindexer;
import org.littletonrobotics.junction.Logger;
-import com.pathplanner.lib.auto.NamedCommands;
-
import edu.wpi.first.math.filter.Debouncer;
import edu.wpi.first.math.filter.Debouncer.DebounceType;
-import edu.wpi.first.units.measure.Time;
import edu.wpi.first.wpilibj.Timer;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj2.command.Command;
-import edu.wpi.first.wpilibj2.command.CommandScheduler;
-import edu.wpi.first.wpilibj2.command.InstantCommand;
import frc.robot.constants.Constants;
import frc.robot.subsystems.Intake.Intake;
import frc.robot.subsystems.Intake.IntakeConstants;
import frc.robot.commands.gpm.IntakeMovementCommand;
import frc.robot.commands.gpm.ReverseMotors;
import frc.robot.commands.gpm.RunSpindexer;
-import frc.robot.commands.gpm.RunSpindexerWithStop;
import frc.robot.commands.gpm.Superstructure;
import frc.robot.constants.Constants;
import frc.robot.subsystems.Intake.Intake;
if (file.isFile() && file.getName().contains(".")) {
try {
long startTime = System.nanoTime();
- String name = file.getName().substring(0, file.getName().indexOf("."));
+ String name = file.getName().substring(0, file.getName().lastIndexOf("."));
// pathGroups.put(name, PathPlannerAuto.getPathGroupFromAutoFile(name));
pathGroups.put(name, PathPlannerPath.fromPathFile(name));
double time = (System.nanoTime() - startTime) / 1000000.0;