AP_NavEKF: Turned previous repeated fusion bug into a design feature!