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

MT99xx protocol for MT99xx, Eachine H7, Yi Zhan i6S

Browse Source
This commit is contained in:
pascallanger
2016-02-01 13:23:28 +01:00
parent 4c8a0b9a63
commit 11283a2199
5 changed files with 243 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
Multiprotocol/Telemetry.ino
View File

@@ -37,6 +37,24 @@ void compute_RSSIdbm(){
RSSI_dBm += 65;
}
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)
{//only packets with the required id and packet length
for(uint8_t i=3;i<6;i++)
pktt[i]=0;
return;
}
else
{
for (uint8_t i=3;i<len;i++)
pktt[i]=pkt[i];
telemetry_link=1;
if(pktt[6]>0)
telemetry_counter=(telemetry_counter+1)%32;
}
}
void frsky_link_frame()
{
frame[0] = 0xFE;