yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-21 01:12:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

fix qgc flow takeoff -> use min takeoff alt if no home position

Browse Source
This commit is contained in:
ChristophTobler
2017-05-10 09:05:39 +02:00
committed by ChristophTobler
parent cdd7c57ded
commit 680cebcb08
1 changed files with 10 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
src/modules/navigator/takeoff.cpp
View File

@@ -104,10 +104,17 @@ Takeoff::set_takeoff_position()
float abs_altitude = 0.0f;
const float min_abs_altitude = _navigator->get_home_position()->alt + _param_min_alt.get();
float min_abs_altitude;
// Use altitude if it has been set.
if (rep->current.valid && PX4_ISFINITE(rep->current.alt)) {
if (_navigator->home_position_valid()) { //only use home position if it is valid
min_abs_altitude = _navigator->get_global_position()->alt + _param_min_alt.get();
} else { //e.g. flow
min_abs_altitude = _param_min_alt.get();
}
// Use altitude if it has been set. If home position is invalid use min_abs_altitude
if (rep->current.valid && PX4_ISFINITE(rep->current.alt) && _navigator->home_position_valid()) {
abs_altitude = rep->current.alt;
// If the altitude suggestion is lower than home + minimum clearance, raise it and complain.