From 850b7864156b6055b0abea6dc61184071e8d7487 Mon Sep 17 00:00:00 2001
From: Goebish <goebish@gmail.com>
Date: Tue, 1 Oct 2019 19:14:16 +0200
Subject: [PATCH] Add RSSI

---
 Multiprotocol/AFHDS2A_Rx_a7105.ino | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/Multiprotocol/AFHDS2A_Rx_a7105.ino b/Multiprotocol/AFHDS2A_Rx_a7105.ino
index cf356cf..4a81bff 100644
--- a/Multiprotocol/AFHDS2A_Rx_a7105.ino
+++ b/Multiprotocol/AFHDS2A_Rx_a7105.ino
@@ -168,7 +168,8 @@ uint16_t AFHDS2A_Rx_callback()
 			A7105_ReadData(AFHDS2A_RX_TXPACKET_SIZE);
 			if (memcmp(&packet[1], rx_id, 4) == 0 && memcmp(&packet[5], rx_tx_addr, 4) == 0) {
 				if (packet[0] = 0x58 && packet[37] == 0x00 && telemetry_link == 0) { // standard packet, send channels to TX
-					// todo: read RSSI
+					int32_t rssi = min(A7105_ReadReg(A7105_1D_RSSI_THOLD),160);
+					RX_RSSI = map(rssi, 160, 8, 0, 100);
 					AFHDS2A_Rx_build_telemetry_packet();
 					telemetry_link = 1;
 				}