position_estimator_inav - first working version