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