X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altosdroid%2Fsrc%2Forg%2Faltusmetrum%2FAltosDroid%2FAltosBluetooth.java;h=3071c8f19ac5ef8b3c7cafc7871366637ec3cc4a;hp=32140b3cbb513b656e476fbbfdef15607f4262b3;hb=3d6fc5fe462531e05ca4b9be1a421490e067a28b;hpb=5ce132b3366cd120499fcbe22b5fbe96d21b8584

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
index 32140b3c..3071c8f1 100644
--- a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
+++ b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
@@ -26,6 +26,7 @@ import java.util.UUID;
 import android.bluetooth.BluetoothAdapter;
 import android.bluetooth.BluetoothDevice;
 import android.bluetooth.BluetoothSocket;
+import android.os.Handler;
 import android.util.Log;
 
 import org.altusmetrum.AltosLib.*;
@@ -37,6 +38,9 @@ public class AltosBluetooth extends AltosLink {
 	private static final boolean D = true;
 
 	private ConnectThread    connect_thread = null;
+	private Thread           input_thread   = null;
+
+	private Handler          handler;
 
 	private BluetoothAdapter adapter;
 	private BluetoothDevice  device;
@@ -45,12 +49,16 @@ public class AltosBluetooth extends AltosLink {
 	private OutputStream     output;
 
 	// Constructor
-	public AltosBluetooth(BluetoothDevice in_device) {
+	public AltosBluetooth(BluetoothDevice in_device, Handler in_handler) {
 		adapter = BluetoothAdapter.getDefaultAdapter();
-
+		device = in_device;
+		handler = in_handler;
 
 		connect_thread = new ConnectThread(device);
 		connect_thread.start();
+
+		input_thread = new Thread(this);
+		input_thread.start();
 	}
 
 	private class ConnectThread extends Thread {
@@ -68,7 +76,7 @@ public class AltosBluetooth extends AltosLink {
 		}
 
 		public void run() {
-			if (D) Log.i(TAG, "BEGIN ConnectThread");
+			if (D) Log.i(TAG, "ConnectThread: BEGIN");
 			setName("ConnectThread");
 
 			// Always cancel discovery because it will slow down a connection
@@ -95,6 +103,10 @@ public class AltosBluetooth extends AltosLink {
 					input = socket.getInputStream();
 					output = socket.getOutputStream();
 
+					// Configure the newly connected device for telemetry
+					print("~\nE 0\n");
+					set_monitor(false);
+
 					// Reset the ConnectThread because we're done
 					AltosBluetooth.this.notify();
 					connect_thread = null;
@@ -111,25 +123,31 @@ public class AltosBluetooth extends AltosLink {
 				if (socket != null)
 					socket.close();
 			} catch (IOException e) {
-				if (D) Log.e(TAG, "close() of connect socket failed", e);
+				if (D) Log.e(TAG, "ConnectThread: close() of connect socket failed", e);
 			}
 		}
 	}
 
 	private synchronized void wait_connected() throws InterruptedException {
+		if (D) Log.i(TAG, "wait_connected(): begin");
 		if (input == null) {
+			if (D) Log.i(TAG, "wait_connected(): waiting");
 			wait();
+			if (D) Log.i(TAG, "wait_connected(): wait ended..");
 		}
 	}
 
 	private void connection_failed() {
+		if (D) Log.e(TAG, "Bluetooth Socket IO failed!");
 	}
 	
 	public void print(String data) {
 		byte[] bytes = data.getBytes();
+		if (D) Log.i(TAG, "print(): begin");
 		try {
 			wait_connected();
 			output.write(bytes);
+			if (D) Log.i(TAG, "print(): Wrote bytes: '" + data.replace('\n', '\\') + "'");
 		} catch (IOException e) {
 			connection_failed();
 		} catch (InterruptedException e) {
@@ -138,8 +156,10 @@ public class AltosBluetooth extends AltosLink {
 	}
 
 	public int getchar() {
+		if (D) Log.i(TAG, "getchar(): begin");
 		try {
 			wait_connected();
+			if (D) Log.i(TAG, "getchar(): proceeding");
 			return input.read();
 		} catch (IOException e) {
 			connection_failed();
@@ -150,11 +170,25 @@ public class AltosBluetooth extends AltosLink {
 	}
 			
 	public void close() {
+		if (D) Log.i(TAG, "close(): begin");
 		synchronized(this) {
+			if (D) Log.i(TAG, "close(): synched");
+
 			if (connect_thread != null) {
+				if (D) Log.i(TAG, "close(): stopping connect_thread");
 				connect_thread.cancel();
 				connect_thread = null;
 			}
+			if (input_thread != null) {
+				if (D) Log.i(TAG, "close(): stopping input_thread");
+				try {
+					if (D) Log.i(TAG, "close(): input_thread.interrupt().....");
+					input_thread.interrupt();
+					if (D) Log.i(TAG, "close(): input_thread.join().....");
+					input_thread.join();
+				} catch (Exception e) {}
+				input_thread = null;
+			}
 		}
 	}