constant climb speed

grt192 · Jan 31, 2024 · 70e4020 · 70e4020
1 parent f823890
commit 70e4020
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/src/main/java/frc/robot/subsystems/climb/ClimbArm.java b/src/main/java/frc/robot/subsystems/climb/ClimbArm.java
@@ -47,7 +47,8 @@ public void update() {
         if (isAtExtension())
             winchMotor.set(0);
         else
-            winchMotor.set(MathUtil.clamp(desiredExtension - extensionEncoder.getPosition() , -MAX_WINCH_POWER, MAX_WINCH_POWER));
+            winchMotor.set(desiredExtension > extensionEncoder.getPosition()
+                ? MAX_WINCH_POWER : -MAX_WINCH_POWER);
 
     }