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