Test print lines

2026-06-09 08:48:07 -06:00 · 2022-01-22 13:21:31 -07:00
parent 7386912b13
commit e0c4bb479b
1 changed files with 2 additions and 0 deletions
@@ -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);
  }