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 update

Browse Source
This commit is contained in:
pascallanger
2017-01-31 15:26:49 +01:00
parent 4f5dfcc65b
commit c7e7a559a6
2 changed files with 3 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
Multiprotocol/Telemetry.ino
View File

@@ -176,7 +176,7 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
for (uint8_t i=3;i<len;i++)
pktt[i]=pkt[i];
telemetry_link=1;
if(pktt[6])
if(pktt[6]>0 && pktt[6]<=10) //increment only for valid hub frames
telemetry_counter=(telemetry_counter+1)%32;
//
#if defined SPORT_TELEMETRY && defined FRSKYX_CC2500_INO
@@ -253,19 +253,7 @@ void frsky_user_frame()
case 0:
indexx=pktt[6];
for(i=0;i<indexx;i++)
{
// if(pktt[j]==0x5E)
// {
// if(c++)
// {
// c=0;
// n++;
// j++;
// }
// }
pktx[i]=pktt[j++];
}
// indexx = indexx-n;
pass=1;
case 1:
@@ -613,6 +601,7 @@ void TelemetryUpdate()
{
AFHDSA_short_frame();
telemetry_link=0;
return;
}
#endif
if(telemetry_link && protocol != MODE_FRSKYX )