mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 03:13:33 +08:00
use full mag fusion
This commit is contained in:
+3
-3
@@ -89,9 +89,9 @@ bool Ekf::update()
|
|||||||
// measurement updates
|
// measurement updates
|
||||||
|
|
||||||
if (_mag_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_mag_sample_delayed)) {
|
if (_mag_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_mag_sample_delayed)) {
|
||||||
fuseHeading();
|
//fuseHeading();
|
||||||
//fuseMag(_mag_fuse_index);
|
fuseMag(_mag_fuse_index);
|
||||||
//_mag_fuse_index = (_mag_fuse_index + 1) % 3;
|
_mag_fuse_index = (_mag_fuse_index + 1) % 3;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (_baro_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_baro_sample_delayed)) {
|
if (_baro_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_baro_sample_delayed)) {
|
||||||
|
|||||||
Reference in New Issue
Block a user