altosui: Compute flight state from eeprom data
[fw/altos] / ao-tools / altosui / AltosUI.java
index 58f39de5efcd22868d8c69b7fbc617d4a6c725ab..2cb0c47935d10ca6c77b70035b56f842c62b6d4d 100644 (file)
@@ -31,6 +31,7 @@ import java.util.concurrent.LinkedBlockingQueue;
 import altosui.Altos;
 import altosui.AltosSerial;
 import altosui.AltosSerialMonitor;
+import altosui.AltosRecord;
 import altosui.AltosTelemetry;
 import altosui.AltosState;
 import altosui.AltosDeviceDialog;
@@ -172,7 +173,7 @@ public class AltosUI extends JFrame {
                else
                        info_add_row(0, "Ground state", "wait (%d)",
                                     state.gps_waiting);
-               info_add_row(0, "Rocket state", "%s", state.data.state);
+               info_add_row(0, "Rocket state", "%s", state.data.state());
                info_add_row(0, "Callsign", "%s", state.data.callsign);
                info_add_row(0, "Rocket serial", "%6d", state.data.serial);
                info_add_row(0, "Rocket flight", "%6d", state.data.flight);
@@ -192,9 +193,9 @@ public class AltosUI extends JFrame {
                if (state.gps == null) {
                        info_add_row(1, "GPS", "not available");
                } else {
-                       if (state.data.gps.gps_locked)
+                       if (state.data.gps.locked)
                                info_add_row(1, "GPS", "   locked");
-                       else if (state.data.gps.gps_connected)
+                       else if (state.data.gps.connected)
                                info_add_row(1, "GPS", " unlocked");
                        else
                                info_add_row(1, "GPS", "  missing");
@@ -320,7 +321,7 @@ public class AltosUI extends JFrame {
 
        private void tell(AltosState state, AltosState old_state) {
                if (old_state == null || old_state.state != state.state) {
-                       voice.speak(state.data.state);
+                       voice.speak(state.data.state());
                        if ((old_state == null || old_state.state <= Altos.ao_flight_boost) &&
                            state.state > Altos.ao_flight_boost) {
                                voice.speak("max speed: %d meters per second.",
@@ -343,7 +344,9 @@ public class AltosUI extends JFrame {
        class DisplayThread extends Thread {
                IdleThread      idle_thread;
 
-               String read() throws InterruptedException { return null; }
+               String          name;
+
+               AltosRecord read() throws InterruptedException, ParseException { return null; }
 
                void close() { }
 
@@ -360,18 +363,19 @@ public class AltosUI extends JFrame {
                        info_finish();
                        idle_thread.start();
                        try {
-                               while ((line = read()) != null) {
+                               for (;;) {
                                        try {
-                                               AltosTelemetry  t = new AltosTelemetry(line);
+                                               AltosRecord record = read();
+                                               if (record == null)
+                                                       break;
                                                old_state = state;
-                                               state = new AltosState(t, state);
+                                               state = new AltosState(record, state);
                                                update(state);
                                                show(state);
                                                tell(state, old_state);
                                                idle_thread.notice(state);
                                        } catch (ParseException pp) {
-                                               System.out.printf("Parse error on %s\n", line);
-                                               System.out.println("exception " + pp);
+                                               System.out.printf("Parse error: %d \"%s\"\n", pp.getErrorOffset(), pp.getMessage());
                                        }
                                }
                        } catch (InterruptedException ee) {
@@ -387,11 +391,20 @@ public class AltosUI extends JFrame {
                }
        }
 
-       class DeviceThread extends DisplayThread {
+       class TelemetryThread extends DisplayThread {
+
+               String readline() throws InterruptedException { return null; }
+
+               AltosRecord read() throws InterruptedException, ParseException {
+                       return new AltosTelemetry(readline());
+               }
+       }
+
+       class DeviceThread extends TelemetryThread {
                AltosSerial     serial;
                LinkedBlockingQueue<String> telem;
 
-               String read() throws InterruptedException {
+               String readline() throws InterruptedException {
                        return telem.take();
                }
 
@@ -404,6 +417,7 @@ public class AltosUI extends JFrame {
                        serial = s;
                        telem = new LinkedBlockingQueue<String>();
                        serial.add_monitor(telem);
+                       name = "telemetry";
                }
        }
 
@@ -435,40 +449,64 @@ public class AltosUI extends JFrame {
                stop_display();
        }
 
-       String readline(FileInputStream s) throws IOException {
-               int c;
-               String  line = "";
+       /*
+        * Open an existing telemetry file and replay it in realtime
+        */
 
-               while ((c = s.read()) != -1) {
-                       if (c == '\r')
-                               continue;
-                       if (c == '\n') {
+       class ReplayTelemetryThread extends TelemetryThread {
+               FileInputStream replay;
+
+               ReplayTelemetryThread(FileInputStream in, String in_name) {
+                       replay = in;
+                       name = in_name;
+               }
+
+               String readline() {
+                       try {
+                               String  line = AltosRecord.gets(replay);
+                               System.out.printf("telemetry line %s\n", line);
                                return line;
+                       } catch (IOException ee) {
+                               JOptionPane.showMessageDialog(AltosUI.this,
+                                                             name,
+                                                             "error reading",
+                                                             JOptionPane.ERROR_MESSAGE);
+                       }
+                       return null;
+               }
+
+               void close () {
+                       try {
+                               replay.close();
+                       } catch (IOException ee) {
                        }
-                       line = line + (char) c;
+                       report();
                }
-               return null;
-       }
 
-       /*
-        * Open an existing telemetry file and replay it in realtime
-        */
+               void update(AltosState state) throws InterruptedException {
+                       /* Make it run in realtime after the rocket leaves the pad */
+                       if (state.state > Altos.ao_flight_pad)
+                               Thread.sleep((int) (Math.min(state.time_change,10) * 1000));
+               }
+       }
 
-       class ReplayThread extends DisplayThread {
+       class ReplayEepromThread extends DisplayThread {
                FileInputStream replay;
-               String filename;
 
-               ReplayThread(FileInputStream in, String name) {
+               AltosEepromReader       reader;
+
+               ReplayEepromThread(FileInputStream in, String in_name) {
                        replay = in;
-                       filename = name;
+                       name = in_name;
+                       reader = new AltosEepromReader (in);
                }
 
-               String read() {
+               AltosRecord read () throws ParseException {
                        try {
-                               return readline(replay);
+                               return reader.read();
                        } catch (IOException ee) {
                                JOptionPane.showMessageDialog(AltosUI.this,
-                                                             filename,
+                                                             name,
                                                              "error reading",
                                                              JOptionPane.ERROR_MESSAGE);
                        }
@@ -482,10 +520,9 @@ public class AltosUI extends JFrame {
                        }
                        report();
                }
-
                void update(AltosState state) throws InterruptedException {
                        /* Make it run in realtime after the rocket leaves the pad */
-                       if (state.state > AltosTelemetry.ao_flight_pad)
+                       if (state.state > Altos.ao_flight_pad)
                                Thread.sleep((int) (Math.min(state.time_change,10) * 1000));
                }
        }
@@ -510,8 +547,8 @@ public class AltosUI extends JFrame {
        private void Replay() {
                JFileChooser    logfile_chooser = new JFileChooser();
 
-               logfile_chooser.setDialogTitle("Select Telemetry File");
-               logfile_chooser.setFileFilter(new FileNameExtensionFilter("Telemetry file", "telem"));
+               logfile_chooser.setDialogTitle("Select Flight Record File");
+               logfile_chooser.setFileFilter(new FileNameExtensionFilter("Flight data file", "eeprom", "telem"));
                logfile_chooser.setCurrentDirectory(AltosPreferences.logdir());
                int returnVal = logfile_chooser.showOpenDialog(AltosUI.this);
 
@@ -522,7 +559,11 @@ public class AltosUI extends JFrame {
                        String  filename = file.getName();
                        try {
                                FileInputStream replay = new FileInputStream(file);
-                               ReplayThread    thread = new ReplayThread(replay, filename);
+                               DisplayThread   thread;
+                               if (filename.endsWith("eeprom"))
+                                   thread = new ReplayEepromThread(replay, filename);
+                               else
+                                   thread = new ReplayTelemetryThread(replay, filename);
                                run_display(thread);
                        } catch (FileNotFoundException ee) {
                                JOptionPane.showMessageDialog(AltosUI.this,