sensor mag add minimal queue and calibration check all

- mag calibration acceptance check sphere/ellipsoid fit status
This commit is contained in:
Daniel Agar
2020-08-21 10:12:13 -04:00
parent b2e8f6839f
commit f2c9865c9b
4 changed files with 64 additions and 38 deletions
@@ -219,9 +219,10 @@ void VehicleMagnetometer::Run()
} else {
sensor_mag_s report;
updated[uorb_index] = _sensor_sub[uorb_index].update(&report);
if (updated[uorb_index]) {
while (_sensor_sub[uorb_index].update(&report)) {
updated[uorb_index] = true;
if (_calibration[uorb_index].device_id() != report.device_id) {
_calibration[uorb_index].set_external(report.is_external);
_calibration[uorb_index].set_device_id(report.device_id);