LPE: Use euler angles derived from quaternion

This commit is contained in:
Lorenz Meier
2016-10-18 20:46:08 +02:00
parent ac936a28dd
commit 13833e5fd6
5 changed files with 34 additions and 21 deletions
@@ -401,6 +401,10 @@ private:
Vector<float, n_x> _x; // state vector
Vector<float, n_u> _u; // input vector
Matrix<float, n_x, n_x> _P; // state covariance matrix
matrix::Dcm<float> _R_att;
Vector3f _eul;
Matrix<float, n_x, n_x> _A; // dynamics matrix
Matrix<float, n_x, n_u> _B; // input matrix
Matrix<float, n_u, n_u> _R; // input covariance