diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-07-04 12:22:55 +0200 |
---|---|---|
committer | Anton Babushkin <anton.babushkin@me.com> | 2014-07-04 12:22:55 +0200 |
commit | 39dab45ac5f9321221eb86e23b0e203ae63f0936 (patch) | |
tree | 7f3f99719a509586db29db0b7174b4e6fd2974ad /src/modules/navigator | |
parent | d7394c7ef973e34d87187420444baad6fcf9854b (diff) | |
parent | 2389a11af1249f657d85d36a5e71db83940a7959 (diff) | |
download | px4-firmware-39dab45ac5f9321221eb86e23b0e203ae63f0936.tar.gz px4-firmware-39dab45ac5f9321221eb86e23b0e203ae63f0936.tar.bz2 px4-firmware-39dab45ac5f9321221eb86e23b0e203ae63f0936.zip |
Merge branch 'master' into dataman_state_nav_rewrite
Diffstat (limited to 'src/modules/navigator')
-rw-r--r-- | src/modules/navigator/mission_block.cpp | 4 | ||||
-rw-r--r-- | src/modules/navigator/rtl.cpp | 2 |
2 files changed, 4 insertions, 2 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 diff --git a/src/modules/navigator/rtl.cpp b/src/modules/navigator/rtl.cpp index 043f773a4..597a2c0ec 100644 --- a/src/modules/navigator/rtl.cpp +++ b/src/modules/navigator/rtl.cpp @@ -227,7 +227,7 @@ RTL::set_rtl_item(position_setpoint_triplet_s *pos_sp_triplet) _navigator->set_can_loiter_at_sp(true); if (autoland) { - mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: RTL: loiter %.1fs", _mission_item.time_inside); + mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: RTL: loiter %.1fs", (double)_mission_item.time_inside); } else { mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: RTL: completed, loiter"); |