position_estimator_inav: more safe EPH/EPV estimation, minor changes