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

Copter: zigzag smoother stops on terrain failure

Browse Source
This commit is contained in:
Randy Mackay 2019-08-22 11:47:43 +09:00
parent 8e385d7453
commit 8a20d37799
1 changed files with 8 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
ArduCopter/mode_zigzag.cpp
View File

@ -122,11 +122,15 @@ void ModeZigZag::return_to_manual_control(bool maintain_target)
if (stage == AUTO) {
stage = MANUAL_REGAIN;
loiter_nav->clear_pilot_desired_acceleration();
if (maintain_target) {
const Vector3f wp_dest = wp_nav->get_wp_destination();
loiter_nav->init_target(wp_dest);
if (maintain_target && wp_nav->origin_and_destination_are_terrain_alt()) {
if (wp_nav->origin_and_destination_are_terrain_alt()) {
copter.surface_tracking.set_target_alt_cm(wp_dest.z);
}
} else {
loiter_nav->init_target();
}
gcs().send_text(MAV_SEVERITY_INFO, "ZigZag: manual control");
}
}