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

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java
index 32140b3c..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;
@@ -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 {
@@ -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;
@@ -123,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) {
@@ -155,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;
+			}
 		}
 	}