android/a2dp: Add initial implementation of socket handling

This adds initial code to handle incoming connection and notifying
connection states.

diff --git a/android/a2dp.c b/android/a2dp.c
index 052f4f3..ea64663 100644 (file)
--- a/android/a2dp.c
+++ b/android/a2dp.c
@@ -32,13 +32,77 @@
 #include <fcntl.h>
 #include <glib.h>
 
+#include "btio/btio.h"
 #include "lib/bluetooth.h"
 #include "log.h"
 #include "a2dp.h"
 #include "hal-msg.h"
 #include "ipc.h"
+#include "utils.h"
+
+#define L2CAP_PSM_AVDTP 0x19
 
 static int notification_sk = -1;
+static GIOChannel *server = NULL;
+static GSList *devices = NULL;
+
+struct a2dp_device {
+       bdaddr_t        dst;
+       uint8_t         state;
+       GIOChannel      *io;
+       guint           watch;
+};
+
+static int device_cmp(gconstpointer s, gconstpointer user_data)
+{
+       const struct a2dp_device *dev = s;
+       const bdaddr_t *dst = user_data;
+
+       return bacmp(&dev->dst, dst);
+}
+
+static void a2dp_device_free(struct a2dp_device *dev)
+{
+       if (dev->watch > 0)
+               g_source_remove(dev->watch);
+
+       if (dev->io)
+               g_io_channel_unref(dev->io);
+
+       devices = g_slist_remove(devices, dev);
+       g_free(dev);
+}
+
+static struct a2dp_device *a2dp_device_new(const bdaddr_t *dst)
+{
+       struct a2dp_device *dev;
+
+       dev = g_new0(struct a2dp_device, 1);
+       bacpy(&dev->dst, dst);
+       devices = g_slist_prepend(devices, dev);
+
+       return dev;
+}
+
+static void bt_a2dp_notify_state(struct a2dp_device *dev, uint8_t state)
+{
+       struct hal_ev_a2dp_conn_state ev;
+       char address[18];
+
+       if (dev->state == state)
+               return;
+
+       dev->state = state;
+
+       ba2str(&dev->dst, address);
+       DBG("device %s state %u", address, state);
+
+       bdaddr2android(&dev->dst, ev.bdaddr);
+       ev.state = state;
+
+       ipc_send(notification_sk, HAL_SERVICE_ID_A2DP,
+                       HAL_EV_A2DP_CONN_STATE, sizeof(ev), &ev, -1);
+}
 
 static uint8_t bt_a2dp_connect(struct hal_cmd_a2dp_connect *cmd, uint16_t len)
 {
@@ -74,10 +138,72 @@ void bt_a2dp_handle_cmd(int sk, uint8_t opcode, void *buf, uint16_t len)
        ipc_send_rsp(sk, HAL_SERVICE_ID_A2DP, status);
 }
 
+static gboolean watch_cb(GIOChannel *chan, GIOCondition cond, gpointer data)
+{
+       struct a2dp_device *dev = data;
+
+       bt_a2dp_notify_state(dev, HAL_A2DP_STATE_DISCONNECTED);
+
+       a2dp_device_free(dev);
+
+       return FALSE;
+}
+
+static void connect_cb(GIOChannel *chan, GError *err, gpointer user_data)
+{
+       struct a2dp_device *dev;
+       bdaddr_t src, dst;
+       char address[18];
+       GError *gerr = NULL;
+       GSList *l;
+
+       if (err) {
+               error("%s", err->message);
+               return;
+       }
+
+       bt_io_get(chan, &gerr,
+                       BT_IO_OPT_SOURCE_BDADDR, &src,
+                       BT_IO_OPT_DEST_BDADDR, &dst,
+                       BT_IO_OPT_INVALID);
+       if (gerr) {
+               error("%s", gerr->message);
+               g_error_free(gerr);
+               g_io_channel_shutdown(chan, TRUE, NULL);
+               return;
+       }
+
+       l = g_slist_find_custom(devices, &dst, device_cmp);
+       if (l)
+               return;
+
+       ba2str(&dst, address);
+       DBG("Incoming connection from %s", address);
+
+       dev = a2dp_device_new(&dst);
+       dev->watch = g_io_add_watch(dev->io, G_IO_HUP | G_IO_ERR | G_IO_NVAL,
+                                                               watch_cb, dev);
+
+       bt_a2dp_notify_state(dev, HAL_A2DP_STATE_CONNECTED);
+}
+
 bool bt_a2dp_register(int sk, const bdaddr_t *addr)
 {
+       GError *err = NULL;
+
        DBG("");
 
+       server = bt_io_listen(connect_cb, NULL, NULL, NULL, &err,
+                               BT_IO_OPT_SOURCE_BDADDR, addr,
+                               BT_IO_OPT_PSM, L2CAP_PSM_AVDTP,
+                               BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_MEDIUM,
+                               BT_IO_OPT_INVALID);
+       if (!server) {
+               error("Failed to listen on AVDTP channel: %s", err->message);
+               g_error_free(err);
+               return false;
+       }
+
        notification_sk = sk;
 
        return true;
@@ -88,4 +214,10 @@ void bt_a2dp_unregister(void)
        DBG("");
 
        notification_sk = -1;
+
+       if (server) {
+               g_io_channel_shutdown(server, TRUE, NULL);
+               g_io_channel_unref(server);
+               server = NULL;
+       }
 }