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

Kyosho FHSS/SYNCRO cleanup

Browse Source
This commit is contained in:
pascallanger 2024-01-30 14:53:28 +01:00
parent 69484b5278
commit ce75dd3355
1 changed files with 18 additions and 15 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
Multiprotocol/Kyosho_a7105.ino
View File

@ -34,11 +34,6 @@ static void __attribute__((unused)) KYOSHO_send_packet()
//unknown may be RX ID on some other remotes
memset(packet+5,0xFF,4);
//unknwon but for Syncro the same values are used for bind and normal
packet[27] = sub_protocol==KYOSHO_FHSS?0x05:0x07; // Syncro is 7
packet[28] = 0x00;
memset(packet+29,0xFF,8);
if(IS_BIND_IN_PROGRESS)
{
packet[ 0] = 0xBC; // bind indicator
@ -48,6 +43,11 @@ static void __attribute__((unused)) KYOSHO_send_packet()
//RF table
for(uint8_t i=0; i<16;i++)
packet[i+11]=hopping_frequency[i+(packet[9]<<4)];
//TX type
packet[27] = sub_protocol==KYOSHO_FHSS ? 0x05:0x07; // FHSS is 5 and Syncro is 7
//Unknown
packet[28] = 0x00;
memset(packet+29,0xFF,8);
//frequency hop during bind
if(packet[9])
rf_ch_num=0x8C;
@ -59,18 +59,21 @@ static void __attribute__((unused)) KYOSHO_send_packet()
packet[ 0] = 0x58; // normal packet
//FHSS 14 channels: steering, throttle, ...
//Syncro 6 channels: steering, throttle, ...
for(uint8_t i = 0; i < 14; i++) //needed?: i < (sub_protocol==KYOSHO_FHSS?14:6); i++)
for(uint8_t i = 0; i < 14; i++) //needed? i < (sub_protocol==KYOSHO_FHSS?14:6); i++)
{
uint16_t temp=convert_channel_ppm(i);
packet[9 + i*2]=temp&0xFF; // low byte of servo timing(1000-2000us)
packet[10 + i*2]=(temp>>8)&0xFF; // high byte of servo timing(1000-2000us)
}
if(sub_protocol==KYOSHO_SYNCRO)
{
//memcpy(&packet[21],&hopping_frequency[11],6); // needed?
packet[34] = 0x0F;
packet[36] = 0x0F;
uint16_t temp = convert_channel_ppm(i);
packet[ 9 + i*2] = temp&0xFF; // low byte of servo timing(1000-2000us)
packet[10 + i*2] = (temp>>8)&0xFF; // high byte of servo timing(1000-2000us)
}
// if(sub_protocol==KYOSHO_SYNCRO) // needed?
// {
// memcpy(&packet[21],&hopping_frequency[11],6);
// packet[27] = 0x07;
// packet[28] = 0x00;
// memset(packet+29,0xFF,8);
// packet[34] = 0x0F;
// packet[36] = 0x0F;
// }
rf_ch_num=hopping_frequency[hopping_frequency_no];
hopping_frequency_no++;
packet[34] |= (hopping_frequency_no&0x0F)<<4;