fix big power draw when source intaking by defaulting to PID loop

2491-NoMythic · May 1, 2024 · 4f193cb · 4f193cb
1 parent b2207b4
commit 4f193cb
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/subsystems/ShooterSubsystem.java b/src/main/java/frc/robot/subsystems/ShooterSubsystem.java
@@ -203,6 +203,7 @@ private static int updateIsReving(int revState, double targetSpeed, double speed
     double revDownEn = -10;
     double revDownDis = 2;
     double difference = targetSpeed - speed;
+    SmartDashboard.putNumber("SHOOTER/desired speed difference", difference);
     if (difference>revUpEn){
       revState = 1;
     } else if (difference<revDownEn && targetSpeed<10){
@@ -220,6 +221,8 @@ private static void updateMotor(TalonFX shooterMotor, int revState, double targe
     shooterMotor.getConfigurator().apply(currentLimits);
     if(targetSpeed == 0) {
       shooterMotor.set(0);
+    } else if(targetSpeed<0) {
+      shooterMotor.setControl(new VelocityDutyCycle(targetSpeed).withSlot(0));
     } else if (revState != 0) {
       shooterMotor.set(revState);
     } else {