Convert unit-quaternion to homogeneous transform
T = q2tr(Q)
Return the rotational homogeneous transform corresponding to the unit quaternion Q.