Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Revision:
12:180e09c4ea26
Parent:
7:bcbcc23983de
Child:
13:2e03d9c03409
--- a/EKF_RPY.h	Mon Oct 21 09:20:25 2019 +0000
+++ b/EKF_RPY.h	Tue Oct 22 19:37:32 2019 +0000
@@ -11,10 +11,13 @@
 public:
 
     EKF_RPY(float Ts, float mx0, float my0, float mz0);
+    EKF_RPY(float Ts);
 
     virtual ~EKF_RPY();
     
+    void set_para();
     void reset();
+    void set_m0(float mx0, float my0, float mz0);
     float get_est_state(uint8_t i);
     void update(float gyro_x, float gyro_y, float gyro_z, float accel_x, float accel_y, float magnet_x, float magnet_y);