/* * Copyright © 2011 Keith Packard * Copyright © 2012 Mike Beattie * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; version 2 of the License. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. */ package org.altusmetrum.AltosDroid; import java.text.*; import java.io.*; import java.util.concurrent.*; import android.util.Log; import android.os.Handler; import org.altusmetrum.AltosLib.*; public class TelemetryReader extends Thread { private static final String TAG = "TelemetryReader"; int crc_errors; Handler handler; AltosLink link; AltosRecord previous; LinkedBlockingQueue telem; public AltosRecord read() throws ParseException, AltosCRCException, InterruptedException, IOException { AltosLine l = telem.take(); if (l.line == null) throw new IOException("IO error"); AltosRecord next = AltosTelemetry.parse(l.line, previous); previous = next; return next; } public void close() { previous = null; link.remove_monitor(telem); link = null; telem.clear(); telem = null; } public void run() { AltosState state = null; try { for (;;) { try { AltosRecord record = read(); if (record == null) break; state = new AltosState(record, state); handler.obtainMessage(TelemetryService.MSG_TELEMETRY, state).sendToTarget(); } catch (ParseException pp) { Log.e(TAG, String.format("Parse error: %d \"%s\"", pp.getErrorOffset(), pp.getMessage())); } catch (AltosCRCException ce) { ++crc_errors; } } } catch (InterruptedException ee) { } catch (IOException ie) { } finally { close(); } } public TelemetryReader (AltosLink in_link, Handler in_handler) { link = in_link; handler = in_handler; previous = null; telem = new LinkedBlockingQueue(); link.add_monitor(telem); } }