From: maxwtan <100314265+MaxwellTTan20@users.noreply.github.com> Date: Fri, 20 Feb 2026 22:31:07 +0000 (-0800) Subject: s X-Git-Url: https://git.taranathan.com/?a=commitdiff_plain;h=faae2a7edaf4bc9b604c2fbd96758082809c76d3;p=FRC2026.git s --- diff --git a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java index 412b42a..140161a 100644 --- a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java +++ b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java @@ -123,14 +123,14 @@ public class LinearClimb extends SubsystemBase implements LinearClimbIO{ @Override public void periodic() { + double power = pid.calculate(motor.getPosition().getValueAsDouble()); // if it is not calibrating, do normal stuff if (!calibrating) { - double power = pid.calculate(motor.getPosition().getValueAsDouble()); power = MathUtil.clamp(power, -MAX_POWER, MAX_POWER); - motor.set(power); - } else { - motor.set(ClimbConstants.CALIBRATION_POWER); + } else{ + power = ClimbConstants.CALIBRATION_POWER; } + motor.set(power); Logger.recordOutput("LinearClimb/setpointMeters", Units.rotationsToRadians(pid.getSetpoint()) * ClimbConstants.WHEEL_RADIUS / ClimbConstants.CLIMB_GEAR_RATIO); } diff --git a/src/main/java/frc/robot/subsystems/Intake/Intake.java b/src/main/java/frc/robot/subsystems/Intake/Intake.java index 81db32c..21342f9 100644 --- a/src/main/java/frc/robot/subsystems/Intake/Intake.java +++ b/src/main/java/frc/robot/subsystems/Intake/Intake.java @@ -335,6 +335,10 @@ public class Intake extends SubsystemBase implements IntakeIO{ rollerMotor.close(); } + public void calibrate(){ + + } + @Override public void updateInputs() { inputs.leftPosition = rotationsToInches(leftMotor.getPosition().getValueAsDouble());