diff --git a/src/drivers/imu/invensense/icm20602/ICM20602.cpp b/src/drivers/imu/invensense/icm20602/ICM20602.cpp index ca559cd503..c13ab0b800 100644 --- a/src/drivers/imu/invensense/icm20602/ICM20602.cpp +++ b/src/drivers/imu/invensense/icm20602/ICM20602.cpp @@ -274,7 +274,6 @@ void ICM20602::RunImpl() if (samples > _fifo_gyro_samples) { // grab desired number of samples, but reschedule next cycle sooner int extra_samples = samples - _fifo_gyro_samples; - timestamp_sample -= extra_samples * static_cast(FIFO_SAMPLE_DT); samples = _fifo_gyro_samples; if (_fifo_gyro_samples > extra_samples) { diff --git a/src/drivers/imu/invensense/icm20649/ICM20649.cpp b/src/drivers/imu/invensense/icm20649/ICM20649.cpp index 434c5e7e8b..e38c9381b8 100644 --- a/src/drivers/imu/invensense/icm20649/ICM20649.cpp +++ b/src/drivers/imu/invensense/icm20649/ICM20649.cpp @@ -229,7 +229,6 @@ void ICM20649::RunImpl() if (samples > _fifo_gyro_samples) { // grab desired number of samples, but reschedule next cycle sooner int extra_samples = samples - _fifo_gyro_samples; - timestamp_sample -= extra_samples * static_cast(FIFO_SAMPLE_DT); samples = _fifo_gyro_samples; if (_fifo_gyro_samples > extra_samples) { diff --git a/src/drivers/imu/invensense/icm20948/ICM20948.cpp b/src/drivers/imu/invensense/icm20948/ICM20948.cpp index 95f863560e..d95cb636c3 100644 --- a/src/drivers/imu/invensense/icm20948/ICM20948.cpp +++ b/src/drivers/imu/invensense/icm20948/ICM20948.cpp @@ -265,7 +265,6 @@ void ICM20948::RunImpl() if (samples > _fifo_gyro_samples) { // grab desired number of samples, but reschedule next cycle sooner int extra_samples = samples - _fifo_gyro_samples; - timestamp_sample -= extra_samples * static_cast(FIFO_SAMPLE_DT); samples = _fifo_gyro_samples; if (_fifo_gyro_samples > extra_samples) {