do not try to calculate FOH altitude when distance and acceptance radius are 0

This commit is contained in:
Andreas Antener
2016-04-02 21:29:26 +01:00
committed by Lorenz Meier
parent 31862be420
commit aafeab63d5
+1 -1
View File
@@ -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;
}