Drake geometry util additions

Added rotation conversion functions + test. Moved angleDiff to drakeGeometryUtil.
can we make these available on the matlab side, too?