mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-28 04:10:35 +08:00
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:
@@ -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);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user