Browse Source

Shorten the reset param name to INAV_W_XY_RES_V

sbg
Antonio Sanniravong 11 years ago
parent
commit
211c721b48
  1. 4
      src/modules/position_estimator_inav/position_estimator_inav_main.c
  2. 6
      src/modules/position_estimator_inav/position_estimator_inav_params.c
  3. 4
      src/modules/position_estimator_inav/position_estimator_inav_params.h

4
src/modules/position_estimator_inav/position_estimator_inav_main.c

@ -918,8 +918,8 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
} }
} else { } else {
/* gradually reset xy velocity estimates */ /* gradually reset xy velocity estimates */
inertial_filter_correct(-x_est[1], dt, x_est, 1, params.w_xy_reset_v); inertial_filter_correct(-x_est[1], dt, x_est, 1, params.w_xy_res_v);
inertial_filter_correct(-y_est[1], dt, y_est, 1, params.w_xy_reset_v); inertial_filter_correct(-y_est[1], dt, y_est, 1, params.w_xy_res_v);
} }
/* detect land */ /* detect land */

6
src/modules/position_estimator_inav/position_estimator_inav_params.c

@ -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_P, 1.0f);
PARAM_DEFINE_FLOAT(INAV_W_XY_GPS_V, 2.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_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_GPS_FLOW, 0.1f);
PARAM_DEFINE_FLOAT(INAV_W_ACC_BIAS, 0.05f); PARAM_DEFINE_FLOAT(INAV_W_ACC_BIAS, 0.05f);
PARAM_DEFINE_FLOAT(INAV_FLOW_K, 0.15f); PARAM_DEFINE_FLOAT(INAV_FLOW_K, 0.15f);
@ -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_p = param_find("INAV_W_XY_GPS_P");
h->w_xy_gps_v = param_find("INAV_W_XY_GPS_V"); 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_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_gps_flow = param_find("INAV_W_GPS_FLOW");
h->w_acc_bias = param_find("INAV_W_ACC_BIAS"); h->w_acc_bias = param_find("INAV_W_ACC_BIAS");
h->flow_k = param_find("INAV_FLOW_K"); h->flow_k = param_find("INAV_FLOW_K");
@ -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_p, &(p->w_xy_gps_p));
param_get(h->w_xy_gps_v, &(p->w_xy_gps_v)); 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_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_gps_flow, &(p->w_gps_flow));
param_get(h->w_acc_bias, &(p->w_acc_bias)); param_get(h->w_acc_bias, &(p->w_acc_bias));
param_get(h->flow_k, &(p->flow_k)); param_get(h->flow_k, &(p->flow_k));

4
src/modules/position_estimator_inav/position_estimator_inav_params.h

@ -47,7 +47,7 @@ struct position_estimator_inav_params {
float w_xy_gps_p; float w_xy_gps_p;
float w_xy_gps_v; float w_xy_gps_v;
float w_xy_flow; float w_xy_flow;
float w_xy_reset_v; float w_xy_res_v;
float w_gps_flow; float w_gps_flow;
float w_acc_bias; float w_acc_bias;
float flow_k; float flow_k;
@ -67,7 +67,7 @@ struct position_estimator_inav_param_handles {
param_t w_xy_gps_p; param_t w_xy_gps_p;
param_t w_xy_gps_v; param_t w_xy_gps_v;
param_t w_xy_flow; param_t w_xy_flow;
param_t w_xy_reset_v; param_t w_xy_res_v;
param_t w_gps_flow; param_t w_gps_flow;
param_t w_acc_bias; param_t w_acc_bias;
param_t flow_k; param_t flow_k;

Loading…
Cancel
Save