diff --git a/src/lib/tecs/TECS.cpp b/src/lib/tecs/TECS.cpp index 7b462684e8..cd765b71b5 100644 --- a/src/lib/tecs/TECS.cpp +++ b/src/lib/tecs/TECS.cpp @@ -412,6 +412,7 @@ void TECSControl::_calcPitchControl(float dt, const Input &input, const Specific const float pitch_increment = dt * param.vert_accel_limit / math::max(input.tas, FLT_EPSILON); _pitch_setpoint = constrain(pitch_setpoint, _pitch_setpoint - pitch_increment, _pitch_setpoint + pitch_increment); + _pitch_setpoint = constrain(_pitch_setpoint, param.pitch_min, param.pitch_max); //Debug Output _debug_output.energy_balance_rate_estimate = seb_rate.estimate;