Adding module-bt-discover

1 files changed, 461 insertions, 0 deletions

diff --git a/src/modules/module-bt-discover.c b/src/modules/module-bt-discover.c
new file mode 100644
index 00000000..f855ad15
--- /dev/null
+++ b/src/modules/module-bt-discover.c
@@ -0,0 +1,461 @@
+/* TODO LIST
+ * listen to signals AdapterAdded, AdapterRemoved, DeviceCreated and DeviceRemoved
+ * listen to org.freedesktop.DBus.NameOwnerChanged, to properly handle hcid activity
+ */
+
+/***
+    This file is part of PulseAudio.
+
+    Copyright 2008 Joao Paulo Rechi Vita
+
+    PulseAudio is free software; you can redistribute it and/or modify
+    it under the terms of the GNU Lesser General Public License as published
+    by the Free Software Foundation; either version 2 of the License,
+    or (at your option) any later version.
+
+    PulseAudio is distributed in the hope that it will be useful, but
+    WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+    General Public License for more details.
+
+    You should have received a copy of the GNU Lesser General Public License
+    along with PulseAudio; if not, write to the Free Software
+    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
+    USA.
+***/
+
+#include <config.h>
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+
+#include <pulse/xmalloc.h>
+#include <pulsecore/module.h>
+#include <pulsecore/modargs.h>
+
+#include "dbus-util.h"
+/* TODO: Create symdef file for static linking
+ * #include "module-bt-proximity-symdef.h" */
+
+PA_MODULE_AUTHOR("Joao Paulo Rechi Vita");
+PA_MODULE_DESCRIPTION("Detect available bluetooth audio devices and load bluetooth audio drivers");
+PA_MODULE_VERSION(PACKAGE_VERSION);
+PA_MODULE_USAGE("");
+
+#define AUDIO_DEVICE_INTERFACE  "org.bluez.audio.Device"
+#define GENERIC_AUDIO_UUID      "00001203-0000-1000-8000-00805F9B34FB"
+#define HSP_HS_UUID             "00001108-0000-1000-8000-00805F9B34FB"
+#define HSP_AG_UUID             "00001112-0000-1000-8000-00805F9B34FB"
+#define HFP_HS_UUID             "0000111E-0000-1000-8000-00805F9B34FB"
+#define HFP_AG_UUID             "0000111F-0000-1000-8000-00805F9B34FB"
+#define ADVANCED_AUDIO_UUID     "0000110D-0000-1000-8000-00805F9B34FB"
+#define A2DP_SOURCE_UUID        "0000110A-0000-1000-8000-00805F9B34FB"
+#define A2DP_SINK_UUID          "0000110B-0000-1000-8000-00805F9B34FB"
+#define AVRCP_REMOTE_UUID       "0000110E-0000-1000-8000-00805F9B34FB"
+#define AVRCP_TARGET_UUID       "0000110C-0000-1000-8000-00805F9B34FB"
+
+#define VERBOSE 1
+
+typedef struct adapter adapter_t;
+typedef struct device device_t;
+typedef struct uuid uuid_t;
+
+struct uuid {
+    char *uuid;
+    uuid_t *next;
+};
+
+struct device {
+    char *name;
+    char *object_path;
+    int paired;
+    adapter_t *adapter;
+    char *alias;
+    int connected;
+    uuid_t *uuid_list;
+    char *address;
+    int class;
+    int trusted;
+    device_t *next;
+};
+
+struct adapter {
+    char *object_path;
+    char *mode;
+    char *address;
+    device_t *device_list;
+    adapter_t *next;
+};
+
+struct userdata {
+    pa_module *module;
+    pa_dbus_connection *conn;
+    adapter_t *adapter_list;
+};
+
+uuid_t *uuid_new(const char *uuid) {
+    uuid_t *node = pa_xnew0(uuid_t, 1);
+    node->uuid = pa_xstrdup(uuid);
+    node->next = NULL;
+    return node;
+}
+
+void uuid_list_append(uuid_t *node, const char *uuid) {
+    while (node->next != NULL) node = node->next;
+    node->next = uuid_new(uuid);
+}
+
+device_t *device_new(const char *device, adapter_t *adapter) {
+    device_t *node = pa_xnew0(device_t, 1);
+    node->name = NULL;
+    node->object_path = pa_xstrdup(device);
+    node->paired = -1;
+    node->adapter = adapter;
+    node->alias = NULL;
+    node->connected = -1;
+    node->uuid_list = uuid_new("UUID_HEAD");
+    node->address = NULL;
+    node->class = -1;
+    node->trusted = -1;
+    node->next = NULL;
+    return node;
+}
+
+void device_list_append(device_t *node, const char *device, adapter_t *adapter) {
+    while (node->next != NULL) node = node->next;
+    node->next = device_new(device, adapter);
+}
+
+adapter_t *adapter_new(const char *adapter) {
+    adapter_t *node = pa_xnew0(adapter_t, 1);
+    node->object_path = pa_xstrdup(adapter);
+    node->mode = NULL;
+    node->address = NULL;
+    node->device_list = device_new("/DEVICE_HEAD", NULL);
+    node->next = NULL;
+    return node;
+}
+
+void adapter_list_append(adapter_t *node, const char *adapter) {
+    while (node->next != NULL) node = node->next;
+    node->next = adapter_new(adapter);
+}
+
+void print_devices(device_t *device_list) {
+    device_t *device_list_i = device_list;
+    while (device_list_i != NULL) {
+        uuid_t *uuid_list_i = device_list_i->uuid_list;
+        if (strcmp(device_list_i->object_path, "/DEVICE_HEAD") != 0) {
+            pa_log("    [ %s ]", device_list_i->object_path);
+            pa_log("        Name = %s", device_list_i->name);
+            pa_log("        Paired = %d", device_list_i->paired);
+            pa_log("        Adapter = %s", device_list_i->adapter->object_path);
+            pa_log("        Alias = %s", device_list_i->alias);
+            pa_log("        Connected = %d", device_list_i->connected);
+            pa_log("        UUIDs = ");
+            while (uuid_list_i != NULL) {
+                if (strcmp(uuid_list_i->uuid, "UUID_HEAD") != 0) {
+                    pa_log("            %s", uuid_list_i->uuid);
+                }
+                uuid_list_i = uuid_list_i->next;
+            }
+            pa_log("        Address = %s", device_list_i->address);
+            pa_log("        Class = 0x%x", device_list_i->class);
+            pa_log("        Trusted = %d", device_list_i->trusted);
+        }
+        device_list_i = device_list_i->next;
+    }
+}
+
+void print_adapters(adapter_t *adapter_list) {
+    adapter_t *adapter_list_i = adapter_list;
+    while (adapter_list_i != NULL) {
+        if (strcmp(adapter_list_i->object_path, "/ADAPTER_HEAD") != 0) {
+            pa_log("[ %s ]", adapter_list_i->object_path);
+            pa_log("    Mode = %s", adapter_list_i->mode);
+            pa_log("    Address = %s", adapter_list_i->address);
+            print_devices(adapter_list_i->device_list);
+        }
+        adapter_list_i = adapter_list_i->next;
+    }
+}
+
+DBusMessageIter call_dbus_method(pa_dbus_connection *conn, const char *destination, const char *path, const char *interface,
+        const char *method) {
+    DBusMessage *msg;
+    DBusPendingCall *pending;
+    DBusMessageIter args;
+
+    /* construct the DBusMessage */
+    msg = dbus_message_new_method_call(destination, path, interface, method);
+
+    /* send the message and get a handle for a reply */
+    if (!dbus_connection_send_with_reply(pa_dbus_connection_get(conn), msg, &pending, -1)) { 
+        pa_log("Out Of Memory!"); 
+    }
+    if (pending == NULL) { 
+        pa_log("Pending Call Null"); 
+    }
+    dbus_connection_flush(pa_dbus_connection_get(conn));
+
+    /* free msg */
+    dbus_message_unref(msg);
+
+    /* wait for reply */
+    dbus_pending_call_block(pending);
+
+    /* get the reply */
+    msg = dbus_pending_call_steal_reply(pending);
+    if (msg == NULL) {
+        pa_log("Reply Null");
+    }
+
+    /* free pending */
+    dbus_pending_call_unref(pending);
+
+    /* read the reply */
+    if (!dbus_message_iter_init(msg, &args))
+        pa_log("Reply has no arguments");
+
+    dbus_message_unref(msg);
+
+    return args;
+
+}
+
+void detect_adapters(adapter_t *adapter_list, pa_dbus_connection *conn) {
+    DBusMessageIter arg_i, element_i, dict_i, variant_i;
+    adapter_t *adapter_list_i;
+    const char *key, *value;
+
+    /* get adapters */
+    arg_i = call_dbus_method(conn, "org.bluez", "/", "org.bluez.Manager", "ListAdapters");
+    dbus_message_iter_recurse(&arg_i, &element_i);
+    while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
+        if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_OBJECT_PATH) {
+            dbus_message_iter_get_basic(&element_i, &value);
+            adapter_list_append(adapter_list, value);
+        }
+        dbus_message_iter_next(&element_i);
+    }
+
+    /* get adapter properties */
+    adapter_list_i = adapter_list->next;
+    while (adapter_list_i != NULL) {
+        arg_i = call_dbus_method(conn, "org.bluez", adapter_list_i->object_path, "org.bluez.Adapter", "GetProperties");
+        dbus_message_iter_recurse(&arg_i, &element_i);
+        while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
+            if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
+                dbus_message_iter_recurse(&element_i, &dict_i);
+                dbus_message_iter_get_basic(&dict_i, &key);
+                dbus_message_iter_next(&dict_i);
+                dbus_message_iter_recurse(&dict_i, &variant_i);
+                dbus_message_iter_get_basic(&variant_i, &value);
+                if (strcmp(key, "Mode") == 0) {
+                    adapter_list_i->mode = pa_xstrdup(value);
+                }
+                else if (strcmp(key, "Address") == 0) {
+                    adapter_list_i->address = pa_xstrdup(value);
+                }
+            }
+            dbus_message_iter_next(&element_i);
+        }
+        adapter_list_i = adapter_list_i->next;
+    }
+}
+
+void detect_devices(adapter_t *adapter_list, pa_dbus_connection *conn) {
+    DBusMessageIter arg_i, element_i, dict_i, variant_i;
+    adapter_t *adapter_list_i;
+    device_t *device_list_i, *device_list_prev_i;
+    const char *key, *value;
+    unsigned int uvalue;
+
+    /* get devices of each adapter */
+    adapter_list_i = adapter_list->next;
+    while (adapter_list_i != NULL) {
+        arg_i = call_dbus_method(conn, "org.bluez", adapter_list_i->object_path , "org.bluez.Adapter", "ListDevices");
+        dbus_message_iter_recurse(&arg_i, &element_i);
+        while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
+            if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_OBJECT_PATH) {
+                dbus_message_iter_get_basic(&element_i, &value);
+                device_list_append(adapter_list_i->device_list, value, adapter_list_i);
+            }
+            dbus_message_iter_next(&element_i);
+        }
+        adapter_list_i = adapter_list_i->next;
+    }
+
+    /* get device properties */
+    adapter_list_i = adapter_list->next;
+    while (adapter_list_i != NULL) {
+        device_list_prev_i = adapter_list_i->device_list;
+        device_list_i = adapter_list_i->device_list->next;
+        while (device_list_i != NULL) {
+            arg_i = call_dbus_method(conn, "org.bluez", device_list_i->object_path, "org.bluez.Device", "GetProperties");
+            dbus_message_iter_recurse(&arg_i, &element_i);
+            while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
+                if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
+                    dbus_message_iter_recurse(&element_i, &dict_i);
+                    dbus_message_iter_get_basic(&dict_i, &key);
+                    dbus_message_iter_next(&dict_i);
+                    dbus_message_iter_recurse(&dict_i, &variant_i);
+                    if (strcmp(key, "Name") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &value);
+                        device_list_i->name = pa_xstrdup(value);
+                    }
+                    else if (strcmp(key, "Paired") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &uvalue);
+                        device_list_i->paired = uvalue;
+                    }
+                    else if (strcmp(key, "Alias") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &value);
+                        device_list_i->alias = pa_xstrdup(value);
+                    }
+                    else if (strcmp(key, "Connected") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &uvalue);
+                        device_list_i->connected = uvalue;
+                    }
+                    else if (strcmp(key, "UUIDs") == 0) {
+                        DBusMessageIter uuid_i;
+                        int is_audio_device = 0;
+                        dbus_message_iter_recurse(&variant_i, &uuid_i);
+                        while (dbus_message_iter_get_arg_type(&uuid_i) != DBUS_TYPE_INVALID) {
+                            dbus_message_iter_get_basic(&uuid_i, &value);
+                            if ( (strcmp(value, HSP_HS_UUID) == 0) || (strcmp(value, HFP_HS_UUID) == 0) ||
+                                (strcmp(value, A2DP_SOURCE_UUID) == 0) || (strcmp(value, A2DP_SINK_UUID) == 0) )
+                                is_audio_device = 1;
+                            uuid_list_append(device_list_i->uuid_list, value);
+                            dbus_message_iter_next(&uuid_i);
+                        }
+                        if (!is_audio_device) {
+                            /* remove current device */
+                            device_list_prev_i->next = device_list_i->next;
+                            pa_xfree(device_list_i);
+                            break;
+                        }
+                    }
+                    else if (strcmp(key, "Address") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &value);
+                        device_list_i->address = pa_xstrdup(value);
+                    }
+                    else if (strcmp(key, "Class") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &uvalue);
+                        device_list_i->class = uvalue;
+                    }
+                    else if (strcmp(key, "Trusted") == 0) {
+                        dbus_message_iter_get_basic(&variant_i, &uvalue);
+                        device_list_i->trusted = uvalue;
+                    }
+                }
+                dbus_message_iter_next(&element_i);
+            }
+            device_list_prev_i = device_list_prev_i->next;
+            if (device_list_prev_i == NULL)
+                device_list_i = NULL;
+            else
+                device_list_i = device_list_prev_i->next;
+        }
+        adapter_list_i = adapter_list_i->next;
+    }
+}
+
+void pa__done(pa_module* m) {
+    struct userdata *u;
+    adapter_t *adapter_list_i, *adapter_list_next_i;
+    device_t *device_list_i, *device_list_next_i;
+
+    pa_assert(m);
+
+    if (!(u = m->userdata))
+        return;
+
+    if ((adapter_list_i = u->adapter_list) != NULL) {
+        while ((adapter_list_next_i = adapter_list_i->next) != NULL) {
+            if ((device_list_i = adapter_list_i->device_list) != NULL) {
+                while ((device_list_next_i = device_list_i->next) != NULL) {
+                    pa_xfree(device_list_i);
+                    device_list_i = device_list_next_i;
+                }
+                pa_xfree(device_list_i);
+            }
+            pa_xfree(adapter_list_i);
+            adapter_list_i = adapter_list_next_i;
+        }
+        pa_xfree(adapter_list_i);
+    }
+
+    pa_dbus_connection_unref(u->conn);
+    pa_xfree(u);
+    pa_log("Unloading module-bt-discover");
+    return;
+}
+
+int pa__init(pa_module* m) {
+    pa_modargs *ma = NULL;
+    DBusError err;
+    DBusMessageIter arg_i, element_i;
+    adapter_t *adapter_list_i;
+    device_t *device_list_i;
+    const char *value;
+    unsigned int hcid_running = 0;
+    struct userdata *u;
+
+    pa_assert(m);
+    dbus_error_init(&err);
+    pa_log("Loading module-bt-discover");
+    m->userdata = u = pa_xnew0(struct userdata, 1);
+    u->module = m;
+
+    /* connect to the bus */
+    u->conn = pa_dbus_bus_get(m->core, DBUS_BUS_SYSTEM, &err);
+    if ( dbus_error_is_set(&err) || (u->conn == NULL) ) {
+        pa_log("Failed to get D-Bus connection: %s", err.message);
+        goto fail;
+    }
+
+    /* check if hcid is running */
+    arg_i = call_dbus_method(u->conn, "org.freedesktop.DBus", "/org/freedesktop/DBus" , "org.freedesktop.DBus", "ListNames");
+    dbus_message_iter_recurse(&arg_i, &element_i);
+    while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
+        if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_STRING) {
+            dbus_message_iter_get_basic(&element_i, &value);
+            if (strcmp(value, "org.bluez") == 0)
+                hcid_running = 1;
+        }
+        dbus_message_iter_next(&element_i);
+    }
+    if (!hcid_running) {
+        pa_log("hcid not running");
+        goto fail;
+    }
+
+    /* static detection of bluetooth devices */
+    u->adapter_list = adapter_new("/ADAPTER_HEAD");
+    detect_adapters(u->adapter_list, u->conn);
+    detect_devices(u->adapter_list, u->conn);
+
+    if (VERBOSE) print_adapters(u->adapter_list);
+
+    /* load device modules */
+    adapter_list_i = u->adapter_list->next;
+    while (adapter_list_i != NULL) {
+        device_list_i = adapter_list_i->device_list->next;
+        while (device_list_i != NULL) {
+            pa_log("Loading module-bt-device for %s", device_list_i->name); /* CHECK: Should it be name or alias? */
+            /* call module */
+            device_list_i = device_list_i->next;
+        }
+        adapter_list_i = adapter_list_i->next;
+    }
+
+    return 0;
+
+fail:
+    if (ma)
+        pa_modargs_free(ma);
+    dbus_error_free(&err);
+    pa__done(m);
+    return -1;
+}