gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-07-06 13:57:54 +00:00
Code Issues Projects Releases Wiki Activity

AFHDS2A: changes

Browse Source
This commit is contained in:
pascallanger 2016-10-21 10:55:55 +02:00
parent d1e40ee71c
commit 42c7431416
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
Multiprotocol/AFHDS2A_a7105.ino
View File

@ -159,7 +159,6 @@ static void AFHDS2A_build_packet(uint8_t type)
packet[9 + ch*2] = Servo_data[CH_AETR[ch]]&0xFF; packet[9 + ch*2] = Servo_data[CH_AETR[ch]]&0xFF;
packet[10 + ch*2] = (Servo_data[CH_AETR[ch]]>>8)&0xFF; packet[10 + ch*2] = (Servo_data[CH_AETR[ch]]>>8)&0xFF;
} }
packet[37] = 0x00;
break; break;
case AFHDS2A_PACKET_FAILSAFE: case AFHDS2A_PACKET_FAILSAFE:
packet[0] = 0x56; packet[0] = 0x56;
@ -176,7 +175,6 @@ static void AFHDS2A_build_packet(uint8_t type)
packet[10+ ch*2] = 0xff; packet[10+ ch*2] = 0xff;
} }
} }
packet[37] = 0x00;
break; break;
case AFHDS2A_PACKET_SETTINGS: case AFHDS2A_PACKET_SETTINGS:
packet[0] = 0xaa; packet[0] = 0xaa;
@ -200,16 +198,16 @@ static void AFHDS2A_build_packet(uint8_t type)
packet[21] = 0xdd; // SBUS output enabled packet[21] = 0xdd; // SBUS output enabled
else else
packet[21] = 0xde; // IBUS packet[21] = 0xde; // IBUS
packet[37] = 0x00;
break; break;
} }
packet[37] = 0x00;
} }
#define AFHDS2A_WAIT_WRITE 0x80 #define AFHDS2A_WAIT_WRITE 0x80
uint16_t ReadAFHDS2A() uint16_t ReadAFHDS2A()
{ {
static uint8_t packet_type = AFHDS2A_PACKET_STICKS; static uint8_t packet_type = AFHDS2A_PACKET_STICKS;
static int32_t packet_counter=0; static uint16_t packet_counter=0;
switch(phase) switch(phase)
{ {
@ -255,6 +253,8 @@ uint16_t ReadAFHDS2A()
bind_phase++; bind_phase++;
if(bind_phase>=4) if(bind_phase>=4)
{ {
packet_counter=0;
packet_type = AFHDS2A_PACKET_STICKS;
hopping_frequency_no=1; hopping_frequency_no=1;
phase = AFHDS2A_DATA; phase = AFHDS2A_DATA;
BIND_DONE; BIND_DONE;