gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2026-01-01 11:13:18 +00:00
Code Issues Projects Releases Wiki Activity

FrSkyD and X telemetry

Browse Source
This commit is contained in:
pascallanger
2017-02-03 21:06:21 +01:00
parent 70f52afb3d
commit 21ab94c512
2 changed files with 32 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
Multiprotocol/Telemetry.ino
View File

@@ -177,26 +177,33 @@ void frsky_check_telemetry(uint8_t *pkt,uint8_t len)
TX_LQI = pkt[len-1]&0x7F;
for (uint8_t i=3;i<len-2;i++)
pktt[i]=pkt[i]; // Buffer telemetry values to be sent
if((pktt[6]>0 && pktt[6]<=10) && ( pktt[7] & 0x1F ) == (telemetry_counter & 0x1F) )
if(pktt[6]>0 && pktt[6]<=10)
{
uint8_t topBit = 0 ;
if ( telemetry_counter & 0x80 )
if (protocol==MODE_FRSKYD)
{
if ( ( telemetry_counter & 0x1F ) != RetrySequence )
if ( ( pktt[7] & 0x1F ) == (telemetry_counter & 0x1F) )
{
topBit = 0x80 ;
uint8_t topBit = 0 ;
if ( telemetry_counter & 0x80 )
{
if ( ( telemetry_counter & 0x1F ) != RetrySequence )
{
topBit = 0x80 ;
}
}
telemetry_counter = ( (telemetry_counter+1)%32 ) | topBit ; // Request next telemetry frame
}
else
{
// incorrect sequence
RetrySequence = pktt[7] & 0x1F ;
telemetry_counter |= 0x80 ;
}
}
telemetry_counter = ( (telemetry_counter+1)%32 ) | topBit ; // Request next telemetry frame
}
else
{
if(pktt[6]>0 && pktt[6]<=10)
{
// incorrect sequence
RetrySequence = pktt[7] & 0x1F ;
telemetry_counter |= 0x80 ;
}
pktt[6]=0; // Discard packet
}
//