void updateJointAngle() { // Set joint pos jointAngle = Helpers.Math.normalizeAngle(joint.getActiveAngle()); }