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

FrSkyD telemetry fix

Browse Source
This commit is contained in:
pascallanger 2017-02-04 10:11:25 +01:00
parent 04bbe3187f
commit 3516e5ae8a
2 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Multiprotocol/Multiprotocol.h
View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1 #define VERSION_MAJOR 1
#define VERSION_MINOR 1 #define VERSION_MINOR 1
#define VERSION_REVISION 6 #define VERSION_REVISION 6
#define VERSION_PATCH_LEVEL 12 #define VERSION_PATCH_LEVEL 13
//****************** //******************
// Protocols // Protocols
//****************** //******************

3
Multiprotocol/Telemetry.ino
View File

@ -165,7 +165,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
if(pkt[1] == rx_tx_addr[3] && pkt[2] == rx_tx_addr[2] && len ==(pkt[0] + 3)) if(pkt[1] == rx_tx_addr[3] && pkt[2] == rx_tx_addr[2] && len ==(pkt[0] + 3))
{ {
telemetry_link|=1; // Telemetry data is available telemetry_link|=1; // Telemetry data is available
/*preious version /*previous version
RSSI_dBm = (((uint16_t)(pktt[len-2])*18)>>4); RSSI_dBm = (((uint16_t)(pktt[len-2])*18)>>4);
if(pktt[len-2] >=128) RSSI_dBm -= 164; if(pktt[len-2] >=128) RSSI_dBm -= 164;
else RSSI_dBm += 130;*/ else RSSI_dBm += 130;*/
@ -199,6 +199,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
// incorrect sequence // incorrect sequence
RetrySequence = pktt[7] & 0x1F ; RetrySequence = pktt[7] & 0x1F ;
telemetry_counter |= 0x80 ; telemetry_counter |= 0x80 ;
pktt[6]=0 ; // Discard current packet and wait for retransmit
} }
} }
} }