dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

rtl: fixed computation of return altitude if destination is not home 

Signed-off-by: RomanBapst <bapstroman@gmail.com>
This commit is contained in:
RomanBapst 2021-09-02 17:47:19 +03:00 committed by Lorenz Meier
parent d32f0d6168
commit 93075ad5e8
1 changed files with 1 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
src/modules/navigator/rtl.cpp
View File

@ -269,8 +269,7 @@ void RTL::on_activation()
_rtl_alt = calculate_return_alt_from_cone_half_angle((float)_param_rtl_cone_half_angle_deg.get());
} else {
_rtl_alt = max(global_position.alt, max(_destination.alt,
_navigator->get_home_position()->alt + _param_rtl_return_alt.get()));
_rtl_alt = max(global_position.alt, _destination.alt + _param_rtl_return_alt.get());
}