From 1e448b09a9c249b6b0ad363f1c7a587cf9c62b75 Mon Sep 17 00:00:00 2001
From: 3djc <lesitewebdejc@hotmail.com>
Date: Sun, 2 Dec 2018 09:10:08 +0100
Subject: [PATCH] RSSI handling

---
 radio/src/telemetry/frsky.cpp | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/radio/src/telemetry/frsky.cpp b/radio/src/telemetry/frsky.cpp
index e2c072e2d..94349eaed 100644
--- a/radio/src/telemetry/frsky.cpp
+++ b/radio/src/telemetry/frsky.cpp
@@ -51,6 +51,12 @@ void processFrskyPXX2Data(uint8_t data)
         telemetryRxBuffer[telemetryRxBufferCount++] = data;
         if (telemetryRxBuffer[0] + 3 /* 1 byte for length, 2 bytes for CRC */ == telemetryRxBufferCount) {
           if (checkPXX2PacketCRC(telemetryRxBuffer)) {
+            if (telemetryRxBuffer[2] & 0x80) {
+              telemetryData.rssi.set(telemetryRxBuffer[2] & 0x7f);
+            }
+            else {
+              // TODO : vbat handling
+            }
             sportProcessTelemetryPacketWithoutCrc(telemetryRxBuffer + 6 /* LEN, TYPE, RSSI/BAT, TP/SS/FW_T, FW_VER, Data ID */);
           }
           telemetryRxBufferCount = 0;