code.delx.au - pulseaudio/blob - src/modules/bluetooth/module-bluetooth-discover.c

   1 /***
   2     This file is part of PulseAudio.
   3
   4     Copyright 2008 Joao Paulo Rechi Vita
   5
   6     PulseAudio is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU Lesser General Public License as published
   8     by the Free Software Foundation; either version 2 of the License,
   9     or (at your option) any later version.
  10
  11     PulseAudio is distributed in the hope that it will be useful, but
  12     WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14     General Public License for more details.
  15
  16     You should have received a copy of the GNU Lesser General Public License
  17     along with PulseAudio; if not, write to the Free Software
  18     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
  19     USA.
  20 ***/
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <stdio.h>
  27 #include <stdlib.h>
  28 #include <string.h>
  29
  30 #include <pulse/xmalloc.h>
  31 #include <pulsecore/module.h>
  32 #include <pulsecore/modargs.h>
  33 #include <pulsecore/macro.h>
  34 #include <pulsecore/llist.h>
  35 #include <pulsecore/core-util.h>
  36
  37 #include "dbus-util.h"
  38 #include "module-bluetooth-discover-symdef.h"
  39
  40 PA_MODULE_AUTHOR("Joao Paulo Rechi Vita");
  41 PA_MODULE_DESCRIPTION("Detect available bluetooth audio devices and load bluetooth audio drivers");
  42 PA_MODULE_VERSION(PACKAGE_VERSION);
  43 PA_MODULE_USAGE("");
  44
  45 struct module {
  46     char *profile;
  47     pa_module *pa_m;
  48     PA_LLIST_FIELDS(struct module);
  49 };
  50
  51 struct uuid {
  52     char *uuid;
  53     PA_LLIST_FIELDS(struct uuid);
  54 };
  55
  56 struct device {
  57     char *name;
  58     char *object_path;
  59     int paired;
  60     char *alias;
  61     int connected;
  62     PA_LLIST_HEAD(struct uuid, uuid_list);
  63     char *address;
  64     int class;
  65     int trusted;
  66     PA_LLIST_HEAD(struct module, module_list);
  67     PA_LLIST_FIELDS(struct device);
  68 };
  69
  70 struct userdata {
  71     pa_module *module;
  72     pa_dbus_connection *conn;
  73     PA_LLIST_HEAD(struct device, device_list);
  74 };
  75
  76 static struct module *module_new(const char *profile, pa_module *pa_m) {
  77     struct module *m;
  78
  79     m = pa_xnew(struct module, 1);
  80     m->profile = pa_xstrdup(profile);
  81     m->pa_m = pa_m;
  82     PA_LLIST_INIT(struct module, m);
  83
  84     return m;
  85 }
  86
  87 static void module_free(struct module *m) {
  88     pa_assert(m);
  89
  90     pa_xfree(m->profile);
  91     pa_xfree(m);
  92 }
  93
  94 static struct uuid *uuid_new(const char *uuid) {
  95     struct uuid *node;
  96
  97     node = pa_xnew(struct uuid, 1);
  98     node->uuid = pa_xstrdup(uuid);
  99     PA_LLIST_INIT(struct uuid, node);
 100
 101     return node;
 102 }
 103
 104 static void uuid_free(struct uuid *uuid) {
 105     pa_assert(uuid);
 106
 107     pa_xfree(uuid->uuid);
 108     pa_xfree(uuid);
 109 }
 110
 111 static struct device *device_new(const char *object_path) {
 112     struct device *node;
 113
 114     node = pa_xnew(struct device, 1);
 115     node->name = NULL;
 116     node->object_path = pa_xstrdup(object_path);
 117     node->paired = -1;
 118     node->alias = NULL;
 119     node->connected = -1;
 120     PA_LLIST_HEAD_INIT(struct uuid, node->uuid_list);
 121     node->address = NULL;
 122     node->class = -1;
 123     node->trusted = -1;
 124     PA_LLIST_HEAD_INIT(struct module, node->module_list);
 125     PA_LLIST_INIT(struct device, node);
 126
 127     return node;
 128 }
 129
 130 static void device_free(struct device *device) {
 131     struct module *m;
 132     struct uuid *i;
 133
 134     pa_assert(device);
 135
 136     while ((m = device->module_list)) {
 137         PA_LLIST_REMOVE(struct module, device->module_list, m);
 138         module_free(m);
 139     }
 140
 141     while ((i = device->uuid_list)) {
 142         PA_LLIST_REMOVE(struct uuid, device->uuid_list, i);
 143         uuid_free(i);
 144     }
 145
 146     pa_xfree(device->name);
 147     pa_xfree(device->object_path);
 148     pa_xfree(device->alias);
 149     pa_xfree(device->address);
 150     pa_xfree(device);
 151 }
 152
 153 static struct device* device_find(struct userdata *u, const char *path) {
 154     struct device *i;
 155
 156     for (i = u->device_list; i; i = i->next)
 157         if (pa_streq(i->object_path, path))
 158             return i;
 159
 160     return NULL;
 161 }
 162
 163 static int parse_device_property(struct userdata *u, struct device *d, DBusMessageIter *i) {
 164     const char *key;
 165     DBusMessageIter variant_i;
 166
 167     pa_assert(u);
 168     pa_assert(d);
 169     pa_assert(i);
 170
 171     if (dbus_message_iter_get_arg_type(i) != DBUS_TYPE_STRING) {
 172         pa_log("Property name not a string.");
 173         return -1;
 174     }
 175
 176     dbus_message_iter_get_basic(i, &key);
 177
 178     if (!dbus_message_iter_next(i))  {
 179         pa_log("Property value missing");
 180         return -1;
 181     }
 182
 183     if (dbus_message_iter_get_arg_type(i) != DBUS_TYPE_VARIANT) {
 184         pa_log("Property value not a variant.");
 185         return -1;
 186     }
 187
 188     dbus_message_iter_recurse(i, &variant_i);
 189
 190     pa_log_debug("Parsing device property %s", key);
 191
 192     switch (dbus_message_iter_get_arg_type(&variant_i)) {
 193
 194         case DBUS_TYPE_STRING: {
 195
 196             const char *value;
 197             dbus_message_iter_get_basic(&variant_i, &value);
 198
 199             if (pa_streq(key, "Name")) {
 200                 pa_xfree(d->name);
 201                 d->name = pa_xstrdup(value);
 202             } else if (pa_streq(key, "Alias")) {
 203                 pa_xfree(d->alias);
 204                 d->alias = pa_xstrdup(value);
 205             } else if (pa_streq(key, "Address")) {
 206                 pa_xfree(d->address);
 207                 d->address = pa_xstrdup(value);
 208             }
 209
 210             break;
 211         }
 212
 213         case DBUS_TYPE_BOOLEAN: {
 214
 215             dbus_bool_t value;
 216             dbus_message_iter_get_basic(&variant_i, &value);
 217
 218             if (pa_streq(key, "Paired"))
 219                 d->paired = !!value;
 220             else if (pa_streq(key, "Connected"))
 221                 d->connected = !!value;
 222             else if (pa_streq(key, "Trusted"))
 223                 d->trusted = !!value;
 224
 225             break;
 226         }
 227
 228         case DBUS_TYPE_UINT32: {
 229
 230             uint32_t value;
 231             dbus_message_iter_get_basic(&variant_i, &value);
 232
 233             if (pa_streq(key, "Class"))
 234                 d->class = (int) value;
 235
 236             break;
 237         }
 238
 239         case DBUS_TYPE_ARRAY: {
 240
 241             DBusMessageIter ai;
 242             dbus_message_iter_recurse(&variant_i, &ai);
 243
 244             if (dbus_message_iter_get_arg_type(&ai) == DBUS_TYPE_STRING &&
 245                 pa_streq(key, "UUIDs")) {
 246
 247                 while (dbus_message_iter_get_arg_type(&ai) != DBUS_TYPE_INVALID) {
 248                     struct uuid *node;
 249                     const char *value;
 250
 251                     dbus_message_iter_get_basic(&ai, &value);
 252                     node = uuid_new(value);
 253                     PA_LLIST_PREPEND(struct uuid, d->uuid_list, node);
 254
 255                     if (!dbus_message_iter_next(&ai))
 256                         break;
 257                 }
 258             }
 259
 260             break;
 261         }
 262     }
 263
 264     return 0;
 265 }
 266
 267 static int get_device_properties(struct userdata *u, struct device *d) {
 268     DBusError e;
 269     DBusMessage *m = NULL, *r = NULL;
 270     DBusMessageIter arg_i, element_i;
 271     int ret = -1;
 272
 273     pa_assert(u);
 274     pa_assert(d);
 275
 276     dbus_error_init(&e);
 277
 278     pa_assert_se(m = dbus_message_new_method_call("org.bluez", d->object_path, "org.bluez.Device", "GetProperties"));
 279
 280     r = dbus_connection_send_with_reply_and_block(pa_dbus_connection_get(u->conn), m, -1, &e);
 281
 282     if (!r) {
 283         pa_log("org.bluez.Device.GetProperties failed: %s", e.message);
 284         goto finish;
 285     }
 286
 287     if (!dbus_message_iter_init(r, &arg_i)) {
 288         pa_log("org.bluez.Device.GetProperties reply has no arguments");
 289         goto finish;
 290     }
 291
 292     if (dbus_message_iter_get_arg_type(&arg_i) != DBUS_TYPE_ARRAY) {
 293         pa_log("org.bluez.Device.GetProperties argument is not an array");
 294         goto finish;
 295     }
 296
 297     dbus_message_iter_recurse(&arg_i, &element_i);
 298     while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
 299
 300         if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 301             DBusMessageIter dict_i;
 302
 303             dbus_message_iter_recurse(&element_i, &dict_i);
 304
 305             if (parse_device_property(u, d, &dict_i) < 0)
 306                 goto finish;
 307         }
 308
 309         if (!dbus_message_iter_next(&element_i))
 310             break;
 311     }
 312
 313     ret = 0;
 314
 315 finish:
 316     if (m)
 317         dbus_message_unref(m);
 318     if (r)
 319         dbus_message_unref(r);
 320
 321     dbus_error_free(&e);
 322
 323     return ret;
 324 }
 325
 326 static void load_module_for_device(struct userdata *u, struct device *d, const char *profile) {
 327     char *args;
 328     pa_module *pa_m;
 329     struct module *m;
 330
 331     pa_assert(u);
 332     pa_assert(d);
 333
 334     get_device_properties(u, d);
 335     args = pa_sprintf_malloc("sink_name=\"%s\" address=\"%s\" profile=\"%s\"", d->name, d->address, profile);
 336     pa_m = pa_module_load(u->module->core, "module-bluetooth-device", args);
 337     pa_xfree(args);
 338
 339     if (!m) {
 340         pa_log_debug("Failed to load module for device %s", d->object_path);
 341         return;
 342     }
 343
 344     m = module_new(profile, pa_m);
 345     PA_LLIST_PREPEND(struct module, d->module_list, m);
 346 }
 347
 348 static DBusHandlerResult filter_cb(DBusConnection *bus, DBusMessage *msg, void *userdata) {
 349     DBusMessageIter arg_i;
 350     DBusError err;
 351     const char *value;
 352     struct userdata *u;
 353
 354     pa_assert(bus);
 355     pa_assert(msg);
 356     pa_assert(userdata);
 357     u = userdata;
 358
 359     dbus_error_init(&err);
 360
 361     pa_log_debug("dbus: interface=%s, path=%s, member=%s\n",
 362             dbus_message_get_interface(msg),
 363             dbus_message_get_path(msg),
 364             dbus_message_get_member(msg));
 365
 366     if (dbus_message_is_signal(msg, "org.bluez.Adapter", "DeviceRemoved")) {
 367
 368         if (!dbus_message_iter_init(msg, &arg_i))
 369             pa_log("dbus: message has no parameters");
 370         else if (dbus_message_iter_get_arg_type(&arg_i) != DBUS_TYPE_OBJECT_PATH)
 371             pa_log("dbus: argument is not object path");
 372         else {
 373             struct device *d;
 374
 375             dbus_message_iter_get_basic(&arg_i, &value);
 376             pa_log_debug("hcid: device %s removed", value);
 377
 378             if ((d = device_find(u, value))) {
 379                 PA_LLIST_REMOVE(struct device, u->device_list, d);
 380                 device_free(d);
 381             }
 382         }
 383
 384     } else if (dbus_message_is_signal(msg, "org.bluez.Headset", "PropertyChanged") ||
 385                dbus_message_is_signal(msg, "org.bluez.AudioSink", "PropertyChanged")) {
 386
 387         struct device *d;
 388         const char *profile;
 389         DBusMessageIter variant_i;
 390
 391         if (!dbus_message_iter_init(msg, &arg_i)) {
 392             pa_log("dbus: message has no parameters");
 393             goto done;
 394         }
 395
 396         if (dbus_message_iter_get_arg_type(&arg_i) != DBUS_TYPE_STRING) {
 397             pa_log("Property name not a string.");
 398             goto done;
 399         }
 400
 401         dbus_message_iter_get_basic(&arg_i, &value);
 402
 403         if (!dbus_message_iter_next(&arg_i)) {
 404             pa_log("Property value missing");
 405             goto done;
 406         }
 407
 408         if (dbus_message_iter_get_arg_type(&arg_i) != DBUS_TYPE_VARIANT) {
 409             pa_log("Property value not a variant.");
 410             goto done;
 411         }
 412
 413         dbus_message_iter_recurse(&arg_i, &variant_i);
 414
 415         if (dbus_message_iter_get_arg_type(&variant_i) == DBUS_TYPE_BOOLEAN) {
 416             dbus_bool_t connected;
 417             dbus_message_iter_get_basic(&variant_i, &connected);
 418
 419             if (!pa_streq(value, "Connected") || !connected)
 420                 goto done;
 421         }
 422
 423         if (!(d = device_find(u, dbus_message_get_path(msg)))) {
 424                 d = device_new(dbus_message_get_path(msg));
 425                 PA_LLIST_PREPEND(struct device, u->device_list, d);
 426         }
 427
 428         if (dbus_message_is_signal(msg, "org.bluez.Headset", "PropertyChanged"))
 429             profile = "hsp";
 430         else
 431             profile = "a2dp";
 432
 433         load_module_for_device(u, d, profile);
 434     }
 435
 436 done:
 437     dbus_error_free(&err);
 438     return DBUS_HANDLER_RESULT_HANDLED;
 439 }
 440
 441 void pa__done(pa_module* m) {
 442     struct userdata *u;
 443     struct device *i;
 444
 445     pa_assert(m);
 446
 447     if (!(u = m->userdata))
 448         return;
 449
 450     while ((i = u->device_list)) {
 451         PA_LLIST_REMOVE(struct device, u->device_list, i);
 452         device_free(i);
 453     }
 454
 455     if (u->conn)
 456         pa_dbus_connection_unref(u->conn);
 457
 458     pa_xfree(u);
 459 }
 460
 461 int pa__init(pa_module* m) {
 462     DBusError err;
 463     struct userdata *u;
 464
 465     pa_assert(m);
 466     dbus_error_init(&err);
 467
 468     m->userdata = u = pa_xnew(struct userdata, 1);
 469     u->module = m;
 470     PA_LLIST_HEAD_INIT(struct device, u->device_list);
 471
 472     /* connect to the bus */
 473     u->conn = pa_dbus_bus_get(m->core, DBUS_BUS_SYSTEM, &err);
 474     if (dbus_error_is_set(&err) || (u->conn == NULL) ) {
 475         pa_log("Failed to get D-Bus connection: %s", err.message);
 476         goto fail;
 477     }
 478
 479     /* dynamic detection of bluetooth audio devices */
 480     if (!dbus_connection_add_filter(pa_dbus_connection_get(u->conn), filter_cb, u, NULL)) {
 481         pa_log_error("Failed to add filter function");
 482         goto fail;
 483     }
 484
 485     dbus_bus_add_match(pa_dbus_connection_get(u->conn), "type='signal',sender='org.bluez',interface='org.bluez.Adapter',member='DeviceRemoved'", &err);
 486     if (dbus_error_is_set(&err)) {
 487         pa_log_error("Unable to subscribe to org.bluez.Adapter signals: %s: %s", err.name, err.message);
 488         goto fail;
 489     }
 490
 491     dbus_bus_add_match(pa_dbus_connection_get(u->conn), "type='signal',sender='org.bluez',interface='org.bluez.Headset',member='PropertyChanged'", &err);
 492     if (dbus_error_is_set(&err)) {
 493         pa_log_error("Unable to subscribe to org.bluez.Headset signals: %s: %s", err.name, err.message);
 494         goto fail;
 495     }
 496
 497     dbus_bus_add_match(pa_dbus_connection_get(u->conn), "type='signal',sender='org.bluez',interface='org.bluez.AudioSink',member='PropertyChanged'", &err);
 498     if (dbus_error_is_set(&err)) {
 499         pa_log_error("Unable to subscribe to org.bluez.AudioSink signals: %s: %s", err.name, err.message);
 500         goto fail;
 501     }
 502
 503     return 0;
 504
 505 fail:
 506     dbus_error_free(&err);
 507     pa__done(m);
 508
 509     return -1;
 510 }