altosdroid: lots of debugging statements

[fw/altos] / altosdroid / src / org / altusmetrum / AltosDroid / TelemetryService.java

diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
index cf7ae6da452a312dd095d7810ca052b2877db7a8..a61a1eda6b620f7988c4636c6f57c7dbca8cc281 100644 (file)
--- a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
+++ b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryService.java
@@ -61,12 +61,13 @@ public class TelemetryService extends Service {
        //private NotificationManager mNM;
 
        ArrayList<Messenger> mClients = new ArrayList<Messenger>(); // Keeps track of all current registered clients.
-       final Messenger mMessenger = new Messenger(new IncomingHandler()); // Target we publish for clients to send messages to IncomingHandler.
+       final Handler   mHandler   = new IncomingHandler(this);
+       final Messenger mMessenger = new Messenger(mHandler); // Target we publish for clients to send messages to IncomingHandler.
 
        // Name of the connected device
        private String mConnectedDeviceName = null;
        private AltosBluetooth mAltosBluetooth = null;
-
+       private int state = STATE_NONE;
        LinkedBlockingQueue<AltosLine> telem;
 
        // Handler of incoming messages from clients.
@@ -92,6 +93,8 @@ public class TelemetryService extends Service {
                                break;
                        case MSG_CONNECTED:
                                if (D) Log.d(TAG, "Connected to device");
+                               s.setState(STATE_CONNECTED);
+                               s.mAltosBluetooth.add_monitor(s.telem);
                                break;
                        default:
                                super.handleMessage(msg);
@@ -99,8 +102,21 @@ public class TelemetryService extends Service {
                }
        }
 
+       private void sendMessageToClients(Message m) {
+               for (int i=mClients.size()-1; i>=0; i--) {
+                       try {
+                               mClients.get(i).send(m);
+                       } catch (RemoteException e) {
+                               mClients.remove(i);
+                       }
+               }
+       }
+
        private void stopAltosBluetooth() {
+               if (D) Log.i(TAG, "Stopping BT");
+               setState(STATE_READY);
                if (mAltosBluetooth != null) {
+                       if (D) Log.i(TAG, "Closing AltosBluetooth");
                        mAltosBluetooth.close();
                        mAltosBluetooth = null;
                }
@@ -108,8 +124,16 @@ public class TelemetryService extends Service {
        }
 
        private void startAltosBluetooth(BluetoothDevice d) {
-               mAltosBluetooth = new AltosBluetooth(d);
-               mAltosBluetooth.add_monitor(telem);
+                       if (D) Log.i(TAG, "Connecting to " + d.getName());
+                       mAltosBluetooth = new AltosBluetooth(d, mHandler);
+                       setState(STATE_CONNECTING);
+       }
+
+       private synchronized void setState(int s) {
+               if (D) Log.d(TAG, "setState() " + state + " -> " + s);
+               state = s;
+
+               sendMessageToClients(Message.obtain(null, AltosDroid.MSG_STATE_CHANGE, state, -1));
        }
 
        @Override
@@ -118,6 +142,7 @@ public class TelemetryService extends Service {
                //mNM = (NotificationManager)getSystemService(NOTIFICATION_SERVICE);
 
                telem = new LinkedBlockingQueue<AltosLine>();
+               setState(STATE_READY);
        }
 
        @Override