diff --git a/src/main/java/frc4388/robot/subsystems/Climber.java b/src/main/java/frc4388/robot/subsystems/Climber.java index 74b8880..d9d006e 100644 --- a/src/main/java/frc4388/robot/subsystems/Climber.java +++ b/src/main/java/frc4388/robot/subsystems/Climber.java @@ -154,6 +154,8 @@ public class Climber extends SubsystemBase { double tiltAngle = m_groundRelative ? getRobotTilt() : 0.d; + System.out.println(getJointAngles(0, 0, 0)); + double[] jointAngles = getJointAngles(m_position[0], m_position[1], tiltAngle); setJointAngles(jointAngles); }