AHRS

Dependencies:   Eigen

Dependents:   IndNav_QK3_T265

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);
 }