AP_NavEKF: Clean up flight detector logic