altb_pmic / Mbed 2 deprecated Test_ekf

Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Diff: EKF_RP.cpp

Revision:
18:f374ca9a3e75
Parent:
17:1d98928f7681
Child:
19:ccb6fc8bf872
--- a/EKF_RP.cpp	Fri Oct 25 08:44:32 2019 +0000
+++ b/EKF_RP.cpp	Mon Oct 28 11:31:48 2019 +0000
@@ -28,7 +28,7 @@
     calc_H();
     initialize_Q();
     initialize_R();
-    P = Q;
+    P = 1000000.0f * ( F * P * F.transpose() + Q );
     K.setZero();
     I.setIdentity();
     e.setZero();