Add functions to obtain the Y and Z axes of the coordinate system corresponding to a (normalized) quaternion.
Provide an alternative initialization function for the revolute-spherical joint.

Add more comprehensive comments.