mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-31 18:47:21 +08:00
sensors: vehicle_imu don't round measured accel and gyro sample rates
This commit is contained in:
@@ -226,7 +226,7 @@ void VehicleIMU::Run()
|
|||||||
if (!_intervals_configured && UpdateIntervalAverage(_gyro_interval, gyro.timestamp_sample)) {
|
if (!_intervals_configured && UpdateIntervalAverage(_gyro_interval, gyro.timestamp_sample)) {
|
||||||
update_integrator_config = true;
|
update_integrator_config = true;
|
||||||
publish_status = true;
|
publish_status = true;
|
||||||
_status.gyro_rate_hz = roundf(1e6f / _gyro_interval.update_interval);
|
_status.gyro_rate_hz = 1e6f / _gyro_interval.update_interval;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -272,7 +272,7 @@ void VehicleIMU::Run()
|
|||||||
if (!_intervals_configured && UpdateIntervalAverage(_accel_interval, accel.timestamp_sample)) {
|
if (!_intervals_configured && UpdateIntervalAverage(_accel_interval, accel.timestamp_sample)) {
|
||||||
update_integrator_config = true;
|
update_integrator_config = true;
|
||||||
publish_status = true;
|
publish_status = true;
|
||||||
_status.accel_rate_hz = roundf(1e6f / _accel_interval.update_interval);
|
_status.accel_rate_hz = 1e6f / _accel_interval.update_interval;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user