Add module position sanity checks

This commit is contained in:
2026-01-31 13:54:12 -05:00
parent 359a9a6bbb
commit c5df269a49
3 changed files with 35 additions and 1 deletions

View File

@@ -134,6 +134,35 @@ public class Drivetrain extends SubsystemBase {
Logger.recordOutput("Drivetrain/Heading", getHeading());
}
public Command runFrontLeft() {
return run(() -> {
frontLeft.setDesiredState(new SwerveModuleState(
1,
new Rotation2d()));
});
}
public Command runFrontRight() {
return run(() -> {
frontRight.setDesiredState(new SwerveModuleState(
1,
new Rotation2d()));
});
}
public Command runRearLeft() {
return run(() -> {
rearLeft.setDesiredState(new SwerveModuleState(
1,
new Rotation2d()));
});
}
public Command runRearRight() {
return run(() -> {
rearRight.setDesiredState(new SwerveModuleState(
1,
new Rotation2d()));
});
}
public Command disableOutputs() {
return run(() -> {
frontLeft.disableOutput();