mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
drivers/imu: ensure timestamp_sample adjustment isn't done as float (continued)
This commit is contained in:
parent
e31dd34388
commit
b5d401b20c
@ -206,7 +206,7 @@ void BMI055_Accelerometer::RunImpl()
|
||||
if (samples == _fifo_samples + 1) {
|
||||
// sample timestamp set from data ready already corresponds to _fifo_samples
|
||||
if (timestamp_sample == 0) {
|
||||
timestamp_sample = now - FIFO_SAMPLE_DT;
|
||||
timestamp_sample = now - static_cast<int>(FIFO_SAMPLE_DT);
|
||||
}
|
||||
|
||||
samples--;
|
||||
|
||||
@ -206,7 +206,7 @@ void BMI055_Gyroscope::RunImpl()
|
||||
if (samples == _fifo_samples + 1) {
|
||||
// sample timestamp set from data ready already corresponds to _fifo_samples
|
||||
if (timestamp_sample == 0) {
|
||||
timestamp_sample = now - FIFO_SAMPLE_DT;
|
||||
timestamp_sample = now - static_cast<int>(FIFO_SAMPLE_DT);
|
||||
}
|
||||
|
||||
samples--;
|
||||
|
||||
@ -207,7 +207,7 @@ void BMI088_Gyroscope::RunImpl()
|
||||
if (samples == _fifo_samples + 1) {
|
||||
// sample timestamp set from data ready already corresponds to _fifo_samples
|
||||
if (timestamp_sample == 0) {
|
||||
timestamp_sample = now - FIFO_SAMPLE_DT;
|
||||
timestamp_sample = now - static_cast<int>(FIFO_SAMPLE_DT);
|
||||
}
|
||||
|
||||
samples--;
|
||||
|
||||
@ -274,7 +274,7 @@ 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 * FIFO_SAMPLE_DT;
|
||||
timestamp_sample -= extra_samples * static_cast<int>(FIFO_SAMPLE_DT);
|
||||
samples = _fifo_gyro_samples;
|
||||
|
||||
ScheduleOnInterval(_fifo_empty_interval_us,
|
||||
|
||||
@ -229,7 +229,7 @@ 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 * FIFO_SAMPLE_DT;
|
||||
timestamp_sample -= extra_samples * static_cast<int>(FIFO_SAMPLE_DT);
|
||||
samples = _fifo_gyro_samples;
|
||||
|
||||
ScheduleOnInterval(_fifo_empty_interval_us,
|
||||
|
||||
@ -265,7 +265,7 @@ 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 * FIFO_SAMPLE_DT;
|
||||
timestamp_sample -= extra_samples * static_cast<int>(FIFO_SAMPLE_DT);
|
||||
samples = _fifo_gyro_samples;
|
||||
|
||||
ScheduleOnInterval(_fifo_empty_interval_us,
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user