Test print lines

This commit is contained in:
66945
2022-01-22 13:21:31 -07:00
parent 7386912b13
commit e0c4bb479b
@@ -154,6 +154,8 @@ public class Climber extends SubsystemBase {
double tiltAngle = m_groundRelative ? getRobotTilt() : 0.d; double tiltAngle = m_groundRelative ? getRobotTilt() : 0.d;
System.out.println(getJointAngles(0, 0, 0));
double[] jointAngles = getJointAngles(m_position[0], m_position[1], tiltAngle); double[] jointAngles = getJointAngles(m_position[0], m_position[1], tiltAngle);
setJointAngles(jointAngles); setJointAngles(jointAngles);
} }