+ 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.data.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);
+
+ /* The SkyTraq GPS doesn't report these values */
+ if (false) {
+ 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 error", "%6d m(h)%3d m(v)",
+ state.gps.h_error, state.gps.v_error);
+ }
+ info_add_row(1, "GPS hdop", "%8.1f", state.gps.hdop);
+
+ 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", "%6.0f m", 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();
+ }
+
+ /* User Preferences */
+ Preferences altosui_preferences = Preferences.userNodeForPackage(this.getClass());
+
+ /* Log directory */
+ private File logdir = null;
+
+ /* logdir preference name */
+ final static String logdirPreference = "LOGDIR";
+
+ /* Default logdir is ~/TeleMetrum */
+ final static String logdirName = "TeleMetrum";
+
+ /* Initialize logdir from preferences */
+ {
+ String logdir_string = altosui_preferences.get(logdirPreference, null);
+ if (logdir_string != null)
+ logdir = new File(logdir_string);
+ else
+ /* a hack -- make the file chooser tell us what the default directory
+ * would be and stick our logdir in a subdirectory of that.
+ */
+ logdir = new File(new JFileChooser().getCurrentDirectory(), logdirName);
+ }
+
+ private void set_logdir(File new_logdir) {
+ logdir = new_logdir;
+ System.out.printf("Set logdir to %s\n", logdir.toString());
+ synchronized (altosui_preferences) {
+ altosui_preferences.put(logdirPreference, logdir.getPath());
+ try {
+ altosui_preferences.flush();
+ } catch (BackingStoreException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ altosui_preferences.absolutePath(),
+ "Cannot save prefernces",
+ JOptionPane.ERROR_MESSAGE);
+ }
+ }
+ }
+
+ private boolean check_dir(File dir) {
+ if (!dir.exists()) {
+ if (!dir.mkdirs()) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ dir.getName(),
+ "Cannot create directory",
+ JOptionPane.ERROR_MESSAGE);
+ return false;
+ }
+ } else if (!dir.isDirectory()) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ dir.getName(),
+ "Is not a directory",
+ JOptionPane.ERROR_MESSAGE);
+ return false;
+ }
+ return true;
+ }
+
+ class DisplayThread extends Thread {
+ String read() throws InterruptedException { return null; }
+
+ void close() { }
+
+ void update(AltosState state) throws InterruptedException { }
+
+ public void run() {
+ String line;
+ AltosState state = null;
+
+ info_reset();
+ info_finish();
+ try {
+ while ((line = read()) != null) {
+ try {
+ AltosTelemetry t = new AltosTelemetry(line);
+ state = new AltosState(t, state);
+ update(state);
+ show(state);
+ } catch (ParseException pp) {
+ System.out.printf("Parse error on %s\n", line);
+ System.out.println("exception " + pp);
+ }
+ }
+ } catch (InterruptedException ee) {
+ } finally {
+ close();
+ }
+ }
+ }
+
+ class DeviceThread extends DisplayThread {
+ AltosSerial serial;
+ LinkedBlockingQueue<String> telem;
+
+ String read() throws InterruptedException {
+ return telem.take();
+ }
+
+ void close() {
+ serial.close();
+ serial.remove_monitor(telem);
+ System.out.println("DisplayThread done");
+ }
+
+ public DeviceThread(AltosSerial s) {
+ serial = s;
+ telem = new LinkedBlockingQueue<String>();
+ serial.add_monitor(telem);
+ }
+ }
+
+ private void ConnectToDevice() {
+ AltosDevice device = AltosDeviceDialog.show(AltosUI.this, "TeleDongle");
+
+ if (device != null) {
+ try {
+ serialLine.connect(device.tty);
+ DeviceThread thread = new DeviceThread(serialLine);
+ run_display(thread);
+ } catch (FileNotFoundException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ device.tty,
+ "Cannot open serial port",
+ JOptionPane.ERROR_MESSAGE);
+ } catch (NoSuchPortException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ device.tty,
+ "No such serial port",
+ JOptionPane.ERROR_MESSAGE);
+ } catch (PortInUseException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ device.tty,
+ "Port in use",
+ JOptionPane.ERROR_MESSAGE);
+ } catch (IOException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ device.tty,
+ "Unkonwn I/O error",
+ JOptionPane.ERROR_MESSAGE);
+ }
+ }
+ }
+
+ void DisconnectFromDevice () {
+ stop_display();
+ }
+
+ String readline(FileInputStream s) throws IOException {
+ int c;
+ String line = "";
+
+ while ((c = s.read()) != -1) {
+ if (c == '\r')
+ continue;
+ if (c == '\n')
+ return line;
+ line = line + (char) c;
+ }
+ return null;
+ }
+
+ /*
+ * Open an existing telemetry file and replay it in realtime
+ */
+
+ class ReplayThread extends DisplayThread {
+ FileInputStream replay;
+ String filename;
+
+ ReplayThread(FileInputStream in, String name) {
+ replay = in;
+ filename = name;
+ }
+
+ String read() {
+ try {
+ return readline(replay);
+ } catch (IOException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ filename,
+ "error reading",
+ JOptionPane.ERROR_MESSAGE);
+ }
+ return null;
+ }
+
+ void close () {
+ try {
+ replay.close();
+ } catch (IOException ee) {
+ }
+ }
+
+ void update(AltosState state) throws InterruptedException {
+ /* Make it run in realtime after the rocket leaves the pad */
+ if (state.state > AltosTelemetry.ao_flight_pad)
+ Thread.sleep((int) (state.time_change * 1000));
+ }
+ }
+
+ Thread display_thread;
+
+ private void stop_display() {
+ if (display_thread != null && display_thread.isAlive())
+ display_thread.interrupt();
+ display_thread = null;
+ }
+
+ private void run_display(Thread thread) {
+ stop_display();
+ display_thread = thread;
+ display_thread.start();
+ }
+
+ /*
+ * Replay a flight from telemetry data
+ */
+ private void Replay() {
+ JFileChooser logfile_chooser = new JFileChooser();
+
+ logfile_chooser.setDialogTitle("Select Telemetry File");
+ logfile_chooser.setFileFilter(new FileNameExtensionFilter("Telemetry file", "telem"));
+ logfile_chooser.setCurrentDirectory(logdir);
+ int returnVal = logfile_chooser.showOpenDialog(AltosUI.this);
+
+ if (returnVal == JFileChooser.APPROVE_OPTION) {
+ File file = logfile_chooser.getSelectedFile();
+ if (file == null)
+ System.out.println("No file selected?");
+ String filename = file.getName();
+ try {
+ FileInputStream replay = new FileInputStream(file);
+ ReplayThread thread = new ReplayThread(replay, filename);
+ run_display(thread);
+ } catch (FileNotFoundException ee) {
+ JOptionPane.showMessageDialog(AltosUI.this,
+ filename,
+ "Cannot open serial port",
+ JOptionPane.ERROR_MESSAGE);
+ }
+ }
+ }
+
+ /* Connect to TeleMetrum, either directly or through
+ * a TeleDongle over the packet link
+ */
+ private void SaveFlightData() {
+ }
+
+ /* Configure the log directory. This is where all telemetry and eeprom files
+ * will be written to, and where replay will look for telemetry files
+ */
+ private void ConfigureLog() {
+ JFileChooser logdir_chooser = new JFileChooser();
+
+ logdir_chooser.setDialogTitle("Configure Data Logging Directory");
+ logdir_chooser.setCurrentDirectory(logdir.getParentFile());
+ logdir_chooser.setFileSelectionMode(JFileChooser.DIRECTORIES_ONLY);
+
+ if (logdir_chooser.showDialog(AltosUI.this, "Select Directory") == JFileChooser.APPROVE_OPTION) {
+ File dir = logdir_chooser.getSelectedFile();
+ if (check_dir(dir))
+ set_logdir(dir);
+ }
+ }
+
+ /* Create the AltosUI menus
+ */