added dquat2rotmat.
drotmat2rpy, drotmat2quat.