From 43c284349096d4e3c964219324e888a312194fe4 Mon Sep 17 00:00:00 2001 From: Pascal Langer Date: Wed, 23 Sep 2020 23:08:26 +0200 Subject: [PATCH] Update AFHDS2A_a7105.ino --- Multiprotocol/AFHDS2A_a7105.ino | 14 ++++++-------- 1 file changed, 6 insertions(+), 8 deletions(-) diff --git a/Multiprotocol/AFHDS2A_a7105.ino b/Multiprotocol/AFHDS2A_a7105.ino index 756d204..3ca8f1b 100644 --- a/Multiprotocol/AFHDS2A_a7105.ino +++ b/Multiprotocol/AFHDS2A_a7105.ino @@ -272,7 +272,7 @@ static void AFHDS2A_build_packet(uint8_t type) #define AFHDS2A_WAIT_WRITE 0x80 #ifdef STM32_BOARD - #define AFHDS2A_WRITE_TIME 1500 + #define AFHDS2A_WRITE_TIME 1550 #else #define AFHDS2A_WRITE_TIME 1700 #endif @@ -281,7 +281,7 @@ uint16_t ReadAFHDS2A() { static uint8_t packet_type; static uint16_t packet_counter; - uint8_t data_rx; + uint8_t data_rx=0; uint16_t start; #ifndef FORCE_AFHDS2A_TUNING A7105_AdjustLOBaseFreq(1); @@ -358,10 +358,8 @@ uint16_t ReadAFHDS2A() telemetry_set_input_sync(3850); #endif AFHDS2A_build_packet(packet_type); - if((A7105_ReadReg(A7105_00_MODE) & 0x01)) // Check if something has been received... - data_rx=0; - else - data_rx=1; // Yes + if((A7105_ReadReg(A7105_00_MODE) & 0x01)==0) // Check if something has been received... + data_rx=1; // Yes A7105_WriteData(AFHDS2A_TXPACKET_SIZE, hopping_frequency[hopping_frequency_no++]); if(hopping_frequency_no >= AFHDS2A_NUMFREQ) hopping_frequency_no = 0; @@ -377,13 +375,13 @@ uint16_t ReadAFHDS2A() } else #endif - packet_type = AFHDS2A_PACKET_STICKS; // todo : check for settings changes + packet_type = AFHDS2A_PACKET_STICKS; // todo : check for settings changes } if(!(A7105_ReadReg(A7105_00_MODE) & (1<<5 | 1<<6)) && data_rx==1) { // RX+FECF+CRCF Ok A7105_ReadData(AFHDS2A_RXPACKET_SIZE); if(packet[0] == 0xAA && packet[9] == 0xFC) - packet_type=AFHDS2A_PACKET_SETTINGS; // RX is asking for settings + packet_type=AFHDS2A_PACKET_SETTINGS; // RX is asking for settings else if((packet[0] == 0xAA && packet[9]!=0xFD) || packet[0] == 0xAC) {// Normal telemetry packet, ignore packets which contain the RX configuration: AA FD FF 32 00 01 00 FF FF FF 05 DC 05 DE FA FF FF FF FF FF FF FF FF FF FF FF FF FF FF