diff --git a/src/main/java/competition/subsystems/shooter/ShooterSubsystem.java b/src/main/java/competition/subsystems/shooter/ShooterSubsystem.java index fc40a920..f225bf61 100644 --- a/src/main/java/competition/subsystems/shooter/ShooterSubsystem.java +++ b/src/main/java/competition/subsystems/shooter/ShooterSubsystem.java @@ -9,6 +9,7 @@ import xbot.common.command.SimpleWaitForMaintainerCommand; import xbot.common.controls.actuators.XCANMotorController; import xbot.common.controls.actuators.XCANMotorControllerPIDProperties; +import xbot.common.properties.AngularVelocityProperty; import xbot.common.properties.DoubleProperty; import xbot.common.properties.PropertyFactory; import xbot.common.resiliency.DeviceHealth; @@ -20,8 +21,6 @@ import java.util.List; import static edu.wpi.first.units.Units.RPM; -import static edu.wpi.first.units.Units.Rotations; -import static edu.wpi.first.units.Units.RotationsPerSecond; import static edu.wpi.first.units.Units.Seconds; @Singleton @@ -40,6 +39,8 @@ public class ShooterSubsystem extends BaseSetpointSubsystem !healthyMotors.contains(motor) + && motor.getHealth() == DeviceHealth.Healthy) + .toList(); + for (var motor : otherMotors) { + motor.setVelocityTarget(lowPowerModeVelocity.get()); + } + } } public boolean isReadyToFire() {