AHRS
Dependencies: Eigen
Diff: EKF_RPY.cpp
- Revision:
- 24:7fe0935b3bd2
- Parent:
- 23:71996bfe68eb
--- a/EKF_RPY.cpp Wed Nov 13 11:40:46 2019 +0000 +++ b/EKF_RPY.cpp Mon Jan 06 10:15:44 2020 +0000 @@ -63,11 +63,11 @@ /* x = [ang; v; b_g] = [0: phi 1: theta 2: psi - 3: b_gx - 4: b_gy - 5: b_gz - 6: vx - 7: vy] */ + 3: vx + 4: vy + 5: b_gx + 6: b_gy + 7: b_gz] */ return x(i); }