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

FRSKY1

Browse Source
This commit is contained in:
pascallanger 2016-09-01 18:09:35 +02:00
parent 043a8336e5
commit 7c43c38e28
1 changed files with 8 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
Multiprotocol/FrSky1_cc2500.ino
View File

@ -165,24 +165,25 @@ static uint16_t ReadFRSKY1()
} }
if (state >= FRSKY_DATA1) if (state >= FRSKY_DATA1)
{ {
CC2500_Strobe(CC2500_SIDLE);
uint8_t chan = FRSKY1_calc_channel(); uint8_t chan = FRSKY1_calc_channel();
CC2500_WriteReg(CC2500_0A_CHANNR, chan * 5 + 6); CC2500_Strobe(CC2500_SIDLE);
FRSKY1_build_data_packet();
CC2500_WriteData(packet, packet[0]+1);
if (state == FRSKY_DATA5)
{
if (option != prev_option) if (option != prev_option)
{ {
CC2500_WriteReg(CC2500_0C_FSCTRL0, option); CC2500_WriteReg(CC2500_0C_FSCTRL0, option);
prev_option=option; prev_option=option;
} }
CC2500_WriteReg(CC2500_0A_CHANNR, chan * 5 + 6);
FRSKY1_build_data_packet();
if (state == FRSKY_DATA5)
{
CC2500_SetPower(); CC2500_SetPower();
state = FRSKY_DATA1; state = FRSKY_DATA1;
} }
else else
state++; state++;
CC2500_WriteData(packet, packet[0]+1);
return 9006; return 9006;
} }
return 0; return 0;
@ -190,7 +191,6 @@ static uint16_t ReadFRSKY1()
uint16_t initFRSKY1() uint16_t initFRSKY1()
{ {
//u8 data[2] = {(fixed_id >> 8) & 0xff, fixed_id & 0xff};
crc8 = FRSKY1_crc8_le(0x6b, rx_tx_addr+2, 2); // Use rx_tx_addr[2] and rx_tx_addr[3] since we want to use RX_Num crc8 = FRSKY1_crc8_le(0x6b, rx_tx_addr+2, 2); // Use rx_tx_addr[2] and rx_tx_addr[3] since we want to use RX_Num
FRSKY1_init(); FRSKY1_init();
seed = 1; seed = 1;