diff --git a/tecs/tecs.cpp b/tecs/tecs.cpp index 7680e863b3..b5f8597942 100644 --- a/tecs/tecs.cpp +++ b/tecs/tecs.cpp @@ -522,9 +522,9 @@ void TECS::_initialize_states(float pitch, float throttle_cruise, float baro_alt _vert_pos_state = baro_altitude; _tas_rate_state = 0.0f; _tas_state = _EAS * EAS2TAS; - _throttle_integ_state = (_in_air ? throttle_cruise : 0.0f); + _throttle_integ_state = 0.0f; _pitch_integ_state = 0.0f; - _last_throttle_setpoint = throttle_cruise; + _last_throttle_setpoint = (_in_air ? throttle_cruise : 0.0f);; _last_pitch_setpoint = constrain(pitch, _pitch_setpoint_min, _pitch_setpoint_max); _pitch_setpoint_unc = _last_pitch_setpoint; _hgt_setpoint_adj_prev = baro_altitude;