From b7b279961142dfeee728da4250ff48e20ffc34af Mon Sep 17 00:00:00 2001
From: pascallanger <planger@mathworks.com>
Date: Wed, 31 Aug 2016 10:22:36 +0200
Subject: [PATCH] FrSky option applied live

---
 Multiprotocol/FrSky_cc2500.ino | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/Multiprotocol/FrSky_cc2500.ino b/Multiprotocol/FrSky_cc2500.ino
index 6051524..6e00447 100644
--- a/Multiprotocol/FrSky_cc2500.ino
+++ b/Multiprotocol/FrSky_cc2500.ino
@@ -50,6 +50,7 @@ static void __attribute__((unused)) frsky2way_init(uint8_t bind)
 				val=bind ? 0x43 : 0x03;
 		CC2500_WriteReg(reg,val);
 	}
+	prev_option = option ;
 
 	CC2500_SetTxRxMode(TX_EN);
 	CC2500_SetPower();
@@ -208,6 +209,11 @@ uint16_t ReadFrSky_2way()
 		}
 		CC2500_Strobe(CC2500_SIDLE);
 		CC2500_WriteReg(CC2500_0A_CHANNR, get_chan_num(counter % 47));
+		if ( prev_option != option )
+		{
+			CC2500_WriteReg(CC2500_0C_FSCTRL0,option);	// Frequency offset hack 
+			prev_option = option ;
+		}
 		CC2500_WriteReg(CC2500_23_FSCAL3, 0x89);
 		CC2500_Strobe(CC2500_SFRX);        
 		frsky2way_data_frame();