Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 08:38:36 -04:00
Code Issues Packages Projects Releases Wiki Activity

NavEKF: check baro health before consuming

Browse Source
This commit is contained in:
Randy Mackay 2015-08-12 14:59:58 -07:00
parent 79efad339f
commit 8b17d32994
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF/AP_NavEKF.cpp
View File

@ -4269,7 +4269,7 @@ void NavEKF::readGpsData()
void NavEKF::readHgtData()
{
// check to see if baro measurement has changed so we know if a new measurement has arrived
if (_baro.get_last_update() != lastHgtMeasTime) {
if (_baro.healthy() && _baro.get_last_update() != lastHgtMeasTime) {
// Don't use Baro height if operating in optical flow mode as we use range finder instead
if (_fusionModeGPS == 3 && _altSource == 1) {
if ((imuSampleTime_ms - rngValidMeaTime_ms) < 2000) {