altb_pmic
/
Test_ekf
Testing ekf implementation for Quadro_1.
Diff: EKF_RP.cpp
- Revision:
- 20:0227c82a78c2
- Parent:
- 19:ccb6fc8bf872
- Child:
- 21:aab1ac72095b
--- a/EKF_RP.cpp Mon Oct 28 12:08:15 2019 +0000 +++ b/EKF_RP.cpp Mon Oct 28 12:14:59 2019 +0000 @@ -32,8 +32,7 @@ K.setZero(); I.setIdentity(); e.setZero(); - P.setZero(); - increase_diag_P(); + P = scale_P0 * I; } void EKF_RP::increase_diag_P()