EKF: move small simple getters to header

- return by const reference where possible
This commit is contained in:
Daniel Agar
2020-10-30 09:48:45 -04:00
committed by GitHub
parent defb35d8f5
commit 48a8992caf
6 changed files with 109 additions and 131 deletions
-10
View File
@@ -103,16 +103,6 @@ void Ekf::initialiseCovariance()
}
Vector3f Ekf::getPositionVariance() const
{
return P.slice<3,3>(7,7).diag();
}
Vector3f Ekf::getVelocityVariance() const
{
return P.slice<3,3>(4,4).diag();
}
void Ekf::predictCovariance()
{
// assign intermediate state variables