@ -22,10 +22,10 @@
@@ -22,10 +22,10 @@
# define POSNE_M_NSE_DEFAULT 0.5f
# define ALT_M_NSE_DEFAULT 2.0f
# define MAG_M_NSE_DEFAULT 0.05f
# define GYRO_P_NSE_DEFAULT 1.5 E-02f
# define ACC_P_NSE_DEFAULT 3 .5E-01f
# define GYRO_P_NSE_DEFAULT 1.0 E-02f
# define ACC_P_NSE_DEFAULT 2 .5E-01f
# define GBIAS_P_NSE_DEFAULT 1.0E-04f
# define ABIAS_P_NSE_DEFAULT 3 .0E-03f
# define ABIAS_P_NSE_DEFAULT 1 .0E-03f
# define MAGB_P_NSE_DEFAULT 1.0E-04f
# define MAGE_P_NSE_DEFAULT 1.0E-03f
# define VEL_I_GATE_DEFAULT 500
@ -48,10 +48,10 @@
@@ -48,10 +48,10 @@
# define POSNE_M_NSE_DEFAULT 0.5f
# define ALT_M_NSE_DEFAULT 2.0f
# define MAG_M_NSE_DEFAULT 0.05f
# define GYRO_P_NSE_DEFAULT 1.5 E-02f
# define ACC_P_NSE_DEFAULT 3 .5E-01f
# define GYRO_P_NSE_DEFAULT 1.0 E-02f
# define ACC_P_NSE_DEFAULT 2 .5E-01f
# define GBIAS_P_NSE_DEFAULT 1.0E-04f
# define ABIAS_P_NSE_DEFAULT 3 .0E-03f
# define ABIAS_P_NSE_DEFAULT 1 .0E-03f
# define MAGB_P_NSE_DEFAULT 1.0E-04f
# define MAGE_P_NSE_DEFAULT 1.0E-03f
# define VEL_I_GATE_DEFAULT 500
@ -74,10 +74,10 @@
@@ -74,10 +74,10 @@
# define POSNE_M_NSE_DEFAULT 0.5f
# define ALT_M_NSE_DEFAULT 3.0f
# define MAG_M_NSE_DEFAULT 0.05f
# define GYRO_P_NSE_DEFAULT 1.5 E-02f
# define ACC_P_NSE_DEFAULT 3 .5E-01f
# define GYRO_P_NSE_DEFAULT 1.0 E-02f
# define ACC_P_NSE_DEFAULT 2 .5E-01f
# define GBIAS_P_NSE_DEFAULT 1.0E-04f
# define ABIAS_P_NSE_DEFAULT 3 .0E-03f
# define ABIAS_P_NSE_DEFAULT 1 .0E-03f
# define MAGB_P_NSE_DEFAULT 1.0E-04f
# define MAGE_P_NSE_DEFAULT 1.0E-03f
# define VEL_I_GATE_DEFAULT 500
@ -100,10 +100,10 @@
@@ -100,10 +100,10 @@
# define POSNE_M_NSE_DEFAULT 0.5f
# define ALT_M_NSE_DEFAULT 2.0f
# define MAG_M_NSE_DEFAULT 0.05f
# define GYRO_P_NSE_DEFAULT 1.5 E-02f
# define ACC_P_NSE_DEFAULT 3 .5E-01f
# define GYRO_P_NSE_DEFAULT 1.0 E-02f
# define ACC_P_NSE_DEFAULT 2 .5E-01f
# define GBIAS_P_NSE_DEFAULT 1.0E-04f
# define ABIAS_P_NSE_DEFAULT 3 .0E-03f
# define ABIAS_P_NSE_DEFAULT 1 .0E-03f
# define MAGB_P_NSE_DEFAULT 1.0E-04f
# define MAGE_P_NSE_DEFAULT 1.0E-03f
# define VEL_I_GATE_DEFAULT 500