use full mag fusion

This commit is contained in:
Roman
2016-01-08 06:59:10 +01:00
parent f8354bb5e9
commit a41f75ffb1
+3 -3
View File
@@ -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)) {