diff --git a/src/modules/local_position_estimator/sensors/mocap.cpp b/src/modules/local_position_estimator/sensors/mocap.cpp index 6a2d1059f43..9991fbbe25c 100644 --- a/src/modules/local_position_estimator/sensors/mocap.cpp +++ b/src/modules/local_position_estimator/sensors/mocap.cpp @@ -38,7 +38,7 @@ void BlockLocalPositionEstimator::mocapInit() // get reference for global position globallocalconverter_getref(&_ref_lat, &_ref_lon, &_ref_alt); - _global_ref_timestamp = hrt_absolute_time(); + _global_ref_timestamp = _timeStamp; _is_global_cov_init = globallocalconverter_initialized(); if (!_map_ref.init_done && _is_global_cov_init && !_visionUpdated) { diff --git a/src/modules/local_position_estimator/sensors/vision.cpp b/src/modules/local_position_estimator/sensors/vision.cpp index ea43192e303..9f5c4f4f21c 100644 --- a/src/modules/local_position_estimator/sensors/vision.cpp +++ b/src/modules/local_position_estimator/sensors/vision.cpp @@ -43,7 +43,7 @@ void BlockLocalPositionEstimator::visionInit() // get reference for global position globallocalconverter_getref(&_ref_lat, &_ref_lon, &_ref_alt); - _global_ref_timestamp = hrt_absolute_time(); + _global_ref_timestamp = _timeStamp; _is_global_cov_init = globallocalconverter_initialized(); if (!_map_ref.init_done && _is_global_cov_init) {