From 2bca19fc5e19e383dda41dc6da0671f16a503f5f Mon Sep 17 00:00:00 2001 From: sander Date: Thu, 28 Jul 2016 21:01:56 +0200 Subject: [PATCH] Remove acceptance radius from takeoff altitude for MC --- src/modules/navigator/mission_block.cpp | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) diff --git a/src/modules/navigator/mission_block.cpp b/src/modules/navigator/mission_block.cpp index 34eb53edbe..9e9ed4785d 100644 --- a/src/modules/navigator/mission_block.cpp +++ b/src/modules/navigator/mission_block.cpp @@ -166,8 +166,7 @@ MissionBlock::is_mission_item_reached() if ((_mission_item.nav_cmd == NAV_CMD_TAKEOFF || _mission_item.nav_cmd == NAV_CMD_VTOL_TAKEOFF) && _navigator->get_vstatus()->is_rotary_wing) { /* require only altitude for takeoff for multicopter, do not use waypoint acceptance radius */ - if (_navigator->get_global_position()->alt > - altitude_amsl - _navigator->get_altitude_acceptance_radius()) { + if (_navigator->get_global_position()->alt >= altitude_amsl) { _waypoint_position_reached = true; } } else if (_mission_item.nav_cmd == NAV_CMD_TAKEOFF) {