Fixed quaternion to rpy again
Renamed function
Merge pull request #15 from jannikb/master

Fixed an error with the conversion from quaternion to rpy.
Changed moveit: references to cl-tf2: for pose transformation functions
Merge branch 'master' of github.com:cram-code/cram_physics