AP_NavEKF: Fixed bug in pre GPS fix updates