mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
FW Takeoff: fix loiter altitude not set in some cases
* Fix Takeoff mode to respect MIS_TAKEOFF_ALT Takeoff mode never transitions to hold after takeoff alt. * style: run make format
This commit is contained in:
parent
edc2536bdd
commit
f98fdbc452
@ -203,6 +203,8 @@ Takeoff::set_takeoff_position()
|
||||
}
|
||||
|
||||
if (!PX4_ISFINITE(_loiter_altitude_msl)) {
|
||||
_loiter_altitude_msl = takeoff_altitude_amsl;
|
||||
|
||||
if (_navigator->get_loiter_min_alt() > FLT_EPSILON) {
|
||||
_loiter_altitude_msl = math::max(_loiter_altitude_msl, takeoff_altitude_amsl + _navigator->get_loiter_min_alt());
|
||||
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user