From c7e7a559a694d4cec36c6ac9db53648011f1d521 Mon Sep 17 00:00:00 2001
From: pascallanger <planger@mathworks.com>
Date: Tue, 31 Jan 2017 15:26:49 +0100
Subject: [PATCH] FrSkyD Telemetry update

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

diff --git a/Multiprotocol/Telemetry.ino b/Multiprotocol/Telemetry.ino
index 7b3e85c..8789ffb 100644
--- a/Multiprotocol/Telemetry.ino
+++ b/Multiprotocol/Telemetry.ino
@@ -176,7 +176,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
 		for (uint8_t i=3;i<len;i++)
 			pktt[i]=pkt[i];				 
 		telemetry_link=1;
-		if(pktt[6])
+		if(pktt[6]>0 && pktt[6]<=10)	//increment only for valid hub frames
 			telemetry_counter=(telemetry_counter+1)%32;
 		//
 #if defined SPORT_TELEMETRY && defined FRSKYX_CC2500_INO
@@ -253,19 +253,7 @@ void frsky_user_frame()
 			case 0:
 				indexx=pktt[6];
 				for(i=0;i<indexx;i++)
-				{
-//					if(pktt[j]==0x5E)
-//					{
-//						if(c++)
-//						{
-//							c=0;
-//							n++;
-//							j++;
-//						}
-//					}
 					pktx[i]=pktt[j++];
-				}	
-//				indexx = indexx-n;
 				pass=1;
 				
 			case 1:
@@ -613,6 +601,7 @@ void TelemetryUpdate()
 		{
 			AFHDSA_short_frame();
 			telemetry_link=0;
+			return;
 		}
     #endif        
 		if(telemetry_link && protocol != MODE_FRSKYX )
diff --git a/Multiprotocol/_Config.h b/Multiprotocol/_Config.h
index c3e6732..363f6bf 100644
--- a/Multiprotocol/_Config.h
+++ b/Multiprotocol/_Config.h
@@ -118,7 +118,7 @@
 //On a 9XR_PRO running ersky9x both commented and uncommented will work depending on the radio setting Invert COM1 under the Telemetry menu.
 //On other addon/replacement boards like the 9xtreme board or the Ar9x board, you need to uncomment the line below.
 //For er9x it depends if you have an inveter mod or not on the telemetry pin. If you don't have an inverter comment this line.
-#define INVERT_TELEMETRY
+//#define INVERT_TELEMETRY
 
 //Comment if you don't want to send Multi status telemetry frames (Protocol available, Bind in progress, version...)
 //Use with er9x/erksy9x, for OpenTX MULTI_TELEMETRY below is preferred instead