From 21a37013b03c10ce8708d682d1916f67dacf4a84 Mon Sep 17 00:00:00 2001
From: midelic <midelic@gmail.com>
Date: Fri, 12 Aug 2016 00:51:40 +0300
Subject: [PATCH] Change option value on the fly

---
 Multiprotocol/FrSkyX_cc2500.ino | 8 +++++++-
 1 file changed, 7 insertions(+), 1 deletion(-)

diff --git a/Multiprotocol/FrSkyX_cc2500.ino b/Multiprotocol/FrSkyX_cc2500.ino
index 4b198af..f4aea70 100644
--- a/Multiprotocol/FrSkyX_cc2500.ino
+++ b/Multiprotocol/FrSkyX_cc2500.ino
@@ -124,7 +124,8 @@ static void __attribute__((unused)) frskyX_init()
 		CC2500_WriteReg(reg,val);
 	}
 
-	CC2500_WriteReg(CC2500_07_PKTCTRL1, 0x04);			
+	CC2500_WriteReg(CC2500_07_PKTCTRL1, 0x04);
+        LastOption = option ;
 	CC2500_WriteReg(CC2500_0C_FSCTRL0, option);
 	CC2500_Strobe(CC2500_SIDLE);    
 	//
@@ -287,6 +288,11 @@ uint16_t ReadFrSkyX()
 			state++;			
 			break;		
 		case FRSKY_DATA1:
+			if ( LastOption != option )
+			{
+				CC2500_WriteReg(CC2500_0C_FSCTRL0,option);	// Frequency offset hack 
+				LastOption = option ;
+			}
 			LED_ON;
 			CC2500_SetTxRxMode(TX_EN);
 			set_start(channr);