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

Fixed Frsky telemetry

Browse Source
This commit is contained in:
pascallanger 2016-07-27 20:55:53 +02:00
parent 05cc4b4bd1
commit 9ab8b84d81
2 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Multiprotocol/FrSky_cc2500.ino
View File

@ -195,7 +195,7 @@ uint16_t ReadFrSky_2way()
if (state == FRSKY_DATA1) if (state == FRSKY_DATA1)
{ {
len = CC2500_ReadReg(CC2500_3B_RXBYTES | CC2500_READ_BURST) & 0x7F; len = CC2500_ReadReg(CC2500_3B_RXBYTES | CC2500_READ_BURST) & 0x7F;
if (len<=MAX_PKT)//27 bytes if (len && len<=MAX_PKT)//27 bytes
{ {
CC2500_ReadData(pkt, len); //received telemetry packets CC2500_ReadData(pkt, len); //received telemetry packets
#if defined(TELEMETRY) #if defined(TELEMETRY)

2
Multiprotocol/Telemetry.ino
View File

@ -64,7 +64,7 @@ void compute_RSSIdbm()
void frsky_check_telemetry(uint8_t *pkt,uint8_t len) 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))
{ {
for (uint8_t i=3;i<len;i++) for (uint8_t i=3;i<len;i++)
pktt[i]=pkt[i]; pktt[i]=pkt[i];