mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-19 13:09:06 +08:00
ekf2: mag control reset mag_lpf on first sample
This commit is contained in:
parent
c2f13dbccf
commit
e3d73cd837
@ -51,7 +51,7 @@ void Ekf::controlMagFusion()
|
||||
if (mag_data_ready) {
|
||||
|
||||
// sensor or calibration has changed, clear any mag bias and reset low pass filter
|
||||
if (mag_sample.reset) {
|
||||
if (mag_sample.reset || (_mag_counter == 0)) {
|
||||
// Zero the magnetometer bias states
|
||||
_state.mag_B.zero();
|
||||
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user