From: maxwtan <100314265+MaxwellTTan20@users.noreply.github.com> Date: Wed, 18 Feb 2026 20:43:18 +0000 (-0800) Subject: fix stuff X-Git-Url: https://git.taranathan.com/?a=commitdiff_plain;h=3d0fc38f205ea78aeaa8399e166ca63f4746a759;p=FRC2026.git fix stuff --- diff --git a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java index c5e86ee..000b3d2 100644 --- a/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java +++ b/src/main/java/frc/robot/subsystems/Climb/LinearClimb.java @@ -1,5 +1,7 @@ package frc.robot.subsystems.Climb; +import org.littletonrobotics.junction.Logger; + import com.ctre.phoenix6.configs.CurrentLimitsConfigs; import com.ctre.phoenix6.configs.TalonFXConfiguration; import com.ctre.phoenix6.hardware.TalonFX; @@ -118,7 +120,8 @@ public class LinearClimb extends SubsystemBase implements LinearClimbIO{ } else { motor.set(ClimbConstants.CALIBRATION_POWER); } - SmartDashboard.putNumber("Position", getPosition()); + + Logger.recordOutput("LinearClimb/setpointMeters", Units.rotationsToRadians(pid.getSetpoint()) * ClimbConstants.WHEEL_RADIUS / ClimbConstants.CLIMB_GEAR_RATIO); } /** * sets supply and stator current limits @@ -147,7 +150,7 @@ public class LinearClimb extends SubsystemBase implements LinearClimbIO{ * stops calibration and sets current limits to normal. */ public void stopCalibrating() { - motor.setPosition(downPosition); + motor.setPosition((Units.radiansToRotations(downPosition / ClimbConstants.WHEEL_RADIUS)) * ClimbConstants.CLIMB_GEAR_RATIO); calibrating = false; setCurrentLimits(ClimbConstants.CLIMB_CURRENT); }