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

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
index 79e31e89..3bfa3488 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;
@@ -44,6 +48,19 @@ public class AltosBluetooth extends AltosLink {
 	private InputStream      input;
 	private OutputStream     output;
 
+	// Constructor
+	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 {
 		private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB");
 
@@ -86,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;
@@ -114,13 +135,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 +170,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 +187,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
+}