diff --git a/src/main/java/frc/robot/subsystems/climb/ClimbArm.java b/src/main/java/frc/robot/subsystems/climb/ClimbArm.java index 356d14da..ba3bb542 100644 --- 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); }