aboutsummaryrefslogtreecommitdiff
path: root/src/modules/navigator/mission_block.cpp
diff options
context:
space:
mode:
authorLorenz Meier <lm@inf.ethz.ch>2014-06-30 12:20:23 +0200
committerLorenz Meier <lm@inf.ethz.ch>2014-06-30 12:20:23 +0200
commit20de2da032083187bd89914942ffc8574904c885 (patch)
treeaa552bcda048250b28d3c62bb6470fc37cf79a75 /src/modules/navigator/mission_block.cpp
parent35cd487a428a9c76609faa8ae0f99afdc376b5a1 (diff)
downloadpx4-firmware-20de2da032083187bd89914942ffc8574904c885.tar.gz
px4-firmware-20de2da032083187bd89914942ffc8574904c885.tar.bz2
px4-firmware-20de2da032083187bd89914942ffc8574904c885.zip
Navigator: Warning fixes
Diffstat (limited to 'src/modules/navigator/mission_block.cpp')
-rw-r--r--src/modules/navigator/mission_block.cpp4
1 files changed, 3 insertions, 1 deletions
diff --git a/src/modules/navigator/mission_block.cpp b/src/modules/navigator/mission_block.cpp
index 9b8d3d9c7..26a573544 100644
--- a/src/modules/navigator/mission_block.cpp
+++ b/src/modules/navigator/mission_block.cpp
@@ -42,6 +42,8 @@
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
+#include <math.h>
+#include <float.h>
#include <systemlib/err.h>
#include <geo/geo.h>
@@ -222,7 +224,7 @@ MissionBlock::set_loiter_item(struct position_setpoint_triplet_s *pos_sp_triplet
}
if (pos_sp_triplet->current.type != SETPOINT_TYPE_LOITER
- || pos_sp_triplet->current.loiter_radius != _navigator->get_loiter_radius()
+ || (fabsf(pos_sp_triplet->current.loiter_radius - _navigator->get_loiter_radius()) > FLT_EPSILON)
|| pos_sp_triplet->current.loiter_direction != 1
|| pos_sp_triplet->previous.valid
|| !pos_sp_triplet->current.valid