Browse Source

test: Update unit test to match expected behaviour

master
Paul Riseborough 4 years ago committed by Daniel Agar
parent
commit
1b1c049e81
  1. 5
      test/test_EKF_initialization.cpp

5
test/test_EKF_initialization.cpp

@ -120,17 +120,12 @@ class EkfInitializationTest : public ::testing::Test { @@ -120,17 +120,12 @@ class EkfInitializationTest : public ::testing::Test {
{
const Dcmf R_to_earth = Dcmf(_ekf->getQuaternion());
const Vector3f dvel_bias_var = _ekf_wrapper.getDeltaVelBiasVariance();
const Vector3f accel_bias = _ekf->getAccelBias();
for (int i = 0; i < 3; i++){
if (fabsf(R_to_earth(2, i)) > 0.8f) {
// Highly observable, the variance decreases
EXPECT_LT(dvel_bias_var(i), 4.0e-6f) << "axis " << i;
} else {
// Poorly observable, the variance is set to 0
EXPECT_FLOAT_EQ(dvel_bias_var(i), 0.f) << "axis" << i;
EXPECT_FLOAT_EQ(accel_bias(i), 0.f) << "axis" << i;
}
}
}

Loading…
Cancel
Save