2 * Copyright © 2010 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
21 import java.awt.event.*;
23 import javax.swing.filechooser.FileNameExtensionFilter;
24 import javax.swing.table.*;
28 import java.util.prefs.*;
29 import java.util.concurrent.LinkedBlockingQueue;
31 import altosui.AltosSerial;
32 import altosui.AltosSerialMonitor;
33 import altosui.AltosTelemetry;
34 import altosui.AltosState;
35 import altosui.AltosDeviceDialog;
36 import altosui.AltosPreferences;
37 import altosui.AltosLog;
38 import altosui.AltosVoice;
42 class AltosFlightStatusTableModel extends AbstractTableModel {
43 private String[] columnNames = {"Height (m)", "State", "RSSI (dBm)", "Speed (m/s)" };
44 private Object[] data = { 0, "idle", 0, 0 };
46 public int getColumnCount() { return columnNames.length; }
47 public int getRowCount() { return 2; }
48 public Object getValueAt(int row, int col) {
50 return columnNames[col];
54 public void setValueAt(Object value, int col) {
56 fireTableCellUpdated(1, col);
59 public void setValueAt(Object value, int row, int col) {
60 setValueAt(value, col);
63 public void set(AltosState state) {
64 setValueAt(String.format("%1.0f", state.height), 0);
65 setValueAt(state.data.state, 1);
66 setValueAt(state.data.rssi, 2);
67 double speed = state.baro_speed;
70 setValueAt(String.format("%1.0f", speed), 3);
74 class AltosFlightInfoTableModel extends AbstractTableModel {
75 private String[] columnNames = {"Field", "Value"};
81 public InfoLine(String n, String v) {
87 private ArrayList<InfoLine> rows = new ArrayList<InfoLine>();
89 public int getColumnCount() { return columnNames.length; }
90 public String getColumnName(int col) { return columnNames[col]; }
92 public int getRowCount() { return 20; }
94 public Object getValueAt(int row, int col) {
95 if (row >= rows.size())
98 return rows.get(row).name;
100 return rows.get(row).value;
104 int prev_num_rows = 0;
106 public void resetRow() {
109 public void addRow(String name, String value) {
110 if (current_row >= rows.size())
111 rows.add(current_row, new InfoLine(name, value));
113 rows.set(current_row, new InfoLine(name, value));
116 public void finish() {
117 if (current_row > prev_num_rows) {
118 fireTableRowsInserted(prev_num_rows, current_row - 1);
119 prev_num_rows = current_row;
121 fireTableDataChanged();
125 public class AltosUI extends JFrame {
126 private int channel = -1;
128 private AltosFlightStatusTableModel flightStatusModel;
129 private JTable flightStatus;
131 static final int info_columns = 3;
133 private AltosFlightInfoTableModel[] flightInfoModel;
134 private JTable[] flightInfo;
135 private AltosSerial serial_line;
136 private AltosLog altos_log;
141 private Font statusFont = new Font("SansSerif", Font.BOLD, 24);
142 private Font infoLabelFont = new Font("SansSerif", Font.PLAIN, 14);
143 private Font infoValueFont = new Font("Monospaced", Font.PLAIN, 14);
145 public AltosVoice voice = new AltosVoice();
149 String[] statusNames = { "Height (m)", "State", "RSSI (dBm)", "Speed (m/s)" };
150 Object[][] statusData = { { "0", "pad", "-50", "0" } };
152 AltosPreferences.init(this);
154 vbox = Box.createVerticalBox();
157 flightStatusModel = new AltosFlightStatusTableModel();
158 flightStatus = new JTable(flightStatusModel);
159 flightStatus.setFont(statusFont);
160 TableColumnModel tcm = flightStatus.getColumnModel();
161 for (int i = 0; i < flightStatusModel.getColumnCount(); i++) {
162 DefaultTableCellRenderer r = new DefaultTableCellRenderer();
163 r.setFont(statusFont);
164 r.setHorizontalAlignment(SwingConstants.CENTER);
165 tcm.getColumn(i).setCellRenderer(r);
168 FontMetrics statusMetrics = flightStatus.getFontMetrics(statusFont);
169 int statusHeight = (statusMetrics.getHeight() + statusMetrics.getLeading()) * 15 / 10;
170 flightStatus.setRowHeight(statusHeight);
171 flightStatus.setShowGrid(false);
173 vbox.add(flightStatus);
175 hbox = Box.createHorizontalBox();
178 flightInfo = new JTable[3];
179 flightInfoModel = new AltosFlightInfoTableModel[3];
181 FontMetrics infoValueMetrics = flightStatus.getFontMetrics(infoValueFont);
182 int infoHeight = (infoValueMetrics.getHeight() + infoValueMetrics.getLeading()) * 20 / 10;
184 for (int i = 0; i < info_columns; i++) {
185 ibox[i] = Box.createVerticalBox();
186 flightInfoModel[i] = new AltosFlightInfoTableModel();
187 flightInfo[i] = new JTable(flightInfoModel[i]);
188 flightInfo[i].setFont(infoValueFont);
189 flightInfo[i].setRowHeight(infoHeight);
190 flightInfo[i].setShowGrid(true);
191 ibox[i].add(flightInfo[i].getTableHeader());
192 ibox[i].add(flightInfo[i]);
200 serial_line = new AltosSerial();
201 altos_log = new AltosLog(serial_line);
202 int dpi = Toolkit.getDefaultToolkit().getScreenResolution();
203 this.setSize(new Dimension (infoValueMetrics.charWidth('0') * 6 * 20,
204 statusHeight * 4 + infoHeight * 17));
206 setDefaultCloseOperation(JFrame.DO_NOTHING_ON_CLOSE);
207 addWindowListener(new WindowAdapter() {
209 public void windowClosing(WindowEvent e) {
215 public void info_reset() {
216 for (int i = 0; i < info_columns; i++)
217 flightInfoModel[i].resetRow();
220 public void info_add_row(int col, String name, String value) {
221 flightInfoModel[col].addRow(name, value);
224 public void info_add_row(int col, String name, String format, Object value) {
225 flightInfoModel[col].addRow(name, String.format(format, value));
228 public void info_add_row(int col, String name, String format, Object v1, Object v2) {
229 flightInfoModel[col].addRow(name, String.format(format, v1, v2));
232 public void info_add_row(int col, String name, String format, Object v1, Object v2, Object v3) {
233 flightInfoModel[col].addRow(name, String.format(format, v1, v2, v3));
236 public void info_add_deg(int col, String name, double v, int pos, int neg) {
242 double deg = Math.floor(v);
243 double min = (v - deg) * 60;
245 flightInfoModel[col].addRow(name, String.format("%3.0f°%08.5f'", deg, min));
248 public void info_finish() {
249 for (int i = 0; i < info_columns; i++)
250 flightInfoModel[i].finish();
253 static final int MIN_PAD_SAMPLES = 10;
255 public void show(AltosState state) {
256 flightStatusModel.set(state);
259 if (state.npad >= MIN_PAD_SAMPLES)
260 info_add_row(0, "Ground state", "%s", "ready");
262 info_add_row(0, "Ground state", "wait (%d)",
263 MIN_PAD_SAMPLES - state.npad);
264 info_add_row(0, "Rocket state", "%s", state.data.state);
265 info_add_row(0, "Callsign", "%s", state.data.callsign);
266 info_add_row(0, "Rocket serial", "%6d", state.data.serial);
267 info_add_row(0, "Rocket flight", "%6d", state.data.flight);
269 info_add_row(0, "RSSI", "%6d dBm", state.data.rssi);
270 info_add_row(0, "Height", "%6.0f m", state.height);
271 info_add_row(0, "Max height", "%6.0f m", state.max_height);
272 info_add_row(0, "Acceleration", "%8.1f m/s²", state.acceleration);
273 info_add_row(0, "Max acceleration", "%8.1f m/s²", state.max_acceleration);
274 info_add_row(0, "Speed", "%8.1f m/s", state.ascent ? state.speed : state.baro_speed);
275 info_add_row(0, "Max Speed", "%8.1f m/s", state.max_speed);
276 info_add_row(0, "Temperature", "%9.2f °C", state.temperature);
277 info_add_row(0, "Battery", "%9.2f V", state.battery);
278 info_add_row(0, "Drogue", "%9.2f V", state.drogue_sense);
279 info_add_row(0, "Main", "%9.2f V", state.main_sense);
280 info_add_row(0, "Pad altitude", "%6.0f m", state.ground_altitude);
281 if (state.gps == null) {
282 info_add_row(1, "GPS", "not available");
284 if (state.data.gps.gps_locked)
285 info_add_row(1, "GPS", " locked");
286 else if (state.data.gps.gps_connected)
287 info_add_row(1, "GPS", " unlocked");
289 info_add_row(1, "GPS", " missing");
290 info_add_row(1, "Satellites", "%6d", state.data.gps.nsat);
291 info_add_deg(1, "Latitude", state.gps.lat, 'N', 'S');
292 info_add_deg(1, "Longitude", state.gps.lon, 'E', 'W');
293 info_add_row(1, "GPS altitude", "%6d", state.gps.alt);
294 info_add_row(1, "GPS height", "%6.0f", state.gps_height);
296 /* The SkyTraq GPS doesn't report these values */
298 info_add_row(1, "GPS ground speed", "%8.1f m/s %3d°",
299 state.gps.ground_speed,
301 info_add_row(1, "GPS climb rate", "%8.1f m/s",
302 state.gps.climb_rate);
303 info_add_row(1, "GPS error", "%6d m(h)%3d m(v)",
304 state.gps.h_error, state.gps.v_error);
306 info_add_row(1, "GPS hdop", "%8.1f", state.gps.hdop);
308 if (state.npad > 0) {
309 if (state.from_pad != null) {
310 info_add_row(1, "Distance from pad", "%6.0f m", state.from_pad.distance);
311 info_add_row(1, "Direction from pad", "%6.0f°", state.from_pad.bearing);
313 info_add_row(1, "Distance from pad", "unknown");
314 info_add_row(1, "Direction from pad", "unknown");
316 info_add_deg(1, "Pad latitude", state.pad_lat, 'N', 'S');
317 info_add_deg(1, "Pad longitude", state.pad_lon, 'E', 'W');
318 info_add_row(1, "Pad GPS alt", "%6.0f m", state.pad_alt);
320 info_add_row(1, "GPS date", "%04d-%02d-%02d",
321 state.gps.gps_time.year,
322 state.gps.gps_time.month,
323 state.gps.gps_time.day);
324 info_add_row(1, "GPS time", " %02d:%02d:%02d",
325 state.gps.gps_time.hour,
326 state.gps.gps_time.minute,
327 state.gps.gps_time.second);
331 if (state.gps.cc_gps_sat == null)
332 info_add_row(2, "Satellites Visible", "%4d", 0);
334 info_add_row(2, "Satellites Visible", "%4d", state.gps.cc_gps_sat.length);
335 for (c = 0; c < state.gps.cc_gps_sat.length; c++) {
336 info_add_row(2, "Satellite id,C/N0",
338 state.gps.cc_gps_sat[c].svid,
339 state.gps.cc_gps_sat[c].c_n0);
346 class IdleThread extends Thread {
348 private AltosState state;
351 int reported_landing = 0;
360 /* reset the landing count once we hear about a new flight */
361 if (state.state < AltosTelemetry.ao_flight_drogue)
362 reported_landing = 0;
364 /* Shut up once the rocket is on the ground */
365 if (reported_landing > 2)
368 /* If the rocket isn't on the pad, then report height */
369 if (state.state > AltosTelemetry.ao_flight_pad) {
370 voice.speak(String.format("%d meters", (int) (state.height + 0.5)));
373 /* If the rocket is coming down, check to see if it has landed;
374 * either we've got a landed report or we haven't heard from it in
378 (System.currentTimeMillis() - state.report_time > 10000 ||
379 state.state == AltosTelemetry.ao_flight_landed))
381 if (Math.abs(state.baro_speed) < 20 && state.height < 100)
382 voice.speak("rocket landed safely");
384 voice.speak("rocket may have crashed");
385 if (state.gps != null)
386 voice.speak(String.format("bearing %d degrees, range %d meters",
387 (int) (state.from_pad.bearing + 0.5),
388 (int) (state.from_pad.distance + 0.5)));
392 } catch (InterruptedException ie) {
396 public void notice(AltosState new_state) {
401 private void tell(AltosState state, AltosState old_state) {
402 if (old_state == null || old_state.state != state.state) {
403 voice.speak(state.data.state);
404 switch (state.state) {
405 case AltosTelemetry.ao_flight_fast:
406 voice.speak(String.format("max speed %d meters per second",
407 (int) (state.max_speed + 0.5)));
409 case AltosTelemetry.ao_flight_drogue:
410 voice.speak(String.format("max height %d meters",
411 (int) (state.max_height + 0.5)));
418 class DisplayThread extends Thread {
419 String read() throws InterruptedException { return null; }
423 void update(AltosState state) throws InterruptedException { }
427 AltosState state = null;
428 AltosState old_state = null;
429 IdleThread idle_thread = new IdleThread();
435 while ((line = read()) != null) {
437 AltosTelemetry t = new AltosTelemetry(line);
439 state = new AltosState(t, state);
442 tell(state, old_state);
443 idle_thread.notice(state);
444 } catch (ParseException pp) {
445 System.out.printf("Parse error on %s\n", line);
446 System.out.println("exception " + pp);
449 } catch (InterruptedException ee) {
452 idle_thread.interrupt();
457 class DeviceThread extends DisplayThread {
459 LinkedBlockingQueue<String> telem;
461 String read() throws InterruptedException {
467 serial.remove_monitor(telem);
468 System.out.println("DisplayThread done");
471 public DeviceThread(AltosSerial s) {
473 telem = new LinkedBlockingQueue<String>();
474 serial.add_monitor(telem);
478 private void ConnectToDevice() {
479 altos_device device = AltosDeviceDialog.show(AltosUI.this, "TeleDongle");
481 if (device != null) {
483 serial_line.open(device);
484 DeviceThread thread = new DeviceThread(serial_line);
486 } catch (FileNotFoundException ee) {
487 JOptionPane.showMessageDialog(AltosUI.this,
489 "Cannot open serial port",
490 JOptionPane.ERROR_MESSAGE);
491 } catch (IOException ee) {
492 JOptionPane.showMessageDialog(AltosUI.this,
495 JOptionPane.ERROR_MESSAGE);
500 void DisconnectFromDevice () {
504 String readline(FileInputStream s) throws IOException {
508 while ((c = s.read()) != -1) {
513 line = line + (char) c;
519 * Open an existing telemetry file and replay it in realtime
522 class ReplayThread extends DisplayThread {
523 FileInputStream replay;
526 ReplayThread(FileInputStream in, String name) {
533 return readline(replay);
534 } catch (IOException ee) {
535 JOptionPane.showMessageDialog(AltosUI.this,
538 JOptionPane.ERROR_MESSAGE);
546 } catch (IOException ee) {
550 void update(AltosState state) throws InterruptedException {
551 /* Make it run in realtime after the rocket leaves the pad */
552 if (state.state > AltosTelemetry.ao_flight_pad)
553 Thread.sleep((int) (state.time_change * 1000));
557 Thread display_thread;
559 private void stop_display() {
560 if (display_thread != null && display_thread.isAlive())
561 display_thread.interrupt();
562 display_thread = null;
565 private void run_display(Thread thread) {
567 display_thread = thread;
568 display_thread.start();
572 * Replay a flight from telemetry data
574 private void Replay() {
575 JFileChooser logfile_chooser = new JFileChooser();
577 logfile_chooser.setDialogTitle("Select Telemetry File");
578 logfile_chooser.setFileFilter(new FileNameExtensionFilter("Telemetry file", "telem"));
579 logfile_chooser.setCurrentDirectory(AltosPreferences.logdir());
580 int returnVal = logfile_chooser.showOpenDialog(AltosUI.this);
582 if (returnVal == JFileChooser.APPROVE_OPTION) {
583 File file = logfile_chooser.getSelectedFile();
585 System.out.println("No file selected?");
586 String filename = file.getName();
588 FileInputStream replay = new FileInputStream(file);
589 ReplayThread thread = new ReplayThread(replay, filename);
591 } catch (FileNotFoundException ee) {
592 JOptionPane.showMessageDialog(AltosUI.this,
594 "Cannot open serial port",
595 JOptionPane.ERROR_MESSAGE);
600 /* Connect to TeleMetrum, either directly or through
601 * a TeleDongle over the packet link
603 private void SaveFlightData() {
606 /* Create the AltosUI menus
608 private void createMenu() {
609 JMenuBar menubar = new JMenuBar();
612 JRadioButtonMenuItem radioitem;
616 menu = new JMenu("File");
617 menu.setMnemonic(KeyEvent.VK_F);
620 item = new JMenuItem("Quit",KeyEvent.VK_Q);
621 item.setAccelerator(KeyStroke.getKeyStroke(KeyEvent.VK_Q,
622 ActionEvent.CTRL_MASK));
623 item.addActionListener(new ActionListener() {
624 public void actionPerformed(ActionEvent e) {
633 menu = new JMenu("Device");
634 menu.setMnemonic(KeyEvent.VK_D);
637 item = new JMenuItem("Connect to Device",KeyEvent.VK_C);
638 item.addActionListener(new ActionListener() {
639 public void actionPerformed(ActionEvent e) {
645 item = new JMenuItem("Disconnect from Device",KeyEvent.VK_D);
646 item.addActionListener(new ActionListener() {
647 public void actionPerformed(ActionEvent e) {
648 DisconnectFromDevice();
655 item = new JMenuItem("Save Flight Data",KeyEvent.VK_S);
656 item.addActionListener(new ActionListener() {
657 public void actionPerformed(ActionEvent e) {
663 item = new JMenuItem("Replay",KeyEvent.VK_R);
664 item.addActionListener(new ActionListener() {
665 public void actionPerformed(ActionEvent e) {
673 menu = new JMenu("Log");
674 menu.setMnemonic(KeyEvent.VK_L);
677 item = new JMenuItem("New Log",KeyEvent.VK_N);
678 item.addActionListener(new ActionListener() {
679 public void actionPerformed(ActionEvent e) {
684 item = new JMenuItem("Configure Log",KeyEvent.VK_C);
685 item.addActionListener(new ActionListener() {
686 public void actionPerformed(ActionEvent e) {
687 AltosPreferences.ConfigureLog();
694 menu = new JMenu("Voice", true);
695 menu.setMnemonic(KeyEvent.VK_V);
698 radioitem = new JRadioButtonMenuItem("Enable Voice");
699 radioitem.addActionListener(new ActionListener() {
700 public void actionPerformed(ActionEvent e) {
708 menu = new JMenu("Channel", true);
709 menu.setMnemonic(KeyEvent.VK_C);
711 ButtonGroup group = new ButtonGroup();
713 for (int c = 0; c <= 9; c++) {
714 radioitem = new JRadioButtonMenuItem(String.format("Channel %1d (%7.3fMHz)", c,
717 radioitem.setActionCommand(String.format("%d", c));
718 radioitem.addActionListener(new ActionListener() {
719 public void actionPerformed(ActionEvent e) {
720 System.out.println("Command: " + e.getActionCommand() + " param: " +
725 group.add(radioitem);
729 this.setJMenuBar(menubar);
732 public static void main(final String[] args) {
733 AltosUI altosui = new AltosUI();
734 altosui.setVisible(true);