EKF2 always use IMU timestamp as now

This commit is contained in:
Daniel Agar 2019-02-06 09:16:44 -05:00
parent 4c4ee67954
commit ddc9522712
1 changed files with 1 additions and 9 deletions

View File

@ -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];