ekf2-flow: use same measurement prediction as in jacobian derivation

Also avoid double division in flow prediction
This commit is contained in:
bresch
2025-03-31 11:34:25 +02:00
committed by Mathieu Bresciani
parent 82ea544e8c
commit cdab0cb6e4
2 changed files with 15 additions and 10 deletions
+1
View File
@@ -791,6 +791,7 @@ private:
// calculate optical flow body angular rate compensation
void calcOptFlowBodyRateComp(const flowSample &flow_sample);
float predictFlowHagl() const;
float predictFlowRange() const;
Vector2f predictFlow(const Vector3f &flow_gyro) const;