position_estimator_inav: better handling of lost GPS, minor fixes