Fixed quaternion to yaw/pitch/roll conversion