X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altosdroid%2Fsrc%2Forg%2Faltusmetrum%2FAltosDroid%2FAltosBluetooth.java;h=51ef5e94652d2c2dfe47a3d0b774497d873a1f7c;hb=deda23963586eb07a32f9a3c83a0355178e19340;hp=5a8ed096ff429f6e88b5ddf60006ebbe7fd24390;hpb=150a726e125aa7d181c00348ddd1791fd84164e5;p=fw%2Faltos

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
index 5a8ed096..51ef5e94 100644
--- a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
+++ b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
@@ -1,6 +1,6 @@
 /*
- * Copyright © 2011 Keith Packard <keithp@keithp.com>
- * Copyright © 2012 Mike Beattie <mike@ethernal.org>
+ * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ * Copyright © 2012 Mike Beattie <mike@ethernal.org>
  *
  * 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
@@ -31,7 +31,7 @@ import android.os.Handler;
 //import android.os.Message;
 import android.util.Log;
 
-import org.altusmetrum.AltosLib.*;
+import org.altusmetrum.altoslib_5.*;
 
 public class AltosBluetooth extends AltosLink {
 
@@ -52,6 +52,7 @@ public class AltosBluetooth extends AltosLink {
 
 	// Constructor
 	public AltosBluetooth(BluetoothDevice in_device, Handler in_handler) {
+//		set_debug(D);
 		adapter = BluetoothAdapter.getDefaultAdapter();
 		device = in_device;
 		handler = in_handler;
@@ -59,8 +60,6 @@ public class AltosBluetooth extends AltosLink {
 		connect_thread = new ConnectThread(device);
 		connect_thread.start();
 
-		input_thread = new Thread(this);
-		input_thread.start();
 	}
 
 	private class ConnectThread extends Thread {
@@ -108,20 +107,22 @@ public class AltosBluetooth extends AltosLink {
 					return;
 				}
 
+				input_thread = new Thread(AltosBluetooth.this);
+				input_thread.start();
+
 				// Configure the newly connected device for telemetry
 				print("~\nE 0\n");
 				set_monitor(false);
 
-				// Reset the ConnectThread because we're done
-				connect_thread = null;
-
-				// Send the device name back to the Telemetry Service
-				name = device.getName();
+				// Let TelemetryService know we're connected
 				handler.obtainMessage(TelemetryService.MSG_CONNECTED).sendToTarget();
 
 				// Notify other waiting threads, now that we're connected
 				AltosBluetooth.this.notifyAll();
 
+				// Reset the ConnectThread because we're done
+				connect_thread = null;
+
 				if (D) Log.d(TAG, "ConnectThread: Connect completed");
 			}
 		}
@@ -136,14 +137,32 @@ public class AltosBluetooth extends AltosLink {
 		}
 	}
 
+	public double frequency() {
+		return frequency;
+	}
+
+	public int telemetry_rate() {
+		return telemetry_rate;
+	}
+
+	public void save_frequency() {
+		AltosPreferences.set_frequency(0, frequency);
+	}
+
+	public void save_telemetry_rate() {
+		AltosPreferences.set_telemetry_rate(0, telemetry_rate);
+	}
+
 	private synchronized void wait_connected() throws InterruptedException, IOException {
 		if (input == null) {
+			if (D) Log.d(TAG, "wait_connected...");
 			wait();
+			if (D) Log.d(TAG, "wait_connected done");
 			if (input == null) throw new IOException();
 		}
 	}
 
-	private void connection_failed() {
+	private void connection_lost() {
 		if (D) Log.e(TAG, "Connection lost during I/O");
 		handler.obtainMessage(TelemetryService.MSG_DISCONNECTED).sendToTarget();
 	}
@@ -156,22 +175,47 @@ public class AltosBluetooth extends AltosLink {
 			output.write(bytes);
 			if (D) Log.d(TAG, "print(): Wrote bytes: '" + data.replace('\n', '\\') + "'");
 		} catch (IOException e) {
-			connection_failed();
+			connection_lost();
 		} catch (InterruptedException e) {
-			connection_failed();
+			connection_lost();
 		}
 	}
 
-	public int getchar() {
+	public void putchar(byte c) {
+		byte[] bytes = { c };
+		if (D) Log.d(TAG, "print(): begin");
 		try {
 			wait_connected();
-			return input.read();
+			output.write(bytes);
+			if (D) Log.d(TAG, "print(): Wrote byte: '" + c + "'");
 		} catch (IOException e) {
-			connection_failed();
-		} catch (java.lang.InterruptedException e) {
-			connection_failed();
+			connection_lost();
+		} catch (InterruptedException e) {
+			connection_lost();
 		}
-		return AltosLink.ERROR;
+	}
+
+	private static final int buffer_size = 1024;
+
+	private byte[] buffer = new byte[buffer_size];
+	private int buffer_len = 0;
+	private int buffer_off = 0;
+
+	public int getchar() {
+		while (buffer_off == buffer_len) {
+			try {
+				wait_connected();
+				buffer_len = input.read(buffer);
+				buffer_off = 0;
+			} catch (IOException e) {
+				connection_lost();
+				return AltosLink.ERROR;
+			} catch (java.lang.InterruptedException e) {
+				connection_lost();
+				return AltosLink.ERROR;
+			}
+		}
+		return buffer[buffer_off++];
 	}
 
 	public void close() {
@@ -207,6 +251,13 @@ public class AltosBluetooth extends AltosLink {
 	}
 
 
+	// We override this method so that we can add some debugging. Not 100% elegant, but more useful
+	// than debugging one char at a time above in getchar()!
+	public void add_reply(AltosLine line) throws InterruptedException {
+		if (D) Log.d(TAG, String.format("Got REPLY: %s", line.line));
+		super.add_reply(line);
+	}
+
 	//public void flush_output() { super.flush_output(); }
 
 	// Stubs of required methods when extending AltosLink