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

Allow TX to request forwarding of FlySky telemetry data

Browse Source
This commit is contained in:
Arne Schwabe
2016-11-04 20:45:56 +01:00
parent 455a2dba8a
commit 7840438bfc
5 changed files with 35 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
Multiprotocol/Telemetry.ino
View File

@@ -61,6 +61,15 @@ void DSM_frame()
}
#endif
#if defined AFHDS2A_TELEMETRY
void AFHDSA_short_frame()
{
Serial_write(0xAA); // Telemetry packet
for (uint8_t i = 0; i < 29; i++) // RSSI value followed by 4*7 bytes of telemetry data
Serial_write(pkt[i]);
}
#endif
void frskySendStuffed()
{
Serial_write(START_STOP);
@@ -485,6 +494,13 @@ void TelemetryUpdate()
return;
}
#endif
#if defined AFHDS2A_TELEMETRY
if(telemetry_link == 2 && protocol == MODE_AFHDS2A)
{
AFHDSA_short_frame();
telemetry_link=0;
}
#endif
if(telemetry_link && protocol != MODE_FRSKYX )
{ // FrSkyD + Hubsan + AFHDS2A
frsky_link_frame();