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();