From 95df593c2f073d9c81b14f7ab827fcfaaabbbe33 Mon Sep 17 00:00:00 2001
From: 3djc <lesitewebdejc@hotmail.com>
Date: Fri, 26 Jan 2018 18:57:34 +0100
Subject: [PATCH] Align python crossfire parser to c equivalent (#5595)

Align python Crossfire parser to C equivalent
---
 radio/util/crossfire-parse.py | 5 +++--
 1 file changed, 3 insertions(+), 2 deletions(-)

diff --git a/radio/util/crossfire-parse.py b/radio/util/crossfire-parse.py
index 680fb5d40..5ad2b8639 100755
--- a/radio/util/crossfire-parse.py
+++ b/radio/util/crossfire-parse.py
@@ -5,7 +5,7 @@
 
 from __future__ import division, print_function
 
-import sys
+import sys, struct
 
 lineNumber = 0
 crossfireDataBuff = []
@@ -77,7 +77,8 @@ def crc8(buffer):
     return crc
 
 def ParseGPS(payload):
-    pass
+    lat, long, speed, head, alt, numsat = struct.unpack('>iiHHHB', bytes(bytearray(payload)))          # bytes(bytearray) casting is required for python 2.7.3 compatibility
+    return "[GPS] lat:%f long:%f speed:%d heading:%d alt:%d numsat:%d" % (lat / 1e7, long / 1e7, speed / 100, head / 100, alt - 1000, numsat)
 
 def ParseBattery(payload):
     voltage = float((payload[0] << 8) + payload[1]) / 10