position_estimator_inav: handle in-flight GPS fix properly

@sjwilks, @LorenzMeier, this should solve the problem you had, test please.
Tested on HIL only.