X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=altosdroid%2Fsrc%2Forg%2Faltusmetrum%2FAltosDroid%2FAltosBluetooth.java;h=c16e3cf5bc8365d57d1a63de86ad6dff6eb71dc3;hb=fe6680dd3b4c31b3d4edc3f06a142f02bcb879df;hp=79e31e8901ce6ddcc4de1ff998a21c157d42e0dd;hpb=b59e7d0b201290f2cb0fd494ef28c1402e11ba3b;p=fw%2Faltos

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
index 79e31e89..c16e3cf5 100644
--- a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
+++ b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
@@ -37,6 +37,7 @@ public class AltosBluetooth extends AltosLink {
 	private static final boolean D = true;
 
 	private ConnectThread    connect_thread = null;
+	private Thread           input_thread   = null;
 
 	private BluetoothAdapter adapter;
 	private BluetoothDevice  device;
@@ -44,6 +45,18 @@ public class AltosBluetooth extends AltosLink {
 	private InputStream      input;
 	private OutputStream     output;
 
+	// Constructor
+	public AltosBluetooth(BluetoothDevice in_device) {
+		adapter = BluetoothAdapter.getDefaultAdapter();
+		device = in_device;
+
+		connect_thread = new ConnectThread(device);
+		connect_thread.start();
+
+		input_thread = new Thread(this);
+		input_thread.start();
+	}
+
 	private class ConnectThread extends Thread {
 		private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB");
 
@@ -86,6 +99,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;
@@ -114,13 +131,16 @@ public class AltosBluetooth extends AltosLink {
 	}
 
 	private void connection_failed() {
+		if (D) Log.i(TAG, "Bluetooth Connection failed!");
 	}
 	
 	public void print(String data) {
 		byte[] bytes = data.getBytes();
 		try {
+			if (D) Log.i(TAG, "Entering print();");
 			wait_connected();
 			output.write(bytes);
+			if (D) Log.i(TAG, "Writing bytes: '" + data + "'");
 		} catch (IOException e) {
 			connection_failed();
 		} catch (InterruptedException e) {
@@ -146,6 +166,13 @@ public class AltosBluetooth extends AltosLink {
 				connect_thread.cancel();
 				connect_thread = null;
 			}
+			if (input_thread != null) {
+				try {
+					input_thread.interrupt();
+					input_thread.join();
+				} catch (Exception e) {}
+				input_thread = null;
+			}
 		}
 	}
 
@@ -156,9 +183,4 @@ public class AltosBluetooth extends AltosLink {
 	public boolean show_reply_timeout() { return true; }
 	public void hide_reply_timeout()    { }
 
-	public AltosBluetooth(BluetoothDevice device) {
-		adapter = BluetoothAdapter.getDefaultAdapter();
-		connect_thread = new ConnectThread(device, true);
-		connect_thread.start();
-	}
-}
\ No newline at end of file
+}