diff --git a/src/modules/flight_mode_manager/tasks/ManualAltitude/FlightTaskManualAltitude.cpp b/src/modules/flight_mode_manager/tasks/ManualAltitude/FlightTaskManualAltitude.cpp index 942165a8b8..95cc9630d7 100644 --- a/src/modules/flight_mode_manager/tasks/ManualAltitude/FlightTaskManualAltitude.cpp +++ b/src/modules/flight_mode_manager/tasks/ManualAltitude/FlightTaskManualAltitude.cpp @@ -352,7 +352,7 @@ void FlightTaskManualAltitude::_updateSetpoints() sp = _man_input_filter.getState(); _rotateIntoHeadingFrame(sp); - if (sp.length() > 1.0f) { + if (sp.longerThan(1.0f)) { sp.normalize(); }