Mirror/opentx
1
0
Fork 0
mirror of https://github.com/opentx/opentx.git synced 2025-07-26 01:35:21 +03:00
Code Issues Wiki Activity

[XFire] Telemetry parser script updated

Browse source
This commit is contained in:
Bertrand Songis 2016-11-02 09:19:14 +01:00
parent 8a9f541753
commit c3f0b01307
1 changed files with 7 additions and 4 deletions
Download patch file Download diff file Expand all files Collapse all files

11
radio/util/crossfire-parse.py
View file

@ -22,7 +22,10 @@ crossfire_types = [
"FLOAT", "FLOAT",
"TEXT_SELECTION", "TEXT_SELECTION",
"STRING", "STRING",
"FOLDER" "FOLDER",
"INFO",
"COMMAND",
"VTX",
] ]
def dump(data, maxLen=None): def dump(data, maxLen=None):
@ -68,12 +71,12 @@ def ParseFieldRequest(payload):
def ParseField(payload): def ParseField(payload):
name = "" name = ""
i = 5 i = 6
while payload[i] != 0: while payload[i] != 0:
name += chr(payload[i]) name += chr(payload[i])
i += 1 i += 1
i += 1 i += 1
return '[Field] %s device=0x%02x field=%d parent=%d type=%s' % (name, payload[1], payload[2], payload[3], crossfire_types[payload[4]]) return '[Field] %s device=0x%02x field=%d parent=%d type=%s' % (name, payload[1], payload[2], payload[4], crossfire_types[payload[5] & 0x7f])
parsers = ( parsers = (
(0x02, ParseGPS), (0x02, ParseGPS),
@ -113,7 +116,7 @@ def ParseData(data):
crossfireDataBuff = crossfireDataBuff[1:] crossfireDataBuff = crossfireDataBuff[1:]
continue continue
length = crossfireDataBuff[1] length = crossfireDataBuff[1]
if length < 2 or length > 0x32: if length < 2 or length > 0x40:
print("Skipped 2 bytes", dump(crossfireDataBuff[:2])) print("Skipped 2 bytes", dump(crossfireDataBuff[:2]))
crossfireDataBuff = crossfireDataBuff[2:] crossfireDataBuff = crossfireDataBuff[2:]
continue continue