altb_pmic
/
Test_ekf
Testing ekf implementation for Quadro_1.
Diff: EKF_RP.cpp
- Revision:
- 6:f9569a07aff5
- Parent:
- 5:676cbc33c81b
- Child:
- 7:bcbcc23983de
--- a/EKF_RP.cpp Sun Oct 20 08:59:31 2019 +0000 +++ b/EKF_RP.cpp Sun Oct 20 10:20:05 2019 +0000 @@ -35,7 +35,7 @@ float EKF_RP::get_est_state(uint8_t i) { - /* x = [ang; b_g; v] */ + /* x = [ang; b_g; v] = [phi; theta; b_gx; b_gy; vx; vy] */ return x(i); }