Quaternion to Heading, Pitch, and Roll Matlab tool