ekf2: treat inhibited states as "consider states" and remove conservative covariance matrix fixes (#22597)

When a state stops to be estimated it becomes a "consider state". Its value and variance are frozen but its covariance with other states continue to evolve normally.

 - removes conservative accel bias variance limiting
 - force symmetry is skipped after fusion of NED vel/pos (a direct measurement)

---------

Co-authored-by: bresch <brescianimathieu@gmail.com>
This commit is contained in:
Daniel Agar
2024-01-24 14:14:09 -05:00
committed by GitHub
parent 2c81c9fdea
commit 51155f7a29
13 changed files with 874 additions and 1039 deletions
@@ -95,7 +95,7 @@ TEST_F(EkfAccelerometerTest, biasEstimatePositive)
const float biases[4] = {0.1f, 0.2f, 0.3f, 0.38f};
for (int i = 0; i < 4; i ++) {
testBias(biases[i], 10, 0.03f);
testBias(biases[i], 60, 0.03f);
}
}
@@ -104,7 +104,7 @@ TEST_F(EkfAccelerometerTest, biasEstimateNegative)
const float biases[4] = {-0.12f, -0.22f, -0.31, -0.4f};
for (int i = 0; i < 4; i ++) {
testBias(biases[i], 10, 0.03f);
testBias(biases[i], 60, 0.03f);
}
}