From 1916eb30955c6538ba243359d1ff5224309dcaf3 Mon Sep 17 00:00:00 2001 From: Pascal Langer Date: Fri, 10 May 2019 11:04:21 +0200 Subject: [PATCH] AFHDS2A: add debug on full telemetry frames --- Multiprotocol/AFHDS2A_a7105.ino | 13 ++++++++----- Multiprotocol/Multiprotocol.h | 2 +- 2 files changed, 9 insertions(+), 6 deletions(-) diff --git a/Multiprotocol/AFHDS2A_a7105.ino b/Multiprotocol/AFHDS2A_a7105.ino index 9ecb620..8ff9c4a 100644 --- a/Multiprotocol/AFHDS2A_a7105.ino +++ b/Multiprotocol/AFHDS2A_a7105.ino @@ -90,13 +90,8 @@ static void AFHDS2A_update_telemetry() { // forward telemetry to TX, skip rx and tx id to save space pkt[0]= TX_RSSI; - debug("T="); for(int i=9;i < AFHDS2A_RXPACKET_SIZE; i++) - { pkt[i-8]=packet[i]; - debug(" %02X",packet[i]); - } - debugln(""); telemetry_link=2; return; } @@ -328,6 +323,14 @@ uint16_t ReadAFHDS2A() if(!(A7105_ReadReg(A7105_00_MODE) & (1<<5 | 1<<6)) && data_rx==1) { // RX+FECF+CRCF Ok A7105_ReadData(AFHDS2A_RXPACKET_SIZE); + #ifdef DEBUG_SERIAL + debug("T="); + for(uint8_t i=0;i < AFHDS2A_RXPACKET_SIZE; i++) + { + debug(" %02X",packet[i]); + } + debugln(""); + #endif if(packet[0] == 0xaa) { if(packet[9] == 0xfc) diff --git a/Multiprotocol/Multiprotocol.h b/Multiprotocol/Multiprotocol.h index fb261a6..d05643f 100644 --- a/Multiprotocol/Multiprotocol.h +++ b/Multiprotocol/Multiprotocol.h @@ -19,7 +19,7 @@ #define VERSION_MAJOR 1 #define VERSION_MINOR 2 #define VERSION_REVISION 1 -#define VERSION_PATCH_LEVEL 42 +#define VERSION_PATCH_LEVEL 43 //****************** // Protocols