import java.lang.ref.WeakReference;
import java.util.ArrayList;
-import java.util.concurrent.LinkedBlockingQueue;
+import java.util.concurrent.TimeoutException;
import android.app.Notification;
//import android.app.NotificationManager;
import android.util.Log;
import android.widget.Toast;
-import org.altusmetrum.AltosLib.*;
+//import org.altusmetrum.AltosLib.*;
public class TelemetryService extends Service {
static final int MSG_CONNECTED = 4;
static final int MSG_CONNECT_FAILED = 5;
static final int MSG_DISCONNECTED = 6;
+ static final int MSG_TELEMETRY = 7;
public static final int STATE_NONE = 0;
public static final int STATE_READY = 1;
// Name of the connected device
private BluetoothDevice device = null;
private AltosBluetooth mAltosBluetooth = null;
+ private TelemetryReader mTelemetryReader = null;
+
+ // internally track state of bluetooth connection
private int state = STATE_NONE;
- LinkedBlockingQueue<AltosLine> telem;
// Handler of incoming messages from clients.
static class IncomingHandler extends Handler {
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);
+ s.connected();
break;
case MSG_CONNECT_FAILED:
if (D) Log.d(TAG, "Connection failed... retrying");
if (D) Log.d(TAG, "Disconnected from " + s.device.getName());
s.stopAltosBluetooth();
break;
+ case MSG_TELEMETRY:
+ s.sendMessageToClients(Message.obtain(null, AltosDroid.MSG_TELEMETRY, msg.obj));
+ break;
default:
super.handleMessage(msg);
}
}
private void stopAltosBluetooth() {
- if (D) Log.i(TAG, "Stopping BT");
+ if (D) Log.d(TAG, "stopAltosBluetooth(): begin");
setState(STATE_READY);
+ if (mTelemetryReader != null) {
+ if (D) Log.d(TAG, "stopAltosBluetooth(): stopping TelemetryReader");
+ mTelemetryReader.interrupt();
+ try {
+ mTelemetryReader.join();
+ } catch (InterruptedException e) {
+ }
+ mTelemetryReader = null;
+ }
if (mAltosBluetooth != null) {
- if (D) Log.i(TAG, "Closing AltosBluetooth");
+ if (D) Log.d(TAG, "stopAltosBluetooth(): stopping AltosBluetooth");
mAltosBluetooth.close();
mAltosBluetooth = null;
}
device = null;
- telem.clear();
}
private void startAltosBluetooth() {
if (mAltosBluetooth == null) {
- if (D) Log.i(TAG, "Connecting to " + device.getName());
+ if (D) Log.d(TAG, String.format("startAltosBluetooth(): Connecting to %s (%s)", device.getName(), device.getAddress()));
mAltosBluetooth = new AltosBluetooth(device, mHandler);
setState(STATE_CONNECTING);
} else {
}
private synchronized void setState(int s) {
- if (D) Log.d(TAG, "setState() " + state + " -> " + s);
+ if (D) Log.d(TAG, "setState(): " + state + " -> " + s);
state = s;
sendMessageToClients(Message.obtain(null, AltosDroid.MSG_STATE_CHANGE, state, -1));
}
+ private void connected() {
+ sendMessageToClients(Message.obtain(null, AltosDroid.MSG_DEVNAME, device.getName()));
+ setState(STATE_CONNECTED);
+ try {
+ sendMessageToClients(Message.obtain(null, AltosDroid.MSG_DEVCONFIG, mAltosBluetooth.config_data()));
+ } catch (InterruptedException e) {
+ } catch (TimeoutException e) {
+ }
+ mTelemetryReader = new TelemetryReader(mAltosBluetooth, mHandler);
+ mTelemetryReader.start();
+ }
+
+
@Override
public void onCreate() {
// Create a reference to the NotificationManager so that we can update our notifcation text later
//mNM = (NotificationManager)getSystemService(NOTIFICATION_SERVICE);
- telem = new LinkedBlockingQueue<AltosLine>();
setState(STATE_READY);
}