From 203c2a999a093fb5698000bdc2e7ffc9d045b13b Mon Sep 17 00:00:00 2001 From: maxwtan <100314265+MaxwellTTan20@users.noreply.github.com> Date: Sun, 15 Feb 2026 16:33:24 -0800 Subject: [PATCH] a --- src/main/java/frc/robot/constants/Climb/ClimbConstants.java | 6 +++--- src/main/java/frc/robot/subsystems/Climb/LinearClimb.java | 4 ++-- 2 files changed, 5 insertions(+), 5 deletions(-) diff --git a/src/main/java/frc/robot/constants/Climb/ClimbConstants.java b/src/main/java/frc/robot/constants/Climb/ClimbConstants.java index 328b1c7..295735d 100644 --- a/src/main/java/frc/robot/constants/Climb/ClimbConstants.java +++ b/src/main/java/frc/robot/constants/Climb/ClimbConstants.java @@ -8,8 +8,8 @@ public class ClimbConstants { public final static double MAX_ACCELERATION = 0.3; public final static double RADIUS = 0.3; public final static double CLIMB_HEIGHT = 4; - public final static double STRONG_CURRENT = 5.0; - public final static double WEAK_CURRENT = 4.0; + public final static double STRONG_CURRENT = 42.0; + public final static double WEAK_CURRENT = 7.0; public final static double OFFSET = 100.0; - public final static double CLIMB_OFFSET = 45.0; + public final static double CLIMB_OFFSET = 80.0; } diff --git a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java index 11e67c8..b893c41 100644 --- a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java +++ b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java @@ -86,7 +86,6 @@ public class LinearClimb extends SubsystemBase{ double power = pid.calculate(motor.getPosition().getValueAsDouble()); power = MathUtil.clamp(power, -0.2, 0.2); motor.set(power); - SmartDashboard.putNumber("Position", getPosition()); }else{ if(counter > 250){ stopCalibrating(); @@ -94,6 +93,7 @@ public class LinearClimb extends SubsystemBase{ motor.set(0.15); counter += 1; } + SmartDashboard.putNumber("Position", getPosition()); } public void setCurrentLimits(double limit){ TalonFXConfiguration config = new TalonFXConfiguration(); @@ -114,7 +114,7 @@ public class LinearClimb extends SubsystemBase{ setCurrentLimits(ClimbConstants.WEAK_CURRENT); } public void stopCalibrating(){ - downPosition = motor.getPosition().getValueAsDouble(); + downPosition = motor.getPosition().getValueAsDouble() - 1.0; upPosition = downPosition - ClimbConstants.OFFSET; climbPosition = upPosition + ClimbConstants.CLIMB_OFFSET; setSetpoint(downPosition); -- 2.39.5