altosui: Support raw telemetry from TeleDongle

Use raw telemetry frames when TeleDongle supports them, this involves
parsing the hex dump of the packet instead of having teledongle take
the packet apart. Only the legacy format is working at this point; the
altos bits for the new split telemetry frames is not written yet.

Signed-off-by: Keith Packard <keithp@keithp.com>

1 files changed, 5 insertions, 1 deletions

diff --git a/altosui/AltosTelemetryReader.java b/altosui/AltosTelemetryReader.java
index 980391b4..18f17841 100644
--- a/altosui/AltosTelemetryReader.java
+++ b/altosui/AltosTelemetryReader.java
@@ -26,6 +26,7 @@ class AltosTelemetryReader extends AltosFlightReader {
 	AltosDevice	device;
 	AltosSerial	serial;
 	AltosLog	log;
+	AltosRecord	previous;
 
 	LinkedBlockingQueue<AltosLine> telem;
 
@@ -33,7 +34,9 @@ class AltosTelemetryReader extends AltosFlightReader {
 		AltosLine l = telem.take();
 		if (l.line == null)
 			throw new IOException("IO error");
-		return new AltosTelemetry(l.line);
+		AltosRecord	next = AltosTelemetry.parse(l.line, previous);
+		previous = next;
+		return next;
 	}
 
 	void close(boolean interrupted) {
@@ -58,6 +61,7 @@ class AltosTelemetryReader extends AltosFlightReader {
 		serial = new AltosSerial(device);
 		log = new AltosLog(serial);
 		name = device.toShortString();
+		previous = null;
 
 		telem = new LinkedBlockingQueue<AltosLine>();
 		serial.set_radio();