ekf2: simplify state var constraint

2026-10-22 21:43:33 +08:00 · 2023-09-19 09:37:50 -04:00
parent 779ea3f4d1
commit 51dbd8ee4c
2 changed files with 23 additions and 43 deletions
@@ -1047,6 +1047,8 @@ private:
 	// force symmetry when the argument is true
 	void fixCovarianceErrors(bool force_symmetry);

+	void constrainStateVar(const IdxDof &state, float min, float max);
+
 	// constrain the ekf states
 	void constrainStates();