altosui: Add support for downloading TeleMini/TeleNano flight logs
[fw/altos] / altosui / AltosEepromDownload.java
index 5d19acec472987b4a742aaebbb3453734ef80970..f96a3dc90527559b685d2c28b94a090a53ba9467 100644 (file)
@@ -37,14 +37,17 @@ public class AltosEepromDownload implements Runnable {
        boolean                 remote;
        Thread                  eeprom_thread;
        AltosEepromMonitor      monitor;
-       int                     flight = 0;
-       int                     year = 0, month = 0, day = 0;
-       boolean                 want_file = false;
-       FileWriter              eeprom_file = null;
-       LinkedList<String>      eeprom_pending = new LinkedList<String>();
+
+       int                     flight;
+       int                     year, month, day;
+       boolean                 want_file;
+       FileWriter              eeprom_file;
+       LinkedList<String>      eeprom_pending;
+
        AltosEepromList         flights;
        ActionListener          listener;
        boolean                 success;
+       ParseException          parse_exception;
 
        private void FlushPending() throws IOException {
                for (String s : flights.config_data) {
@@ -75,15 +78,119 @@ public class AltosEepromDownload implements Runnable {
                }
        }
 
+       void Log(AltosEepromRecord r) throws IOException {
+               if (r.cmd != Altos.AO_LOG_INVALID) {
+                       String log_line = String.format("%c %4x %4x %4x\n",
+                                                       r.cmd, r.tick, r.a, r.b);
+                       if (eeprom_file != null)
+                               eeprom_file.write(log_line);
+                       else
+                               eeprom_pending.add(log_line);
+               }
+       }
+
+       static final int        log_full = 1;
+       static final int        log_tiny = 2;
+
+       boolean                 done;
+       int                     state;
+
+       void CaptureFull(AltosEepromChunk eechunk) throws IOException {
+               AltosEepromBlock        eeblock = new AltosEepromBlock(eechunk);
+
+               if (eeblock.has_flight) {
+                       flight = eeblock.flight;
+                       monitor.set_flight(flight);
+               }
+               if (eeblock.has_date) {
+                       year = eeblock.year;
+                       month = eeblock.month;
+                       day = eeblock.day;
+                       want_file = true;
+               }
+
+               if (eeblock.size() == 0 ||
+                   eeblock.has_state && eeblock.state == Altos.ao_flight_landed)
+                       done = true;
+
+               /* Monitor state transitions to update display */
+               if (eeblock.has_state) {
+                       if (eeblock.state > Altos.ao_flight_pad)
+                               want_file = true;
+                       if (eeblock.state > state)
+                               state = eeblock.state;
+               }
+
+               if (parse_exception == null && eeblock.parse_exception != null)
+                       parse_exception = eeblock.parse_exception;
+
+               CheckFile(false);
+
+               for (int record = 0; record < eeblock.size(); record++)
+                       Log(eeblock.get(record));
+       }
+
+       boolean start;
+       int     tiny_tick;
+
+       void CaptureTiny (AltosEepromChunk eechunk) throws IOException {
+               boolean some_reasonable_data = false;
+
+               for (int i = 0; i < eechunk.data.length; i += 2) {
+                       int     v = eechunk.data16(i);
+
+                       if (i == 0 && start) {
+                               tiny_tick = 0;
+                               start = false;
+                               flight = v;
+                               Log(new AltosEepromRecord(Altos.AO_LOG_FLIGHT, tiny_tick, 0, v));
+                               some_reasonable_data = true;
+                       } else {
+                               int     s = v ^ 0x8000;
+                               if (Altos.ao_flight_startup <= s && s <= Altos.ao_flight_invalid) {
+                                       Log(new AltosEepromRecord(Altos.AO_LOG_STATE, tiny_tick, s, 0));
+                                       if (s == Altos.ao_flight_landed) {
+                                               done = true;
+                                               break;
+                                       }
+                                       some_reasonable_data = true;
+                               } else {
+                                       if (v != 0xffff)
+                                               some_reasonable_data = true;
+                                       Log(new AltosEepromRecord(Altos.AO_LOG_HEIGHT, tiny_tick, v, 0));
+                                       if (state < Altos.ao_flight_drogue)
+                                               tiny_tick += 10;
+                                       else
+                                               tiny_tick += 100;
+                               }
+                       }
+               }
+               CheckFile(false);
+               if (!some_reasonable_data)
+                       done = true;
+       }
+
        void CaptureLog(AltosEepromLog log) throws IOException, InterruptedException, TimeoutException {
                int                     block, state_block = 0;
-               int                     state = 0;
-               boolean                 done = false;
-               int                     record;
+               int                     log_style = 0;
+
+               state = 0;
+               done = false;
+               start = true;
 
                if (flights.config_data.serial == 0)
                        throw new IOException("no serial number found");
 
+               /* Reset per-capture variables */
+               flight = 0;
+               year = 0;
+               month = 0;
+               day = 0;
+               want_file = false;
+               eeprom_file = null;
+               eeprom_pending = new LinkedList<String>();
+
+               /* Set serial number in the monitor dialog window */
                monitor.set_serial(flights.config_data.serial);
                /* Now scan the eeprom, reading blocks of data and converting to .eeprom file form */
 
@@ -91,42 +198,26 @@ public class AltosEepromDownload implements Runnable {
                for (block = log.start_block; !done && block < log.end_block; block++) {
                        monitor.set_value(Altos.state_to_string[state], state, block - state_block);
 
-                       AltosEepromBlock        eeblock = new AltosEepromBlock(serial_line, block);
-
-                       if (eeblock.has_flight) {
-                               flight = eeblock.flight;
-                               monitor.set_flight(flight);
-                       }
-                       if (eeblock.has_date) {
-                               year = eeblock.year;
-                               month = eeblock.month;
-                               day = eeblock.day;
-                               want_file = true;
-                       }
+                       AltosEepromChunk        eechunk = new AltosEepromChunk(serial_line, block);
 
-                       if (eeblock.size() == 0 ||
-                           eeblock.has_state && eeblock.state == Altos.ao_flight_landed)
-                                       done = true;
+                       /*
+                        * Figure out what kind of data is there
+                        */
 
-                       /* Monitor state transitions to update display */
-                       if (eeblock.has_state) {
-                               if (eeblock.state > Altos.ao_flight_pad)
-                                       want_file = true;
-                               if (eeblock.state > state)
-                                       state = eeblock.state;
+                       if (block == log.start_block) {
+                               if (eechunk.data(0) == Altos.AO_LOG_FLIGHT)
+                                       log_style = log_full;
+                               else
+                                       log_style = log_tiny;
                        }
 
-                       CheckFile(false);
-
-                       for (record = 0; record < eeblock.size(); record++) {
-                               AltosEepromRecord r = eeblock.get(record);
-
-                               String log_line = String.format("%c %4x %4x %4x\n",
-                                                               r.cmd, r.tick, r.a, r.b);
-                               if (eeprom_file != null)
-                                       eeprom_file.write(log_line);
-                               else
-                                       eeprom_pending.add(log_line);
+                       switch (log_style) {
+                       case log_full:
+                               CaptureFull(eechunk);
+                               break;
+                       case log_tiny:
+                               CaptureTiny(eechunk);
+                               break;
                        }
                }
                CheckFile(true);
@@ -136,20 +227,21 @@ public class AltosEepromDownload implements Runnable {
                }
        }
 
-       private void show_error_internal(String message, String title) {
+       private void show_message_internal(String message, String title, int message_type) {
                JOptionPane.showMessageDialog(frame,
                                              message,
                                              title,
-                                             JOptionPane.ERROR_MESSAGE);
+                                             message_type);
        }
 
-       private void show_error(String in_message, String in_title) {
+       private void show_message(String in_message, String in_title, int in_message_type) {
                final String message = in_message;
                final String title = in_title;
+               final int message_type = in_message_type;
                Runnable r = new Runnable() {
                                public void run() {
                                        try {
-                                               show_error_internal(message, title);
+                                               show_message_internal(message, title, message_type);
                                        } catch (Exception ex) {
                                        }
                                }
@@ -162,22 +254,33 @@ public class AltosEepromDownload implements Runnable {
                        serial_line.start_remote();
 
                try {
+                       boolean failed = false;
                        for (AltosEepromLog log : flights) {
+                               parse_exception = null;
                                if (log.download) {
                                        monitor.reset();
                                        CaptureLog(log);
                                }
+                               if (parse_exception != null) {
+                                       failed = true;
+                                       show_message(String.format("Flight %d download error\n%s\nValid log data saved",
+                                                                  log.flight,
+                                                                  parse_exception.getMessage()),
+                                                    serial_line.device.toShortString(),
+                                                    JOptionPane.WARNING_MESSAGE);
+                               }
                        }
-                       System.out.printf("All flights successfully downloaded\n");
-                       success = true;
+                       success = !failed;
                } catch (IOException ee) {
-                       show_error (serial_line.device.toShortString(),
-                                   ee.getLocalizedMessage());
+                       show_message(ee.getLocalizedMessage(),
+                                    serial_line.device.toShortString(),
+                                    JOptionPane.ERROR_MESSAGE);
                } catch (InterruptedException ie) {
                } catch (TimeoutException te) {
-                       show_error (String.format("Connection to \"%s\" failed",
-                                                 serial_line.device.toShortString()),
-                                   "Connection Failed");
+                       show_message(String.format("Connection to \"%s\" failed",
+                                                  serial_line.device.toShortString()),
+                                    "Connection Failed",
+                                    JOptionPane.ERROR_MESSAGE);
                }
                if (remote)
                        serial_line.stop_remote();