Converts a quaternion to a rotation matrix
R = quaternion2rot_matrix(q)
quaternion2rot_matrix
converts a quaternion representation
of a rotation to the usual 3x3 matrix representation. This is important in robotics
as well as in inverse kinematic problems arising in 3D computer vision.
http://siptoolbox.sf.net