position_estimator_inav: final offset correction; added timestamp verification