Return rotational submatrix of a homogeneous transformation
R = t2r(T) is the orthonormal rotation matrix component of homogeneous transformation matrix T:
r2t, tr2rt, rt2tr
© 1990-2012 Peter Corke.