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.
18 package org.altusmetrum.altoslib_1;
21 import java.util.concurrent.*;
24 public class AltosIdleMonitor extends Thread {
26 AltosIdleMonitorListener listener;
31 AltosState previous_state;
32 AltosListenerState listener_state;
33 AltosConfigData config_data;
36 int AltosRSSI() throws TimeoutException, InterruptedException {
38 String line = link.get_reply_no_dialog(5000);
40 throw new TimeoutException();
41 String[] items = line.split("\\s+");
44 if (!items[0].equals("RSSI:"))
46 int rssi = Integer.parseInt(items[1]);
50 boolean has_sensor_tm(AltosConfigData config_data) {
51 return config_data.product.startsWith("TeleMetrum") || config_data.product.startsWith("TeleMini");
54 boolean has_sensor_mm(AltosConfigData config_data) {
55 return config_data.product.startsWith("TeleMega");
58 boolean has_gps(AltosConfigData config_data) {
59 return config_data.product.startsWith("TeleMetrum") || config_data.product.startsWith("TeleMega");
62 AltosRecord sensor_mm(AltosConfigData config_data) throws InterruptedException, TimeoutException {
63 AltosRecordMM record_mm = new AltosRecordMM();
64 AltosSensorMM sensor = new AltosSensorMM(link);
65 AltosMs5607 ms5607 = new AltosMs5607Query(link);
66 AltosIMU imu = new AltosIMUQuery(link);
68 record_mm.accel_plus_g = config_data.accel_cal_plus;
69 record_mm.accel_minus_g = config_data.accel_cal_minus;
71 record_mm.ground_accel = sensor.accel;
72 record_mm.accel = sensor.accel;
73 record_mm.ground_pres = ms5607.pa;
74 record_mm.pres = ms5607.pa;
75 record_mm.temp = ms5607.cc;
77 record_mm.v_batt = sensor.v_batt;
78 record_mm.v_pyro = sensor.v_pyro;
79 record_mm.sense = sensor.sense;
86 void update_state() throws InterruptedException, TimeoutException {
87 AltosRecord record = null;
91 link.set_radio_frequency(frequency);
92 link.set_callsign(callsign);
96 config_data = new AltosConfigData(link);
98 if (has_sensor_tm(config_data))
99 record = new AltosSensorTM(link, config_data);
100 else if (has_sensor_mm(config_data))
101 record = sensor_mm(config_data);
103 record = new AltosRecordNone();
105 if (has_gps(config_data))
106 gps = new AltosGPSQuery(link, config_data);
109 record.callsign = config_data.callsign;
110 record.serial = config_data.serial;
111 record.flight = config_data.log_available() > 0 ? 255 : 0;
113 record.state = AltosLib.ao_flight_idle;
115 record.new_gps = true;
116 state = new AltosState (record, state);
120 if (record != null) {
121 record.rssi = link.rssi();
122 listener_state.battery = link.monitor_battery();
132 public void set_frequency(double in_frequency) {
133 frequency = in_frequency;
137 public void set_callsign(String in_callsign) {
138 callsign = in_callsign;
142 public void post_state() {
143 listener.update(state, listener_state);
146 public void abort() {
152 } catch (InterruptedException ie) {
163 } catch (TimeoutException te) {
167 } catch (InterruptedException ie) {
172 public AltosIdleMonitor(AltosIdleMonitorListener in_listener, AltosLink in_link, boolean in_remote)
173 throws FileNotFoundException, InterruptedException, TimeoutException {
174 listener = in_listener;
178 listener_state = new AltosListenerState();