Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Revision:
10:dd5ea359fb97
Parent:
8:a72cd6356bab
Child:
11:6a7c3795d8fb
--- a/main.cpp	Sun Oct 20 16:30:34 2019 +0000
+++ b/main.cpp	Mon Oct 21 06:58:45 2019 +0000
@@ -20,7 +20,7 @@
 
 Matrix<float, 8, 8> A;
 Matrix<float, 8, 1> b;
-Matrix<float, 8, 8> I;
+Matrix<double, 8, 8> I;
 
 Matrix<float, 4, 1> gyro_x;
 Matrix<float, 4, 1> gyro_y;
@@ -76,7 +76,7 @@
          1,
          8;
          
-    // I.setIdentity();
+    I.setIdentity();
     
     gyro_x   <<  0.01,  0.05, -0.02,  0.02;
     gyro_y   << -0.01, -0.03,  0.01,  0.01;