From f95597a7ce053cb5135990c4e9ceae662afe500a Mon Sep 17 00:00:00 2001
From: Raphael Coeffic <raphael.coeffic@frafos.com>
Date: Mon, 14 Mar 2022 09:27:54 +0100
Subject: [PATCH] Enable telemetry mirroring for any telemetry protocol

---
 radio/src/telemetry/crossfire.cpp | 2 --
 radio/src/telemetry/frsky.cpp     | 2 --
 radio/src/telemetry/ghost.cpp     | 2 --
 radio/src/telemetry/telemetry.cpp | 4 ++++
 4 files changed, 4 insertions(+), 6 deletions(-)

diff --git a/radio/src/telemetry/crossfire.cpp b/radio/src/telemetry/crossfire.cpp
index ef30d580f..7feaa28ee 100644
--- a/radio/src/telemetry/crossfire.cpp
+++ b/radio/src/telemetry/crossfire.cpp
@@ -293,8 +293,6 @@ void processCrossfireTelemetryData(uint8_t data, uint8_t module)
   uint8_t * rxBuffer = getTelemetryRxBuffer(module);
   uint8_t &rxBufferCount = getTelemetryRxBufferCount(module);
 
-  telemetryMirrorSend(data);
-
   if (rxBufferCount == 0 && data != RADIO_ADDRESS && data != UART_SYNC) {
     TRACE("[XF] address 0x%02X error", data);
     return;
diff --git a/radio/src/telemetry/frsky.cpp b/radio/src/telemetry/frsky.cpp
index a2d1e798e..f6a35f5a8 100644
--- a/radio/src/telemetry/frsky.cpp
+++ b/radio/src/telemetry/frsky.cpp
@@ -24,8 +24,6 @@
 
 void processFrskyTelemetryData(uint8_t data)
 {
-  telemetryMirrorSend(data);
-
   if (pushFrskyTelemetryData(data)) {
     if (IS_FRSKY_SPORT_PROTOCOL()) {
       sportProcessTelemetryPacket(telemetryRxBuffer);
diff --git a/radio/src/telemetry/ghost.cpp b/radio/src/telemetry/ghost.cpp
index 879eeaaf0..5fcf48353 100755
--- a/radio/src/telemetry/ghost.cpp
+++ b/radio/src/telemetry/ghost.cpp
@@ -322,8 +322,6 @@ void processGhostTelemetryFrame()
 
 void processGhostTelemetryData(uint8_t data)
 {
-  telemetryMirrorSend(data);
-
   if (telemetryRxBufferCount == 0 && data != GHST_ADDR_RADIO) {
     TRACE("[GH] address 0x%02X error", data);
     return;
diff --git a/radio/src/telemetry/telemetry.cpp b/radio/src/telemetry/telemetry.cpp
index 670d94c5d..443e86a36 100644
--- a/radio/src/telemetry/telemetry.cpp
+++ b/radio/src/telemetry/telemetry.cpp
@@ -108,6 +108,10 @@ void telemetryMirrorSend(uint8_t data)
 
 void processTelemetryData(uint8_t data)
 {
+  if (telemetryProtocol != PROTOCOL_TELEMETRY_MULTIMODULE) {
+    telemetryMirrorSend(data);
+  }
+  
 #if defined(CROSSFIRE)
   if (telemetryProtocol == PROTOCOL_TELEMETRY_CROSSFIRE) {
     processCrossfireTelemetryData(data, EXTERNAL_MODULE);