gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-11 00:48:14 +00:00
Code Issues Projects Releases Wiki Activity

FrSky option applied live

Browse Source
This commit is contained in:
pascallanger 2016-08-31 10:22:36 +02:00
parent ece59ac374
commit b7b2799611
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
Multiprotocol/FrSky_cc2500.ino
View File

@ -50,6 +50,7 @@ static void __attribute__((unused)) frsky2way_init(uint8_t bind)
val=bind ? 0x43 : 0x03; val=bind ? 0x43 : 0x03;
CC2500_WriteReg(reg,val); CC2500_WriteReg(reg,val);
} }
prev_option = option ;
CC2500_SetTxRxMode(TX_EN); CC2500_SetTxRxMode(TX_EN);
CC2500_SetPower(); CC2500_SetPower();
@ -208,6 +209,11 @@ uint16_t ReadFrSky_2way()
} }
CC2500_Strobe(CC2500_SIDLE); CC2500_Strobe(CC2500_SIDLE);
CC2500_WriteReg(CC2500_0A_CHANNR, get_chan_num(counter % 47)); 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_WriteReg(CC2500_23_FSCAL3, 0x89);
CC2500_Strobe(CC2500_SFRX); CC2500_Strobe(CC2500_SFRX);
frsky2way_data_frame(); frsky2way_data_frame();