Consistent Jacobian and its derivatives of BallJoint and FreeJoint