Finalized version of position_estimator_inav.