diff --git a/libraries/AP_NavEKF3/AP_NavEKF3.cpp b/libraries/AP_NavEKF3/AP_NavEKF3.cpp index e771c4e666..320cf434a1 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3.cpp @@ -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.5E-02f -#define ACC_P_NSE_DEFAULT 3.5E-01f +#define GYRO_P_NSE_DEFAULT 1.0E-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 @@ #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.5E-02f -#define ACC_P_NSE_DEFAULT 3.5E-01f +#define GYRO_P_NSE_DEFAULT 1.0E-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 @@ #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.5E-02f -#define ACC_P_NSE_DEFAULT 3.5E-01f +#define GYRO_P_NSE_DEFAULT 1.0E-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 @@ #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.5E-02f -#define ACC_P_NSE_DEFAULT 3.5E-01f +#define GYRO_P_NSE_DEFAULT 1.0E-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