ekf2: clear test ratios, flags, etc when stopping mag fusion

This commit is contained in:
Daniel Agar
2022-03-22 10:04:50 -04:00
parent 65a587e56a
commit 05133aed27
2 changed files with 22 additions and 7 deletions
-3
View File
@@ -195,9 +195,6 @@ bool Ekf::fuseMag(const Vector3f &mag, bool update_all_states)
}
}
// we are no longer using heading fusion so set the reported test level to zero
_yaw_test_ratio = 0.0f;
// if any axis fails, abort the mag fusion
if (!all_innovation_checks_passed) {
return false;