Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-25 01:03:59 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: do not use guided waypoint for loiter location

Browse Source 
Currently this waypoint is set 10,000m away by the avoidance behaviour

Instead, immediately enter loiter mode
This commit is contained in:
Peter Barker 2020-08-16 11:24:44 +10:00 committed by Randy Mackay
parent 2ee2742707
commit d44ad0a2a7
1 changed files with 10 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
ArduPlane/avoidance_adsb.cpp
View File

@ -134,11 +134,20 @@ void AP_Avoidance_Plane::handle_recovery(RecoveryAction recovery_action)
case RecoveryAction::RESUME_IF_AUTO_ELSE_LOITER: case RecoveryAction::RESUME_IF_AUTO_ELSE_LOITER:
if (prev_control_mode_number == Mode::Number::AUTO) { if (prev_control_mode_number == Mode::Number::AUTO) {
plane.set_mode(plane.mode_auto, ModeReason::AVOIDANCE_RECOVERY); plane.set_mode(plane.mode_auto, ModeReason::AVOIDANCE_RECOVERY);
} else {
// let ModeAvoidADSB continue in its guided
// behaviour, but reset the loiter location,
// rather than where the avoidance location was
plane.guided_WP_loc = plane.current_loc;
plane.set_guided_WP();
} }
// else do nothing, same as RecoveryAction::LOITER
break; break;
default: default:
// user has specified an invalid recovery action;
// loiter where we are
plane.guided_WP_loc = plane.current_loc;
plane.set_guided_WP();
break; break;
} // switch } // switch
} }