code.delx.au - pulseaudio/blob - src/modules/bluetooth/bluez5-util.c

   1 /***
   2   This file is part of PulseAudio.
   3
   4   Copyright 2008-2013 João 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
   8   published by the Free Software Foundation; either version 2.1 of the
   9   License, 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
  17   License 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 <pulse/xmalloc.h>
  27
  28 #include <pulsecore/core.h>
  29 #include <pulsecore/core-util.h>
  30 #include <pulsecore/dbus-shared.h>
  31 #include <pulsecore/log.h>
  32 #include <pulsecore/macro.h>
  33 #include <pulsecore/refcnt.h>
  34 #include <pulsecore/shared.h>
  35
  36 #include "a2dp-codecs.h"
  37
  38 #include "bluez5-util.h"
  39
  40 #define BLUEZ_SERVICE "org.bluez"
  41 #define BLUEZ_ADAPTER_INTERFACE BLUEZ_SERVICE ".Adapter1"
  42 #define BLUEZ_DEVICE_INTERFACE BLUEZ_SERVICE ".Device1"
  43 #define BLUEZ_MEDIA_INTERFACE BLUEZ_SERVICE ".Media1"
  44 #define BLUEZ_MEDIA_ENDPOINT_INTERFACE BLUEZ_SERVICE ".MediaEndpoint1"
  45 #define BLUEZ_MEDIA_TRANSPORT_INTERFACE BLUEZ_SERVICE ".MediaTransport1"
  46
  47 #define BLUEZ_ERROR_NOT_SUPPORTED "org.bluez.Error.NotSupported"
  48
  49 #define A2DP_SOURCE_ENDPOINT "/MediaEndpoint/A2DPSource"
  50 #define A2DP_SINK_ENDPOINT "/MediaEndpoint/A2DPSink"
  51
  52 #define ENDPOINT_INTROSPECT_XML                                         \
  53     DBUS_INTROSPECT_1_0_XML_DOCTYPE_DECL_NODE                           \
  54     "<node>"                                                            \
  55     " <interface name=\"" BLUEZ_MEDIA_ENDPOINT_INTERFACE "\">"          \
  56     "  <method name=\"SetConfiguration\">"                              \
  57     "   <arg name=\"transport\" direction=\"in\" type=\"o\"/>"          \
  58     "   <arg name=\"properties\" direction=\"in\" type=\"ay\"/>"        \
  59     "  </method>"                                                       \
  60     "  <method name=\"SelectConfiguration\">"                           \
  61     "   <arg name=\"capabilities\" direction=\"in\" type=\"ay\"/>"      \
  62     "   <arg name=\"configuration\" direction=\"out\" type=\"ay\"/>"    \
  63     "  </method>"                                                       \
  64     "  <method name=\"ClearConfiguration\">"                            \
  65     "   <arg name=\"transport\" direction=\"in\" type=\"o\"/>"          \
  66     "  </method>"                                                       \
  67     "  <method name=\"Release\">"                                       \
  68     "  </method>"                                                       \
  69     " </interface>"                                                     \
  70     " <interface name=\"org.freedesktop.DBus.Introspectable\">"         \
  71     "  <method name=\"Introspect\">"                                    \
  72     "   <arg name=\"data\" type=\"s\" direction=\"out\"/>"              \
  73     "  </method>"                                                       \
  74     " </interface>"                                                     \
  75     "</node>"
  76
  77 struct pa_bluetooth_discovery {
  78     PA_REFCNT_DECLARE;
  79
  80     pa_core *core;
  81     pa_dbus_connection *connection;
  82     bool filter_added;
  83     bool matches_added;
  84     bool objects_listed;
  85     pa_hook hooks[PA_BLUETOOTH_HOOK_MAX];
  86     pa_hashmap *adapters;
  87     pa_hashmap *devices;
  88     pa_hashmap *transports;
  89
  90     PA_LLIST_HEAD(pa_dbus_pending, pending);
  91 };
  92
  93 static pa_dbus_pending* send_and_add_to_pending(pa_bluetooth_discovery *y, DBusMessage *m,
  94                                                                   DBusPendingCallNotifyFunction func, void *call_data) {
  95     pa_dbus_pending *p;
  96     DBusPendingCall *call;
  97
  98     pa_assert(y);
  99     pa_assert(m);
 100
 101     pa_assert_se(dbus_connection_send_with_reply(pa_dbus_connection_get(y->connection), m, &call, -1));
 102
 103     p = pa_dbus_pending_new(pa_dbus_connection_get(y->connection), m, call, y, call_data);
 104     PA_LLIST_PREPEND(pa_dbus_pending, y->pending, p);
 105     dbus_pending_call_set_notify(call, func, p, NULL);
 106
 107     return p;
 108 }
 109
 110 static const char *check_variant_property(DBusMessageIter *i) {
 111     const char *key;
 112
 113     pa_assert(i);
 114
 115     if (dbus_message_iter_get_arg_type(i) != DBUS_TYPE_STRING) {
 116         pa_log_error("Property name not a string.");
 117         return NULL;
 118     }
 119
 120     dbus_message_iter_get_basic(i, &key);
 121
 122     if (!dbus_message_iter_next(i)) {
 123         pa_log_error("Property value missing");
 124         return NULL;
 125     }
 126
 127     if (dbus_message_iter_get_arg_type(i) != DBUS_TYPE_VARIANT) {
 128         pa_log_error("Property value not a variant.");
 129         return NULL;
 130     }
 131
 132     return key;
 133 }
 134
 135 pa_bluetooth_transport *pa_bluetooth_transport_new(pa_bluetooth_device *d, const char *owner, const char *path,
 136                                                    pa_bluetooth_profile_t p, const uint8_t *config, size_t size) {
 137     pa_bluetooth_transport *t;
 138
 139     t = pa_xnew0(pa_bluetooth_transport, 1);
 140     t->device = d;
 141     t->owner = pa_xstrdup(owner);
 142     t->path = pa_xstrdup(path);
 143     t->profile = p;
 144     t->config_size = size;
 145
 146     if (size > 0) {
 147         t->config = pa_xnew(uint8_t, size);
 148         memcpy(t->config, config, size);
 149     }
 150
 151     pa_assert_se(pa_hashmap_put(d->discovery->transports, t->path, t) >= 0);
 152
 153     return t;
 154 }
 155
 156 static const char *transport_state_to_string(pa_bluetooth_transport_state_t state) {
 157     switch(state) {
 158         case PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED:
 159             return "disconnected";
 160         case PA_BLUETOOTH_TRANSPORT_STATE_IDLE:
 161             return "idle";
 162         case PA_BLUETOOTH_TRANSPORT_STATE_PLAYING:
 163             return "playing";
 164     }
 165
 166     return "invalid";
 167 }
 168
 169 static void transport_state_changed(pa_bluetooth_transport *t, pa_bluetooth_transport_state_t state) {
 170     bool old_any_connected;
 171
 172     pa_assert(t);
 173
 174     if (t->state == state)
 175         return;
 176
 177     old_any_connected = pa_bluetooth_device_any_transport_connected(t->device);
 178
 179     pa_log_debug("Transport %s state changed from %s to %s",
 180                  t->path, transport_state_to_string(t->state), transport_state_to_string(state));
 181
 182     t->state = state;
 183     if (state == PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED)
 184         t->device->transports[t->profile] = NULL;
 185
 186     pa_hook_fire(&t->device->discovery->hooks[PA_BLUETOOTH_HOOK_TRANSPORT_STATE_CHANGED], t);
 187
 188     if (old_any_connected != pa_bluetooth_device_any_transport_connected(t->device))
 189         pa_hook_fire(&t->device->discovery->hooks[PA_BLUETOOTH_HOOK_DEVICE_CONNECTION_CHANGED], t->device);
 190 }
 191
 192 void pa_bluetooth_transport_put(pa_bluetooth_transport *t) {
 193     transport_state_changed(t, PA_BLUETOOTH_TRANSPORT_STATE_IDLE);
 194 }
 195
 196 void pa_bluetooth_transport_free(pa_bluetooth_transport *t) {
 197     pa_assert(t);
 198
 199     pa_hashmap_remove(t->device->discovery->transports, t->path);
 200     pa_xfree(t->owner);
 201     pa_xfree(t->path);
 202     pa_xfree(t->config);
 203     pa_xfree(t);
 204 }
 205
 206 static int bluez5_transport_acquire_cb(pa_bluetooth_transport *t, bool optional, size_t *imtu, size_t *omtu) {
 207     DBusMessage *m, *r;
 208     DBusError err;
 209     int ret;
 210     uint16_t i, o;
 211     const char *method = optional ? "TryAcquire" : "Acquire";
 212
 213     pa_assert(t);
 214     pa_assert(t->device);
 215     pa_assert(t->device->discovery);
 216
 217     pa_assert_se(m = dbus_message_new_method_call(t->owner, t->path, BLUEZ_MEDIA_TRANSPORT_INTERFACE, method));
 218
 219     dbus_error_init(&err);
 220
 221     r = dbus_connection_send_with_reply_and_block(pa_dbus_connection_get(t->device->discovery->connection), m, -1, &err);
 222     if (!r) {
 223         if (optional && pa_streq(err.name, "org.bluez.Error.NotAvailable"))
 224             pa_log_info("Failed optional acquire of unavailable transport %s", t->path);
 225         else
 226             pa_log_error("Transport %s() failed for transport %s (%s)", method, t->path, err.message);
 227
 228         dbus_error_free(&err);
 229         return -1;
 230     }
 231
 232     if (!dbus_message_get_args(r, &err, DBUS_TYPE_UNIX_FD, &ret, DBUS_TYPE_UINT16, &i, DBUS_TYPE_UINT16, &o,
 233                                DBUS_TYPE_INVALID)) {
 234         pa_log_error("Failed to parse %s() reply: %s", method, err.message);
 235         dbus_error_free(&err);
 236         ret = -1;
 237         goto finish;
 238     }
 239
 240     if (imtu)
 241         *imtu = i;
 242
 243     if (omtu)
 244         *omtu = o;
 245
 246 finish:
 247     dbus_message_unref(r);
 248     return ret;
 249 }
 250
 251 static void bluez5_transport_release_cb(pa_bluetooth_transport *t) {
 252     DBusMessage *m;
 253     DBusError err;
 254
 255     pa_assert(t);
 256     pa_assert(t->device);
 257     pa_assert(t->device->discovery);
 258
 259     dbus_error_init(&err);
 260
 261     if (t->state <= PA_BLUETOOTH_TRANSPORT_STATE_IDLE) {
 262         pa_log_info("Transport %s auto-released by BlueZ or already released", t->path);
 263         return;
 264     }
 265
 266     pa_assert_se(m = dbus_message_new_method_call(t->owner, t->path, BLUEZ_MEDIA_TRANSPORT_INTERFACE, "Release"));
 267     dbus_connection_send_with_reply_and_block(pa_dbus_connection_get(t->device->discovery->connection), m, -1, &err);
 268
 269     if (dbus_error_is_set(&err)) {
 270         pa_log_error("Failed to release transport %s: %s", t->path, err.message);
 271         dbus_error_free(&err);
 272     } else
 273         pa_log_info("Transport %s released", t->path);
 274 }
 275
 276 bool pa_bluetooth_device_any_transport_connected(const pa_bluetooth_device *d) {
 277     unsigned i;
 278
 279     pa_assert(d);
 280
 281     if (d->device_info_valid != 1)
 282         return false;
 283
 284     for (i = 0; i < PA_BLUETOOTH_PROFILE_COUNT; i++)
 285         if (d->transports[i] && d->transports[i]->state != PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED)
 286             return true;
 287
 288     return false;
 289 }
 290
 291 static int transport_state_from_string(const char* value, pa_bluetooth_transport_state_t *state) {
 292     pa_assert(value);
 293     pa_assert(state);
 294
 295     if (pa_streq(value, "idle"))
 296         *state = PA_BLUETOOTH_TRANSPORT_STATE_IDLE;
 297     else if (pa_streq(value, "pending") || pa_streq(value, "active"))
 298         *state = PA_BLUETOOTH_TRANSPORT_STATE_PLAYING;
 299     else
 300         return -1;
 301
 302     return 0;
 303 }
 304
 305 static void parse_transport_property(pa_bluetooth_transport *t, DBusMessageIter *i) {
 306     const char *key;
 307     DBusMessageIter variant_i;
 308
 309     key = check_variant_property(i);
 310     if (key == NULL)
 311         return;
 312
 313     dbus_message_iter_recurse(i, &variant_i);
 314
 315     switch (dbus_message_iter_get_arg_type(&variant_i)) {
 316
 317         case DBUS_TYPE_STRING: {
 318
 319             const char *value;
 320             dbus_message_iter_get_basic(&variant_i, &value);
 321
 322             if (pa_streq(key, "State")) {
 323                 pa_bluetooth_transport_state_t state;
 324
 325                 if (transport_state_from_string(value, &state) < 0) {
 326                     pa_log_error("Invalid state received: %s", value);
 327                     return;
 328                 }
 329
 330                 transport_state_changed(t, state);
 331             }
 332
 333             break;
 334         }
 335     }
 336
 337     return;
 338 }
 339
 340 static int parse_transport_properties(pa_bluetooth_transport *t, DBusMessageIter *i) {
 341     DBusMessageIter element_i;
 342
 343     dbus_message_iter_recurse(i, &element_i);
 344
 345     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 346         DBusMessageIter dict_i;
 347
 348         dbus_message_iter_recurse(&element_i, &dict_i);
 349
 350         parse_transport_property(t, &dict_i);
 351
 352         dbus_message_iter_next(&element_i);
 353     }
 354
 355     return 0;
 356 }
 357
 358 static pa_bluetooth_device* device_create(pa_bluetooth_discovery *y, const char *path) {
 359     pa_bluetooth_device *d;
 360
 361     pa_assert(y);
 362     pa_assert(path);
 363
 364     d = pa_xnew0(pa_bluetooth_device, 1);
 365     d->discovery = y;
 366     d->path = pa_xstrdup(path);
 367     d->uuids = pa_hashmap_new_full(pa_idxset_string_hash_func, pa_idxset_string_compare_func, NULL, pa_xfree);
 368
 369     pa_hashmap_put(y->devices, d->path, d);
 370
 371     return d;
 372 }
 373
 374 pa_bluetooth_device* pa_bluetooth_discovery_get_device_by_path(pa_bluetooth_discovery *y, const char *path) {
 375     pa_bluetooth_device *d;
 376
 377     pa_assert(y);
 378     pa_assert(PA_REFCNT_VALUE(y) > 0);
 379     pa_assert(path);
 380
 381     if ((d = pa_hashmap_get(y->devices, path)))
 382         if (d->device_info_valid == 1)
 383             return d;
 384
 385     return NULL;
 386 }
 387
 388 pa_bluetooth_device* pa_bluetooth_discovery_get_device_by_address(pa_bluetooth_discovery *y, const char *remote, const char *local) {
 389     pa_bluetooth_device *d;
 390     void *state = NULL;
 391
 392     pa_assert(y);
 393     pa_assert(PA_REFCNT_VALUE(y) > 0);
 394     pa_assert(remote);
 395     pa_assert(local);
 396
 397     while ((d = pa_hashmap_iterate(y->devices, &state, NULL)))
 398         if (pa_streq(d->address, remote) && pa_streq(d->adapter->address, local))
 399             return d->device_info_valid == 1 ? d : NULL;
 400
 401     return NULL;
 402 }
 403
 404 static void device_free(pa_bluetooth_device *d) {
 405     unsigned i;
 406
 407     pa_assert(d);
 408
 409     for (i = 0; i < PA_BLUETOOTH_PROFILE_COUNT; i++) {
 410         pa_bluetooth_transport *t;
 411
 412         if (!(t = d->transports[i]))
 413             continue;
 414
 415         transport_state_changed(t, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED);
 416         pa_bluetooth_transport_free(t);
 417     }
 418
 419     if (d->uuids)
 420         pa_hashmap_free(d->uuids);
 421
 422     d->discovery = NULL;
 423     d->adapter = NULL;
 424     pa_xfree(d->path);
 425     pa_xfree(d->alias);
 426     pa_xfree(d->address);
 427     pa_xfree(d);
 428 }
 429
 430 static void device_remove(pa_bluetooth_discovery *y, const char *path) {
 431     pa_bluetooth_device *d;
 432
 433     if (!(d = pa_hashmap_remove(y->devices, path)))
 434         pa_log_warn("Unknown device removed %s", path);
 435     else {
 436         pa_log_debug("Device %s removed", path);
 437         device_free(d);
 438     }
 439 }
 440
 441 static void set_device_info_valid(pa_bluetooth_device *device, int valid) {
 442     pa_assert(device);
 443     pa_assert(valid == -1 || valid == 0 || valid == 1);
 444
 445     if (valid == device->device_info_valid)
 446         return;
 447
 448     device->device_info_valid = valid;
 449 }
 450
 451 static void device_remove_all(pa_bluetooth_discovery *y) {
 452     pa_bluetooth_device *d;
 453
 454     pa_assert(y);
 455
 456     while ((d = pa_hashmap_steal_first(y->devices))) {
 457         set_device_info_valid(d, -1);
 458         pa_hook_fire(&y->hooks[PA_BLUETOOTH_HOOK_DEVICE_CONNECTION_CHANGED], d);
 459         device_free(d);
 460    }
 461 }
 462
 463 static pa_bluetooth_adapter* adapter_create(pa_bluetooth_discovery *y, const char *path) {
 464     pa_bluetooth_adapter *a;
 465
 466     pa_assert(y);
 467     pa_assert(path);
 468
 469     a = pa_xnew0(pa_bluetooth_adapter, 1);
 470     a->discovery = y;
 471     a->path = pa_xstrdup(path);
 472
 473     pa_hashmap_put(y->adapters, a->path, a);
 474
 475     return a;
 476 }
 477
 478 static void adapter_free(pa_bluetooth_adapter *a) {
 479     pa_bluetooth_device *d;
 480     void *state;
 481
 482     pa_assert(a);
 483     pa_assert(a->discovery);
 484
 485     PA_HASHMAP_FOREACH(d, a->discovery->devices, state)
 486         if (d->adapter == a)
 487             d->adapter = NULL;
 488
 489     pa_xfree(a->path);
 490     pa_xfree(a->address);
 491     pa_xfree(a);
 492 }
 493
 494 static void adapter_remove(pa_bluetooth_discovery *y, const char *path) {
 495     pa_bluetooth_adapter *a;
 496
 497     if (!(a = pa_hashmap_remove(y->adapters, path)))
 498         pa_log_warn("Unknown adapter removed %s", path);
 499     else {
 500         pa_log_debug("Adapter %s removed", path);
 501         adapter_free(a);
 502     }
 503 }
 504
 505 static void parse_device_property(pa_bluetooth_device *d, DBusMessageIter *i, bool is_property_change) {
 506     const char *key;
 507     DBusMessageIter variant_i;
 508
 509     pa_assert(d);
 510
 511     key = check_variant_property(i);
 512     if (key == NULL) {
 513         pa_log_error("Received invalid property for device %s", d->path);
 514         return;
 515     }
 516
 517     dbus_message_iter_recurse(i, &variant_i);
 518
 519     switch (dbus_message_iter_get_arg_type(&variant_i)) {
 520
 521         case DBUS_TYPE_STRING: {
 522             const char *value;
 523             dbus_message_iter_get_basic(&variant_i, &value);
 524
 525             if (pa_streq(key, "Alias")) {
 526                 pa_xfree(d->alias);
 527                 d->alias = pa_xstrdup(value);
 528                 pa_log_debug("%s: %s", key, value);
 529             } else if (pa_streq(key, "Address")) {
 530                 if (is_property_change) {
 531                     pa_log_warn("Device property 'Address' expected to be constant but changed for %s, ignoring", d->path);
 532                     return;
 533                 }
 534
 535                 if (d->address) {
 536                     pa_log_warn("Device %s: Received a duplicate 'Address' property, ignoring", d->path);
 537                     return;
 538                 }
 539
 540                 d->address = pa_xstrdup(value);
 541                 pa_log_debug("%s: %s", key, value);
 542             }
 543
 544             break;
 545         }
 546
 547         case DBUS_TYPE_OBJECT_PATH: {
 548             const char *value;
 549             dbus_message_iter_get_basic(&variant_i, &value);
 550
 551             if (pa_streq(key, "Adapter")) {
 552
 553                 if (is_property_change) {
 554                     pa_log_warn("Device property 'Adapter' expected to be constant but changed for %s, ignoring", d->path);
 555                     return;
 556                 }
 557
 558                 if (d->adapter_path) {
 559                     pa_log_warn("Device %s: Received a duplicate 'Adapter' property, ignoring", d->path);
 560                     return;
 561                 }
 562
 563                 d->adapter_path = pa_xstrdup(value);
 564
 565                 d->adapter = pa_hashmap_get(d->discovery->adapters, value);
 566                 if (!d->adapter)
 567                     pa_log_info("Device %s: 'Adapter' property references an unknown adapter %s.", d->path, value);
 568
 569                 pa_log_debug("%s: %s", key, value);
 570             }
 571
 572             break;
 573         }
 574
 575         case DBUS_TYPE_UINT32: {
 576             uint32_t value;
 577             dbus_message_iter_get_basic(&variant_i, &value);
 578
 579             if (pa_streq(key, "Class")) {
 580                 d->class_of_device = value;
 581                 pa_log_debug("%s: %d", key, value);
 582             }
 583
 584             break;
 585         }
 586
 587         case DBUS_TYPE_ARRAY: {
 588             DBusMessageIter ai;
 589             dbus_message_iter_recurse(&variant_i, &ai);
 590
 591             if (dbus_message_iter_get_arg_type(&ai) == DBUS_TYPE_STRING && pa_streq(key, "UUIDs")) {
 592                 /* bluetoothd never removes UUIDs from a device object so there
 593                  * is no need to handle it here. */
 594                 while (dbus_message_iter_get_arg_type(&ai) != DBUS_TYPE_INVALID) {
 595                     const char *value;
 596                     char *uuid;
 597
 598                     dbus_message_iter_get_basic(&ai, &value);
 599
 600                     if (pa_hashmap_get(d->uuids, value)) {
 601                         dbus_message_iter_next(&ai);
 602                         continue;
 603                     }
 604
 605                     uuid = pa_xstrdup(value);
 606                     pa_hashmap_put(d->uuids, uuid, uuid);
 607
 608                     pa_log_debug("%s: %s", key, value);
 609                     dbus_message_iter_next(&ai);
 610                 }
 611             }
 612
 613             break;
 614         }
 615     }
 616 }
 617
 618 static int parse_device_properties(pa_bluetooth_device *d, DBusMessageIter *i, bool is_property_change) {
 619     DBusMessageIter element_i;
 620
 621     dbus_message_iter_recurse(i, &element_i);
 622
 623     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 624         DBusMessageIter dict_i;
 625
 626         dbus_message_iter_recurse(&element_i, &dict_i);
 627         parse_device_property(d, &dict_i, is_property_change);
 628         dbus_message_iter_next(&element_i);
 629     }
 630
 631     if (!d->address || !d->adapter_path || !d->alias) {
 632         pa_log_error("Non-optional information missing for device %s", d->path);
 633         set_device_info_valid(d, -1);
 634         return -1;
 635     }
 636
 637     if (!is_property_change && d->adapter)
 638         set_device_info_valid(d, 1);
 639
 640     /* If d->adapter is NULL, device_info_valid will be left as 0, and updated
 641      * after all interfaces have been parsed. */
 642
 643     return 0;
 644 }
 645
 646 static void parse_adapter_properties(pa_bluetooth_adapter *a, DBusMessageIter *i, bool is_property_change) {
 647     DBusMessageIter element_i;
 648
 649     pa_assert(a);
 650
 651     dbus_message_iter_recurse(i, &element_i);
 652
 653     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 654         DBusMessageIter dict_i, variant_i;
 655         const char *key;
 656
 657         dbus_message_iter_recurse(&element_i, &dict_i);
 658
 659         key = check_variant_property(&dict_i);
 660         if (key == NULL) {
 661             pa_log_error("Received invalid property for adapter %s", a->path);
 662             return;
 663         }
 664
 665         dbus_message_iter_recurse(&dict_i, &variant_i);
 666
 667         if (dbus_message_iter_get_arg_type(&variant_i) == DBUS_TYPE_STRING && pa_streq(key, "Address")) {
 668             const char *value;
 669
 670             if (is_property_change) {
 671                 pa_log_warn("Adapter property 'Address' expected to be constant but changed for %s, ignoring", a->path);
 672                 return;
 673             }
 674
 675             if (a->address) {
 676                 pa_log_warn("Adapter %s received a duplicate 'Address' property, ignoring", a->path);
 677                 return;
 678             }
 679
 680             dbus_message_iter_get_basic(&variant_i, &value);
 681             a->address = pa_xstrdup(value);
 682         }
 683
 684         dbus_message_iter_next(&element_i);
 685     }
 686 }
 687
 688 static void register_endpoint_reply(DBusPendingCall *pending, void *userdata) {
 689     DBusMessage *r;
 690     pa_dbus_pending *p;
 691     pa_bluetooth_discovery *y;
 692     char *endpoint;
 693
 694     pa_assert(pending);
 695     pa_assert_se(p = userdata);
 696     pa_assert_se(y = p->context_data);
 697     pa_assert_se(endpoint = p->call_data);
 698     pa_assert_se(r = dbus_pending_call_steal_reply(pending));
 699
 700     if (dbus_message_is_error(r, BLUEZ_ERROR_NOT_SUPPORTED)) {
 701         pa_log_info("Couldn't register endpoint %s because it is disabled in BlueZ", endpoint);
 702         goto finish;
 703     }
 704
 705     if (dbus_message_get_type(r) == DBUS_MESSAGE_TYPE_ERROR) {
 706         pa_log_error(BLUEZ_MEDIA_INTERFACE ".RegisterEndpoint() failed: %s: %s", dbus_message_get_error_name(r),
 707                      pa_dbus_get_error_message(r));
 708         goto finish;
 709     }
 710
 711 finish:
 712     dbus_message_unref(r);
 713
 714     PA_LLIST_REMOVE(pa_dbus_pending, y->pending, p);
 715     pa_dbus_pending_free(p);
 716
 717     pa_xfree(endpoint);
 718 }
 719
 720 static void register_endpoint(pa_bluetooth_discovery *y, const char *path, const char *endpoint, const char *uuid) {
 721     DBusMessage *m;
 722     DBusMessageIter i, d;
 723     uint8_t codec = 0;
 724
 725     pa_log_debug("Registering %s on adapter %s", endpoint, path);
 726
 727     pa_assert_se(m = dbus_message_new_method_call(BLUEZ_SERVICE, path, BLUEZ_MEDIA_INTERFACE, "RegisterEndpoint"));
 728
 729     dbus_message_iter_init_append(m, &i);
 730     dbus_message_iter_append_basic(&i, DBUS_TYPE_OBJECT_PATH, &endpoint);
 731     dbus_message_iter_open_container(&i, DBUS_TYPE_ARRAY, DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING DBUS_TYPE_STRING_AS_STRING
 732                                          DBUS_TYPE_VARIANT_AS_STRING DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &d);
 733     pa_dbus_append_basic_variant_dict_entry(&d, "UUID", DBUS_TYPE_STRING, &uuid);
 734     pa_dbus_append_basic_variant_dict_entry(&d, "Codec", DBUS_TYPE_BYTE, &codec);
 735
 736     if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SOURCE) || pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SINK)) {
 737         a2dp_sbc_t capabilities;
 738
 739         capabilities.channel_mode = SBC_CHANNEL_MODE_MONO | SBC_CHANNEL_MODE_DUAL_CHANNEL | SBC_CHANNEL_MODE_STEREO |
 740                                     SBC_CHANNEL_MODE_JOINT_STEREO;
 741         capabilities.frequency = SBC_SAMPLING_FREQ_16000 | SBC_SAMPLING_FREQ_32000 | SBC_SAMPLING_FREQ_44100 |
 742                                  SBC_SAMPLING_FREQ_48000;
 743         capabilities.allocation_method = SBC_ALLOCATION_SNR | SBC_ALLOCATION_LOUDNESS;
 744         capabilities.subbands = SBC_SUBBANDS_4 | SBC_SUBBANDS_8;
 745         capabilities.block_length = SBC_BLOCK_LENGTH_4 | SBC_BLOCK_LENGTH_8 | SBC_BLOCK_LENGTH_12 | SBC_BLOCK_LENGTH_16;
 746         capabilities.min_bitpool = MIN_BITPOOL;
 747         capabilities.max_bitpool = MAX_BITPOOL;
 748
 749         pa_dbus_append_basic_array_variant_dict_entry(&d, "Capabilities", DBUS_TYPE_BYTE, &capabilities, sizeof(capabilities));
 750     }
 751
 752     dbus_message_iter_close_container(&i, &d);
 753
 754     send_and_add_to_pending(y, m, register_endpoint_reply, pa_xstrdup(endpoint));
 755 }
 756
 757 static void parse_interfaces_and_properties(pa_bluetooth_discovery *y, DBusMessageIter *dict_i) {
 758     DBusMessageIter element_i;
 759     const char *path;
 760     void *state;
 761     pa_bluetooth_device *d;
 762
 763     pa_assert(dbus_message_iter_get_arg_type(dict_i) == DBUS_TYPE_OBJECT_PATH);
 764     dbus_message_iter_get_basic(dict_i, &path);
 765
 766     pa_assert_se(dbus_message_iter_next(dict_i));
 767     pa_assert(dbus_message_iter_get_arg_type(dict_i) == DBUS_TYPE_ARRAY);
 768
 769     dbus_message_iter_recurse(dict_i, &element_i);
 770
 771     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 772         DBusMessageIter iface_i;
 773         const char *interface;
 774
 775         dbus_message_iter_recurse(&element_i, &iface_i);
 776
 777         pa_assert(dbus_message_iter_get_arg_type(&iface_i) == DBUS_TYPE_STRING);
 778         dbus_message_iter_get_basic(&iface_i, &interface);
 779
 780         pa_assert_se(dbus_message_iter_next(&iface_i));
 781         pa_assert(dbus_message_iter_get_arg_type(&iface_i) == DBUS_TYPE_ARRAY);
 782
 783         if (pa_streq(interface, BLUEZ_ADAPTER_INTERFACE)) {
 784             pa_bluetooth_adapter *a;
 785
 786             if ((a = pa_hashmap_get(y->adapters, path))) {
 787                 pa_log_error("Found duplicated D-Bus path for device %s", path);
 788                 return;
 789             } else
 790                 a = adapter_create(y, path);
 791
 792             pa_log_debug("Adapter %s found", path);
 793
 794             parse_adapter_properties(a, &iface_i, false);
 795             if (!a->address)
 796                 return;
 797
 798             register_endpoint(y, path, A2DP_SOURCE_ENDPOINT, PA_BLUETOOTH_UUID_A2DP_SOURCE);
 799             register_endpoint(y, path, A2DP_SINK_ENDPOINT, PA_BLUETOOTH_UUID_A2DP_SINK);
 800
 801         } else if (pa_streq(interface, BLUEZ_DEVICE_INTERFACE)) {
 802
 803             if ((d = pa_hashmap_get(y->devices, path))) {
 804                 if (d->device_info_valid != 0) {
 805                     pa_log_error("Found duplicated D-Bus path for device %s", path);
 806                     return;
 807                 }
 808             } else
 809                 d = device_create(y, path);
 810
 811             pa_log_debug("Device %s found", d->path);
 812
 813             parse_device_properties(d, &iface_i, false);
 814
 815         } else
 816             pa_log_debug("Unknown interface %s found, skipping", interface);
 817
 818         dbus_message_iter_next(&element_i);
 819     }
 820
 821     PA_HASHMAP_FOREACH(d, y->devices, state) {
 822         if (d->device_info_valid != 0)
 823             continue;
 824
 825         if (!d->adapter && d->adapter_path) {
 826             d->adapter = pa_hashmap_get(d->discovery->adapters, d->adapter_path);
 827             if (!d->adapter) {
 828                 pa_log_error("Device %s is child of nonexistent adapter %s", d->path, d->adapter_path);
 829                 set_device_info_valid(d, -1);
 830             } else
 831                 set_device_info_valid(d, 1);
 832         }
 833     }
 834
 835     return;
 836 }
 837
 838 static void get_managed_objects_reply(DBusPendingCall *pending, void *userdata) {
 839     pa_dbus_pending *p;
 840     pa_bluetooth_discovery *y;
 841     DBusMessage *r;
 842     DBusMessageIter arg_i, element_i;
 843
 844     pa_assert_se(p = userdata);
 845     pa_assert_se(y = p->context_data);
 846     pa_assert_se(r = dbus_pending_call_steal_reply(pending));
 847
 848     if (dbus_message_is_error(r, DBUS_ERROR_UNKNOWN_METHOD)) {
 849         pa_log_warn("BlueZ D-Bus ObjectManager not available");
 850         goto finish;
 851     }
 852
 853     if (dbus_message_get_type(r) == DBUS_MESSAGE_TYPE_ERROR) {
 854         pa_log_error("GetManagedObjects() failed: %s: %s", dbus_message_get_error_name(r), pa_dbus_get_error_message(r));
 855         goto finish;
 856     }
 857
 858     if (!dbus_message_iter_init(r, &arg_i) || !pa_streq(dbus_message_get_signature(r), "a{oa{sa{sv}}}")) {
 859         pa_log_error("Invalid reply signature for GetManagedObjects()");
 860         goto finish;
 861     }
 862
 863     dbus_message_iter_recurse(&arg_i, &element_i);
 864     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 865         DBusMessageIter dict_i;
 866
 867         dbus_message_iter_recurse(&element_i, &dict_i);
 868
 869         parse_interfaces_and_properties(y, &dict_i);
 870
 871         dbus_message_iter_next(&element_i);
 872     }
 873
 874     y->objects_listed = true;
 875
 876 finish:
 877     dbus_message_unref(r);
 878
 879     PA_LLIST_REMOVE(pa_dbus_pending, y->pending, p);
 880     pa_dbus_pending_free(p);
 881 }
 882
 883 static void get_managed_objects(pa_bluetooth_discovery *y) {
 884     DBusMessage *m;
 885
 886     pa_assert(y);
 887
 888     pa_assert_se(m = dbus_message_new_method_call(BLUEZ_SERVICE, "/", "org.freedesktop.DBus.ObjectManager",
 889                                                   "GetManagedObjects"));
 890     send_and_add_to_pending(y, m, get_managed_objects_reply, NULL);
 891 }
 892
 893 pa_hook* pa_bluetooth_discovery_hook(pa_bluetooth_discovery *y, pa_bluetooth_hook_t hook) {
 894     pa_assert(y);
 895     pa_assert(PA_REFCNT_VALUE(y) > 0);
 896
 897     return &y->hooks[hook];
 898 }
 899
 900 static DBusHandlerResult filter_cb(DBusConnection *bus, DBusMessage *m, void *userdata) {
 901     pa_bluetooth_discovery *y;
 902     DBusError err;
 903
 904     pa_assert(bus);
 905     pa_assert(m);
 906     pa_assert_se(y = userdata);
 907
 908     dbus_error_init(&err);
 909
 910     if (dbus_message_is_signal(m, "org.freedesktop.DBus", "NameOwnerChanged")) {
 911         const char *name, *old_owner, *new_owner;
 912
 913         if (!dbus_message_get_args(m, &err,
 914                                    DBUS_TYPE_STRING, &name,
 915                                    DBUS_TYPE_STRING, &old_owner,
 916                                    DBUS_TYPE_STRING, &new_owner,
 917                                    DBUS_TYPE_INVALID)) {
 918             pa_log_error("Failed to parse org.freedesktop.DBus.NameOwnerChanged: %s", err.message);
 919             goto fail;
 920         }
 921
 922         if (pa_streq(name, BLUEZ_SERVICE)) {
 923             if (old_owner && *old_owner) {
 924                 pa_log_debug("Bluetooth daemon disappeared");
 925                 device_remove_all(y);
 926                 pa_hashmap_remove_all(y->adapters);
 927                 y->objects_listed = false;
 928             }
 929
 930             if (new_owner && *new_owner) {
 931                 pa_log_debug("Bluetooth daemon appeared");
 932                 get_managed_objects(y);
 933             }
 934         }
 935
 936         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 937     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.ObjectManager", "InterfacesAdded")) {
 938         DBusMessageIter arg_i;
 939
 940         if (!y->objects_listed)
 941             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 942
 943         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "oa{sa{sv}}")) {
 944             pa_log_error("Invalid signature found in InterfacesAdded");
 945             goto fail;
 946         }
 947
 948         parse_interfaces_and_properties(y, &arg_i);
 949
 950         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 951     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.ObjectManager", "InterfacesRemoved")) {
 952         const char *p;
 953         DBusMessageIter arg_i;
 954         DBusMessageIter element_i;
 955
 956         if (!y->objects_listed)
 957             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 958
 959         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "oas")) {
 960             pa_log_error("Invalid signature found in InterfacesRemoved");
 961             goto fail;
 962         }
 963
 964         dbus_message_iter_get_basic(&arg_i, &p);
 965
 966         pa_assert_se(dbus_message_iter_next(&arg_i));
 967         pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_ARRAY);
 968
 969         dbus_message_iter_recurse(&arg_i, &element_i);
 970
 971         while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_STRING) {
 972             const char *iface;
 973
 974             dbus_message_iter_get_basic(&element_i, &iface);
 975
 976             if (pa_streq(iface, BLUEZ_DEVICE_INTERFACE))
 977                 device_remove(y, p);
 978             else if (pa_streq(iface, BLUEZ_ADAPTER_INTERFACE))
 979                 adapter_remove(y, p);
 980
 981             dbus_message_iter_next(&element_i);
 982         }
 983
 984         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 985
 986     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.Properties", "PropertiesChanged")) {
 987         DBusMessageIter arg_i;
 988         const char *iface;
 989
 990         if (!y->objects_listed)
 991             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 992
 993         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "sa{sv}as")) {
 994             pa_log_error("Invalid signature found in PropertiesChanged");
 995             goto fail;
 996         }
 997
 998         dbus_message_iter_get_basic(&arg_i, &iface);
 999
