2 * Copyright © 2011 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;
22 import java.util.concurrent.*;
24 public class AltosConfigData implements Iterable<String> {
26 /* Version information */
27 public String manufacturer;
28 public String product;
31 public int log_format;
32 public String version;
34 /* Strings returned */
35 public LinkedList<String> lines;
37 /* Config information */
39 public int main_deploy;
40 public int apogee_delay;
41 public int apogee_lockout;
44 public int radio_frequency;
45 public String callsign;
46 public int radio_enable;
47 public int radio_calibration;
48 /* Old HAS_RADIO values */
49 public int radio_channel;
50 public int radio_setting;
53 public int accel_cal_plus, accel_cal_minus;
54 public int pad_orientation;
57 public int flight_log_max;
60 public int ignite_mode;
63 public String aes_key;
66 public AltosPyro[] pyros;
70 /* Storage info replies */
71 public int storage_size;
72 public int storage_erase_unit;
74 /* Log listing replies */
75 public int stored_flight;
78 public static String get_string(String line, String label) throws ParseException {
79 if (line.startsWith(label)) {
80 String quoted = line.substring(label.length()).trim();
82 if (quoted.startsWith("\""))
83 quoted = quoted.substring(1);
84 if (quoted.endsWith("\""))
85 quoted = quoted.substring(0,quoted.length()-1);
88 throw new ParseException("mismatch", 0);
91 public static int get_int(String line, String label) throws NumberFormatException, ParseException {
92 if (line.startsWith(label)) {
93 String tail = line.substring(label.length()).trim();
94 String[] tokens = tail.split("\\s+");
95 if (tokens.length > 0)
96 return Integer.parseInt(tokens[0]);
98 throw new ParseException("mismatch", 0);
101 public Iterator<String> iterator() {
102 return lines.iterator();
105 public int log_available() {
106 switch (log_format) {
107 case AltosLib.AO_LOG_FORMAT_TINY:
108 if (stored_flight == 0)
111 case AltosLib.AO_LOG_FORMAT_TELEMETRY:
112 case AltosLib.AO_LOG_FORMAT_TELESCIENCE:
115 if (flight_log_max <= 0)
117 int log_space = storage_size - storage_erase_unit;
118 int log_used = stored_flight * flight_log_max;
120 if (log_used >= log_space)
122 return (log_space - log_used) / flight_log_max;
126 int[] parse_version(String v) {
127 String[] parts = v.split("\\.");
128 int r[] = new int[parts.length];
130 for (int i = 0; i < parts.length; i++) {
132 r[i] = AltosLib.fromdec(parts[i]);
133 } catch (NumberFormatException n) {
141 public int compare_version(String other) {
142 int[] me = parse_version(version);
143 int[] them = parse_version(other);
145 int l = Math.min(me.length, them.length);
147 for (int i = 0; i < l; i++) {
148 int d = me[i] - them[i];
159 public void reset() {
160 lines = new LinkedList<String>();
170 public void parse_line(String line) {
172 /* Version replies */
173 try { manufacturer = get_string(line, "manufacturer"); } catch (Exception e) {}
174 try { product = get_string(line, "product"); } catch (Exception e) {}
175 try { serial = get_int(line, "serial-number"); } catch (Exception e) {}
176 try { flight = get_int(line, "current-flight"); } catch (Exception e) {}
177 try { log_format = get_int(line, "log-format"); } catch (Exception e) {}
178 try { version = get_string(line, "software-version"); } catch (Exception e) {}
180 /* Version also contains MS5607 info, which we ignore here */
182 /* Config show replies */
185 try { main_deploy = get_int(line, "Main deploy:"); } catch (Exception e) {}
186 try { apogee_delay = get_int(line, "Apogee delay:"); } catch (Exception e) {}
187 try { apogee_lockout = get_int(line, "Apogee lockout:"); } catch (Exception e) {}
191 radio_frequency = get_int(line, "Frequency:");
192 if (radio_frequency < 0)
193 radio_frequency = 434550;
194 } catch (Exception e) {}
195 try { callsign = get_string(line, "Callsign:"); } catch (Exception e) {}
196 try { radio_enable = get_int(line, "Radio enable:"); } catch (Exception e) {}
197 try { radio_calibration = get_int(line, "Radio cal:"); } catch (Exception e) {}
199 /* Old HAS_RADIO values */
200 try { radio_channel = get_int(line, "Radio channel:"); } catch (Exception e) {}
201 try { radio_setting = get_int(line, "Radio setting:"); } catch (Exception e) {}
205 if (line.startsWith("Accel cal")) {
206 String[] bits = line.split("\\s+");
207 if (bits.length >= 6) {
208 accel_cal_plus = Integer.parseInt(bits[3]);
209 accel_cal_minus = Integer.parseInt(bits[5]);
212 } catch (Exception e) {}
213 try { pad_orientation = get_int(line, "Pad orientation:"); } catch (Exception e) {}
216 try { flight_log_max = get_int(line, "Max flight log:"); } catch (Exception e) {}
219 try { ignite_mode = get_int(line, "Ignite mode:"); } catch (Exception e) {}
222 try { aes_key = get_string(line, "AES key:"); } catch (Exception e) {}
226 npyro = get_int(line, "Pyro-count:");
227 pyros = new AltosPyro[npyro];
229 } catch (Exception e) {}
232 AltosPyro p = new AltosPyro(pyro, line);
233 if (pyro < npyro - 1)
235 } catch (Exception e) {}
238 /* Storage info replies */
239 try { storage_size = get_int(line, "Storage size:"); } catch (Exception e) {}
240 try { storage_erase_unit = get_int(line, "Storage erase unit"); } catch (Exception e) {}
242 /* Log listing replies */
243 try { get_int(line, "flight"); stored_flight++; } catch (Exception e) {}
246 public AltosConfigData() {
250 private void read_link(AltosLink link, String finished) throws InterruptedException, TimeoutException {
252 String line = link.get_reply();
254 throw new TimeoutException();
255 if (line.contains("Syntax error"))
257 this.parse_line(line);
259 /* signals the end of the version info */
260 if (line.startsWith(finished))
265 public AltosConfigData(AltosLink link) throws InterruptedException, TimeoutException {
267 link.printf("c s\nf\nv\n");
268 read_link(link, "software-version");
269 switch (log_format) {
270 case AltosLib.AO_LOG_FORMAT_TELEMETRY:
271 case AltosLib.AO_LOG_FORMAT_TELESCIENCE:
275 read_link(link, "done");