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:48:12 +00:00
Code Issues Projects Releases Wiki Activity

AFHDS2A: Fix LQI to channel

Browse Source
This commit is contained in:
pascallanger 2019-10-26 15:40:46 +02:00
parent aee92737ca
commit 61970b028e
2 changed files with 14 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
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];
@ -346,11 +347,17 @@ uint16_t ReadAFHDS2A()
if(!memcmp(&packet[1], rx_tx_addr, 4)) if(!memcmp(&packet[1], rx_tx_addr, 4))
{ // Validate TX address { // Validate TX address
#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 2 #define VERSION_MINOR 2
#define VERSION_REVISION 1 #define VERSION_REVISION 1
#define VERSION_PATCH_LEVEL 85 #define VERSION_PATCH_LEVEL 86
//****************** //******************
// Protocols // Protocols