+ // Handler of incoming messages from clients.
+ static class IncomingHandler extends Handler {
+ private final WeakReference<TelemetryService> service;
+ IncomingHandler(TelemetryService s) { service = new WeakReference<TelemetryService>(s); }
+
+ @Override
+ public void handleMessage(Message msg) {
+ TelemetryService s = service.get();
+ switch (msg.what) {
+ case MSG_REGISTER_CLIENT:
+ s.mClients.add(msg.replyTo);
+ try {
+ msg.replyTo.send(Message.obtain(null, AltosDroid.MSG_STATE_CHANGE, s.state, -1));
+ } catch (RemoteException e) {
+ s.mClients.remove(msg.replyTo);
+ }
+ if (D) Log.d(TAG, "Client bound to service");
+ break;
+ case MSG_UNREGISTER_CLIENT:
+ s.mClients.remove(msg.replyTo);
+ if (D) Log.d(TAG, "Client unbound from service");
+ break;
+ case MSG_CONNECT:
+ if (D) Log.d(TAG, "Connect command received");
+ s.device = (BluetoothDevice) msg.obj;
+ s.startAltosBluetooth();
+ break;
+ case MSG_CONNECTED:
+ if (D) Log.d(TAG, "Connected to device");
+ s.sendMessageToClients(Message.obtain(null, AltosDroid.MSG_DEVNAME, s.device.getName()));
+ s.setState(STATE_CONNECTED);
+ s.mAltosBluetooth.add_monitor(s.telem);
+ break;
+ default:
+ super.handleMessage(msg);
+ }
+ }
+ }
+
+ 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;
+ }
+ device = null;
+ telem.clear();
+ }
+
+ private void startAltosBluetooth() {
+ if (mAltosBluetooth == null) {
+ if (D) Log.i(TAG, "Connecting to " + device.getName());
+ mAltosBluetooth = new AltosBluetooth(device, mHandler);
+ setState(STATE_CONNECTING);
+ } else {
+ stopAltosBluetooth();
+ mHandler.sendMessageDelayed(Message.obtain(null, MSG_CONNECT, device), 1000);
+ }
+ }
+
+ 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));
+ }
+