fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-01 20:44:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

init height using baro when set to ev height (#388)

Browse Source 
this also makes sure the _baro_hgt_offset is being initialized correctly
This commit is contained in:
ChristophTobler 2018-01-29 21:33:28 +01:00 committed by Paul Riseborough
parent a2d6a4dded
commit 337cdcc59a
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
EKF/ekf.cpp
View File

@ -190,8 +190,8 @@ bool Ekf::initialiseFilter()
// accumulate enough height measurements to be confident in the qulaity of the data
if (_primary_hgt_source == VDIST_SENSOR_BARO || _primary_hgt_source == VDIST_SENSOR_GPS ||
_primary_hgt_source == VDIST_SENSOR_RANGE) {
// if the user parameter specifies use of GPS/range finder for height we use baro height initially and switch to GPS/range finder
_primary_hgt_source == VDIST_SENSOR_RANGE || _primary_hgt_source == VDIST_SENSOR_EV) {
// if the user parameter specifies use of GPS/range/EV finder for height we use baro height initially and switch to GPS/range/EV finder
// later when it passes checks.
if (_baro_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_baro_sample_delayed)) {
if ((_hgt_counter == 0) && (_baro_sample_delayed.time_us != 0)) {