fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2: optical flow failing also reset terrain if needed

Browse Source
This commit is contained in:
Daniel Agar 2024-06-27 17:54:35 -04:00
parent ea8f14b883
commit 6be06ecbb3
1 changed files with 4 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/ekf2/EKF/aid_sources/optical_flow/optical_flow_control.cpp
View File

@ -145,6 +145,10 @@ void Ekf::controlOpticalFlowFusion(const imuSample &imu_delayed)
if (is_flow_required) {
resetFlowFusion();
if (_hagl_sensor_status.flags.flow && !isTerrainEstimateValid()) {
resetTerrainToFlow();
}
} else {
stopFlowFusion();
}