ekf: disable xy accel bias learning before takeoff (#818)

* ekf: disable xy accel bias learning before takeoff

As those biases are usually poorly observable before takeoff because
they are almost perpendicular to the gravity vector, learning is often
driven by noise and numerical issues. This results in incorrect bias
learning before takeoff when the drone is static on ground for a long
period of time.

* ekf: update unit test and change indicator
This commit is contained in:
Mathieu Bresciani
2020-05-19 10:02:40 +02:00
committed by GitHub
parent 9788c3bdf2
commit 37d9cef262
3 changed files with 348 additions and 349 deletions
+1 -1
View File
@@ -103,7 +103,7 @@ class EkfInitializationTest : public ::testing::Test {
EXPECT_TRUE(pos_var(1) > pos_variance_limit) << "pos_var(1)" << pos_var(1);
EXPECT_TRUE(pos_var(2) > pos_variance_limit) << "pos_var(2)" << pos_var(2);
const float vel_variance_limit = 0.4f;
const float vel_variance_limit = 0.3f;
EXPECT_TRUE(vel_var(0) > vel_variance_limit) << "vel_var(0)" << vel_var(0);
EXPECT_TRUE(vel_var(1) > vel_variance_limit) << "vel_var(1)" << vel_var(1);
EXPECT_TRUE(vel_var(2) > vel_variance_limit) << "vel_var(2)" << vel_var(2);