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

Fixed an error with the conversion from quaternion to rpy.