Drake geometry util additions

Added rotation conversion functions + test. Moved angleDiff to drakeGeometryUtil.
It's a uniformly random orientation, represented as rpy. This is not the same as 'randn(3, 1)'. What do you think would be a better name?