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
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)

View File

@ -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