AP_NavEKF: Reduced chances of bad initialisation when indoors