AFHDS2A: add debug on full telemetry frames

This commit is contained in:
Pascal Langer 2019-05-10 11:04:21 +02:00
parent fc3eec7ae1
commit 1916eb3095
2 changed files with 9 additions and 6 deletions

View File

@ -90,13 +90,8 @@ static void AFHDS2A_update_telemetry()
{ {
// forward telemetry to TX, skip rx and tx id to save space // forward telemetry to TX, skip rx and tx id to save space
pkt[0]= TX_RSSI; pkt[0]= TX_RSSI;
debug("T=");
for(int i=9;i < AFHDS2A_RXPACKET_SIZE; i++) for(int i=9;i < AFHDS2A_RXPACKET_SIZE; i++)
{
pkt[i-8]=packet[i]; pkt[i-8]=packet[i];
debug(" %02X",packet[i]);
}
debugln("");
telemetry_link=2; telemetry_link=2;
return; return;
} }
@ -328,6 +323,14 @@ uint16_t ReadAFHDS2A()
if(!(A7105_ReadReg(A7105_00_MODE) & (1<<5 | 1<<6)) && data_rx==1) if(!(A7105_ReadReg(A7105_00_MODE) & (1<<5 | 1<<6)) && data_rx==1)
{ // RX+FECF+CRCF Ok { // RX+FECF+CRCF Ok
A7105_ReadData(AFHDS2A_RXPACKET_SIZE); 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[0] == 0xaa)
{ {
if(packet[9] == 0xfc) if(packet[9] == 0xfc)

View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1 #define VERSION_MAJOR 1
#define VERSION_MINOR 2 #define VERSION_MINOR 2
#define VERSION_REVISION 1 #define VERSION_REVISION 1
#define VERSION_PATCH_LEVEL 42 #define VERSION_PATCH_LEVEL 43
//****************** //******************
// Protocols // Protocols