From d681ba424a77c4ce21c54ce12e727eb88587c919 Mon Sep 17 00:00:00 2001
From: Bertrand Songis <bsongis@gmail.com>
Date: Sat, 7 Sep 2019 13:11:04 +0200
Subject: [PATCH] Fixes #6717

---
 radio/src/telemetry/frsky_sport.cpp | 9 ++++++++-
 1 file changed, 8 insertions(+), 1 deletion(-)

diff --git a/radio/src/telemetry/frsky_sport.cpp b/radio/src/telemetry/frsky_sport.cpp
index 1a268e69d..daa3afaf1 100644
--- a/radio/src/telemetry/frsky_sport.cpp
+++ b/radio/src/telemetry/frsky_sport.cpp
@@ -162,7 +162,14 @@ void sportProcessTelemetryPacketWithoutCrc(uint8_t origin, const uint8_t * packe
 #endif
 
   if (primId == DATA_FRAME) {
-    uint8_t originMask = (origin == TELEMETRY_ENDPOINT_SPORT ? 0x02 : origin >> 2);
+    uint8_t originMask;
+    if (origin == TELEMETRY_ENDPOINT_SPORT) {
+      originMask = 0x04;
+    }
+    else {
+      uint8_t moduleIndex = (origin >> 2);
+      originMask = 0x01 << moduleIndex;
+    }
     uint8_t instance = physicalId + (origin << 5);
     if (dataId == RSSI_ID) {
       data = SPORT_DATA_U8(packet);