From 4dacac29c6e4220193744f7b3847fb7ad28a613a Mon Sep 17 00:00:00 2001
From: Pascal Langer <planger@mathworks.com>
Date: Thu, 4 Mar 2021 09:52:54 +0100
Subject: [PATCH] SBUS/CPPM: restore normal telemetry on student link lost

Once the setup is done check the "Disable telemetry" box to make sure that there is no interference between the internal module and Multi telemetry.
---
 Multiprotocol/Multiprotocol.ino | 23 ++++++++++++++---------
 1 file changed, 14 insertions(+), 9 deletions(-)

diff --git a/Multiprotocol/Multiprotocol.ino b/Multiprotocol/Multiprotocol.ino
index b50ae27..bcee833 100644
--- a/Multiprotocol/Multiprotocol.ino
+++ b/Multiprotocol/Multiprotocol.ino
@@ -839,15 +839,20 @@ bool Update_All()
 		{ // Protocol requests telemetry to be disabled
 			if( protocol == PROTO_FRSKY_RX || protocol == PROTO_AFHDS2A_RX || protocol == PROTO_BAYANG_RX || protocol == PROTO_DSM_RX )
 			{ // RX protocol
-				#ifdef SEND_SBUS_SERIAL
-					if(telemetry_link & 1)
-						Send_SBUS_USART1();
-				#endif
-				#ifdef SEND_CPPM
-					if(telemetry_link & 2)
-						Send_CCPM_USART1();
-				#endif
-				telemetry_link = 0x80;						// update done
+				if(RX_LQI == 0)
+					telemetry_link = 0x00;						// restore normal telemetry on connection loss
+				else
+				{
+					#ifdef SEND_SBUS_SERIAL
+						if(telemetry_link & 1)
+							Send_SBUS_USART1();
+					#endif
+					#ifdef SEND_CPPM
+						if(telemetry_link & 2)
+							Send_CCPM_USART1();
+					#endif
+					telemetry_link = 0x80;						// update done
+				}
 			}
 		}
 		else