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

AC_WPNav: OA handles failure to set wp on deactivation 

This may never happen in practice but just in case
This commit is contained in:
Randy Mackay 2023-12-01 17:11:44 +09:00
parent 8546dfaf4d
commit 0c8f427d42
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AC_WPNav/AC_WPNav_OA.cpp
View File

@ -91,7 +91,10 @@ bool AC_WPNav_OA::update_wpnav()
case AP_OAPathPlanner::OA_NOT_REQUIRED:
if (_oa_state != oa_retstate) {
// object avoidance has become inactive so reset target to original destination
set_wp_destination(_destination_oabak, _terrain_alt_oabak);
if (!set_wp_destination(_destination_oabak, _terrain_alt_oabak)) {
// trigger terrain failsafe
return false;
}
_oa_state = oa_retstate;
}
break;