2 * Copyright © 2011 Keith Packard <keithp@keithp.com>
3 * Copyright © 2012 Mike Beattie <mike@ethernal.org>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; version 2 of the License.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
20 package org.altusmetrum.AltosDroid;
24 import java.util.concurrent.*;
25 import android.util.Log;
26 import android.os.Handler;
28 import org.altusmetrum.altoslib_5.*;
31 public class TelemetryReader extends Thread {
33 private static final String TAG = "TelemetryReader";
34 private static final boolean D = true;
41 AltosState state = null;
43 AltosFlightReader stacked;
45 LinkedBlockingQueue<AltosLine> telemQueue;
47 public AltosState read() throws ParseException, AltosCRCException, InterruptedException, IOException {
48 AltosLine l = telemQueue.take();
50 throw new IOException("IO error");
51 AltosTelemetry telem = AltosTelemetryLegacy.parse(l.line);
53 state = new AltosState();
55 state = state.clone();
56 telem.update_state(state);
62 if (stacked != null) {
66 link.remove_monitor(telemQueue);
73 AltosState state = null;
76 if (D) Log.d(TAG, "starting reader");
77 while (stacked != null) {
78 AltosState stacked_state = null;
80 stacked_state = stacked.read();
81 } catch (ParseException pe) {
83 } catch (AltosCRCException ce) {
86 if (stacked_state != null)
87 state = stacked_state;
92 if (D) Log.d(TAG, "Send initial state");
93 handler.obtainMessage(TelemetryService.MSG_TELEMETRY, state).sendToTarget();
95 if (D) Log.d(TAG, "starting loop");
96 while (telemQueue != null) {
99 handler.obtainMessage(TelemetryService.MSG_TELEMETRY, state).sendToTarget();
100 } catch (ParseException pp) {
101 Log.e(TAG, String.format("Parse error: %d \"%s\"", pp.getErrorOffset(), pp.getMessage()));
102 } catch (AltosCRCException ce) {
104 handler.obtainMessage(TelemetryService.MSG_CRC_ERROR, new Integer(crc_errors)).sendToTarget();
107 } catch (InterruptedException ee) {
108 } catch (IOException ie) {
114 public TelemetryReader (AltosLink in_link, Handler in_handler, AltosFlightReader in_stacked) {
115 if (D) Log.d(TAG, "connected TelemetryReader create started");
117 handler = in_handler;
118 stacked = in_stacked;
121 telemQueue = new LinkedBlockingQueue<AltosLine>();
122 link.add_monitor(telemQueue);
123 link.set_telemetry(AltosLib.ao_telemetry_standard);
125 if (D) Log.d(TAG, "connected TelemetryReader created");
128 private static AltosFlightReader existing_data(AltosLink link) {
132 File file = AltosPreferences.logfile(link.serial);
134 AltosStateIterable iterable = AltosStateIterable.iterable(file);
135 if (iterable != null)
136 return new AltosReplayReader(iterable.iterator(), file, false);
141 public TelemetryReader(AltosLink link, Handler handler) {
142 this(link, handler, existing_data(link));