|
|
|
@ -793,7 +793,7 @@ void NavEKF3_core::selectHeightForFusion()
@@ -793,7 +793,7 @@ void NavEKF3_core::selectHeightForFusion()
|
|
|
|
|
baroDataToFuse = storedBaro.recall(baroDataDelayed, imuDataDelayed.time_ms); |
|
|
|
|
|
|
|
|
|
// select height source
|
|
|
|
|
if (((frontend->_useRngSwHgt > 0) || (frontend->_altSource == 1)) && (imuSampleTime_ms - rngValidMeaTime_ms < 500)) { |
|
|
|
|
if (((frontend->_useRngSwHgt > 0) && (frontend->_altSource == 1)) && (imuSampleTime_ms - rngValidMeaTime_ms < 500)) { |
|
|
|
|
if (frontend->_altSource == 1) { |
|
|
|
|
// always use range finder
|
|
|
|
|
activeHgtSource = HGT_SOURCE_RNG; |
|
|
|
|