forked from Archive/PX4-Autopilot
Warn on far waypoints
This commit is contained in:
parent
3856ab8d2a
commit
4d03202c4c
|
@ -273,6 +273,10 @@ Mission::check_dist_1wp()
|
||||||
|
|
||||||
if (dist_to_1wp < _param_dist_1wp.get()) {
|
if (dist_to_1wp < _param_dist_1wp.get()) {
|
||||||
_dist_1wp_ok = true;
|
_dist_1wp_ok = true;
|
||||||
|
if (dist_to_1wp > ((_param_dist_1wp.get() * 3) / 2)) {
|
||||||
|
/* allow at 2/3 distance, but warn */
|
||||||
|
mavlink_log_critical(_navigator->get_mavlink_fd(), "Warning: First waypoint very far: %d m", (int)dist_to_1wp);
|
||||||
|
}
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
|
|
Loading…
Reference in New Issue