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