fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Mission handling: Use default acceptance radius in case its set to zero

Browse Source
This commit is contained in:
Lorenz Meier 2015-12-03 21:24:58 +01:00
parent dc3a101b4a
commit daee5eeefa
1 changed files with 8 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/modules/navigator/mission_block.cpp
View File

@ -143,7 +143,14 @@ MissionBlock::is_mission_item_reached()
}
} else {
/* for normal mission items used their acceptance radius */
if (dist >= 0.0f && dist <= _navigator->get_acceptance_radius(_mission_item.acceptance_radius)) {
float mission_acceptance_radius = _navigator->get_acceptance_radius(_mission_item.acceptance_radius);
/* if set to zero use the default instead */
if (mission_acceptance_radius < 0.001f) {
mission_acceptance_radius = _navigator->get_acceptance_radius();
}
if (dist >= 0.0f && dist <= mission_acceptance_radius) {
_waypoint_position_reached = true;
}
}