diff --git a/Multiprotocol/Telemetry.ino b/Multiprotocol/Telemetry.ino index a7d692a..c8e8466 100644 --- a/Multiprotocol/Telemetry.ino +++ b/Multiprotocol/Telemetry.ino @@ -24,7 +24,7 @@ #define STUFF_MASK 0x20 #define MAX_PKTX 10 uint8_t pktx[MAX_PKTX]; -uint8_t index; +uint8_t idxt; uint8_t pass = 0; uint8_t frame[18]; @@ -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= FRSKY_SPORT_PACKET_SIZE) + if (idxt >= FRSKY_SPORT_PACKET_SIZE) {//8 bytes no crc sport = 1;//ok to send pass = 0;//reset @@ -407,4 +400,4 @@ void frskyUpdate() #endif } -#endif \ No newline at end of file +#endif