gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-12-28 07:23:17 +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
Download Patch File Download Diff File Expand all files Collapse all files

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