From e0c4bb479be123451ff6a2bc601103ea708a7d1b Mon Sep 17 00:00:00 2001 From: 66945 <66945@psdschools.org> Date: Sat, 22 Jan 2022 13:21:31 -0700 Subject: [PATCH] Test print lines --- src/main/java/frc4388/robot/subsystems/Climber.java | 2 ++ 1 file changed, 2 insertions(+) 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); }