From 600049898a86b166928d02605226edb64b7d0a56 Mon Sep 17 00:00:00 2001
From: Pascal Langer <pascal_langer@yahoo.fr>
Date: Thu, 4 Mar 2021 21:28:06 +0100
Subject: [PATCH] SBUS/CPPM: fixed switching from CPPM to SBUS

---
 Multiprotocol/Multiprotocol.ino | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/Multiprotocol/Multiprotocol.ino b/Multiprotocol/Multiprotocol.ino
index 181e30b..72b4799 100644
--- a/Multiprotocol/Multiprotocol.ino
+++ b/Multiprotocol/Multiprotocol.ino
@@ -2141,7 +2141,11 @@ static void __attribute__((unused)) crc8_update(uint8_t byte)
 		usart_enable(USART1);
 		SbusInitialised = true;
 		#ifdef SEND_CPPM
-			CppmInitialised = false;
+			if(CppmInitialised)
+			{
+				TIMER1_BASE->CR1 = 0 ;
+				CppmInitialised = false;
+			}
 		#endif
 	}
 
@@ -2238,7 +2242,7 @@ static void __attribute__((unused)) crc8_update(uint8_t byte)
 		setupTrainerPulses() ;
 		RCC_BASE->APB2ENR |= RCC_APB2ENR_IOPAEN ;						// Enable portA clock
 		#ifdef SEND_SBUS_SERIAL
-			if ( SbusInitialised == true )
+			if(SbusInitialised)
 			{
 				SbusInitialised = false ;
 				USART1_BASE->CR1 = 0 ;