mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 16:13:34 +08:00
Mission feasibility: remove 2/3rds distance warnings that don't reject a mission (#9743)
This commit is contained in:
@@ -497,14 +497,6 @@ MissionFeasibilityChecker::checkDistanceToFirstWaypoint(const mission_s &mission
|
|||||||
|
|
||||||
if (dist_to_1wp < max_distance) {
|
if (dist_to_1wp < max_distance) {
|
||||||
|
|
||||||
if (dist_to_1wp > ((max_distance * 2) / 3)) {
|
|
||||||
/* allow at 2/3 distance, but warn */
|
|
||||||
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
|
|
||||||
"First waypoint far away: %d meters.", (int)dist_to_1wp);
|
|
||||||
|
|
||||||
_navigator->get_mission_result()->warning = true;
|
|
||||||
}
|
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
@@ -557,17 +549,7 @@ MissionFeasibilityChecker::checkDistancesBetweenWaypoints(const mission_s &missi
|
|||||||
mission_item.lat, mission_item.lon,
|
mission_item.lat, mission_item.lon,
|
||||||
last_lat, last_lon);
|
last_lat, last_lon);
|
||||||
|
|
||||||
if (dist_between_waypoints < max_distance) {
|
if (dist_between_waypoints > max_distance) {
|
||||||
|
|
||||||
if (dist_between_waypoints > ((max_distance * 2) / 3)) {
|
|
||||||
/* allow at 2/3 distance, but warn */
|
|
||||||
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
|
|
||||||
"Distance between waypoints very far: %d meters.", (int)dist_between_waypoints);
|
|
||||||
|
|
||||||
_navigator->get_mission_result()->warning = true;
|
|
||||||
}
|
|
||||||
|
|
||||||
} else {
|
|
||||||
/* item is too far from home */
|
/* item is too far from home */
|
||||||
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
|
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
|
||||||
"Distance between waypoints too far: %d meters, %d max.",
|
"Distance between waypoints too far: %d meters, %d max.",
|
||||||
|
|||||||
Reference in New Issue
Block a user