gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-04 21:08:12 +00:00
Code Issues Projects Releases Wiki Activity

Fix AFHDS2A RX_LQI forward on CH

Browse Source 
Hopefully...
This commit is contained in:
pascallanger 2019-10-25 22:03:39 +02:00
parent b156f66146
commit 0fddd9c119
2 changed files with 15 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
Multiprotocol/AFHDS2A_a7105.ino
View File

@ -122,7 +122,8 @@ static void AFHDS2A_update_telemetry()
telemetry_link=1; telemetry_link=1;
break; break;
case AFHDS2A_SENSOR_RX_ERR_RATE: case AFHDS2A_SENSOR_RX_ERR_RATE:
RX_LQI=packet[index+2]; if(packet[index+2]<=100)
RX_LQI=packet[index+2];
break; break;
case AFHDS2A_SENSOR_RX_RSSI: case AFHDS2A_SENSOR_RX_RSSI:
RX_RSSI = -packet[index+2]; RX_RSSI = -packet[index+2];
@ -349,13 +350,19 @@ uint16_t ReadAFHDS2A()
if(packet[0] == 0xAA || packet[0] == 0xAC) if(packet[0] == 0xAA || packet[0] == 0xAC)
{ {
if(!memcmp(&packet[1], rx_tx_addr, 4)) if(!memcmp(&packet[1], rx_tx_addr, 4))
{ // Validate TX address { // TX address validated
#ifdef AFHDS2A_LQI_CH #ifdef AFHDS2A_LQI_CH
for(uint8_t sensor=0; sensor<7; sensor++) if(packet[0]==0xAA && packet[9]!=0xFD)
{//read LQI value for RX output {// Normal telemetry packet
uint8_t index = 9+(4*sensor); for(uint8_t sensor=0; sensor<7; sensor++)
if(packet[index]==AFHDS2A_SENSOR_RX_ERR_RATE) {//read LQI value for RX output
RX_LQI=packet[index+2]; uint8_t index = 9+(4*sensor);
if(packet[index]==AFHDS2A_SENSOR_RX_ERR_RATE && packet[index+2]<=100)
{
RX_LQI=packet[index+2];
break;
}
}
} }
#endif #endif
#if defined(AFHDS2A_FW_TELEMETRY) || defined(AFHDS2A_HUB_TELEMETRY) #if defined(AFHDS2A_FW_TELEMETRY) || defined(AFHDS2A_HUB_TELEMETRY)

2
Multiprotocol/Multiprotocol.h
View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1 #define VERSION_MAJOR 1
#define VERSION_MINOR 3 #define VERSION_MINOR 3
#define VERSION_REVISION 0 #define VERSION_REVISION 0
#define VERSION_PATCH_LEVEL 22 #define VERSION_PATCH_LEVEL 23
//****************** //******************
// Protocols // Protocols