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<AltosLine> 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<AltosLine>();
		link.add_monitor(telem);
	}
}