|
|
|
@ -281,7 +281,7 @@ TEST_F(EkfExternalVisionTest, velocityFrameBody)
@@ -281,7 +281,7 @@ TEST_F(EkfExternalVisionTest, velocityFrameBody)
|
|
|
|
|
// THEN: As the drone is turned 90 degrees, velocity variance
|
|
|
|
|
// along local y axis is expected to be bigger
|
|
|
|
|
const Vector3f velVar_new = _ekf->getVelocityVariance(); |
|
|
|
|
EXPECT_NEAR(velVar_new(1) / velVar_new(0), 80.f, 10.f); |
|
|
|
|
EXPECT_NEAR(velVar_new(1) / velVar_new(0), 80.f, 15.f); |
|
|
|
|
|
|
|
|
|
const Vector3f vel_earth_est = _ekf->getVelocity(); |
|
|
|
|
EXPECT_NEAR(vel_earth_est(0), 0.0f, 0.1f); |
|
|
|
@ -316,7 +316,7 @@ TEST_F(EkfExternalVisionTest, velocityFrameLocal)
@@ -316,7 +316,7 @@ TEST_F(EkfExternalVisionTest, velocityFrameLocal)
|
|
|
|
|
// THEN: Independently on drones heading, velocity variance
|
|
|
|
|
// along local x axis is expected to be bigger
|
|
|
|
|
const Vector3f velVar_new = _ekf->getVelocityVariance(); |
|
|
|
|
EXPECT_NEAR(velVar_new(0) / velVar_new(1), 80.f, 10.f); |
|
|
|
|
EXPECT_NEAR(velVar_new(0) / velVar_new(1), 80.f, 15.f); |
|
|
|
|
|
|
|
|
|
const Vector3f vel_earth_est = _ekf->getVelocity(); |
|
|
|
|
EXPECT_NEAR(vel_earth_est(0), 1.0f, 0.1f); |
|
|
|
|