+ // 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);
+ 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.startAltosBluetooth((BluetoothDevice) msg.obj);
+ 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);
+ }
+ }
+ }
+
+ private void stopAltosBluetooth() {
+ setState(STATE_READY);
+ if (mAltosBluetooth != null) {
+ mAltosBluetooth.close();
+ mAltosBluetooth = null;
+ }
+ telem.clear();
+ }
+
+ private void startAltosBluetooth(BluetoothDevice d) {
+ 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));
+ }
+