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

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