gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-11 00:28:14 +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
Show Stats 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++) for (uint8_t i=3;i<len;i++)
pktt[i]=pkt[i]; pktt[i]=pkt[i];
telemetry_link=1; 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; telemetry_counter=(telemetry_counter+1)%32;
// //
#if defined SPORT_TELEMETRY && defined FRSKYX_CC2500_INO #if defined SPORT_TELEMETRY && defined FRSKYX_CC2500_INO
@ -253,19 +253,7 @@ void frsky_user_frame()
case 0: case 0:
indexx=pktt[6]; indexx=pktt[6];
for(i=0;i<indexx;i++) for(i=0;i<indexx;i++)
{
// if(pktt[j]==0x5E)
// {
// if(c++)
// {
// c=0;
// n++;
// j++;
// }
// }
pktx[i]=pktt[j++]; pktx[i]=pktt[j++];
}
// indexx = indexx-n;
pass=1; pass=1;
case 1: case 1:
@ -613,6 +601,7 @@ void TelemetryUpdate()
{ {
AFHDSA_short_frame(); AFHDSA_short_frame();
telemetry_link=0; telemetry_link=0;
return;
} }
#endif #endif
if(telemetry_link && protocol != MODE_FRSKYX ) if(telemetry_link && protocol != MODE_FRSKYX )

2
Multiprotocol/_Config.h
View File

@ -118,7 +118,7 @@
//On a 9XR_PRO running ersky9x both commented and uncommented will work depending on the radio setting Invert COM1 under the Telemetry menu. //On a 9XR_PRO running ersky9x both commented and uncommented will work depending on the radio setting Invert COM1 under the Telemetry menu.
//On other addon/replacement boards like the 9xtreme board or the Ar9x board, you need to uncomment the line below. //On other addon/replacement boards like the 9xtreme board or the Ar9x board, you need to uncomment the line below.
//For er9x it depends if you have an inveter mod or not on the telemetry pin. If you don't have an inverter comment this line. //For er9x it depends if you have an inveter mod or not on the telemetry pin. If you don't have an inverter comment this line.
#define INVERT_TELEMETRY //#define INVERT_TELEMETRY
//Comment if you don't want to send Multi status telemetry frames (Protocol available, Bind in progress, version...) //Comment if you don't want to send Multi status telemetry frames (Protocol available, Bind in progress, version...)
//Use with er9x/erksy9x, for OpenTX MULTI_TELEMETRY below is preferred instead //Use with er9x/erksy9x, for OpenTX MULTI_TELEMETRY below is preferred instead