Robot Reveal

This commit is contained in:
C4llSiqn
2025-02-21 16:54:18 -07:00
parent c5c6dd2eed
commit c9a947d3b8
6 changed files with 47 additions and 8 deletions
@@ -130,6 +130,18 @@ public class Elevator extends SubsystemBase {
break;
}
case BallRemoverL2Primed: {
PIDPosition(elevatorMotor, ElevatorConstants.WAITING_POSITION_ELEVATOR);
PIDPosition(endefectorMotor, ElevatorConstants.COMPLETLY_MIDDLE_ENDEFECTOR);
break;
}
case BallRemoverL2Go: {
PIDPosition(elevatorMotor, ElevatorConstants.WAITING_POSITION_ELEVATOR);
PIDPosition(endefectorMotor, ElevatorConstants.DEALGAE_L2_EENDEFECTOR);
break;
}
default: {
assert false;
}
@@ -304,8 +304,9 @@ public class SwerveDrive extends Subsystem {
}
public void stopModules() {
stopped = true;
swerveDriveTrain.setControl(new SwerveRequest.SwerveDriveBrake());
// stopped = true;
// swerveDriveTrain.setControl(new SwerveRequest.SwerveDriveBrake());
softStop();
}
@Override