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 pa_bluetooth_device* device_create(pa_bluetooth_discovery *y, const char *path) {
 292     pa_bluetooth_device *d;
 293
 294     pa_assert(y);
 295     pa_assert(path);
 296
 297     d = pa_xnew0(pa_bluetooth_device, 1);
 298     d->discovery = y;
 299     d->path = pa_xstrdup(path);
 300     d->uuids = pa_hashmap_new_full(pa_idxset_string_hash_func, pa_idxset_string_compare_func, NULL, pa_xfree);
 301
 302     pa_hashmap_put(y->devices, d->path, d);
 303
 304     return d;
 305 }
 306
 307 pa_bluetooth_device* pa_bluetooth_discovery_get_device_by_path(pa_bluetooth_discovery *y, const char *path) {
 308     pa_bluetooth_device *d;
 309
 310     pa_assert(y);
 311     pa_assert(PA_REFCNT_VALUE(y) > 0);
 312     pa_assert(path);
 313
 314     if ((d = pa_hashmap_get(y->devices, path)))
 315         if (d->device_info_valid == 1)
 316             return d;
 317
 318     return NULL;
 319 }
 320
 321 pa_bluetooth_device* pa_bluetooth_discovery_get_device_by_address(pa_bluetooth_discovery *y, const char *remote, const char *local) {
 322     pa_bluetooth_device *d;
 323     void *state = NULL;
 324
 325     pa_assert(y);
 326     pa_assert(PA_REFCNT_VALUE(y) > 0);
 327     pa_assert(remote);
 328     pa_assert(local);
 329
 330     while ((d = pa_hashmap_iterate(y->devices, &state, NULL)))
 331         if (pa_streq(d->address, remote) && pa_streq(d->adapter->address, local))
 332             return d->device_info_valid == 1 ? d : NULL;
 333
 334     return NULL;
 335 }
 336
 337 static void device_free(pa_bluetooth_device *d) {
 338     unsigned i;
 339
 340     pa_assert(d);
 341
 342     for (i = 0; i < PA_BLUETOOTH_PROFILE_COUNT; i++) {
 343         pa_bluetooth_transport *t;
 344
 345         if (!(t = d->transports[i]))
 346             continue;
 347
 348         transport_state_changed(t, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED);
 349         pa_bluetooth_transport_free(t);
 350     }
 351
 352     if (d->uuids)
 353         pa_hashmap_free(d->uuids);
 354
 355     d->discovery = NULL;
 356     d->adapter = NULL;
 357     pa_xfree(d->path);
 358     pa_xfree(d->alias);
 359     pa_xfree(d->address);
 360     pa_xfree(d);
 361 }
 362
 363 static void device_remove(pa_bluetooth_discovery *y, const char *path) {
 364     pa_bluetooth_device *d;
 365
 366     if (!(d = pa_hashmap_remove(y->devices, path)))
 367         pa_log_warn("Unknown device removed %s", path);
 368     else {
 369         pa_log_debug("Device %s removed", path);
 370         device_free(d);
 371     }
 372 }
 373
 374 static void device_remove_all(pa_bluetooth_discovery *y) {
 375     pa_bluetooth_device *d;
 376
 377     pa_assert(y);
 378
 379     while ((d = pa_hashmap_steal_first(y->devices))) {
 380         d->device_info_valid = -1;
 381         pa_hook_fire(&y->hooks[PA_BLUETOOTH_HOOK_DEVICE_CONNECTION_CHANGED], d);
 382         device_free(d);
 383    }
 384 }
 385
 386 static pa_bluetooth_adapter* adapter_create(pa_bluetooth_discovery *y, const char *path) {
 387     pa_bluetooth_adapter *a;
 388
 389     pa_assert(y);
 390     pa_assert(path);
 391
 392     a = pa_xnew0(pa_bluetooth_adapter, 1);
 393     a->discovery = y;
 394     a->path = pa_xstrdup(path);
 395
 396     pa_hashmap_put(y->adapters, a->path, a);
 397
 398     return a;
 399 }
 400
 401 static void adapter_free(pa_bluetooth_adapter *a) {
 402     pa_bluetooth_device *d;
 403     void *state;
 404
 405     pa_assert(a);
 406     pa_assert(a->discovery);
 407
 408     PA_HASHMAP_FOREACH(d, a->discovery->devices, state)
 409         if (d->adapter == a)
 410             d->adapter = NULL;
 411
 412     pa_xfree(a->path);
 413     pa_xfree(a->address);
 414     pa_xfree(a);
 415 }
 416
 417 static void adapter_remove(pa_bluetooth_discovery *y, const char *path) {
 418     pa_bluetooth_adapter *a;
 419
 420     if (!(a = pa_hashmap_remove(y->adapters, path)))
 421         pa_log_warn("Unknown adapter removed %s", path);
 422     else {
 423         pa_log_debug("Adapter %s removed", path);
 424         adapter_free(a);
 425     }
 426 }
 427
 428 static void adapter_remove_all(pa_bluetooth_discovery *y) {
 429     pa_bluetooth_adapter *a;
 430
 431     pa_assert(y);
 432
 433     /* When this function is called all devices have already been freed */
 434
 435     while ((a = pa_hashmap_steal_first(y->adapters)))
 436         adapter_free(a);
 437 }
 438
 439 static void parse_device_property(pa_bluetooth_device *d, DBusMessageIter *i, bool is_property_change) {
 440     const char *key;
 441     DBusMessageIter variant_i;
 442
 443     pa_assert(d);
 444
 445     key = check_variant_property(i);
 446     if (key == NULL) {
 447         pa_log_error("Received invalid property for device %s", d->path);
 448         return;
 449     }
 450
 451     dbus_message_iter_recurse(i, &variant_i);
 452
 453     switch (dbus_message_iter_get_arg_type(&variant_i)) {
 454
 455         case DBUS_TYPE_STRING: {
 456             const char *value;
 457             dbus_message_iter_get_basic(&variant_i, &value);
 458
 459             if (pa_streq(key, "Alias")) {
 460                 pa_xfree(d->alias);
 461                 d->alias = pa_xstrdup(value);
 462                 pa_log_debug("%s: %s", key, value);
 463             } else if (pa_streq(key, "Address")) {
 464                 if (is_property_change) {
 465                     pa_log_warn("Device property 'Address' expected to be constant but changed for %s, ignoring", d->path);
 466                     return;
 467                 }
 468
 469                 if (d->address) {
 470                     pa_log_warn("Device %s: Received a duplicate 'Address' property, ignoring", d->path);
 471                     return;
 472                 }
 473
 474                 d->address = pa_xstrdup(value);
 475                 pa_log_debug("%s: %s", key, value);
 476             }
 477
 478             break;
 479         }
 480
 481         case DBUS_TYPE_OBJECT_PATH: {
 482             const char *value;
 483             dbus_message_iter_get_basic(&variant_i, &value);
 484
 485             if (pa_streq(key, "Adapter")) {
 486
 487                 if (is_property_change) {
 488                     pa_log_warn("Device property 'Adapter' expected to be constant but changed for %s, ignoring", d->path);
 489                     return;
 490                 }
 491
 492                 if (d->adapter_path) {
 493                     pa_log_warn("Device %s: Received a duplicate 'Adapter' property, ignoring", d->path);
 494                     return;
 495                 }
 496
 497                 d->adapter_path = pa_xstrdup(value);
 498
 499                 d->adapter = pa_hashmap_get(d->discovery->adapters, value);
 500                 if (!d->adapter)
 501                     pa_log_info("Device %s: 'Adapter' property references an unknown adapter %s.", d->path, value);
 502
 503                 pa_log_debug("%s: %s", key, value);
 504             }
 505
 506             break;
 507         }
 508
 509         case DBUS_TYPE_UINT32: {
 510             uint32_t value;
 511             dbus_message_iter_get_basic(&variant_i, &value);
 512
 513             if (pa_streq(key, "Class")) {
 514                 d->class_of_device = value;
 515                 pa_log_debug("%s: %d", key, value);
 516             }
 517
 518             break;
 519         }
 520
 521         case DBUS_TYPE_ARRAY: {
 522             DBusMessageIter ai;
 523             dbus_message_iter_recurse(&variant_i, &ai);
 524
 525             if (dbus_message_iter_get_arg_type(&ai) == DBUS_TYPE_STRING && pa_streq(key, "UUIDs")) {
 526                 /* bluetoothd never removes UUIDs from a device object so there
 527                  * is no need to handle it here. */
 528                 while (dbus_message_iter_get_arg_type(&ai) != DBUS_TYPE_INVALID) {
 529                     const char *value;
 530                     char *uuid;
 531
 532                     dbus_message_iter_get_basic(&ai, &value);
 533
 534                     if (pa_hashmap_get(d->uuids, value)) {
 535                         dbus_message_iter_next(&ai);
 536                         continue;
 537                     }
 538
 539                     uuid = pa_xstrdup(value);
 540                     pa_hashmap_put(d->uuids, uuid, uuid);
 541
 542                     pa_log_debug("%s: %s", key, value);
 543                     dbus_message_iter_next(&ai);
 544                 }
 545             }
 546
 547             break;
 548         }
 549     }
 550 }
 551
 552 static int parse_device_properties(pa_bluetooth_device *d, DBusMessageIter *i, bool is_property_change) {
 553     DBusMessageIter element_i;
 554     int ret = 0;
 555
 556     dbus_message_iter_recurse(i, &element_i);
 557
 558     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 559         DBusMessageIter dict_i;
 560
 561         dbus_message_iter_recurse(&element_i, &dict_i);
 562         parse_device_property(d, &dict_i, is_property_change);
 563         dbus_message_iter_next(&element_i);
 564     }
 565
 566     if (!d->address || !d->adapter_path || !d->alias) {
 567         pa_log_error("Non-optional information missing for device %s", d->path);
 568         d->device_info_valid = -1;
 569         return -1;
 570     }
 571
 572     d->device_info_valid = 1;
 573     return ret;
 574 }
 575
 576 static void parse_adapter_properties(pa_bluetooth_adapter *a, DBusMessageIter *i, bool is_property_change) {
 577     DBusMessageIter element_i;
 578
 579     pa_assert(a);
 580
 581     dbus_message_iter_recurse(i, &element_i);
 582
 583     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 584         DBusMessageIter dict_i, variant_i;
 585         const char *key;
 586
 587         dbus_message_iter_recurse(&element_i, &dict_i);
 588
 589         key = check_variant_property(&dict_i);
 590         if (key == NULL) {
 591             pa_log_error("Received invalid property for adapter %s", a->path);
 592             return;
 593         }
 594
 595         dbus_message_iter_recurse(&dict_i, &variant_i);
 596
 597         if (dbus_message_iter_get_arg_type(&variant_i) == DBUS_TYPE_STRING && pa_streq(key, "Address")) {
 598             char *value;
 599
 600             if (is_property_change) {
 601                 pa_log_warn("Adapter property 'Address' expected to be constant but changed for %s, ignoring", a->path);
 602                 return;
 603             }
 604
 605             if (a->address) {
 606                 pa_log_warn("Adapter %s received a duplicate 'Address' property, ignoring", a->path);
 607                 return;
 608             }
 609
 610             dbus_message_iter_get_basic(&variant_i, &value);
 611             a->address = pa_xstrdup(value);
 612         }
 613
 614         dbus_message_iter_next(&element_i);
 615     }
 616 }
 617
 618 static void register_endpoint_reply(DBusPendingCall *pending, void *userdata) {
 619     DBusMessage *r;
 620     pa_dbus_pending *p;
 621     pa_bluetooth_discovery *y;
 622     char *endpoint;
 623
 624     pa_assert(pending);
 625     pa_assert_se(p = userdata);
 626     pa_assert_se(y = p->context_data);
 627     pa_assert_se(endpoint = p->call_data);
 628     pa_assert_se(r = dbus_pending_call_steal_reply(pending));
 629
 630     if (dbus_message_is_error(r, BLUEZ_ERROR_NOT_SUPPORTED)) {
 631         pa_log_info("Couldn't register endpoint %s because it is disabled in BlueZ", endpoint);
 632         goto finish;
 633     }
 634
 635     if (dbus_message_get_type(r) == DBUS_MESSAGE_TYPE_ERROR) {
 636         pa_log_error(BLUEZ_MEDIA_INTERFACE ".RegisterEndpoint() failed: %s: %s", dbus_message_get_error_name(r),
 637                      pa_dbus_get_error_message(r));
 638         goto finish;
 639     }
 640
 641 finish:
 642     dbus_message_unref(r);
 643
 644     PA_LLIST_REMOVE(pa_dbus_pending, y->pending, p);
 645     pa_dbus_pending_free(p);
 646
 647     pa_xfree(endpoint);
 648 }
 649
 650 static void register_endpoint(pa_bluetooth_discovery *y, const char *path, const char *endpoint, const char *uuid) {
 651     DBusMessage *m;
 652     DBusMessageIter i, d;
 653     uint8_t codec = 0;
 654
 655     pa_log_debug("Registering %s on adapter %s", endpoint, path);
 656
 657     pa_assert_se(m = dbus_message_new_method_call(BLUEZ_SERVICE, path, BLUEZ_MEDIA_INTERFACE, "RegisterEndpoint"));
 658
 659     dbus_message_iter_init_append(m, &i);
 660     dbus_message_iter_append_basic(&i, DBUS_TYPE_OBJECT_PATH, &endpoint);
 661     dbus_message_iter_open_container(&i, DBUS_TYPE_ARRAY, DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING DBUS_TYPE_STRING_AS_STRING
 662                                          DBUS_TYPE_VARIANT_AS_STRING DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &d);
 663     pa_dbus_append_basic_variant_dict_entry(&d, "UUID", DBUS_TYPE_STRING, &uuid);
 664     pa_dbus_append_basic_variant_dict_entry(&d, "Codec", DBUS_TYPE_BYTE, &codec);
 665
 666     if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SOURCE) || pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SINK)) {
 667         a2dp_sbc_t capabilities;
 668
 669         capabilities.channel_mode = SBC_CHANNEL_MODE_MONO | SBC_CHANNEL_MODE_DUAL_CHANNEL | SBC_CHANNEL_MODE_STEREO |
 670                                     SBC_CHANNEL_MODE_JOINT_STEREO;
 671         capabilities.frequency = SBC_SAMPLING_FREQ_16000 | SBC_SAMPLING_FREQ_32000 | SBC_SAMPLING_FREQ_44100 |
 672                                  SBC_SAMPLING_FREQ_48000;
 673         capabilities.allocation_method = SBC_ALLOCATION_SNR | SBC_ALLOCATION_LOUDNESS;
 674         capabilities.subbands = SBC_SUBBANDS_4 | SBC_SUBBANDS_8;
 675         capabilities.block_length = SBC_BLOCK_LENGTH_4 | SBC_BLOCK_LENGTH_8 | SBC_BLOCK_LENGTH_12 | SBC_BLOCK_LENGTH_16;
 676         capabilities.min_bitpool = MIN_BITPOOL;
 677         capabilities.max_bitpool = MAX_BITPOOL;
 678
 679         pa_dbus_append_basic_array_variant_dict_entry(&d, "Capabilities", DBUS_TYPE_BYTE, &capabilities, sizeof(capabilities));
 680     }
 681
 682     dbus_message_iter_close_container(&i, &d);
 683
 684     send_and_add_to_pending(y, m, register_endpoint_reply, pa_xstrdup(endpoint));
 685 }
 686
 687 static void parse_interfaces_and_properties(pa_bluetooth_discovery *y, DBusMessageIter *dict_i) {
 688     DBusMessageIter element_i;
 689     const char *path;
 690     void *state;
 691     pa_bluetooth_device *d;
 692
 693     pa_assert(dbus_message_iter_get_arg_type(dict_i) == DBUS_TYPE_OBJECT_PATH);
 694     dbus_message_iter_get_basic(dict_i, &path);
 695
 696     pa_assert_se(dbus_message_iter_next(dict_i));
 697     pa_assert(dbus_message_iter_get_arg_type(dict_i) == DBUS_TYPE_ARRAY);
 698
 699     dbus_message_iter_recurse(dict_i, &element_i);
 700
 701     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 702         DBusMessageIter iface_i;
 703         const char *interface;
 704
 705         dbus_message_iter_recurse(&element_i, &iface_i);
 706
 707         pa_assert(dbus_message_iter_get_arg_type(&iface_i) == DBUS_TYPE_STRING);
 708         dbus_message_iter_get_basic(&iface_i, &interface);
 709
 710         pa_assert_se(dbus_message_iter_next(&iface_i));
 711         pa_assert(dbus_message_iter_get_arg_type(&iface_i) == DBUS_TYPE_ARRAY);
 712
 713         if (pa_streq(interface, BLUEZ_ADAPTER_INTERFACE)) {
 714             pa_bluetooth_adapter *a;
 715
 716             if ((a = pa_hashmap_get(y->adapters, path))) {
 717                 pa_log_error("Found duplicated D-Bus path for device %s", path);
 718                 return;
 719             } else
 720                 a = adapter_create(y, path);
 721
 722             pa_log_debug("Adapter %s found", path);
 723
 724             parse_adapter_properties(a, &iface_i, false);
 725             if (!a->address)
 726                 return;
 727
 728             register_endpoint(y, path, A2DP_SOURCE_ENDPOINT, PA_BLUETOOTH_UUID_A2DP_SOURCE);
 729             register_endpoint(y, path, A2DP_SINK_ENDPOINT, PA_BLUETOOTH_UUID_A2DP_SINK);
 730
 731         } else if (pa_streq(interface, BLUEZ_DEVICE_INTERFACE)) {
 732
 733             if ((d = pa_hashmap_get(y->devices, path))) {
 734                 if (d->device_info_valid != 0) {
 735                     pa_log_error("Found duplicated D-Bus path for device %s", path);
 736                     return;
 737                 }
 738             } else
 739                 d = device_create(y, path);
 740
 741             pa_log_debug("Device %s found", d->path);
 742
 743             parse_device_properties(d, &iface_i, false);
 744
 745         } else
 746             pa_log_debug("Unknown interface %s found, skipping", interface);
 747
 748         dbus_message_iter_next(&element_i);
 749     }
 750
 751     PA_HASHMAP_FOREACH(d, y->devices, state)
 752         if (!d->adapter && d->adapter_path) {
 753             d->adapter = pa_hashmap_get(d->discovery->adapters, d->adapter_path);
 754             if (!d->adapter) {
 755                 pa_log_error("Device %s is child of nonexistent adapter %s", d->path, d->adapter_path);
 756                 d->device_info_valid = -1;
 757             }
 758         }
 759
 760     return;
 761 }
 762
 763 static void get_managed_objects_reply(DBusPendingCall *pending, void *userdata) {
 764     pa_dbus_pending *p;
 765     pa_bluetooth_discovery *y;
 766     DBusMessage *r;
 767     DBusMessageIter arg_i, element_i;
 768
 769     pa_assert_se(p = userdata);
 770     pa_assert_se(y = p->context_data);
 771     pa_assert_se(r = dbus_pending_call_steal_reply(pending));
 772
 773     if (dbus_message_is_error(r, DBUS_ERROR_UNKNOWN_METHOD)) {
 774         pa_log_warn("BlueZ D-Bus ObjectManager not available");
 775         goto finish;
 776     }
 777
 778     if (dbus_message_get_type(r) == DBUS_MESSAGE_TYPE_ERROR) {
 779         pa_log_error("GetManagedObjects() failed: %s: %s", dbus_message_get_error_name(r), pa_dbus_get_error_message(r));
 780         goto finish;
 781     }
 782
 783     if (!dbus_message_iter_init(r, &arg_i) || !pa_streq(dbus_message_get_signature(r), "a{oa{sa{sv}}}")) {
 784         pa_log_error("Invalid reply signature for GetManagedObjects()");
 785         goto finish;
 786     }
 787
 788     dbus_message_iter_recurse(&arg_i, &element_i);
 789     while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
 790         DBusMessageIter dict_i;
 791
 792         dbus_message_iter_recurse(&element_i, &dict_i);
 793
 794         parse_interfaces_and_properties(y, &dict_i);
 795
 796         dbus_message_iter_next(&element_i);
 797     }
 798
 799     y->objects_listed = true;
 800
 801 finish:
 802     dbus_message_unref(r);
 803
 804     PA_LLIST_REMOVE(pa_dbus_pending, y->pending, p);
 805     pa_dbus_pending_free(p);
 806 }
 807
 808 static void get_managed_objects(pa_bluetooth_discovery *y) {
 809     DBusMessage *m;
 810
 811     pa_assert(y);
 812
 813     pa_assert_se(m = dbus_message_new_method_call(BLUEZ_SERVICE, "/", "org.freedesktop.DBus.ObjectManager",
 814                                                   "GetManagedObjects"));
 815     send_and_add_to_pending(y, m, get_managed_objects_reply, NULL);
 816 }
 817
 818 pa_hook* pa_bluetooth_discovery_hook(pa_bluetooth_discovery *y, pa_bluetooth_hook_t hook) {
 819     pa_assert(y);
 820     pa_assert(PA_REFCNT_VALUE(y) > 0);
 821
 822     return &y->hooks[hook];
 823 }
 824
 825 static DBusHandlerResult filter_cb(DBusConnection *bus, DBusMessage *m, void *userdata) {
 826     pa_bluetooth_discovery *y;
 827     DBusError err;
 828
 829     pa_assert(bus);
 830     pa_assert(m);
 831     pa_assert_se(y = userdata);
 832
 833     dbus_error_init(&err);
 834
 835     if (dbus_message_is_signal(m, "org.freedesktop.DBus", "NameOwnerChanged")) {
 836         const char *name, *old_owner, *new_owner;
 837
 838         if (!dbus_message_get_args(m, &err,
 839                                    DBUS_TYPE_STRING, &name,
 840                                    DBUS_TYPE_STRING, &old_owner,
 841                                    DBUS_TYPE_STRING, &new_owner,
 842                                    DBUS_TYPE_INVALID)) {
 843             pa_log_error("Failed to parse org.freedesktop.DBus.NameOwnerChanged: %s", err.message);
 844             goto fail;
 845         }
 846
 847         if (pa_streq(name, BLUEZ_SERVICE)) {
 848             if (old_owner && *old_owner) {
 849                 pa_log_debug("Bluetooth daemon disappeared");
 850                 device_remove_all(y);
 851                 adapter_remove_all(y);
 852                 y->objects_listed = false;
 853             }
 854
 855             if (new_owner && *new_owner) {
 856                 pa_log_debug("Bluetooth daemon appeared");
 857                 get_managed_objects(y);
 858             }
 859         }
 860
 861         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 862     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.ObjectManager", "InterfacesAdded")) {
 863         DBusMessageIter arg_i;
 864
 865         if (!y->objects_listed)
 866             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 867
 868         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "oa{sa{sv}}")) {
 869             pa_log_error("Invalid signature found in InterfacesAdded");
 870             goto fail;
 871         }
 872
 873         parse_interfaces_and_properties(y, &arg_i);
 874
 875         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 876     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.ObjectManager", "InterfacesRemoved")) {
 877         const char *p;
 878         DBusMessageIter arg_i;
 879         DBusMessageIter element_i;
 880
 881         if (!y->objects_listed)
 882             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 883
 884         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "oas")) {
 885             pa_log_error("Invalid signature found in InterfacesRemoved");
 886             goto fail;
 887         }
 888
 889         dbus_message_iter_get_basic(&arg_i, &p);
 890
 891         pa_assert_se(dbus_message_iter_next(&arg_i));
 892         pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_ARRAY);
 893
 894         dbus_message_iter_recurse(&arg_i, &element_i);
 895
 896         while (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_STRING) {
 897             const char *iface;
 898
 899             dbus_message_iter_get_basic(&element_i, &iface);
 900
 901             if (pa_streq(iface, BLUEZ_DEVICE_INTERFACE))
 902                 device_remove(y, p);
 903             else if (pa_streq(iface, BLUEZ_ADAPTER_INTERFACE))
 904                 adapter_remove(y, p);
 905
 906             dbus_message_iter_next(&element_i);
 907         }
 908
 909         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 910
 911     } else if (dbus_message_is_signal(m, "org.freedesktop.DBus.Properties", "PropertiesChanged")) {
 912         DBusMessageIter arg_i;
 913         const char *iface;
 914
 915         if (!y->objects_listed)
 916             return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; /* No reply received yet from GetManagedObjects */
 917
 918         if (!dbus_message_iter_init(m, &arg_i) || !pa_streq(dbus_message_get_signature(m), "sa{sv}as")) {
 919             pa_log_error("Invalid signature found in PropertiesChanged");
 920             goto fail;
 921         }
 922
 923         dbus_message_iter_get_basic(&arg_i, &iface);
 924
 925         pa_assert_se(dbus_message_iter_next(&arg_i));
 926         pa_assert(dbus_message_iter_get_arg_type(&arg_i) == DBUS_TYPE_ARRAY);
 927
 928         if (pa_streq(iface, BLUEZ_ADAPTER_INTERFACE)) {
 929             pa_bluetooth_adapter *a;
 930
 931             pa_log_debug("Properties changed in adapter %s", dbus_message_get_path(m));
 932
 933             if (!(a = pa_hashmap_get(y->adapters, dbus_message_get_path(m)))) {
 934                 pa_log_warn("Properties changed in unknown adapter");
 935                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 936             }
 937
 938             parse_adapter_properties(a, &arg_i, true);
 939
 940         } else if (pa_streq(iface, BLUEZ_DEVICE_INTERFACE)) {
 941             pa_bluetooth_device *d;
 942
 943             pa_log_debug("Properties changed in device %s", dbus_message_get_path(m));
 944
 945             if (!(d = pa_hashmap_get(y->devices, dbus_message_get_path(m)))) {
 946                 pa_log_warn("Properties changed in unknown device");
 947                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 948             }
 949
 950             if (d->device_info_valid != 1) {
 951                 pa_log_warn("Properties changed in a device which information is unknown or invalid");
 952                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 953             }
 954
 955             parse_device_properties(d, &arg_i, true);
 956         }
 957
 958         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 959     }
 960
 961 fail:
 962     dbus_error_free(&err);
 963
 964     return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 965 }
 966
 967 static uint8_t a2dp_default_bitpool(uint8_t freq, uint8_t mode) {
 968     /* These bitpool values were chosen based on the A2DP spec recommendation */
 969     switch (freq) {
 970         case SBC_SAMPLING_FREQ_16000:
 971         case SBC_SAMPLING_FREQ_32000:
 972             return 53;
 973
 974         case SBC_SAMPLING_FREQ_44100:
 975
 976             switch (mode) {
 977                 case SBC_CHANNEL_MODE_MONO:
 978                 case SBC_CHANNEL_MODE_DUAL_CHANNEL:
 979                     return 31;
 980
 981                 case SBC_CHANNEL_MODE_STEREO:
 982                 case SBC_CHANNEL_MODE_JOINT_STEREO:
 983                     return 53;
 984             }
 985
 986             pa_log_warn("Invalid channel mode %u", mode);
 987             return 53;
 988
 989         case SBC_SAMPLING_FREQ_48000:
 990
 991             switch (mode) {
 992                 case SBC_CHANNEL_MODE_MONO:
 993                 case SBC_CHANNEL_MODE_DUAL_CHANNEL:
 994                     return 29;
 995
 996                 case SBC_CHANNEL_MODE_STEREO:
 997                 case SBC_CHANNEL_MODE_JOINT_STEREO:
 998                     return 51;
 999             }
1000
1001             pa_log_warn("Invalid channel mode %u", mode);
1002             return 51;
1003     }
1004
1005     pa_log_warn("Invalid sampling freq %u", freq);
1006     return 53;
1007 }
1008
1009 const char *pa_bluetooth_profile_to_string(pa_bluetooth_profile_t profile) {
1010     switch(profile) {
1011         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1012             return "a2dp_sink";
1013         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1014             return "a2dp_source";
1015         case PA_BLUETOOTH_PROFILE_OFF:
1016             return "off";
1017     }
1018
1019     return NULL;
1020 }
1021
1022 static DBusMessage *endpoint_set_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1023     pa_bluetooth_discovery *y = userdata;
1024     pa_bluetooth_device *d;
1025     pa_bluetooth_transport *t;
1026     const char *sender, *path, *endpoint_path, *dev_path = NULL, *uuid = NULL;
1027     const uint8_t *config = NULL;
1028     int size = 0;
1029     pa_bluetooth_profile_t p = PA_BLUETOOTH_PROFILE_OFF;
1030     DBusMessageIter args, props;
1031     DBusMessage *r;
1032
1033     if (!dbus_message_iter_init(m, &args) || !pa_streq(dbus_message_get_signature(m), "oa{sv}")) {
1034         pa_log_error("Invalid signature for method SetConfiguration()");
1035         goto fail2;
1036     }
1037
1038     dbus_message_iter_get_basic(&args, &path);
1039
1040     if (pa_hashmap_get(y->transports, path)) {
1041         pa_log_error("Endpoint SetConfiguration(): Transport %s is already configured.", path);
1042         goto fail2;
1043     }
1044
1045     pa_assert_se(dbus_message_iter_next(&args));
1046
1047     dbus_message_iter_recurse(&args, &props);
1048     if (dbus_message_iter_get_arg_type(&props) != DBUS_TYPE_DICT_ENTRY)
1049         goto fail;
1050
1051     /* Read transport properties */
1052     while (dbus_message_iter_get_arg_type(&props) == DBUS_TYPE_DICT_ENTRY) {
1053         const char *key;
1054         DBusMessageIter value, entry;
1055         int var;
1056
1057         dbus_message_iter_recurse(&props, &entry);
1058         dbus_message_iter_get_basic(&entry, &key);
1059
1060         dbus_message_iter_next(&entry);
1061         dbus_message_iter_recurse(&entry, &value);
1062
1063         var = dbus_message_iter_get_arg_type(&value);
1064
1065         if (pa_streq(key, "UUID")) {
1066             if (var != DBUS_TYPE_STRING) {
1067                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1068                 goto fail;
1069             }
1070
1071             dbus_message_iter_get_basic(&value, &uuid);
1072
1073             endpoint_path = dbus_message_get_path(m);
1074             if (pa_streq(endpoint_path, A2DP_SOURCE_ENDPOINT)) {
1075                 if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SOURCE))
1076                     p = PA_BLUETOOTH_PROFILE_A2DP_SINK;
1077             } else if (pa_streq(endpoint_path, A2DP_SINK_ENDPOINT)) {
1078                 if (pa_streq(uuid, PA_BLUETOOTH_UUID_A2DP_SINK))
1079                     p = PA_BLUETOOTH_PROFILE_A2DP_SOURCE;
1080             }
1081
1082             if (p == PA_BLUETOOTH_PROFILE_OFF) {
1083                 pa_log_error("UUID %s of transport %s incompatible with endpoint %s", uuid, path, endpoint_path);
1084                 goto fail;
1085             }
1086         } else if (pa_streq(key, "Device")) {
1087             if (var != DBUS_TYPE_OBJECT_PATH) {
1088                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1089                 goto fail;
1090             }
1091
1092             dbus_message_iter_get_basic(&value, &dev_path);
1093         } else if (pa_streq(key, "Configuration")) {
1094             DBusMessageIter array;
1095             a2dp_sbc_t *c;
1096
1097             if (var != DBUS_TYPE_ARRAY) {
1098                 pa_log_error("Property %s of wrong type %c", key, (char)var);
1099                 goto fail;
1100             }
1101
1102             dbus_message_iter_recurse(&value, &array);
1103             var = dbus_message_iter_get_arg_type(&array);
1104             if (var != DBUS_TYPE_BYTE) {
1105                 pa_log_error("%s is an array of wrong type %c", key, (char)var);
1106                 goto fail;
1107             }
1108
1109             dbus_message_iter_get_fixed_array(&array, &config, &size);
1110             if (size != sizeof(a2dp_sbc_t)) {
1111                 pa_log_error("Configuration array of invalid size");
1112                 goto fail;
1113             }
1114
1115             c = (a2dp_sbc_t *) config;
1116
1117             if (c->frequency != SBC_SAMPLING_FREQ_16000 && c->frequency != SBC_SAMPLING_FREQ_32000 &&
1118                 c->frequency != SBC_SAMPLING_FREQ_44100 && c->frequency != SBC_SAMPLING_FREQ_48000) {
1119                 pa_log_error("Invalid sampling frequency in configuration");
1120                 goto fail;
1121             }
1122
1123             if (c->channel_mode != SBC_CHANNEL_MODE_MONO && c->channel_mode != SBC_CHANNEL_MODE_DUAL_CHANNEL &&
1124                 c->channel_mode != SBC_CHANNEL_MODE_STEREO && c->channel_mode != SBC_CHANNEL_MODE_JOINT_STEREO) {
1125                 pa_log_error("Invalid channel mode in configuration");
1126                 goto fail;
1127             }
1128
1129             if (c->allocation_method != SBC_ALLOCATION_SNR && c->allocation_method != SBC_ALLOCATION_LOUDNESS) {
1130                 pa_log_error("Invalid allocation method in configuration");
1131                 goto fail;
1132             }
1133
1134             if (c->subbands != SBC_SUBBANDS_4 && c->subbands != SBC_SUBBANDS_8) {
1135                 pa_log_error("Invalid SBC subbands in configuration");
1136                 goto fail;
1137             }
1138
1139             if (c->block_length != SBC_BLOCK_LENGTH_4 && c->block_length != SBC_BLOCK_LENGTH_8 &&
1140                 c->block_length != SBC_BLOCK_LENGTH_12 && c->block_length != SBC_BLOCK_LENGTH_16) {
1141                 pa_log_error("Invalid block length in configuration");
1142                 goto fail;
1143             }
1144         }
1145
1146         dbus_message_iter_next(&props);
1147     }
1148
1149     if ((d = pa_hashmap_get(y->devices, dev_path))) {
1150         if (d->device_info_valid == -1) {
1151             pa_log_error("Information about device %s is invalid", dev_path);
1152             goto fail2;
1153         }
1154     } else {
1155         /* InterfacesAdded signal is probably on it's way, device_info_valid is kept as 0. */
1156         pa_log_warn("SetConfiguration() received for unknown device %s", dev_path);
1157         d = device_create(y, dev_path);
1158     }
1159
1160     if (d->transports[p] != NULL) {
1161         pa_log_error("Cannot configure transport %s because profile %s is already used", path, pa_bluetooth_profile_to_string(p));
1162         goto fail2;
1163     }
1164
1165     sender = dbus_message_get_sender(m);
1166
1167     pa_assert_se(r = dbus_message_new_method_return(m));
1168     pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y->connection), r, NULL));
1169     dbus_message_unref(r);
1170
1171     d->transports[p] = t = pa_bluetooth_transport_new(d, sender, path, p, config, size);
1172     t->acquire = bluez5_transport_acquire_cb;
1173     t->release = bluez5_transport_release_cb;
1174     pa_bluetooth_transport_put(t);
1175
1176     pa_log_debug("Transport %s available for profile %s", t->path, pa_bluetooth_profile_to_string(t->profile));
1177
1178     return NULL;
1179
1180 fail:
1181     pa_log_error("Endpoint SetConfiguration(): invalid arguments");
1182
1183 fail2:
1184     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to set configuration"));
1185     return r;
1186 }
1187
1188 static DBusMessage *endpoint_select_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1189     pa_bluetooth_discovery *y = userdata;
1190     a2dp_sbc_t *cap, config;
1191     uint8_t *pconf = (uint8_t *) &config;
1192     int i, size;
1193     DBusMessage *r;
1194     DBusError err;
1195
1196     static const struct {
1197         uint32_t rate;
1198         uint8_t cap;
1199     } freq_table[] = {
1200         { 16000U, SBC_SAMPLING_FREQ_16000 },
1201         { 32000U, SBC_SAMPLING_FREQ_32000 },
1202         { 44100U, SBC_SAMPLING_FREQ_44100 },
1203         { 48000U, SBC_SAMPLING_FREQ_48000 }
1204     };
1205
1206     dbus_error_init(&err);
1207
1208     if (!dbus_message_get_args(m, &err, DBUS_TYPE_ARRAY, DBUS_TYPE_BYTE, &cap, &size, DBUS_TYPE_INVALID)) {
1209         pa_log_error("Endpoint SelectConfiguration(): %s", err.message);
1210         dbus_error_free(&err);
1211         goto fail;
1212     }
1213
1214     if (size != sizeof(config)) {
1215         pa_log_error("Capabilities array has invalid size");
1216         goto fail;
1217     }
1218
1219     pa_zero(config);
1220
1221     /* Find the lowest freq that is at least as high as the requested sampling rate */
1222     for (i = 0; (unsigned) i < PA_ELEMENTSOF(freq_table); i++)
1223         if (freq_table[i].rate >= y->core->default_sample_spec.rate && (cap->frequency & freq_table[i].cap)) {
1224             config.frequency = freq_table[i].cap;
1225             break;
1226         }
1227
1228     if ((unsigned) i == PA_ELEMENTSOF(freq_table)) {
1229         for (--i; i >= 0; i--) {
1230             if (cap->frequency & freq_table[i].cap) {
1231                 config.frequency = freq_table[i].cap;
1232                 break;
1233             }
1234         }
1235
1236         if (i < 0) {
1237             pa_log_error("Not suitable sample rate");
1238             goto fail;
1239         }
1240     }
1241
1242     pa_assert((unsigned) i < PA_ELEMENTSOF(freq_table));
1243
1244     if (y->core->default_sample_spec.channels <= 1) {
1245         if (cap->channel_mode & SBC_CHANNEL_MODE_MONO)
1246             config.channel_mode = SBC_CHANNEL_MODE_MONO;
1247         else if (cap->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO)
1248             config.channel_mode = SBC_CHANNEL_MODE_JOINT_STEREO;
1249         else if (cap->channel_mode & SBC_CHANNEL_MODE_STEREO)
1250             config.channel_mode = SBC_CHANNEL_MODE_STEREO;
1251         else if (cap->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL)
1252             config.channel_mode = SBC_CHANNEL_MODE_DUAL_CHANNEL;
1253         else {
1254             pa_log_error("No supported channel modes");
1255             goto fail;
1256         }
1257     }
1258
1259     if (y->core->default_sample_spec.channels >= 2) {
1260         if (cap->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO)
1261             config.channel_mode = SBC_CHANNEL_MODE_JOINT_STEREO;
1262         else if (cap->channel_mode & SBC_CHANNEL_MODE_STEREO)
1263             config.channel_mode = SBC_CHANNEL_MODE_STEREO;
1264         else if (cap->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL)
1265             config.channel_mode = SBC_CHANNEL_MODE_DUAL_CHANNEL;
1266         else if (cap->channel_mode & SBC_CHANNEL_MODE_MONO)
1267             config.channel_mode = SBC_CHANNEL_MODE_MONO;
1268         else {
1269             pa_log_error("No supported channel modes");
1270             goto fail;
1271         }
1272     }
1273
1274     if (cap->block_length & SBC_BLOCK_LENGTH_16)
1275         config.block_length = SBC_BLOCK_LENGTH_16;
1276     else if (cap->block_length & SBC_BLOCK_LENGTH_12)
1277         config.block_length = SBC_BLOCK_LENGTH_12;
1278     else if (cap->block_length & SBC_BLOCK_LENGTH_8)
1279         config.block_length = SBC_BLOCK_LENGTH_8;
1280     else if (cap->block_length & SBC_BLOCK_LENGTH_4)
1281         config.block_length = SBC_BLOCK_LENGTH_4;
1282     else {
1283         pa_log_error("No supported block lengths");
1284         goto fail;
1285     }
1286
1287     if (cap->subbands & SBC_SUBBANDS_8)
1288         config.subbands = SBC_SUBBANDS_8;
1289     else if (cap->subbands & SBC_SUBBANDS_4)
1290         config.subbands = SBC_SUBBANDS_4;
1291     else {
1292         pa_log_error("No supported subbands");
1293         goto fail;
1294     }
1295
1296     if (cap->allocation_method & SBC_ALLOCATION_LOUDNESS)
1297         config.allocation_method = SBC_ALLOCATION_LOUDNESS;
1298     else if (cap->allocation_method & SBC_ALLOCATION_SNR)
1299         config.allocation_method = SBC_ALLOCATION_SNR;
1300
1301     config.min_bitpool = (uint8_t) PA_MAX(MIN_BITPOOL, cap->min_bitpool);
1302     config.max_bitpool = (uint8_t) PA_MIN(a2dp_default_bitpool(config.frequency, config.channel_mode), cap->max_bitpool);
1303
1304     if (config.min_bitpool > config.max_bitpool)
1305         goto fail;
1306
1307     pa_assert_se(r = dbus_message_new_method_return(m));
1308     pa_assert_se(dbus_message_append_args(r, DBUS_TYPE_ARRAY, DBUS_TYPE_BYTE, &pconf, size, DBUS_TYPE_INVALID));
1309
1310     return r;
1311
1312 fail:
1313     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to select configuration"));
1314     return r;
1315 }
1316
1317 static DBusMessage *endpoint_clear_configuration(DBusConnection *conn, DBusMessage *m, void *userdata) {
1318     pa_bluetooth_discovery *y = userdata;
1319     pa_bluetooth_transport *t;
1320     DBusMessage *r;
1321     DBusError err;
1322     const char *path;
1323
1324     dbus_error_init(&err);
1325
1326     if (!dbus_message_get_args(m, &err, DBUS_TYPE_OBJECT_PATH, &path, DBUS_TYPE_INVALID)) {
1327         pa_log_error("Endpoint ClearConfiguration(): %s", err.message);
1328         dbus_error_free(&err);
1329         goto fail;
1330     }
1331
1332     if ((t = pa_hashmap_get(y->transports, path))) {
1333         pa_log_debug("Clearing transport %s profile %s", t->path, pa_bluetooth_profile_to_string(t->profile));
1334         transport_state_changed(t, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED);
1335         pa_bluetooth_transport_free(t);
1336     }
1337
1338     pa_assert_se(r = dbus_message_new_method_return(m));
1339
1340     return r;
1341
1342 fail:
1343     pa_assert_se(r = dbus_message_new_error(m, "org.bluez.Error.InvalidArguments", "Unable to clear configuration"));
1344     return r;
1345 }
1346
1347 static DBusMessage *endpoint_release(DBusConnection *conn, DBusMessage *m, void *userdata) {
1348     DBusMessage *r;
1349
1350     pa_assert_se(r = dbus_message_new_error(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE ".Error.NotImplemented",
1351                                             "Method not implemented"));
1352
1353     return r;
1354 }
1355
1356 static DBusHandlerResult endpoint_handler(DBusConnection *c, DBusMessage *m, void *userdata) {
1357     struct pa_bluetooth_discovery *y = userdata;
1358     DBusMessage *r = NULL;
1359     const char *path, *interface, *member;
1360
1361     pa_assert(y);
1362
1363     path = dbus_message_get_path(m);
1364     interface = dbus_message_get_interface(m);
1365     member = dbus_message_get_member(m);
1366
1367     pa_log_debug("dbus: path=%s, interface=%s, member=%s", path, interface, member);
1368
1369     if (!pa_streq(path, A2DP_SOURCE_ENDPOINT) && !pa_streq(path, A2DP_SINK_ENDPOINT))
1370         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1371
1372     if (dbus_message_is_method_call(m, "org.freedesktop.DBus.Introspectable", "Introspect")) {
1373         const char *xml = ENDPOINT_INTROSPECT_XML;
1374
1375         pa_assert_se(r = dbus_message_new_method_return(m));
1376         pa_assert_se(dbus_message_append_args(r, DBUS_TYPE_STRING, &xml, DBUS_TYPE_INVALID));
1377
1378     } else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "SetConfiguration"))
1379         r = endpoint_set_configuration(c, m, userdata);
1380     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "SelectConfiguration"))
1381         r = endpoint_select_configuration(c, m, userdata);
1382     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "ClearConfiguration"))
1383         r = endpoint_clear_configuration(c, m, userdata);
1384     else if (dbus_message_is_method_call(m, BLUEZ_MEDIA_ENDPOINT_INTERFACE, "Release"))
1385         r = endpoint_release(c, m, userdata);
1386     else
1387         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1388
1389     if (r) {
1390         pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y->connection), r, NULL));
1391         dbus_message_unref(r);
1392     }
1393
1394     return DBUS_HANDLER_RESULT_HANDLED;
1395 }
1396
1397 static void endpoint_init(pa_bluetooth_discovery *y, pa_bluetooth_profile_t profile) {
1398     static const DBusObjectPathVTable vtable_endpoint = {
1399         .message_function = endpoint_handler,
1400     };
1401
1402     pa_assert(y);
1403
1404     switch(profile) {
1405         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1406             pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y->connection), A2DP_SOURCE_ENDPOINT,
1407                                                               &vtable_endpoint, y));
1408             break;
1409         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1410             pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y->connection), A2DP_SINK_ENDPOINT,
1411                                                               &vtable_endpoint, y));
1412             break;
1413         default:
1414             pa_assert_not_reached();
1415             break;
1416     }
1417 }
1418
1419 static void endpoint_done(pa_bluetooth_discovery *y, pa_bluetooth_profile_t profile) {
1420     pa_assert(y);
1421
1422     switch(profile) {
1423         case PA_BLUETOOTH_PROFILE_A2DP_SINK:
1424             dbus_connection_unregister_object_path(pa_dbus_connection_get(y->connection), A2DP_SOURCE_ENDPOINT);
1425             break;
1426         case PA_BLUETOOTH_PROFILE_A2DP_SOURCE:
1427             dbus_connection_unregister_object_path(pa_dbus_connection_get(y->connection), A2DP_SINK_ENDPOINT);
1428             break;
1429         default:
1430             pa_assert_not_reached();
1431             break;
1432     }
1433 }
1434
1435 pa_bluetooth_discovery* pa_bluetooth_discovery_get(pa_core *c) {
1436     pa_bluetooth_discovery *y;
1437     DBusError err;
1438     DBusConnection *conn;
1439     unsigned i;
1440
1441     if ((y = pa_shared_get(c, "bluetooth-discovery")))
1442         return pa_bluetooth_discovery_ref(y);
1443
1444     y = pa_xnew0(pa_bluetooth_discovery, 1);
1445     PA_REFCNT_INIT(y);
1446     y->core = c;
1447     y->adapters = pa_hashmap_new(pa_idxset_string_hash_func, pa_idxset_string_compare_func);
1448     y->devices = pa_hashmap_new(pa_idxset_string_hash_func, pa_idxset_string_compare_func);
1449     y->transports = pa_hashmap_new(pa_idxset_string_hash_func, pa_idxset_string_compare_func);
1450     PA_LLIST_HEAD_INIT(pa_dbus_pending, y->pending);
1451
1452     for (i = 0; i < PA_BLUETOOTH_HOOK_MAX; i++)
1453         pa_hook_init(&y->hooks[i], y);
1454
1455     pa_shared_set(c, "bluetooth-discovery", y);
1456
1457     dbus_error_init(&err);
1458
1459     if (!(y->connection = pa_dbus_bus_get(y->core, DBUS_BUS_SYSTEM, &err))) {
1460         pa_log_error("Failed to get D-Bus connection: %s", err.message);
1461         goto fail;
1462     }
1463
1464     conn = pa_dbus_connection_get(y->connection);
1465
1466     /* dynamic detection of bluetooth audio devices */
1467     if (!dbus_connection_add_filter(conn, filter_cb, y, NULL)) {
1468         pa_log_error("Failed to add filter function");
1469         goto fail;
1470     }
1471     y->filter_added = true;
1472
1473     if (pa_dbus_add_matches(conn, &err,
1474             "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged'"
1475             ",arg0='" BLUEZ_SERVICE "'",
1476             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',member='InterfacesAdded'",
1477             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1478             "member='InterfacesRemoved'",
1479             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',member='PropertiesChanged'"
1480             ",arg0='" BLUEZ_ADAPTER_INTERFACE "'",
1481             "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',member='PropertiesChanged'"
1482             ",arg0='" BLUEZ_DEVICE_INTERFACE "'",
1483             NULL) < 0) {
1484         pa_log_error("Failed to add D-Bus matches: %s", err.message);
1485         goto fail;
1486     }
1487     y->matches_added = true;
1488
1489     endpoint_init(y, PA_BLUETOOTH_PROFILE_A2DP_SINK);
1490     endpoint_init(y, PA_BLUETOOTH_PROFILE_A2DP_SOURCE);
1491
1492     get_managed_objects(y);
1493
1494     return y;
1495
1496 fail:
1497     pa_bluetooth_discovery_unref(y);
1498     dbus_error_free(&err);
1499
1500     return NULL;
1501 }
1502
1503 pa_bluetooth_discovery* pa_bluetooth_discovery_ref(pa_bluetooth_discovery *y) {
1504     pa_assert(y);
1505     pa_assert(PA_REFCNT_VALUE(y) > 0);
1506
1507     PA_REFCNT_INC(y);
1508
1509     return y;
1510 }
1511
1512 void pa_bluetooth_discovery_unref(pa_bluetooth_discovery *y) {
1513     pa_assert(y);
1514     pa_assert(PA_REFCNT_VALUE(y) > 0);
1515
1516     if (PA_REFCNT_DEC(y) > 0)
1517         return;
1518
1519     pa_dbus_free_pending_list(&y->pending);
1520
1521     if (y->devices) {
1522         device_remove_all(y);
1523         pa_hashmap_free(y->devices);
1524     }
1525
1526     if (y->adapters) {
1527         adapter_remove_all(y);
1528         pa_hashmap_free(y->adapters);
1529     }
1530
1531     if (y->transports) {
1532         pa_assert(pa_hashmap_isempty(y->transports));
1533         pa_hashmap_free(y->transports);
1534     }
1535
1536     if (y->connection) {
1537
1538         if (y->matches_added)
1539             pa_dbus_remove_matches(pa_dbus_connection_get(y->connection),
1540                 "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged',"
1541                 "arg0='" BLUEZ_SERVICE "'",
1542                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1543                 "member='InterfacesAdded'",
1544                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.ObjectManager',"
1545                 "member='InterfacesRemoved'",
1546                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',"
1547                 "member='PropertiesChanged',arg0='" BLUEZ_ADAPTER_INTERFACE "'",
1548                 "type='signal',sender='" BLUEZ_SERVICE "',interface='org.freedesktop.DBus.Properties',"
1549                 "member='PropertiesChanged',arg0='" BLUEZ_DEVICE_INTERFACE "'",
1550                 NULL);
1551
1552         if (y->filter_added)
1553             dbus_connection_remove_filter(pa_dbus_connection_get(y->connection), filter_cb, y);
1554
1555         endpoint_done(y, PA_BLUETOOTH_PROFILE_A2DP_SINK);
1556         endpoint_done(y, PA_BLUETOOTH_PROFILE_A2DP_SOURCE);
1557
1558         pa_dbus_connection_unref(y->connection);
1559     }
1560
1561     pa_shared_remove(y->core, "bluetooth-discovery");
1562     pa_xfree(y);
1563 }