altoslib/altosui: Get legacy telem working with new AltosState structure
[fw/altos] / altoslib / AltosTelemetryReader.java
index b4293c7349d2d9fda70bd03942aa91c37e0ac031..b1cc009c12814f336bf56b9b3d86be1a460fc4ef 100644 (file)
@@ -27,16 +27,21 @@ public class AltosTelemetryReader extends AltosFlightReader {
        AltosRecord     previous;
        double          frequency;
        int             telemetry;
+       AltosState      state = null;
 
        LinkedBlockingQueue<AltosLine> telem;
 
-       public AltosRecord read() throws InterruptedException, ParseException, AltosCRCException, IOException {
+       public AltosState read() throws InterruptedException, ParseException, AltosCRCException, IOException {
                AltosLine l = telem.take();
                if (l.line == null)
                        throw new IOException("IO error");
-               AltosRecord     next = AltosTelemetry.parse(l.line, previous);
-               previous = next;
-               return next;
+               AltosTelemetry  telem = AltosTelemetryLegacy.parse(l.line);
+               if (state == null)
+                       state = new AltosState();
+               else
+                       state = state.clone();
+               telem.update_state(state);
+               return state;
        }
 
        public void flush() {