Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Rover: boats keep navigating at WP if loiter fails

This commit is contained in:
Randy Mackay 2023-11-28 08:16:12 +09:00
parent cf36ee463a
commit f542d86cd2
1 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
Rover/mode_auto.cpp
View File

@ -77,13 +77,13 @@ void ModeAuto::update()
case Auto_WP: case Auto_WP:
{ {
// boats loiter once the waypoint is reached // boats loiter once the waypoint is reached
bool keep_navigating = true;
if (rover.is_boat() && g2.wp_nav.reached_destination() && !g2.wp_nav.is_fast_waypoint()) { if (rover.is_boat() && g2.wp_nav.reached_destination() && !g2.wp_nav.is_fast_waypoint()) {
start_loiter(); keep_navigating = !start_loiter();
}
// update distance to destination // update navigation controller
_distance_to_destination = rover.current_loc.get_distance(g2.wp_nav.get_destination()); if (keep_navigating) {
} else {
// update navigation controller
navigate_to_waypoint(); navigate_to_waypoint();
} }
break; break;