From 9ab8b84d81fc84c9b46485e33b02eb8697baba1c Mon Sep 17 00:00:00 2001 From: pascallanger Date: Wed, 27 Jul 2016 20:55:53 +0200 Subject: [PATCH] Fixed Frsky telemetry --- Multiprotocol/FrSky_cc2500.ino | 2 +- Multiprotocol/Telemetry.ino | 2 +- 2 files changed, 2 insertions(+), 2 deletions(-) diff --git a/Multiprotocol/FrSky_cc2500.ino b/Multiprotocol/FrSky_cc2500.ino index 85f468e..6051524 100644 --- a/Multiprotocol/FrSky_cc2500.ino +++ b/Multiprotocol/FrSky_cc2500.ino @@ -195,7 +195,7 @@ uint16_t ReadFrSky_2way() if (state == FRSKY_DATA1) { 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 #if defined(TELEMETRY) diff --git a/Multiprotocol/Telemetry.ino b/Multiprotocol/Telemetry.ino index a7d692a..cf8d8d6 100644 --- a/Multiprotocol/Telemetry.ino +++ b/Multiprotocol/Telemetry.ino @@ -64,7 +64,7 @@ void compute_RSSIdbm() 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