AP_AHRS: Scheduling for yaw gain to reduce atitude errors in turning flight