ekf2_terr: refactor terrain estimator - flow aiding

This commit is contained in:
bresch
2022-02-11 10:57:45 -05:00
committed by Daniel Agar
parent 33fd1849e0
commit 2fb7b35a8b
3 changed files with 66 additions and 25 deletions
+4 -3
View File
@@ -680,8 +680,6 @@ private:
// initialise the terrain vertical position estimator
void initHagl();
bool shouldUseOpticalFlowForHagl() const { return (_params.terrain_fusion_mode & TerrainFusionMask::TerrainFuseOpticalFlow); }
void runTerrainEstimator();
void predictHagl();
@@ -695,8 +693,11 @@ private:
float getRngVar();
// update the terrain vertical position estimate using an optical flow measurement
void fuseFlowForTerrain();
void controlHaglFlowFusion();
void startHaglFlowFusion();
void resetHaglFlow();
void stopHaglFlowFusion();
void fuseFlowForTerrain();
void controlHaglFakeFusion();
void resetHaglFake();