Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Revision:
6:f9569a07aff5
Parent:
5:676cbc33c81b
Child:
7:bcbcc23983de
--- a/EKF_RP.cpp	Sun Oct 20 08:59:31 2019 +0000
+++ b/EKF_RP.cpp	Sun Oct 20 10:20:05 2019 +0000
@@ -35,7 +35,7 @@
 
 float EKF_RP::get_est_state(uint8_t i)
 {   
-    /* x = [ang; b_g; v] */
+    /* x = [ang; b_g; v] = [phi; theta; b_gx; b_gy; vx; vy] */
     return x(i);
 }