diff --git a/radio/src/opentx.cpp b/radio/src/opentx.cpp index 14a3a8cc2..079125989 100644 --- a/radio/src/opentx.cpp +++ b/radio/src/opentx.cpp @@ -3085,18 +3085,26 @@ void instantTrim() { evalInputs(e_perout_mode_notrainer); - for (uint8_t i=0; isrcRaw-MIXSRC_Rud == stick) { + delta = anas[ed->chn]; + break; + } + } #else - int16_t delta = anas[i]; + int16_t delta = anas[stick]; #endif if (abs(delta) >= INSTANT_TRIM_MARGIN) { - int16_t trim = limit(TRIM_EXTENDED_MIN, (delta + trims[i]) / 2, TRIM_EXTENDED_MAX); - setTrimValue(trim_phase, i, trim); + int16_t trim = limit(TRIM_EXTENDED_MIN, (delta + trims[stick]) / 2, TRIM_EXTENDED_MAX); + setTrimValue(trim_phase, stick, trim); } } }