AP_NavEKF: Improve robustness to long periods without GPS