From c6ab6969490445451f65c09eeb1c2849cd656df0 Mon Sep 17 00:00:00 2001 From: Pascal Langer Date: Mon, 21 Sep 2020 10:57:19 +0200 Subject: [PATCH] AFHDS2A: fix X6B telemetry issue? --- Multiprotocol/AFHDS2A_a7105.ino | 11 +++++++++-- Multiprotocol/Multiprotocol.h | 2 +- 2 files changed, 10 insertions(+), 3 deletions(-) diff --git a/Multiprotocol/AFHDS2A_a7105.ino b/Multiprotocol/AFHDS2A_a7105.ino index b8b528f..756d204 100644 --- a/Multiprotocol/AFHDS2A_a7105.ino +++ b/Multiprotocol/AFHDS2A_a7105.ino @@ -270,6 +270,13 @@ static void AFHDS2A_build_packet(uint8_t type) } #define AFHDS2A_WAIT_WRITE 0x80 + +#ifdef STM32_BOARD + #define AFHDS2A_WRITE_TIME 1500 +#else + #define AFHDS2A_WRITE_TIME 1700 +#endif + uint16_t ReadAFHDS2A() { static uint8_t packet_type; @@ -399,7 +406,7 @@ uint16_t ReadAFHDS2A() } packet_counter++; phase |= AFHDS2A_WAIT_WRITE; - return 1700; + return AFHDS2A_WRITE_TIME; case AFHDS2A_DATA|AFHDS2A_WAIT_WRITE: //Wait for TX completion start=micros(); @@ -410,7 +417,7 @@ uint16_t ReadAFHDS2A() A7105_SetTxRxMode(RX_EN); A7105_Strobe(A7105_RX); phase &= ~AFHDS2A_WAIT_WRITE; - return 2150; + return 3850-AFHDS2A_WRITE_TIME; } return 3850; // never reached, please the compiler } diff --git a/Multiprotocol/Multiprotocol.h b/Multiprotocol/Multiprotocol.h index 411f8d1..fe26da4 100644 --- a/Multiprotocol/Multiprotocol.h +++ b/Multiprotocol/Multiprotocol.h @@ -19,7 +19,7 @@ #define VERSION_MAJOR 1 #define VERSION_MINOR 3 #define VERSION_REVISION 1 -#define VERSION_PATCH_LEVEL 66 +#define VERSION_PATCH_LEVEL 67 //****************** // Protocols