From aafeab63d56c4d956f6ace771d071060b1d6ac9b Mon Sep 17 00:00:00 2001 From: Andreas Antener Date: Wed, 23 Mar 2016 10:37:35 +0100 Subject: [PATCH] do not try to calculate FOH altitude when distance and acceptance radius are 0 --- src/modules/navigator/mission.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/modules/navigator/mission.cpp b/src/modules/navigator/mission.cpp index b13c8143b5..d5b121fc28 100644 --- a/src/modules/navigator/mission.cpp +++ b/src/modules/navigator/mission.cpp @@ -848,7 +848,7 @@ Mission::altitude_sp_foh_update() } /* Do not try to find a solution if the last waypoint is inside the acceptance radius of the current one */ - if (_distance_current_previous - _navigator->get_acceptance_radius(_mission_item.acceptance_radius) < 0.0f) { + if (_distance_current_previous - _navigator->get_acceptance_radius(_mission_item.acceptance_radius) < FLT_EPSILON) { return; }