altosdroid: Centralize debug printf code
[fw/altos] / altosdroid / src / org / altusmetrum / AltosDroid / AltosBluetooth.java
index dffa9ffb8c31c3612a907d27ef1e32a894425cf1..03ae5cb84a55281bb3fb5046d0809293e06a5f7f 100644 (file)
@@ -1,6 +1,6 @@
 /*
- * Copyright © 2011 Keith Packard <keithp@keithp.com>
- * Copyright © 2012 Mike Beattie <mike@ethernal.org>
+ * Copyright Â© 2011 Keith Packard <keithp@keithp.com>
+ * Copyright Â© 2012 Mike Beattie <mike@ethernal.org>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
@@ -29,186 +29,192 @@ 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_7.*;
 
-public class AltosBluetooth extends AltosLink {
-
-       // Debugging
-       private static final String TAG = "AltosBluetooth";
-       private static final boolean D = true;
+public class AltosBluetooth extends AltosDroidLink {
 
        private ConnectThread    connect_thread = null;
-       private Thread           input_thread   = null;
-
-       private Handler          handler;
 
-       private BluetoothAdapter adapter;
-       private BluetoothDevice  device;
+       private BluetoothDevice  device;
        private BluetoothSocket  socket;
        private InputStream      input;
        private OutputStream     output;
+       private boolean          pause;
 
        // Constructor
-       public AltosBluetooth(BluetoothDevice in_device, Handler in_handler) {
-               adapter = BluetoothAdapter.getDefaultAdapter();
-               device = in_device;
-               handler = in_handler;
+       public AltosBluetooth(BluetoothDevice device, Handler handler, boolean pause) {
+               super(handler);
+               this.device = device;
+               this.handler = handler;
+               this.pause = pause;
 
-               connect_thread = new ConnectThread(device);
+               connect_thread = new ConnectThread();
                connect_thread.start();
+       }
+
+       void connected() {
+               if (closed()) {
+                       AltosDebug.debug("connected after closed");
+                       return;
+               }
 
+               AltosDebug.check_ui("connected\n");
+               try {
+                       synchronized(this) {
+                               if (socket != null) {
+                                       input = socket.getInputStream();
+                                       output = socket.getOutputStream();
+                                       super.connected();
+                               }
+                       }
+               } catch (InterruptedException ie) {
+                       connect_failed();
+               } catch (IOException io) {
+                       connect_failed();
+               }
        }
 
-       private class ConnectThread extends Thread {
-               private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB");
+       private void connect_failed() {
+               if (closed()) {
+                       AltosDebug.debug("connect_failed after closed");
+                       return;
+               }
+
+               close_device();
+               input = null;
+               output = null;
+               handler.obtainMessage(TelemetryService.MSG_CONNECT_FAILED, this).sendToTarget();
+               AltosDebug.error("ConnectThread: Failed to establish connection");
+       }
 
-               public ConnectThread(BluetoothDevice device) {
-                       BluetoothSocket tmp_socket = null;
+       void close_device() {
+               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();
+                               AltosDebug.error("close_socket failed");
                        }
+               }
+       }
+
+       public void close() {
+               super.close();
+               input = null;
+               output = null;
+       }
+
+       private final UUID SPP_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB");
+
+       private void create_socket(BluetoothDevice  device) {
+
+               BluetoothSocket tmp_socket = null;
+
+               AltosDebug.check_ui("create_socket\n");
+               try {
+                       tmp_socket = device.createInsecureRfcommSocketToServiceRecord(SPP_UUID);
+               } catch (IOException e) {
+                       e.printStackTrace();
+               }
+               if (socket != null) {
+                       AltosDebug.debug("Socket already allocated %s", socket.toString());
+                       close_device();
+               }
+               synchronized (this) {
                        socket = tmp_socket;
                }
+       }
+
+       private class ConnectThread extends Thread {
 
                public void run() {
-                       if (D) Log.d(TAG, "ConnectThread: BEGIN");
+                       AltosDebug.debug("ConnectThread: BEGIN (pause %b)", pause);
                        setName("ConnectThread");
 
+                       if (pause) {
+                               try {
+                                       Thread.sleep(4000);
+                               } catch (InterruptedException e) {
+                               }
+                       }
+
+                       create_socket(device);
                        // Always cancel discovery because it will slow down a connection
-                       adapter.cancelDiscovery();
+                       try {
+                               BluetoothAdapter.getDefaultAdapter().cancelDiscovery();
+                       } catch (Exception e) {
+                               AltosDebug.debug("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();
-                               } catch (IOException e) {
-                                       // Close the socket
+                                       local_socket.connect();
+                               } catch (Exception e) {
+                                       AltosDebug.debug("Connect exception %s", e.toString());
                                        try {
-                                               socket.close();
-                                       } catch (IOException e2) {
-                                               if (D) Log.e(TAG, "ConnectThread: Failed to close() socket after failed connection");
+                                               local_socket.close();
+                                       } catch (Exception ce) {
+                                               AltosDebug.debug("Close exception %s", ce.toString());
                                        }
-                                       input = null;
-                                       output = null;
-                                       AltosBluetooth.this.notifyAll();
-                                       handler.obtainMessage(TelemetryService.MSG_CONNECT_FAILED).sendToTarget();
-                                       if (D) Log.e(TAG, "ConnectThread: Failed to establish connection");
-                                       return;
+                                       local_socket = null;
                                }
-
-                               input_thread = new Thread(AltosBluetooth.this);
-                               input_thread.start();
-
-                               // Configure the newly connected device for telemetry
-                               print("~\nE 0\n");
-                               set_monitor(false);
-
-                               // Let TelemetryService know we're connected
-                               handler.obtainMessage(TelemetryService.MSG_CONNECTED).sendToTarget();
-
-                               // Notify other waiting threads, now that we're connected
-                               AltosBluetooth.this.notifyAll();
-
-                               // Reset the ConnectThread because we're done
-                               connect_thread = null;
-
-                               if (D) Log.d(TAG, "ConnectThread: Connect completed");
                        }
-               }
 
-               public void cancel() {
-                       try {
-                               if (socket != null)
-                                       socket.close();
-                       } catch (IOException e) {
-                               if (D) Log.e(TAG, "ConnectThread: close() of connect socket failed", e);
+                       if (local_socket != null) {
+                               connected();
+                       } else {
+                               connect_failed();
                        }
+
+                       AltosDebug.debug("ConnectThread: completed");
                }
        }
 
        private synchronized void wait_connected() throws InterruptedException, IOException {
-               if (input == null) {
+               AltosDebug.check_ui("wait_connected\n");
+               if (input == null && socket != null) {
+                       AltosDebug.debug("wait_connected...");
                        wait();
-                       if (input == null) throw new IOException();
+                       AltosDebug.debug("wait_connected done");
                }
+               if (socket == null)
+                       throw new IOException();
        }
 
-       private void connection_failed() {
-               if (D) Log.e(TAG, "Connection lost during I/O");
-               handler.obtainMessage(TelemetryService.MSG_DISCONNECTED).sendToTarget();
-       }
-
-       public void print(String data) {
-               byte[] bytes = data.getBytes();
-               if (D) Log.d(TAG, "print(): begin");
+       int write(byte[] buffer, int len) {
                try {
-                       wait_connected();
-                       output.write(bytes);
-                       if (D) Log.d(TAG, "print(): Wrote bytes: '" + data.replace('\n', '\\') + "'");
-               } catch (IOException e) {
-                       connection_failed();
-               } catch (InterruptedException e) {
-                       connection_failed();
+                       output.write(buffer, 0, len);
+               } catch (IOException ie) {
+                       return -1;
                }
+               return len;
        }
 
-       public int getchar() {
+       int read(byte[] buffer, int len) {
                try {
-                       wait_connected();
-                       return input.read();
-               } catch (IOException e) {
-                       connection_failed();
-               } catch (java.lang.InterruptedException e) {
-                       connection_failed();
-               }
-               return AltosLink.ERROR;
-       }
-
-       public void close() {
-               if (D) Log.d(TAG, "close(): begin");
-               synchronized(this) {
-                       if (D) Log.d(TAG, "close(): synched");
-
-                       if (connect_thread != null) {
-                               if (D) Log.d(TAG, "close(): stopping connect_thread");
-                               connect_thread.cancel();
-                               connect_thread = null;
-                       }
-                       if (D) Log.d(TAG, "close(): Closing socket");
-                       try {
-                               socket.close();
-                       } catch (IOException e) {
-                               if (D) Log.e(TAG, "close(): unable to close() socket");
-                       }
-                       if (input_thread != null) {
-                               if (D) Log.d(TAG, "close(): stopping input_thread");
-                               try {
-                                       if (D) Log.d(TAG, "close(): input_thread.interrupt().....");
-                                       input_thread.interrupt();
-                                       if (D) Log.d(TAG, "close(): input_thread.join().....");
-                                       input_thread.join();
-                               } catch (Exception e) {}
-                               input_thread = null;
-                       }
-                       input = null;
-                       output = null;
-                       notifyAll();
+                       return input.read(buffer, 0, len);
+               } catch (IOException ie) {
+                       return -1;
                }
        }
 
-
-       //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; }