Another attempt to fix #2722

2015-10-25 21:57:25 +01:00
parent 01226b612a
commit 95040234b3
1 changed files with 4 additions and 2 deletions
@@ -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;
  }