altosui: Generalize and centralize telemetry constants, parse v0.8 telemetry

[fw/altos] / altosui / AltosSerial.java

diff --git a/altosui/AltosSerial.java b/altosui/AltosSerial.java
index 111bd77170fc5514107c4ef75f0ca050a84c4a9a..2e8ce8702ad557a0d691067caf5dc4f02754d20b 100644 (file)
--- a/altosui/AltosSerial.java
+++ b/altosui/AltosSerial.java
@@ -95,7 +95,7 @@ public class AltosSerial implements Runnable {
                                                        }
                                                        if (debug)
                                                                System.out.printf("\t\t\t\t\t%s\n", line);
-                                                       if (line.startsWith("VERSION") || line.startsWith("CRC")) {
+                                                       if (line.startsWith("TELEM") || line.startsWith("VERSION") || line.startsWith("CRC")) {
                                                                for (int e = 0; e < monitors.size(); e++) {
                                                                        LinkedBlockingQueue<AltosLine> q = monitors.get(e);
                                                                        q.put(new AltosLine (line));
@@ -304,7 +304,7 @@ public class AltosSerial implements Runnable {
                                throw new AltosSerialInUseException(device);
                        devices_opened.add(device.getPath());
                }
-               altos = libaltos.altos_open(device);
+               altos = device.open();
                if (altos == null) {
                        close();
                        throw new FileNotFoundException(device.toShortString());
@@ -325,11 +325,16 @@ public class AltosSerial implements Runnable {
                set_callsign(AltosPreferences.callsign());
        }
 
+       private int telemetry_len() {
+               return Altos.telemetry_len(telemetry);
+       }
+
        public void set_channel(int in_channel) {
                channel = in_channel;
                if (altos != null) {
                        if (monitor_mode)
-                               printf("m 0\nc r %d\nm %d\n", channel, telemetry);
+                               printf("m 0\nc r %d\nm %x\n",
+                                      channel, telemetry_len());
                        else
                                printf("c r %d\n", channel);
                        flush_output();
@@ -340,7 +345,7 @@ public class AltosSerial implements Runnable {
                telemetry = in_telemetry;
                if (altos != null) {
                        if (monitor_mode)
-                               printf("m 0\nm %d\n", telemetry);
+                               printf("m 0\nm %x\n", telemetry_len());
                        flush_output();
                }
        }
@@ -349,7 +354,7 @@ public class AltosSerial implements Runnable {
                monitor_mode = monitor;
                if (altos != null) {
                        if (monitor)
-                               printf("m %d\n", telemetry);
+                               printf("m %x\n", telemetry_len());
                        else
                                printf("m 0\n");
                        flush_output();
@@ -393,7 +398,7 @@ public class AltosSerial implements Runnable {
                line = "";
                monitor_mode = false;
                frame = null;
-               telemetry = Altos.ao_telemetry_full;
+               telemetry = Altos.ao_telemetry_standard;
                monitors = new LinkedList<LinkedBlockingQueue<AltosLine>> ();
                reply_queue = new LinkedBlockingQueue<AltosLine> ();
                open();