Clean up GPS data formatting
[fw/altos] / ao-tools / altosui / AltosUI.java
index 21c3e7a27367e9fd4815998709cdb3dc30a65bd4..599c5aecb9f1b3975cd90b94cd36547207577f1f 100644 (file)
@@ -21,7 +21,7 @@ import java.awt.*;
 import java.awt.event.*;
 import javax.swing.*;
 import javax.swing.filechooser.FileNameExtensionFilter;
-import javax.swing.table.AbstractTableModel;
+import javax.swing.table.*;
 import java.io.*;
 import java.util.*;
 import java.text.*;
@@ -43,13 +43,16 @@ class AltosFlightStatusTableModel extends AbstractTableModel {
        private Object[] data = { 0, "idle", 0, 0 };
 
        public int getColumnCount() { return columnNames.length; }
-       public int getRowCount() { return 1; }
-       public String getColumnName(int col) { return columnNames[col]; }
-       public Object getValueAt(int row, int col) { return data[col]; }
+       public int getRowCount() { return 2; }
+       public Object getValueAt(int row, int col) {
+               if (row == 0)
+                       return columnNames[col];
+               return data[col];
+       }
 
        public void setValueAt(Object value, int col) {
                data[col] = value;
-               fireTableCellUpdated(0, col);
+               fireTableCellUpdated(1, col);
        }
 
        public void setValueAt(Object value, int row, int col) {
@@ -57,30 +60,152 @@ class AltosFlightStatusTableModel extends AbstractTableModel {
        }
 
        public void set(AltosState state) {
-               setValueAt(state.height, 0);
+               setValueAt(String.format("%1.0f", state.height), 0);
                setValueAt(state.data.state, 1);
                setValueAt(state.data.rssi, 2);
-               setValueAt(state.speed, 3);
+               double speed = state.baro_speed;
+               if (state.ascent)
+                       speed = state.speed;
+               setValueAt(String.format("%1.0f", speed), 3);
+       }
+}
+
+class AltosFlightStatusCellRenderer extends DefaultTableCellRenderer {
+
+       static Font statusFont = new Font("SansSerif", Font.BOLD, 24);
+
+       @Override public Component getTableCellRendererComponent (JTable table, Object value, boolean isSelected,
+                                                       boolean hasFocus, int row, int column)
+       {
+               Component cell = super.getTableCellRendererComponent
+                       (table, value, isSelected, hasFocus, row, column);
+               System.out.println("Selecting new font for cell " + row + " " + column + " " + statusFont);
+               cell.setFont(statusFont);
+               return cell;
+       }
+
+       public AltosFlightStatusCellRenderer () {
+               super();
+               System.out.println("Made a status cell renderer\n");
+       }
+}
+
+class AltosFlightInfoTableModel extends AbstractTableModel {
+       private String[] columnNames = {"Field", "Value"};
+
+       class InfoLine {
+               String  name;
+               String  value;
+
+               public InfoLine(String n, String v) {
+                       name = n;
+                       value = v;
+               }
+       }
+
+       private ArrayList<InfoLine> rows = new ArrayList<InfoLine>();
+
+       public int getColumnCount() { return columnNames.length; }
+       public String getColumnName(int col) { return columnNames[col]; }
+
+       public int getRowCount() { return 20; }
+
+       public Object getValueAt(int row, int col) {
+               if (row >= rows.size())
+                       return "";
+               if (col == 0)
+                       return rows.get(row).name;
+               else
+                       return rows.get(row).value;
+       }
+
+       int     current_row = 0;
+       int     prev_num_rows = 0;
+
+       public void resetRow() {
+               current_row = 0;
+       }
+       public void addRow(String name, String value) {
+               if (current_row >= rows.size())
+                       rows.add(current_row, new InfoLine(name, value));
+               else
+                       rows.set(current_row, new InfoLine(name, value));
+               current_row++;
+       }
+       public void finish() {
+               if (current_row > prev_num_rows) {
+                       fireTableRowsInserted(prev_num_rows, current_row - 1);
+                       prev_num_rows = current_row;
+               }
+               fireTableDataChanged();
        }
 }
 
 public class AltosUI extends JFrame {
        private int channel = -1;
 
+       private AltosFlightStatusTableModel flightStatusModel;
        private JTable flightStatus;
-       private JTable flightInfo;
+
+       static final int info_columns = 3;
+
+       private AltosFlightInfoTableModel[] flightInfoModel;
+       private JTable[] flightInfo;
        private AltosSerial serialLine;
+       private Box[] ibox;
+       private Box vbox;
+       private Box hbox;
+
+       private Font statusFont = new Font("SansSerif", Font.BOLD, 24);
+       private Font infoLabelFont = new Font("SansSerif", Font.PLAIN, 14);
+       private Font infoValueFont = new Font("Monospaced", Font.PLAIN, 14);
 
        public AltosUI() {
 
                String[] statusNames = { "Height (m)", "State", "RSSI (dBm)", "Speed (m/s)" };
                Object[][] statusData = { { "0", "pad", "-50", "0" } };
 
-               flightStatus = new JTable(statusData, statusNames);
+               vbox = Box.createVerticalBox();
+               this.add(vbox);
+
+               flightStatusModel = new AltosFlightStatusTableModel();
+               flightStatus = new JTable(flightStatusModel);
+               flightStatus.setFont(statusFont);
+               TableColumnModel tcm = flightStatus.getColumnModel();
+               for (int i = 0; i < flightStatusModel.getColumnCount(); i++) {
+                       DefaultTableCellRenderer       r = new DefaultTableCellRenderer();
+                       r.setFont(statusFont);
+                       r.setHorizontalAlignment(SwingConstants.CENTER);
+                       tcm.getColumn(i).setCellRenderer(r);
+               }
 
+               FontMetrics     statusMetrics = flightStatus.getFontMetrics(statusFont);
+               int statusHeight = (statusMetrics.getHeight() + statusMetrics.getLeading()) * 15 / 10;
+               flightStatus.setRowHeight(statusHeight);
                flightStatus.setShowGrid(false);
 
-               this.add(flightStatus);
+               vbox.add(flightStatus);
+
+               hbox = Box.createHorizontalBox();
+               vbox.add(hbox);
+
+               flightInfo = new JTable[3];
+               flightInfoModel = new AltosFlightInfoTableModel[3];
+               ibox = new Box[3];
+               FontMetrics     infoValueMetrics = flightStatus.getFontMetrics(infoValueFont);
+               int infoHeight = (infoValueMetrics.getHeight() + infoValueMetrics.getLeading()) * 20 / 10;
+
+               for (int i = 0; i < info_columns; i++) {
+                       ibox[i] = Box.createVerticalBox();
+                       flightInfoModel[i] = new AltosFlightInfoTableModel();
+                       flightInfo[i] = new JTable(flightInfoModel[i]);
+                       flightInfo[i].setFont(infoValueFont);
+                       flightInfo[i].setRowHeight(infoHeight);
+                       flightInfo[i].setShowGrid(true);
+                       ibox[i].add(flightInfo[i].getTableHeader());
+                       ibox[i].add(flightInfo[i]);
+                       hbox.add(ibox[i]);
+               }
 
                setTitle("AltOS");
 
@@ -89,7 +214,8 @@ public class AltosUI extends JFrame {
                serialLine = new AltosSerial();
                serialLine.monitor(new AltosUIMonitor());
                int dpi = Toolkit.getDefaultToolkit().getScreenResolution();
-               this.setSize(new Dimension (dpi * 5, dpi * 4));
+               this.setSize(new Dimension (infoValueMetrics.charWidth('0') * 6 * 20,
+                                           statusHeight * 4 + infoHeight * 17));
                this.validate();
                setDefaultCloseOperation(JFrame.DO_NOTHING_ON_CLOSE);
                addWindowListener(new WindowAdapter() {
@@ -100,6 +226,133 @@ public class AltosUI extends JFrame {
                });
        }
 
+       public void info_reset() {
+               for (int i = 0; i < info_columns; i++)
+                       flightInfoModel[i].resetRow();
+       }
+
+       public void info_add_row(int col, String name, String value) {
+               flightInfoModel[col].addRow(name, value);
+       }
+
+       public void info_add_row(int col, String name, String format, Object value) {
+               flightInfoModel[col].addRow(name, String.format(format, value));
+       }
+
+       public void info_add_row(int col, String name, String format, Object v1, Object v2) {
+               flightInfoModel[col].addRow(name, String.format(format, v1, v2));
+       }
+
+       public void info_add_row(int col, String name, String format, Object v1, Object v2, Object v3) {
+               flightInfoModel[col].addRow(name, String.format(format, v1, v2, v3));
+       }
+
+       public void info_add_deg(int col, String name, double v, int pos, int neg) {
+               int     c = pos;
+               if (v < 0) {
+                       c = neg;
+                       v = -v;
+               }
+               double  deg = Math.floor(v);
+               double  min = (v - deg) * 60;
+
+               flightInfoModel[col].addRow(name, String.format("%3.0f°%08.5f'", deg, min));
+       }
+
+       public void info_finish() {
+               for (int i = 0; i < info_columns; i++)
+                       flightInfoModel[i].finish();
+       }
+
+       static final int MIN_PAD_SAMPLES = 10;
+
+       public void show(AltosState state) {
+               flightStatusModel.set(state);
+
+               info_reset();
+               if (state.npad >= MIN_PAD_SAMPLES)
+                       info_add_row(0, "Ground state", "%s", "ready");
+               else
+                       info_add_row(0, "Ground state", "wait (%d)",
+                                    MIN_PAD_SAMPLES - state.npad);
+               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);
+
+               info_add_row(0, "RSSI", "%6d    dBm", state.data.rssi);
+               info_add_row(0, "Height", "%6.0f    m", state.height);
+               info_add_row(0, "Max height", "%6.0f    m", state.max_height);
+               info_add_row(0, "Acceleration", "%8.1f  m/s²", state.acceleration);
+               info_add_row(0, "Max acceleration", "%8.1f  m/s²", state.max_acceleration);
+               info_add_row(0, "Speed", "%8.1f  m/s", state.ascent ? state.speed : state.baro_speed);
+               info_add_row(0, "Max Speed", "%8.1f  m/s", state.max_speed);
+               info_add_row(0, "Temperature", "%9.2f °C", state.temperature);
+               info_add_row(0, "Battery", "%9.2f V", state.battery);
+               info_add_row(0, "Drogue", "%9.2f V", state.drogue_sense);
+               info_add_row(0, "Main", "%9.2f V", state.main_sense);
+               info_add_row(0, "Pad altitude", "%6.0f    m", state.ground_altitude);
+               if (state.gps == null) {
+                       info_add_row(1, "GPS", "not available");
+               } else {
+                       if (state.data.gps.gps_locked)
+                               info_add_row(1, "GPS", "   locked");
+                       else if (state.data.gps.gps_connected)
+                               info_add_row(1, "GPS", " unlocked");
+                       else
+                               info_add_row(1, "GPS", "  missing");
+                       info_add_row(1, "Satellites", "%6d", state.gps.nsat);
+                       info_add_deg(1, "Latitude", state.gps.lat, 'N', 'S');
+                       info_add_deg(1, "Longitude", state.gps.lon, 'E', 'W');
+                       info_add_row(1, "GPS altitude", "%6d", state.gps.alt);
+                       info_add_row(1, "GPS height", "%6.0f", state.gps_height);
+                       info_add_row(1, "GPS ground speed", "%8.1f m/s %3d°",
+                                      state.gps.ground_speed,
+                                      state.gps.course);
+                       info_add_row(1, "GPS climb rate", "%8.1f m/s",
+                                    state.gps.climb_rate);
+                       info_add_row(1, "GPS hdop", "%8.1f", state.gps.hdop);
+                       info_add_row(1, "GPS error", "%6d m(h)%3d m(v)",
+                                    state.gps.h_error, state.gps.v_error);
+                       if (state.npad > 0) {
+                               if (state.from_pad != null) {
+                                       info_add_row(1, "Distance from pad", "%6.0f m", state.from_pad.distance);
+                                       info_add_row(1, "Direction from pad", "%6.0f°", state.from_pad.bearing);
+                               } else {
+                                       info_add_row(1, "Distance from pad", "unknown");
+                                       info_add_row(1, "Direction from pad", "unknown");
+                               }
+                               info_add_deg(1, "Pad latitude", state.pad_lat, 'N', 'S');
+                               info_add_deg(1, "Pad longitude", state.pad_lon, 'E', 'W');
+                               info_add_row(1, "Pad GPS alt", "%9.2fm", state.pad_alt);
+                       }
+                       info_add_row(1, "GPS date", "%04d-%02d-%02d",
+                                      state.gps.gps_time.year,
+                                      state.gps.gps_time.month,
+                                      state.gps.gps_time.day);
+                       info_add_row(1, "GPS time", "  %02d:%02d:%02d",
+                                      state.gps.gps_time.hour,
+                                      state.gps.gps_time.minute,
+                                      state.gps.gps_time.second);
+                       int     nsat_vis = 0;
+                       int     c;
+
+                       if (state.gps.cc_gps_sat == null)
+                               info_add_row(2, "Satellites Visible", "%4d", 0);
+                       else {
+                               info_add_row(2, "Satellites Visible", "%4d", state.gps.cc_gps_sat.length);
+                               for (c = 0; c < state.gps.cc_gps_sat.length; c++) {
+                                       info_add_row(2, "Satellite id,C/N0",
+                                                    "%4d, %4d",
+                                                    state.gps.cc_gps_sat[c].svid,
+                                                    state.gps.cc_gps_sat[c].c_n0);
+                               }
+                       }
+               }
+               info_finish();
+       }
+
+
        final JFileChooser deviceChooser = new JFileChooser();
        final JFileChooser logdirChooser = new JFileChooser();
        final String logdirName = "TeleMetrum";
@@ -170,6 +423,49 @@ public class AltosUI extends JFrame {
         * Open an existing telemetry file and replay it in realtime
         */
 
+       class ReplayThread extends Thread {
+               FileInputStream replay;
+               String filename;
+
+               ReplayThread(FileInputStream in, String name) {
+                       replay = in;
+                       filename = name;
+               }
+
+               public void run() {
+                       String  line;
+                       AltosState      state = null;
+                       try {
+                               while ((line = readline(replay)) != null) {
+                                       try {
+                                               AltosTelemetry  t = new AltosTelemetry(line);
+                                               state = new AltosState(t, state);
+                                               show(state);
+                                               try {
+                                                       if (state.state > AltosTelemetry.ao_flight_pad)
+                                                               Thread.sleep((int) (state.time_change * 1000));
+                                               } catch (InterruptedException e) {}
+                                       } catch (ParseException pp) {
+                                               JOptionPane.showMessageDialog(AltosUI.this,
+                                                                             line,
+                                                                             "error parsing",
+                                                                             JOptionPane.ERROR_MESSAGE);
+                                               break;
+                                       }
+                               }
+                       } catch (IOException ee) {
+                               JOptionPane.showMessageDialog(AltosUI.this,
+                                                             filename,
+                                                             "error reading",
+                                                             JOptionPane.ERROR_MESSAGE);
+                       } finally {
+                               try {
+                                       replay.close();
+                               } catch (IOException e) {}
+                       }
+               }
+       }
+
        private void Replay() {
                setLogdir();
                logdirChooser.setDialogTitle("Select Telemetry File");
@@ -183,31 +479,8 @@ public class AltosUI extends JFrame {
                        String  filename = file.getName();
                        try {
                                FileInputStream replay = new FileInputStream(file);
-                               String  line;
-
-                               try {
-                                       while ((line = readline(replay)) != null) {
-                                               try {
-                                                       AltosTelemetry  t = new AltosTelemetry(line);
-                                                       System.out.println ("Version " + t.version + t.callsign);
-                                               } catch (ParseException pp) {
-                                                       JOptionPane.showMessageDialog(AltosUI.this,
-                                                                                     line,
-                                                                                     "error parsing",
-                                                                                     JOptionPane.ERROR_MESSAGE);
-                                                       break;
-                                               }
-                                       }
-                               } catch (IOException ee) {
-                                       JOptionPane.showMessageDialog(AltosUI.this,
-                                                                     filename,
-                                                                     "error reading",
-                                                                     JOptionPane.ERROR_MESSAGE);
-                               } finally {
-                                       try {
-                                               replay.close();
-                                       } catch (IOException e) {}
-                               }
+                               ReplayThread    thread = new ReplayThread(replay, filename);
+                               thread.start();
                        } catch (FileNotFoundException ee) {
                                JOptionPane.showMessageDialog(AltosUI.this,
                                                              filename,