mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-21 09:22:18 +00:00
sensor accel/gyro message cleanup
- split out integrated data into new standalone messages (sensor_accel_integrated and sensor_gyro_integrated)
- publish sensor_gyro at full rate and remove sensor_gyro_control
- limit sensor status publications to 10 Hz
- remove unused accel/gyro raw ADC fields
- add device IDs to sensor_bias and sensor_correction
- vehicle_angular_velocity/vehicle_acceleration: check device ids before using bias and corrections
This commit is contained in:
@@ -1472,6 +1472,10 @@ void Ekf2::Run()
|
||||
|
||||
bias.timestamp = now;
|
||||
|
||||
bias.gyro_device_id = _sensor_selection.gyro_device_id;
|
||||
bias.accel_device_id = _sensor_selection.accel_device_id;
|
||||
bias.mag_device_id = _sensor_selection.mag_device_id;
|
||||
|
||||
// In-run bias estimates
|
||||
_ekf.get_gyro_bias(bias.gyro_bias);
|
||||
_ekf.get_accel_bias(bias.accel_bias);
|
||||
|
||||
Reference in New Issue
Block a user