is it really AUTOPILOT_YAW_THRESHOLD ? it is a bit confusing even if it works