Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Revision:
14:c4bc8ba29c2f
Parent:
12:180e09c4ea26
Child:
15:53485bd1ff28
--- 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;