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

Flysky CX20 mods

Browse Source
This commit is contained in:
pascallanger 2016-11-30 12:18:39 +01:00
parent 2dbf8ebb65
commit 7228b84bf8
1 changed files with 11 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
Multiprotocol/FlySky_a7105.ino
View File

@ -121,9 +121,8 @@ static void __attribute__((unused)) flysky_apply_extension_flags()
break; break;
case CX20: case CX20:
packet_count++;
packet[19] = 0x00; // unknown packet[19] = 0x00; // unknown
packet[20] = (packet_count<<4)|0x0A; packet[20] = (hopping_frequency_no<<4)|0x0A;
break; break;
default: default:
break; break;
@ -164,10 +163,10 @@ uint16_t ReadFlySky()
else else
{ {
flysky_build_packet(0); flysky_build_packet(0);
A7105_WriteData(21, hopping_frequency[hopping_frequency_no]); A7105_WriteData(21, hopping_frequency[hopping_frequency_no & 0x0F]);
hopping_frequency_no = (hopping_frequency_no + 1) & 0x0F;
A7105_SetPower(); A7105_SetPower();
} }
hopping_frequency_no++;
if(sub_protocol==CX20) if(sub_protocol==CX20)
return 3984; return 3984;
@ -199,24 +198,28 @@ uint16_t initFlySky()
chanrow=rx_tx_addr[3] & 0x0F; chanrow=rx_tx_addr[3] & 0x0F;
chanoffset=rx_tx_addr[3]/16; chanoffset=rx_tx_addr[3]/16;
if(sub_protocol==CX20)
{//Haven't figured yet the relation between TX ID and Frequencies
memcpy(rx_tx_addr,"\x06\x35\x89\x72",4);
}
// Build frequency hop table // Build frequency hop table
for(uint8_t i=0;i<16;i++) for(uint8_t i=0;i<16;i++)
{ {
temp=pgm_read_byte_near(&tx_channels[chanrow>>1][i>>2]); temp=pgm_read_byte_near(&tx_channels[chanrow>>1][i>>2]);
if(i&0x01) if(i&0x02)
temp&=0x0F; temp&=0x0F;
else else
temp>>=4; temp>>=4;
temp*=0x0A; temp*=0x0A;
if(i&0x02) if(i&0x01)
temp+=0x50; temp+=0x50;
hopping_frequency[((chanrow&1)?15-i:i)]=temp-chanoffset; hopping_frequency[((chanrow&1)?15-i:i)]=temp-chanoffset;
} }
hopping_frequency_no=0; hopping_frequency_no=0;
if(sub_protocol==CX20) if(sub_protocol==CX20)
{//Haven't figured yet the relation between TX ID and Frequencies {//Haven't figured yet the relation between TX ID and Frequencies
memcpy(rx_tx_addr,"\x06\x35\x89\x72",4); hopping_frequency[0]=0x3A;
memcpy(hopping_frequency,"\x35\x85\x21\x71\x2B\x7B\x3A\x53\x49\x26\x0D\x5D\x3F\x8F\x17\x6",16); hopping_frequency[3]=0x99;
} }
packet_count=0; packet_count=0;
if(IS_AUTOBIND_FLAG_on) if(IS_AUTOBIND_FLAG_on)