ekf2: resetFlowFusion() reset aid src status appropriately

This commit is contained in:
Daniel Agar 2024-06-26 14:45:28 -04:00
parent 8221940b60
commit 1df8f3f9d2

View File

@ -171,11 +171,10 @@ void Ekf::resetFlowFusion()
resetHorizontalPositionTo(Vector2f(0.f, 0.f), 0.f);
}
updateOptFlow(_aid_src_optical_flow);
resetAidSourceStatusZeroInnovation(_aid_src_optical_flow);
_innov_check_fail_status.flags.reject_optflow_X = false;
_innov_check_fail_status.flags.reject_optflow_Y = false;
_aid_src_optical_flow.time_last_fuse = _time_delayed_us;
}
void Ekf::resetTerrainToFlow()