Browse Source

ekf2_main.cpp: fixed bug in the calculation of the mag bias calibration time

Signed-off-by: RomanBapst <bapstroman@gmail.com>
sbg
RomanBapst 5 years ago committed by Mathieu Bresciani
parent
commit
4ddf0f9dc1
  1. 5
      src/modules/ekf2/ekf2_main.cpp

5
src/modules/ekf2/ekf2_main.cpp

@ -1551,6 +1551,11 @@ void Ekf2::Run() @@ -1551,6 +1551,11 @@ void Ekf2::Run()
for (bool &cal_available : _valid_cal_available) {
cal_available = false;
}
} else {
// conditions are NOT OK for learning magnetometer bias, reset timestamp
// but keep the accumulated calibration time
_last_magcal_us = now;
}
// Start checking mag bias estimates when we have accumulated sufficient calibration time

Loading…
Cancel
Save