altos: struct ao_log_mega doesn't have a ground temp value

[fw/altos] / altoslib / AltosTelemetryReader.java

diff --git a/altoslib/AltosTelemetryReader.java b/altoslib/AltosTelemetryReader.java
index 67ac1b6518cfb94f60765c2b9c3b94a86b403015..94fa560b77fce450af0a7a55b9ce573234175342 100644 (file)
--- a/altoslib/AltosTelemetryReader.java
+++ b/altoslib/AltosTelemetryReader.java
@@ -17,7 +17,6 @@
 
 package org.altusmetrum.AltosLib;
 
-import java.lang.*;
 import java.text.*;
 import java.io.*;
 import java.util.concurrent.*;
@@ -44,6 +43,11 @@ public class AltosTelemetryReader extends AltosFlightReader {
                telem.clear();
        }
 
+       public void reset() {
+               previous = null;
+               flush();
+       }
+
        public void close(boolean interrupted) {
                link.remove_monitor(telem);
                log.close();
@@ -59,19 +63,19 @@ public class AltosTelemetryReader extends AltosFlightReader {
 
                try {
                        /* Version 1.0 or later firmware supports all telemetry formats */
-                       if (serial.config_data().compare_version("1.0") >= 0)
+                       if (link.config_data().compare_version("1.0") >= 0)
                                return true;
 
                        /* Version 0.9 firmware only supports 0.9 telemetry */
-                       if (serial.config_data().compare_version("0.9") >= 0) {
-                               if (telemetry == Altos.ao_telemetry_0_9)
+                       if (link.config_data().compare_version("0.9") >= 0) {
+                               if (telemetry == AltosLib.ao_telemetry_0_9)
                                        return true;
                                else
                                        return false;
                        }
 
                        /* Version 0.8 firmware only supports 0.8 telemetry */
-                       if (telemetry == Altos.ao_telemetry_0_8)
+                       if (telemetry == AltosLib.ao_telemetry_0_8)
                                return true;
                        else
                                return false;
@@ -106,14 +110,22 @@ public class AltosTelemetryReader extends AltosFlightReader {
        public AltosTelemetryReader (AltosLink in_link)
                throws IOException, InterruptedException, TimeoutException {
                link = in_link;
-               log = new AltosLog(link);
-               name = link.name;
-               previous = null;
-               telem = new LinkedBlockingQueue<AltosLine>();
-               frequency = AltosPreferences.frequency(link.serial);
-               set_frequency(frequency);
-               telemetry = AltosPreferences.telemetry(link.serial);
-               set_telemetry(telemetry);
-               link.add_monitor(telem);
+               try {
+                       log = new AltosLog(link);
+                       name = link.name;
+                       previous = null;
+                       telem = new LinkedBlockingQueue<AltosLine>();
+                       frequency = AltosPreferences.frequency(link.serial);
+                       set_frequency(frequency);
+                       telemetry = AltosPreferences.telemetry(link.serial);
+                       set_telemetry(telemetry);
+                       link.add_monitor(telem);
+               } catch (TimeoutException e) {
+                       close(true);
+                       throw(e);
+               } catch (InterruptedException e) {
+                       close(true);
+                       throw(e);
+               }
        }
 }