altb_pmic / Mbed 2 deprecated Test_ekf

Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Diff: EKF_RPY.cpp

Revision:
8:a72cd6356bab
Parent:
7:bcbcc23983de
Child:
9:be2e1d2f683d
--- a/EKF_RPY.cpp	Sun Oct 20 13:16:13 2019 +0000
+++ b/EKF_RPY.cpp	Sun Oct 20 14:16:34 2019 +0000
@@ -7,10 +7,10 @@
 {
     this->Ts = Ts;
     /* [n_gyro; n_v; n_b_g] */
-    var_fx << 1000.0f, 1000.0f, 1000.0f,   10.0f, 10.0f,   20.0f, 20.0f, 20.0f;
+    var_fx << 0.1f, 0.1f, 0.1f, 0.001f, 0.001f, 0.002f, 0.002f, 0.002f;
     /* [n_acc; n_mag] */
-    var_gy << 40.0f, 40.0f,   0.1f, 0.1f;
-    rho = 5000.0f;
+    var_gy << 40.0f, 40.0f, 0.1f, 0.1f;
+    rho = 5.0f;
     kv = 0.5f;       /* k1/m */
     g = 9.81f;
     m0 << mx0, my0, mz0;