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);
}