fix: manual elevator methods needs to check if the joystick is zero.

This commit is contained in:
Michael Mikovsky
2025-02-26 16:53:15 -07:00
parent b341acaa3d
commit d59e2f06da
@@ -32,6 +32,9 @@ public class Elevator extends SubsystemBase {
private double elevatorRefrence = 0; private double elevatorRefrence = 0;
private double endeffectorRefrence = 0; private double endeffectorRefrence = 0;
private boolean elevatorManualStop = true;
private boolean endefectorManualStop = true;
private DigitalInput basinBeamBreak; private DigitalInput basinBeamBreak;
private DigitalInput endeffectorLimitSwitch; private DigitalInput endeffectorLimitSwitch;
@@ -219,11 +222,23 @@ public class Elevator extends SubsystemBase {
} }
public void manualElevatorVel(double velocity) { public void manualElevatorVel(double velocity) {
elevatorMotor.set(velocity); if (Math.abs(velocity) > 0.1) {
elevatorMotor.set(velocity);
}
if (!elevatorManualStop) {
elevatorManualStop = true;
elevatorMotor.set(0);
}
} }
public void manualEndeffectorVel(double velocity) { public void manualEndeffectorVel(double velocity) {
endeffectorMotor.set(velocity); if (Math.abs(velocity) > 0.1) {
endeffectorMotor.set(velocity);
}
if (!endefectorManualStop) {
endefectorManualStop = true;
endeffectorMotor.set(0);
}
} }
@Override @Override
@@ -235,7 +250,7 @@ public class Elevator extends SubsystemBase {
SmartDashboard.putString("State", currentState.toString()); SmartDashboard.putString("State", currentState.toString());
if (currentState == CoordinationState.Waiting) { if (currentState == CoordinationState.Waiting) {
// periodicWaiting(); periodicWaiting();
} else if (currentState == CoordinationState.WatingBeamTripped) { } else if (currentState == CoordinationState.WatingBeamTripped) {
// periodicWaitingTripped(); // periodicWaitingTripped();
} else if (currentState == CoordinationState.Ready) { } else if (currentState == CoordinationState.Ready) {