Fixed telemetry mirroring for internal and PXX2 external modules

2022-03-20 16:30:59 +01:00
parent 9fdd5397f6
commit 04c719b180
2 changed files with 6 additions and 2 deletions
@@ -217,6 +217,10 @@ void processResetFrame(uint8_t module, const uint8_t * frame)

 void processTelemetryFrame(uint8_t module, const uint8_t * frame)
 {
+  for (uint8_t i = 0; i < 1 + frame[0]; i++) {
+    telemetryMirrorSend(frame[i]);
+  }
+  
  uint8_t origin = (module << 2) + (frame[3] & 0x03);
  if (origin != TELEMETRY_ENDPOINT_SPORT) {
    sportProcessTelemetryPacketWithoutCrc(origin, &frame[4]);