altb_pmic
/
Test_ekf
Testing ekf implementation for Quadro_1.
Diff: main.cpp
- Revision:
- 10:dd5ea359fb97
- Parent:
- 8:a72cd6356bab
- Child:
- 11:6a7c3795d8fb
diff -r be2e1d2f683d -r dd5ea359fb97 main.cpp --- 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;