diff --git a/src/modules/ekf2/ekf2_main.cpp b/src/modules/ekf2/ekf2_main.cpp index 09dc0cf6f16c67cec317d87211964db77d64f281..e356949dd50a2f61e0aa35629a3d7d8266f63ca8 100644 --- a/src/modules/ekf2/ekf2_main.cpp +++ b/src/modules/ekf2/ekf2_main.cpp @@ -805,15 +805,7 @@ void Ekf2::run() imu_bias_reset_request = !_ekf.reset_imu_bias(); } - // in replay mode we are getting the actual timestamp from the sensor topic - hrt_abstime now = 0; - - if (_replay_mode) { - now = sensors.timestamp; - - } else { - now = hrt_absolute_time(); - } + const hrt_abstime now = sensors.timestamp; // push imu data into estimator float gyro_integral[3];