Browse Source

terrain est: clear innovation/var/test ration when aiding stops

main
bresch 3 years ago committed by Daniel Agar
parent
commit
e2955bdd61
  1. 8
      src/modules/ekf2/EKF/terrain_estimator.cpp

8
src/modules/ekf2/EKF/terrain_estimator.cpp

@ -194,6 +194,10 @@ void Ekf::resetHaglRng() @@ -194,6 +194,10 @@ void Ekf::resetHaglRng()
void Ekf::stopHaglRngFusion()
{
_hagl_sensor_status.flags.range_finder = false;
_hagl_innov = 0.f;
_hagl_innov_var = 0.f;
_hagl_test_ratio = 0.f;
_innov_check_fail_status.flags.reject_hagl = false;
}
void Ekf::fuseHaglRng()
@ -290,6 +294,10 @@ void Ekf::startHaglFlowFusion() @@ -290,6 +294,10 @@ void Ekf::startHaglFlowFusion()
void Ekf::stopHaglFlowFusion()
{
_hagl_sensor_status.flags.flow = false;
_hagl_innov = 0.f;
_hagl_innov_var = 0.f;
_hagl_test_ratio = 0.f;
_innov_check_fail_status.flags.reject_hagl = false;
}
void Ekf::resetHaglFlow()

Loading…
Cancel
Save