unit test: check that the accel bias is only learned when observable (#827)

This commit is contained in:
Mathieu Bresciani
2020-05-25 11:10:01 +02:00
committed by GitHub
parent c91c78dcf6
commit b024cdd282
3 changed files with 41 additions and 0 deletions
+5
View File
@@ -200,3 +200,8 @@ int EkfWrapper::getQuaternionResetCounter() const
_ekf->get_quat_reset(tmp, &counter);
return static_cast<int>(counter);
}
matrix::Vector3f EkfWrapper::getDeltaVelBiasVariance() const
{
return _ekf->covariances_diagonal().slice<3, 1>(13,0);
}
+2
View File
@@ -94,6 +94,8 @@ public:
matrix::Vector<float, 4> getQuaternionVariance() const;
int getQuaternionResetCounter() const;
matrix::Vector3f getDeltaVelBiasVariance() const;
private:
std::shared_ptr<Ekf> _ekf;