Corrected handling of azimuth, roll and pitch