From 197f31d5a1430142018d291174500a74aaa10b1c Mon Sep 17 00:00:00 2001
From: bsongis <bsongis@gmail.com>
Date: Mon, 14 Jul 2014 23:40:59 +0200
Subject: [PATCH] Fixes #1508 - Needs another non regression test

---
 radio/src/opentx.cpp | 8 +++++++-
 1 file changed, 7 insertions(+), 1 deletion(-)

diff --git a/radio/src/opentx.cpp b/radio/src/opentx.cpp
index 07e7082fa..52090bcab 100644
--- a/radio/src/opentx.cpp
+++ b/radio/src/opentx.cpp
@@ -3095,6 +3095,12 @@ ISR(USART0_UDRE_vect)
 
 void instantTrim()
 {
+#if defined(PCBTARANIS)
+  int16_t  anas_0[NUM_INPUTS];
+  evalInputs(e_perout_mode_notrainer | e_perout_mode_nosticks);
+  memcpy(anas_0, anas, sizeof(anas_0));
+#endif
+
   evalInputs(e_perout_mode_notrainer);
 
   for (uint8_t stick=0; stick<NUM_STICKS; stick++) {
@@ -3107,7 +3113,7 @@ void instantTrim()
         ExpoData * ed = expoAddress(e);
         if (!EXPO_VALID(ed)) break; // end of list
         if (ed->srcRaw-MIXSRC_Rud == stick) {
-          delta = anas[ed->chn];
+          delta = anas[ed->chn] - anas_0[ed->chn];
           break;
         }
       }