diff --git a/src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp b/src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp index 845ad50fbf..a457a6ae37 100644 --- a/src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp +++ b/src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp @@ -2293,6 +2293,7 @@ FixedwingPositionControl::task_main() if (_control_mode.flag_control_manual_enabled) { if (_control_mode.flag_control_altitude_enabled && _global_pos.alt_reset_counter != _alt_reset_counter) { _hold_alt += _global_pos.delta_alt; + _alt_reset_counter = _global_pos.alt_reset_counter; } // adjust navigation waypoints in position control mode