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