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[]) @@ -918,8 +918,8 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
}
} else {
/* gradually reset xy velocity estimates */
inertial_filter_correct(-x_est[1], dt, x_est, 1, params.w_xy_reset_v);
inertial_filter_correct(-y_est[1], dt, y_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_res_v);
}
/* 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); @@ -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));

4
src/modules/position_estimator_inav/position_estimator_inav_params.h

@ -47,7 +47,7 @@ struct position_estimator_inav_params { @@ -47,7 +47,7 @@ struct position_estimator_inav_params {
float w_xy_gps_p;
float w_xy_gps_v;
float w_xy_flow;
float w_xy_reset_v;
float w_xy_res_v;
float w_gps_flow;
float w_acc_bias;
float flow_k;
@ -67,7 +67,7 @@ struct position_estimator_inav_param_handles { @@ -67,7 +67,7 @@ struct position_estimator_inav_param_handles {
param_t w_xy_gps_p;
param_t w_xy_gps_v;
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_acc_bias;
param_t flow_k;

Loading…
Cancel
Save