1000         pa_assert_se(dbus_message_iter_next(&arg_i));
1001         pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_ARRAY);
1002
1003         if (pa_streq(iface, BLUEZ_ADAPTER_INTERFACE)) {
1004             pa_bluetooth_adapter *a;
1005
1006             pa_log_debug("Properties changed in adapter %s", dbus_message_get_path(m));
1007
1008             if (!(a = pa_hashmap_get(y->adapters, dbus_message_get_path(m)))) {
1009                 pa_log_warn("Properties changed in unknown adapter");
1010                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1011             }
1012
1013             parse_adapter_properties(a, &arg_i, true);
1014
1015         } else if (pa_streq(iface, BLUEZ_DEVICE_INTERFACE)) {
1016             pa_bluetooth_device *d;
1017
1018             pa_log_debug("Properties changed in device %s", dbus_message_get_path(m));
1019
1020             if (!(d = pa_hashmap_get(y->devices, dbus_message_get_path(m)))) {
1021                 pa_log_warn("Properties changed in unknown device");
1022                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1023             }
1024
1025             if (d->device_info_valid != 1) {
1026                 pa_log_warn("Properties changed in a device which information is unknown or invalid");
1027                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1028             }
1029
1030             parse_device_properties(d, &arg_i, true);
1031         } else if (pa_streq(iface, BLUEZ_MEDIA_TRANSPORT_INTERFACE)) {
1032             pa_bluetooth_transport *t;
1033
1034             pa_log_debug("Properties changed in transport %s", dbus_message_get_path(m));
1035
1036             if (!(t = pa_hashmap_get(y->transports, dbus_message_get_path(m))))
1037                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1038
1039             parse_transport_properties(t, &arg_i);
1040         }
1041
1042         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1043     }
1044
1045 fail:
1046     dbus_error_free(&err);
1047
1048     return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1049 }
1050
1051 static uint8_t a2dp_default_bitpool(uint8_t freq, uint8_t mode) {
1052     /* These bitpool values were chosen based on the A2DP spec recommendation */
1053     switch (freq) {
1054         case SBC_SAMPLING_FREQ_16000:
1055         case SBC_SAMPLING_FREQ_32000:
1056             return 53;
1057
1058         case SBC_SAMPLING_FREQ_44100:
1059
1060             switch (mode) {
1061                 case SBC_CHANNEL_MODE_MONO:
1062                 case SBC_CHANNEL_MODE_DUAL_CHANNEL:
1063                     return 31;
1064
1065                 case SBC_CHANNEL_MODE_STEREO:
1066                 case SBC_CHANNEL_MODE_JOINT_STEREO:
1067                     return 53;
1068             }
1069
1070             pa_log_warn("Invalid channel mode %u", mode);
1071             return 53;
1072
1073         case SBC_SAMPLING_FREQ_48000:
1074
1075             switch (mode) {
1076                 case SBC_CHANNEL_MODE_MONO:
1077                 case SBC_CHANNEL_MODE_DUAL_CHANNEL:
1078                     return 29;
1079
1080                 case SBC_CHANNEL_MODE_STEREO:
1081                 case SBC_CHANNEL_MODE_JOINT_STEREO:
1082                     return 51;
1083             }
1084
1085             pa_log_warn("Invalid channel mode %u", mode);
1086             return 51;
1087     }
1088
1089     pa_log_warn("Invalid sampling freq %u", freq);
1090     return 53;
1091 }
1092
1093 const char *pa_bluetooth_profile_to_string(pa_bluetooth_profile_t profile) {
1094     switch(profile) {
1095         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1096             return "a2dp_sink";
1097         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1098             return "a2dp_source";
1099         case PA_BLUETOOTH_PROFILE_OFF:
1100             return "off";
1101     }
1102
1103     return NULL;
1104 }
1105
1106 static DBusMessage *endpoint_set_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1107     pa_bluetooth_discovery *y = userdata;
1108     pa_bluetooth_device *d;
1109     pa_bluetooth_transport *t;
1110     const char *sender, *path, *endpoint_path, *dev_path = NULL, *uuid = NULL;
1111     const uint8_t *config = NULL;
1112     int size = 0;
1113     pa_bluetooth_profile_t p = PA_BLUETOOTH_PROFILE_OFF;
1114     DBusMessageIter args, props;
1115     DBusMessage *r;
1116
1117     if (!dbus_message_iter_init(m, &args) || !pa_streq(dbus_message_get_signature(m), "oa{sv}")) {
1118         pa_log_error("Invalid signature for method SetConfiguration()");
1119         goto fail2;
1120     }
1121
1122     dbus_message_iter_get_basic(&args, &path);
1123
1124     if (pa_hashmap_get(y->transports, path)) {
1125         pa_log_error("Endpoint SetConfiguration(): Transport %s is already configured.", path);
1126         goto fail2;
1127     }
1128
1129     pa_assert_se(dbus_message_iter_next(&args));
1130
1131     dbus_message_iter_recurse(&args, &props);
1132     if (dbus_message_iter_get_arg_type(&props) != DBUS_TYPE_DICT_ENTRY)
1133         goto fail;
1134
1135     /* Read transport properties */
1136     while (dbus_message_iter_get_arg_type(&props) == DBUS_TYPE_DICT_ENTRY) {
1137         const char *key;
1138         DBusMessageIter value, entry;
1139         int var;
1140
1141         dbus_message_iter_recurse(&props, &entry);
1142         dbus_message_iter_get_basic(&entry, &key);
1143
1144         dbus_message_iter_next(&entry);
1145         dbus_message_iter_recurse(&entry, &value);
1146
1147         var = dbus_message_iter_get_arg_type(&value);
1148
1149         if (pa_streq(key, "UUID")) {
1150             if (var != DBUS_TYPE_STRING) {
1151                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1152                 goto fail;
1153             }
1154
1155             dbus_message_iter_get_basic(&value, &uuid);
1156
1157             endpoint_path = dbus_message_get_path(m);
1158             if (pa_streq(endpoint_path, A2DP_SOURCE_ENDPOINT)) {
1159                 if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SOURCE))
1160                     p = PA_BLUETOOTH_PROFILE_A2DP_SINK;
1161             } else if (pa_streq(endpoint_path, A2DP_SINK_ENDPOINT)) {
1162                 if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SINK))
1163                     p = PA_BLUETOOTH_PROFILE_A2DP_SOURCE;
1164             }
1165
1166             if (p == PA_BLUETOOTH_PROFILE_OFF) {
1167                 pa_log_error("UUID %s of transport %s incompatible with endpoint %s", uuid, path, endpoint_path);
1168                 goto fail;
1169             }
1170         } else if (pa_streq(key, "Device")) {
1171             if (var != DBUS_TYPE_OBJECT_PATH) {
1172                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1173                 goto fail;
1174             }
1175
1176             dbus_message_iter_get_basic(&value, &dev_path);
1177         } else if (pa_streq(key, "Configuration")) {
1178             DBusMessageIter array;
1179             a2dp_sbc_t *c;
1180
1181             if (var != DBUS_TYPE_ARRAY) {
1182                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1183                 goto fail;
1184             }
1185
1186             dbus_message_iter_recurse(&value, &array);
1187             var = dbus_message_iter_get_arg_type(&array);
1188             if (var != DBUS_TYPE_BYTE) {
1189                 pa_log_error("%s is an array of wrong type %c", key, (char)var);
1190                 goto fail;
1191             }
1192
1193             dbus_message_iter_get_fixed_array(&array, &config, &size);
1194             if (size != sizeof(a2dp_sbc_t)) {
1195                 pa_log_error("Configuration array of invalid size");
1196                 goto fail;
1197             }
1198
1199             c = (a2dp_sbc_t *) config;
1200
1201             if (c->frequency != SBC_SAMPLING_FREQ_16000 && c->frequency != SBC_SAMPLING_FREQ_32000 &&
1202                 c->frequency != SBC_SAMPLING_FREQ_44100 && c->frequency != SBC_SAMPLING_FREQ_48000) {
1203                 pa_log_error("Invalid sampling frequency in configuration");
1204                 goto fail;
1205             }
1206
1207             if (c->channel_mode != SBC_CHANNEL_MODE_MONO && c->channel_mode != SBC_CHANNEL_MODE_DUAL_CHANNEL &&
1208                 c->channel_mode != SBC_CHANNEL_MODE_STEREO && c->channel_mode != SBC_CHANNEL_MODE_JOINT_STEREO) {
1209                 pa_log_error("Invalid channel mode in configuration");
1210                 goto fail;
1211             }
1212
1213             if (c->allocation_method != SBC_ALLOCATION_SNR && c->allocation_method != SBC_ALLOCATION_LOUDNESS) {
1214                 pa_log_error("Invalid allocation method in configuration");
1215                 goto fail;
1216             }
1217
1218             if (c->subbands != SBC_SUBBANDS_4 && c->subbands != SBC_SUBBANDS_8) {
1219                 pa_log_error("Invalid SBC subbands in configuration");
1220                 goto fail;
1221             }
1222
1223             if (c->block_length != SBC_BLOCK_LENGTH_4 && c->block_length != SBC_BLOCK_LENGTH_8 &&
1224                 c->block_length != SBC_BLOCK_LENGTH_12 && c->block_length != SBC_BLOCK_LENGTH_16) {
1225                 pa_log_error("Invalid block length in configuration");
1226                 goto fail;
1227             }
1228         }
1229
1230         dbus_message_iter_next(&props);
1231     }
1232
1233     if ((d = pa_hashmap_get(y->devices, dev_path))) {
1234         if (d->device_info_valid == -1) {
1235             pa_log_error("Information about device %s is invalid", dev_path);
1236             goto fail2;
1237         }
1238     } else {
1239         /* InterfacesAdded signal is probably on it's way, device_info_valid is kept as 0. */
1240         pa_log_warn("SetConfiguration() received for unknown device %s", dev_path);
1241         d = device_create(y, dev_path);
1242     }
1243
1244     if (d->transports[p] != NULL) {
1245         pa_log_error("Cannot configure transport %s because profile %s is already used", path, pa_bluetooth_profile_to_string(p));
1246         goto fail2;
1247     }
1248
1249     sender = dbus_message_get_sender(m);
1250
1251     pa_assert_se(r = dbus_message_new_method_return(m));
1252     pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y->connection), r, NULL));
1253     dbus_message_unref(r);
1254
1255     d->transports[p] = t = pa_bluetooth_transport_new(d, sender, path, p, config, size);
1256     t->acquire = bluez5_transport_acquire_cb;
1257     t->release = bluez5_transport_release_cb;
1258     pa_bluetooth_transport_put(t);
1259
1260     pa_log_debug("Transport %s available for profile %s", t->path, pa_bluetooth_profile_to_string(t->profile));
1261
1262     return NULL;
1263
1264 fail:
1265     pa_log_error("Endpoint SetConfiguration(): invalid arguments");
1266
1267 fail2:
1268     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to set configuration"));
1269     return r;
1270 }
1271
1272 static DBusMessage *endpoint_select_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1273     pa_bluetooth_discovery *y = userdata;
1274     a2dp_sbc_t *cap, config;
1275     uint8_t *pconf = (uint8_t *) &config;
1276     int i, size;
1277     DBusMessage *r;
1278     DBusError err;
1279
1280     static const struct {
1281         uint32_t rate;
1282         uint8_t cap;
1283     } freq_table[] = {
1284         { 16000U, SBC_SAMPLING_FREQ_16000 },
1285         { 32000U, SBC_SAMPLING_FREQ_32000 },
1286         { 44100U, SBC_SAMPLING_FREQ_44100 },
1287         { 48000U, SBC_SAMPLING_FREQ_48000 }
1288     };
1289
1290     dbus_error_init(&err);
1291
1292     if (!dbus_message_get_args(m, &err, DBUS_TYPE_ARRAY, DBUS_TYPE_BYTE, &cap, &size, DBUS_TYPE_INVALID)) {
1293         pa_log_error("Endpoint SelectConfiguration(): %s", err.message);
1294         dbus_error_free(&err);
1295         goto fail;
1296     }
1297
1298     if (size != sizeof(config)) {
1299         pa_log_error("Capabilities array has invalid size");
1300         goto fail;
1301     }
1302
1303     pa_zero(config);
1304
1305     /* Find the lowest freq that is at least as high as the requested sampling rate */
1306     for (i = 0; (unsigned) i < PA_ELEMENTSOF(freq_table); i++)
1307         if (freq_table[i].rate >= y->core->default_sample_spec.rate && (cap->frequency & freq_table[i].cap)) {
1308             config.frequency = freq_table[i].cap;
1309             break;
1310         }
1311
1312     if ((unsigned) i == PA_ELEMENTSOF(freq_table)) {
1313         for (--i; i >= 0; i--) {
1314             if (cap->frequency & freq_table[i].cap) {
1315                 config.frequency = freq_table[i].cap;
1316                 break;
1317             }
1318         }
1319
1320         if (i < 0) {
1321             pa_log_error("Not suitable sample rate");
1322             goto fail;
1323         }
1324     }
1325
1326     pa_assert((unsigned) i < PA_ELEMENTSOF(freq_table));
1327
1328     if (y->core->default_sample_spec.channels <= 1) {
1329         if (cap->channel_mode & SBC_CHANNEL_MODE_MONO)
1330             config.channel_mode = SBC_CHANNEL_MODE_MONO;
1331         else if (cap->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO)
1332             config.channel_mode = SBC_CHANNEL_MODE_JOINT_STEREO;
1333         else if (cap->channel_mode & SBC_CHANNEL_MODE_STEREO)
1334             config.channel_mode = SBC_CHANNEL_MODE_STEREO;
1335         else if (cap->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL)
1336             config.channel_mode = SBC_CHANNEL_MODE_DUAL_CHANNEL;
1337         else {
1338             pa_log_error("No supported channel modes");
1339             goto fail;
1340         }
1341     }
1342
1343     if (y->core->default_sample_spec.channels >= 2) {
1344         if (cap->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO)
1345             config.channel_mode = SBC_CHANNEL_MODE_JOINT_STEREO;
1346         else if (cap->channel_mode & SBC_CHANNEL_MODE_STEREO)
1347             config.channel_mode = SBC_CHANNEL_MODE_STEREO;
1348         else if (cap->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL)
1349             config.channel_mode = SBC_CHANNEL_MODE_DUAL_CHANNEL;
1350         else if (cap->channel_mode & SBC_CHANNEL_MODE_MONO)
1351             config.channel_mode = SBC_CHANNEL_MODE_MONO;
1352         else {
1353             pa_log_error("No supported channel modes");
1354             goto fail;
1355         }
1356     }
1357
1358     if (cap->block_length & SBC_BLOCK_LENGTH_16)
1359         config.block_length = SBC_BLOCK_LENGTH_16;
1360     else if (cap->block_length & SBC_BLOCK_LENGTH_12)
1361         config.block_length = SBC_BLOCK_LENGTH_12;
1362     else if (cap->block_length & SBC_BLOCK_LENGTH_8)
1363         config.block_length = SBC_BLOCK_LENGTH_8;
1364     else if (cap->block_length & SBC_BLOCK_LENGTH_4)
1365         config.block_length = SBC_BLOCK_LENGTH_4;
1366     else {
1367         pa_log_error("No supported block lengths");
1368         goto fail;
1369     }
1370
1371     if (cap->subbands & SBC_SUBBANDS_8)
1372         config.subbands = SBC_SUBBANDS_8;
1373     else if (cap->subbands & SBC_SUBBANDS_4)
1374         config.subbands = SBC_SUBBANDS_4;
1375     else {
1376         pa_log_error("No supported subbands");
1377         goto fail;
1378     }
1379
1380     if (cap->allocation_method & SBC_ALLOCATION_LOUDNESS)
1381         config.allocation_method = SBC_ALLOCATION_LOUDNESS;
1382     else if (cap->allocation_method & SBC_ALLOCATION_SNR)
1383         config.allocation_method = SBC_ALLOCATION_SNR;
1384
1385     config.min_bitpool = (uint8_t) PA_MAX(MIN_BITPOOL, cap->min_bitpool);
1386     config.max_bitpool = (uint8_t) PA_MIN(a2dp_default_bitpool(config.frequency, config.channel_mode), cap->max_bitpool);
1387
1388     if (config.min_bitpool > config.max_bitpool)
1389         goto fail;
1390
1391     pa_assert_se(r = dbus_message_new_method_return(m));
1392     pa_assert_se(dbus_message_append_args(r, DBUS_TYPE_ARRAY, DBUS_TYPE_BYTE, &pconf, size, DBUS_TYPE_INVALID));
1393
1394     return r;
1395
1396 fail:
1397     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to select configuration"));
1398     return r;
1399 }
1400
1401 static DBusMessage *endpoint_clear_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1402     pa_bluetooth_discovery *y = userdata;
1403     pa_bluetooth_transport *t;
1404     DBusMessage *r;
1405     DBusError err;
1406     const char *path;
1407
1408     dbus_error_init(&err);
1409
1410     if (!dbus_message_get_args(m, &err, DBUS_TYPE_OBJECT_PATH, &path, DBUS_TYPE_INVALID)) {
1411         pa_log_error("Endpoint ClearConfiguration(): %s", err.message);
1412         dbus_error_free(&err);
1413         goto fail;
1414     }
1415
1416     if ((t = pa_hashmap_get(y->transports, path))) {
1417         pa_log_debug("Clearing transport %s profile %s", t->path, pa_bluetooth_profile_to_string(t->profile));
1418         transport_state_changed(t, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED);
1419         pa_bluetooth_transport_free(t);
1420     }
1421
1422     pa_assert_se(r = dbus_message_new_method_return(m));
1423
1424     return r;
1425
1426 fail:
1427     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to clear configuration"));
1428     return r;
1429 }
1430
1431 static DBusMessage *endpoint_release(DBusConnection *conn, DBusMessage *m, void *userdata) {
1432     DBusMessage *r;
1433
1434     pa_assert_se(r = dbus_message_new_error(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE ".Error.NotImplemented",
1435                                             "Method not implemented"));
1436
1437     return r;
1438 }
1439
1440 static DBusHandlerResult endpoint_handler(DBusConnection *c, DBusMessage *m, void *userdata) {
1441     struct pa_bluetooth_discovery *y = userdata;
1442     DBusMessage *r = NULL;
1443     const char *path, *interface, *member;
1444
1445     pa_assert(y);
1446
1447     path = dbus_message_get_path(m);
1448     interface = dbus_message_get_interface(m);
1449     member = dbus_message_get_member(m);
1450
1451     pa_log_debug("dbus: path=%s, interface=%s, member=%s", path, interface, member);
1452
1453     if (!pa_streq(path, A2DP_SOURCE_ENDPOINT) && !pa_streq(path, A2DP_SINK_ENDPOINT))
1454         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1455
1456     if (dbus_message_is_method_call(m, "org.freedesktop.DBus.Introspectable", "Introspect")) {
1457         const char *xml = ENDPOINT_INTROSPECT_XML;
1458
1459         pa_assert_se(r = dbus_message_new_method_return(m));
1460         pa_assert_se(dbus_message_append_args(r, DBUS_TYPE_STRING, &xml, DBUS_TYPE_INVALID));
1461
1462     } else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "SetConfiguration"))
1463         r = endpoint_set_configuration(c, m, userdata);
1464     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "SelectConfiguration"))
1465         r = endpoint_select_configuration(c, m, userdata);
1466     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "ClearConfiguration"))
1467         r = endpoint_clear_configuration(c, m, userdata);
1468     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "Release"))
1469         r = endpoint_release(c, m, userdata);
1470     else
1471         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1472
1473     if (r) {
1474         pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y->connection), r, NULL));
1475         dbus_message_unref(r);
1476     }
1477
1478     return DBUS_HANDLER_RESULT_HANDLED;
1479 }
1480
1481 static void endpoint_init(pa_bluetooth_discovery *y, pa_bluetooth_profile_t profile) {
1482     static const DBusObjectPathVTable vtable_endpoint = {
1483         .message_function = endpoint_handler,
1484     };
1485
1486     pa_assert(y);
1487
1488     switch(profile) {
1489         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1490             pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y->connection), A2DP_SOURCE_ENDPOINT,
1491                                                               &vtable_endpoint, y));
1492             break;
1493         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1494             pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y->connection), A2DP_SINK_ENDPOINT,
1495                                                               &vtable_endpoint, y));
1496             break;
1497         default:
1498             pa_assert_not_reached();
1499             break;
1500     }
1501 }
1502
1503 static void endpoint_done(pa_bluetooth_discovery *y, pa_bluetooth_profile_t profile) {
1504     pa_assert(y);
1505
1506     switch(profile) {
1507         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1508             dbus_connection_unregister_object_path(pa_dbus_connection_get(y->connection), A2DP_SOURCE_ENDPOINT);
1509             break;
1510         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1511             dbus_connection_unregister_object_path(pa_dbus_connection_get(y->connection), A2DP_SINK_ENDPOINT);
1512             break;
1513         default:
1514             pa_assert_not_reached();
1515             break;
1516     }
1517 }
1518
1519 pa_bluetooth_discovery* pa_bluetooth_discovery_get(pa_core *c) {
1520     pa_bluetooth_discovery *y;
1521     DBusError err;
1522     DBusConnection *conn;
1523     unsigned i;
1524
1525     y = pa_xnew0(pa_bluetooth_discovery, 1);
1526     PA_REFCNT_INIT(y);
1527     y->core = c;
1528     y->adapters = pa_hashmap_new_full(pa_idxset_string_hash_func, pa_idxset_string_compare_func, NULL,
1529                                       (pa_free_cb_t) adapter_free);
1530     y->devices = pa_hashmap_new(pa_idxset_string_hash_func, pa_idxset_string_compare_func);
1531     y->transports = pa_hashmap_new(pa_idxset_string_hash_func, pa_idxset_string_compare_func);
1532     PA_LLIST_HEAD_INIT(pa_dbus_pending, y->pending);
1533
1534     for (i = 0; i < PA_BLUETOOTH_HOOK_MAX; i++)
1535         pa_hook_init(&y->hooks[i], y);
1536
1537     pa_shared_set(c, "bluetooth-discovery", y);
1538
1539     dbus_error_init(&err);
1540
1541     if (!(y->connection = pa_dbus_bus_get(y->core, DBUS_BUS_SYSTEM, &err))) {
1542         pa_log_error("Failed to get D-Bus connection: %s", err.message);
1543         goto fail;
1544     }
1545
1546     conn = pa_dbus_connection_get(y->connection);
1547
1548     /* dynamic detection of bluetooth audio devices */
1549     if (!dbus_connection_add_filter(conn, filter_cb, y, NULL)) {
1550         pa_log_error("Failed to add filter function");
1551         goto fail;
1552     }
1553     y->filter_added = true;
1554
1555     if (pa_dbus_add_matches(conn, &err,
1556             "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged'"
1557             ",arg0='" BLUEZ_SERVICE "'",
1558             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',member='InterfacesAdded'",
1559             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1560             "member='InterfacesRemoved'",
1561             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',member='PropertiesChanged'"
1562             ",arg0='" BLUEZ_ADAPTER_INTERFACE "'",
1563             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',member='PropertiesChanged'"
1564             ",arg0='" BLUEZ_DEVICE_INTERFACE "'",
1565             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',member='PropertiesChanged'"
1566             ",arg0='" BLUEZ_MEDIA_TRANSPORT_INTERFACE "'",
1567             NULL) < 0) {
1568         pa_log_error("Failed to add D-Bus matches: %s", err.message);
1569         goto fail;
1570     }
1571     y->matches_added = true;
1572
1573     endpoint_init(y, PA_BLUETOOTH_PROFILE_A2DP_SINK);
1574     endpoint_init(y, PA_BLUETOOTH_PROFILE_A2DP_SOURCE);
1575
1576     get_managed_objects(y);
1577
1578     return y;
1579
1580 fail:
1581     pa_bluetooth_discovery_unref(y);
1582     dbus_error_free(&err);
1583
1584     return NULL;
1585 }
1586
1587 pa_bluetooth_discovery* pa_bluetooth_discovery_ref(pa_bluetooth_discovery *y) {
1588     pa_assert(y);
1589     pa_assert(PA_REFCNT_VALUE(y) > 0);
1590
1591     PA_REFCNT_INC(y);
1592
1593     return y;
1594 }
1595
1596 void pa_bluetooth_discovery_unref(pa_bluetooth_discovery *y) {
1597     pa_assert(y);
1598     pa_assert(PA_REFCNT_VALUE(y) > 0);
1599
1600     if (PA_REFCNT_DEC(y) > 0)
1601         return;
1602
1603     pa_dbus_free_pending_list(&y->pending);
1604
1605     if (y->devices) {
1606         device_remove_all(y);
1607         pa_hashmap_free(y->devices);
1608     }
1609
1610     if (y->adapters)
1611         pa_hashmap_free(y->adapters);
1612
1613     if (y->transports) {
1614         pa_assert(pa_hashmap_isempty(y->transports));
1615         pa_hashmap_free(y->transports);
1616     }
1617
1618     if (y->connection) {
1619
1620         if (y->matches_added)
1621             pa_dbus_remove_matches(pa_dbus_connection_get(y->connection),
1622                 "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged',"
1623                 "arg0='" BLUEZ_SERVICE "'",
1624                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1625                 "member='InterfacesAdded'",
1626                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1627                 "member='InterfacesRemoved'",
1628                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',"
1629                 "member='PropertiesChanged',arg0='" BLUEZ_ADAPTER_INTERFACE "'",
1630                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',"
1631                 "member='PropertiesChanged',arg0='" BLUEZ_DEVICE_INTERFACE "'",
1632                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',"
1633                 "member='PropertiesChanged',arg0='" BLUEZ_MEDIA_TRANSPORT_INTERFACE "'",
1634                 NULL);
1635
1636         if (y->filter_added)
1637             dbus_connection_remove_filter(pa_dbus_connection_get(y->connection), filter_cb, y);
1638
1639         endpoint_done(y, PA_BLUETOOTH_PROFILE_A2DP_SINK);
1640         endpoint_done(y, PA_BLUETOOTH_PROFILE_A2DP_SOURCE);
1641
1642         pa_dbus_connection_unref(y->connection);
1643     }
1644
1645     pa_shared_remove(y->core, "bluetooth-discovery");
1646     pa_xfree(y);
1647 }