|
|
|
@ -46,7 +46,7 @@ PARAM_DEFINE_FLOAT(INAV_W_Z_SONAR, 3.0f);
@@ -46,7 +46,7 @@ PARAM_DEFINE_FLOAT(INAV_W_Z_SONAR, 3.0f);
|
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_XY_GPS_P, 1.0f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_XY_GPS_V, 2.0f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_XY_FLOW, 5.0f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_XY_RESET_V, 0.2f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_XY_RES_V, 0.2f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_GPS_FLOW, 0.1f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_W_ACC_BIAS, 0.05f); |
|
|
|
|
PARAM_DEFINE_FLOAT(INAV_FLOW_K, 0.15f); |
|
|
|
@ -66,7 +66,7 @@ int parameters_init(struct position_estimator_inav_param_handles *h)
@@ -66,7 +66,7 @@ int parameters_init(struct position_estimator_inav_param_handles *h)
|
|
|
|
|
h->w_xy_gps_p = param_find("INAV_W_XY_GPS_P"); |
|
|
|
|
h->w_xy_gps_v = param_find("INAV_W_XY_GPS_V"); |
|
|
|
|
h->w_xy_flow = param_find("INAV_W_XY_FLOW"); |
|
|
|
|
h->w_xy_reset_v = param_find("INAV_W_XY_RESET_V"); |
|
|
|
|
h->w_xy_res_v = param_find("INAV_W_XY_RES_V"); |
|
|
|
|
h->w_gps_flow = param_find("INAV_W_GPS_FLOW"); |
|
|
|
|
h->w_acc_bias = param_find("INAV_W_ACC_BIAS"); |
|
|
|
|
h->flow_k = param_find("INAV_FLOW_K"); |
|
|
|
@ -89,7 +89,7 @@ int parameters_update(const struct position_estimator_inav_param_handles *h, str
@@ -89,7 +89,7 @@ int parameters_update(const struct position_estimator_inav_param_handles *h, str
|
|
|
|
|
param_get(h->w_xy_gps_p, &(p->w_xy_gps_p)); |
|
|
|
|
param_get(h->w_xy_gps_v, &(p->w_xy_gps_v)); |
|
|
|
|
param_get(h->w_xy_flow, &(p->w_xy_flow)); |
|
|
|
|
param_get(h->w_xy_reset_v, &(p->w_xy_reset_v)); |
|
|
|
|
param_get(h->w_xy_res_v, &(p->w_xy_res_v)); |
|
|
|
|
param_get(h->w_gps_flow, &(p->w_gps_flow)); |
|
|
|
|
param_get(h->w_acc_bias, &(p->w_acc_bias)); |
|
|
|
|
param_get(h->flow_k, &(p->flow_k)); |
|
|
|
|