From 3516e5ae8aaab7a828a5bb7bfa455c94d9451b50 Mon Sep 17 00:00:00 2001
From: pascallanger <planger@mathworks.com>
Date: Sat, 4 Feb 2017 10:11:25 +0100
Subject: [PATCH] FrSkyD telemetry fix

---
 Multiprotocol/Multiprotocol.h | 2 +-
 Multiprotocol/Telemetry.ino   | 3 ++-
 2 files changed, 3 insertions(+), 2 deletions(-)

diff --git a/Multiprotocol/Multiprotocol.h b/Multiprotocol/Multiprotocol.h
index 96a4fad..61af78c 100644
--- a/Multiprotocol/Multiprotocol.h
+++ b/Multiprotocol/Multiprotocol.h
@@ -19,7 +19,7 @@
 #define VERSION_MAJOR		1
 #define VERSION_MINOR		1
 #define VERSION_REVISION	6
-#define VERSION_PATCH_LEVEL	12
+#define VERSION_PATCH_LEVEL	13
 //******************
 // Protocols
 //******************
diff --git a/Multiprotocol/Telemetry.ino b/Multiprotocol/Telemetry.ino
index 8f15ca1..0aa2afd 100644
--- a/Multiprotocol/Telemetry.ino
+++ b/Multiprotocol/Telemetry.ino
@@ -165,7 +165,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
 	if(pkt[1] == rx_tx_addr[3] && pkt[2] == rx_tx_addr[2] && len ==(pkt[0] + 3))
 	{	   
 		telemetry_link|=1;								// Telemetry data is available
-		/*preious version
+		/*previous version
 		RSSI_dBm = (((uint16_t)(pktt[len-2])*18)>>4);
 		if(pktt[len-2] >=128) RSSI_dBm -= 164;
 		else RSSI_dBm += 130;*/
@@ -199,6 +199,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
 					// incorrect sequence
 					RetrySequence = pktt[7] & 0x1F ;
 					telemetry_counter |= 0x80 ;
+					pktt[6]=0 ;							// Discard current packet and wait for retransmit
 				}
 			}
 		}