From 95040234b36db3a2668f37eee03e3ca7c5babe5e Mon Sep 17 00:00:00 2001
From: Bertrand Songis <bsongis@gmail.com>
Date: Sun, 25 Oct 2015 21:57:25 +0100
Subject: [PATCH] Another attempt to fix #2722

---
 radio/src/targets/taranis/trainer_driver.cpp | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

diff --git a/radio/src/targets/taranis/trainer_driver.cpp b/radio/src/targets/taranis/trainer_driver.cpp
index 4094edfd1..7e56b08fb 100644
--- a/radio/src/targets/taranis/trainer_driver.cpp
+++ b/radio/src/targets/taranis/trainer_driver.cpp
@@ -249,8 +249,10 @@ extern "C" void HEARTBEAT_USART_IRQHandler()
   while (status & (USART_FLAG_RXNE | USART_FLAG_ERRORS)) {
     data = HEARTBEAT_USART->DR;
 
-    if (!(status & USART_FLAG_ERRORS))
-      sbusFifo.push(data);
+    if (!(status & USART_FLAG_ERRORS)) {
+      if (currentTrainerMode == TRAINER_MODE_MASTER_SBUS_EXTERNAL_MODULE)
+        sbusFifo.push(data);
+    }
 
     status = HEARTBEAT_USART->SR;
   }