function getJointAngle( joint_id)

Returns the current joint angle

Used with