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:
Ryan Johnston 2026-01-16 10:32:15 -06:00 committed by GitHub
parent edc2536bdd
commit f98fdbc452
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194

View File

@ -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());