X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altosdroid%2Fsrc%2Forg%2Faltusmetrum%2FAltosDroid%2FAltosBluetooth.java;h=da75ffddaf5ffdbd0a8c82049a16cba7f650e751;hp=cc039206924fe682b5e994826dd4681c9ecc6556;hb=cdd7ad469728fde178c69b9c99d70d6e0ab3f12d;hpb=8fdde3e74c6dce35f90f4575ce6914516fc56aba diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java index cc039206..da75ffdd 100644 --- a/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java +++ b/altosdroid/src/org/altusmetrum/AltosDroid/AltosBluetooth.java @@ -26,10 +26,12 @@ import java.util.UUID; import android.bluetooth.BluetoothAdapter; import android.bluetooth.BluetoothDevice; import android.bluetooth.BluetoothSocket; +//import android.os.Bundle; import android.os.Handler; +//import android.os.Message; import android.util.Log; -import org.altusmetrum.AltosLib.*; +import org.altusmetrum.altoslib_6.*; public class AltosBluetooth extends AltosLink { @@ -43,156 +45,283 @@ public class AltosBluetooth extends AltosLink { private Handler handler; private BluetoothAdapter adapter; - private BluetoothDevice device; private BluetoothSocket socket; private InputStream input; private OutputStream output; // Constructor - public AltosBluetooth(BluetoothDevice in_device, Handler in_handler) { + public AltosBluetooth(BluetoothDevice device, Handler handler) { +// set_debug(D); adapter = BluetoothAdapter.getDefaultAdapter(); - device = in_device; - handler = in_handler; + this.handler = handler; - connect_thread = new ConnectThread(device); + create_socket(device); + connect_thread = new ConnectThread(); connect_thread.start(); + } + + private Object closed_lock = new Object(); + private boolean closed = false; - input_thread = new Thread(this); - input_thread.start(); + private boolean closed() { + synchronized(closed_lock) { + return closed; + } } - private class ConnectThread extends Thread { - private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB"); + private void connected() { + if (closed()) { + if (D) Log.d(TAG, "connected after closed"); + return; + } + + try { + synchronized(this) { + if (socket != null) { + input = socket.getInputStream(); + output = socket.getOutputStream(); + + input_thread = new Thread(this); + input_thread.start(); + + // Configure the newly connected device for telemetry + print("~\nE 0\n"); + set_monitor(false); + if (D) Log.d(TAG, "ConnectThread: connected"); + + /* Let TelemetryService know we're connected + */ + handler.obtainMessage(TelemetryService.MSG_CONNECTED, this).sendToTarget(); + + /* Notify other waiting threads that we're connected now + */ + notifyAll(); + } + } + } catch (IOException io) { + connect_failed(); + } + } + + private void connect_failed() { + if (closed()) { + if (D) Log.d(TAG, "connect_failed after closed"); + return; + } + + close_socket(); + input = null; + output = null; + handler.obtainMessage(TelemetryService.MSG_CONNECT_FAILED, this).sendToTarget(); + if (D) Log.e(TAG, "ConnectThread: Failed to establish connection"); + } + + private void disconnected() { + if (closed()) { + if (D) Log.d(TAG, "disconnected after closed"); + return; + } - public ConnectThread(BluetoothDevice device) { - BluetoothSocket tmp_socket = null; + if (D) Log.d(TAG, "Sending disconnected message"); + handler.obtainMessage(TelemetryService.MSG_DISCONNECTED, this).sendToTarget(); + } + + private void close_socket() { + BluetoothSocket tmp_socket; + + synchronized(this) { + tmp_socket = socket; + socket = null; + } + if (tmp_socket != null) { try { - tmp_socket = device.createInsecureRfcommSocketToServiceRecord(SPP_UUID); + tmp_socket.close(); } catch (IOException e) { - e.printStackTrace(); + if (D) Log.e(TAG, "close_socket failed"); } + } + } + + private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB"); + + private void create_socket(BluetoothDevice device) { + + BluetoothSocket tmp_socket = null; + + try { + tmp_socket = device.createInsecureRfcommSocketToServiceRecord(SPP_UUID); + } catch (IOException e) { + e.printStackTrace(); + } + if (socket != null) { + if (D) Log.d(TAG, String.format("Socket already allocated %s", socket.toString())); + close_socket(); + } + synchronized (this) { socket = tmp_socket; } + } + + private class ConnectThread extends Thread { public void run() { - if (D) Log.i(TAG, "ConnectThread: BEGIN"); + if (D) Log.d(TAG, "ConnectThread: BEGIN"); setName("ConnectThread"); // Always cancel discovery because it will slow down a connection - adapter.cancelDiscovery(); + try { + adapter.cancelDiscovery(); + } catch (Exception e) { + if (D) Log.d(TAG, String.format("cancelDiscovery exception %s", e.toString())); + } + + BluetoothSocket local_socket = null; synchronized (AltosBluetooth.this) { - // Make a connection to the BluetoothSocket + if (!closed()) + local_socket = socket; + } + + if (local_socket != null) { try { + // Make a connection to the BluetoothSocket // This is a blocking call and will only return on a // successful connection or an exception - socket.connect(); - - input = socket.getInputStream(); - output = socket.getOutputStream(); + local_socket.connect(); } catch (IOException e) { - // Close the socket - try { - socket.close(); - } catch (IOException e2) { - if (D) Log.e(TAG, "ConnectThread: Failed to close() socket after failed connection"); - } - input = null; - output = null; - AltosBluetooth.this.notifyAll(); - if (D) Log.e(TAG, "ConnectThread: Failed to establish connection"); - return; + if (D) Log.d(TAG, String.format("Connect exception %s", e.toString())); + local_socket = null; } + } - // Configure the newly connected device for telemetry - print("~\nE 0\n"); - set_monitor(false); + if (local_socket != null) { + connected(); + } else { + connect_failed(); + } - // Reset the ConnectThread because we're done - connect_thread = null; + if (D) Log.d(TAG, "ConnectThread: completed"); + } + } - // Notify other waiting threads, now that we're connected - AltosBluetooth.this.notifyAll(); + public double frequency() { + return frequency; + } - if (D) Log.i(TAG, "ConnectThread: Connect completed"); - } - } + public int telemetry_rate() { + return telemetry_rate; + } - public void cancel() { - try { - if (socket != null) - socket.close(); - } catch (IOException e) { - if (D) Log.e(TAG, "ConnectThread: close() of connect socket failed", e); - } - } + 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 (D) Log.i(TAG, "wait_connected(): begin"); - if (input == null) { - if (D) Log.i(TAG, "wait_connected(): waiting"); + if (input == null && socket != null) { + if (D) Log.d(TAG, "wait_connected..."); wait(); - if (D) Log.i(TAG, "wait_connected(): wait ended.."); - if (input == null) throw new IOException(); + if (D) Log.d(TAG, "wait_connected done"); } + if (socket == null) + throw new IOException(); } - 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"); + if (D) Log.d(TAG, "print(): begin"); try { wait_connected(); output.write(bytes); - if (D) Log.i(TAG, "print(): Wrote bytes: '" + data.replace('\n', '\\') + "'"); + if (D) Log.d(TAG, "print(): Wrote bytes: '" + data.replace('\n', '\\') + "'"); } catch (IOException e) { - connection_failed(); + disconnected(); } catch (InterruptedException e) { - connection_failed(); + disconnected(); } } - public int getchar() { - if (D) Log.i(TAG, "getchar(): begin"); + public void putchar(byte c) { + byte[] bytes = { c }; + if (D) Log.d(TAG, "print(): begin"); try { wait_connected(); - if (D) Log.i(TAG, "getchar(): proceeding"); - 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(); + disconnected(); + } catch (InterruptedException e) { + disconnected(); } - return AltosLink.ERROR; } - - 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 (D) Log.i(TAG, "close(): Closing socket"); + private static final int buffer_size = 1024; + + private byte[] buffer = new byte[buffer_size]; + private int buffer_len = 0; + private int buffer_off = 0; + + private byte[] debug_chars = new byte[buffer_size]; + private int debug_off; + + private void debug_input(byte b) { + if (b == '\n') { + Log.d(TAG, " " + new String(debug_chars, 0, debug_off)); + debug_off = 0; + } else { + if (debug_off < buffer_size) + debug_chars[debug_off++] = b; + } + } + + public int getchar() { + while (buffer_off == buffer_len) { try { - socket.close(); + wait_connected(); + buffer_len = input.read(buffer); + buffer_off = 0; } catch (IOException e) { - if (D) Log.e(TAG, "close(): unable to close() socket"); + if (D) Log.d(TAG, "getchar IOException"); + disconnected(); + return AltosLink.ERROR; + } catch (java.lang.InterruptedException e) { + if (D) Log.d(TAG, "getchar Interrupted"); + disconnected(); + return AltosLink.ERROR; } + } + if (D) + debug_input(buffer[buffer_off]); + return buffer[buffer_off++]; + } + + public void closing() { + synchronized(closed_lock) { + if (D) Log.d(TAG, "Marked closed true"); + closed = true; + } + } + + + public void close() { + if (D) Log.d(TAG, "close(): begin"); + + closing(); + + close_socket(); + + synchronized(this) { + if (input_thread != null) { - if (D) Log.i(TAG, "close(): stopping input_thread"); + if (D) Log.d(TAG, "close(): stopping input_thread"); try { - if (D) Log.i(TAG, "close(): input_thread.interrupt()....."); + if (D) Log.d(TAG, "close(): input_thread.interrupt()....."); input_thread.interrupt(); - if (D) Log.i(TAG, "close(): input_thread.join()....."); + if (D) Log.d(TAG, "close(): input_thread.join()....."); input_thread.join(); } catch (Exception e) {} input_thread = null; @@ -203,9 +332,9 @@ public class AltosBluetooth extends AltosLink { } } - //public void flush_output() { super.flush_output(); } + // Stubs of required methods when extending AltosLink public boolean can_cancel_reply() { return false; } public boolean show_reply_timeout() { return true; } public void hide_reply_timeout() { }