mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-26 01:43:35 +08:00
Remove acceptance radius from takeoff altitude for MC
This commit is contained in:
@@ -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)
|
if ((_mission_item.nav_cmd == NAV_CMD_TAKEOFF || _mission_item.nav_cmd == NAV_CMD_VTOL_TAKEOFF)
|
||||||
&& _navigator->get_vstatus()->is_rotary_wing) {
|
&& _navigator->get_vstatus()->is_rotary_wing) {
|
||||||
/* require only altitude for takeoff for multicopter, do not use waypoint acceptance radius */
|
/* require only altitude for takeoff for multicopter, do not use waypoint acceptance radius */
|
||||||
if (_navigator->get_global_position()->alt >
|
if (_navigator->get_global_position()->alt >= altitude_amsl) {
|
||||||
altitude_amsl - _navigator->get_altitude_acceptance_radius()) {
|
|
||||||
_waypoint_position_reached = true;
|
_waypoint_position_reached = true;
|
||||||
}
|
}
|
||||||
} else if (_mission_item.nav_cmd == NAV_CMD_TAKEOFF) {
|
} else if (_mission_item.nav_cmd == NAV_CMD_TAKEOFF) {
|
||||||
|
|||||||
Reference in New Issue
Block a user