diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2014-06-22 11:49:06 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-06-22 11:49:06 +0200 |
commit | 5c6a5411288ea181503269a711de2e626ddb5185 (patch) | |
tree | 5a4cac1b0640bf5ede35e1d4617db75c42833bed /src/modules | |
parent | 57a7e764068178e365b05b7baaa39041762f2e96 (diff) | |
parent | 78b7ba33a5f04a11ac859aecfb72ff34d75cb7ff (diff) | |
download | px4-firmware-5c6a5411288ea181503269a711de2e626ddb5185.tar.gz px4-firmware-5c6a5411288ea181503269a711de2e626ddb5185.tar.bz2 px4-firmware-5c6a5411288ea181503269a711de2e626ddb5185.zip |
Merge pull request #1065 from ggregory8/vision_estimate
Fix to allow filter correction with vision position estimate
Diffstat (limited to 'src/modules')
-rw-r--r-- | src/modules/position_estimator_inav/position_estimator_inav_main.c | 4 |
1 files changed, 2 insertions, 2 deletions
diff --git a/src/modules/position_estimator_inav/position_estimator_inav_main.c b/src/modules/position_estimator_inav/position_estimator_inav_main.c index 9ab21ee38..a6a4db3eb 100644 --- a/src/modules/position_estimator_inav/position_estimator_inav_main.c +++ b/src/modules/position_estimator_inav/position_estimator_inav_main.c @@ -781,8 +781,8 @@ int position_estimator_inav_thread_main(int argc, char *argv[]) epv += 0.005 * dt; // add 1m to EPV each 200s (baro drift) /* use GPS if it's valid and reference position initialized */ - bool use_gps_xy = ref_inited && gps_valid && params.w_xy_gps_p > MIN_VALID_W; - bool use_gps_z = ref_inited && gps_valid && params.w_z_gps_p > MIN_VALID_W; + bool use_gps_xy = (ref_inited && gps_valid && params.w_xy_gps_p > MIN_VALID_W) || vision_valid; + bool use_gps_z = (ref_inited && gps_valid && params.w_z_gps_p > MIN_VALID_W) || vision_valid; /* use flow if it's valid and (accurate or no GPS available) */ bool use_flow = flow_valid && (flow_accurate || !use_gps_xy); |