EKF: Publish initial altitude estimate in any case

This commit is contained in:
Lorenz Meier
2015-06-23 12:57:39 +02:00
committed by tumbili
parent 6a00fce009
commit c46b4a29b8
@@ -699,10 +699,9 @@ void AttitudePositionEstimatorEKF::task_main()
// Publish Local Position estimations
publishLocalPosition();
// Publish Global Position, but only if it's any good
if (_gpsIsGood || _global_pos.dead_reckoning) {
publishGlobalPosition();
}
// Publish Global Position, it will have a large uncertainty
// set if only altitude is known
publishGlobalPosition();
// Publish wind estimates
if (hrt_elapsed_time(&_wind.timestamp) > 99000) {