altb_pmic
/
Test_ekf
Testing ekf implementation for Quadro_1.
Diff: main.cpp
- Revision:
- 14:c4bc8ba29c2f
- Parent:
- 12:180e09c4ea26
- Child:
- 15:53485bd1ff28
diff -r 2e03d9c03409 -r c4bc8ba29c2f main.cpp --- a/main.cpp Tue Oct 22 20:21:04 2019 +0000 +++ b/main.cpp Wed Oct 23 09:59:59 2019 +0000 @@ -1,8 +1,8 @@ #include "mbed.h" #include "iostream" -//#include "Eigen/Dense.h" -#include "Eigen/Core.h" -#include "Eigen/Geometry.h" +#include "Eigen/Dense.h" +// #include "Eigen/Core.h" +// #include "Eigen/Geometry.h" #include "EKF_RP.h" #include "EKF_RPY.h" @@ -20,7 +20,7 @@ Matrix<float, 8, 8> A; Matrix<float, 8, 1> b; -Matrix<float, 8, 8> I; +Matrix<float, 9, 9> I; Matrix<float, 4, 1> gyro_x; Matrix<float, 4, 1> gyro_y;