2 This file is part of PulseAudio.
4 Copyright 2008-2013 João Paulo Rechi Vita
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.
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.
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
26 #include <pulse/xmalloc.h>
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>
36 #include "a2dp-codecs.h"
38 #include "bluez5-util.h"
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_ENDPOINT_INTERFACE BLUEZ_SERVICE ".MediaEndpoint1"
44 #define BLUEZ_MEDIA_TRANSPORT_INTERFACE BLUEZ_SERVICE ".MediaTransport1"
46 #define A2DP_SOURCE_ENDPOINT "/MediaEndpoint/A2DPSource"
47 #define A2DP_SINK_ENDPOINT "/MediaEndpoint/A2DPSink"
49 #define ENDPOINT_INTROSPECT_XML \
50 DBUS_INTROSPECT_1_0_XML_DOCTYPE_DECL_NODE \
52 " <interface name=\"" BLUEZ_MEDIA_ENDPOINT_INTERFACE "\">" \
53 " <method name=\"SetConfiguration\">" \
54 " <arg name=\"transport\" direction=\"in\" type=\"o\"/>" \
55 " <arg name=\"properties\" direction=\"in\" type=\"ay\"/>" \
57 " <method name=\"SelectConfiguration\">" \
58 " <arg name=\"capabilities\" direction=\"in\" type=\"ay\"/>" \
59 " <arg name=\"configuration\" direction=\"out\" type=\"ay\"/>" \
61 " <method name=\"ClearConfiguration\">" \
62 " <arg name=\"transport\" direction=\"in\" type=\"o\"/>" \
64 " <method name=\"Release\">" \
67 " <interface name=\"org.freedesktop.DBus.Introspectable\">" \
68 " <method name=\"Introspect\">" \
69 " <arg name=\"data\" type=\"s\" direction=\"out\"/>" \
74 struct pa_bluetooth_discovery
{
78 pa_dbus_connection
*connection
;
82 pa_hook hooks
[PA_BLUETOOTH_HOOK_MAX
];
85 pa_hashmap
*transports
;
87 PA_LLIST_HEAD(pa_dbus_pending
, pending
);
90 static pa_dbus_pending
* send_and_add_to_pending(pa_bluetooth_discovery
*y
, DBusMessage
*m
,
91 DBusPendingCallNotifyFunction func
, void *call_data
) {
93 DBusPendingCall
*call
;
98 pa_assert_se(dbus_connection_send_with_reply(pa_dbus_connection_get(y
->connection
), m
, &call
, -1));
100 p
= pa_dbus_pending_new(pa_dbus_connection_get(y
->connection
), m
, call
, y
, call_data
);
101 PA_LLIST_PREPEND(pa_dbus_pending
, y
->pending
, p
);
102 dbus_pending_call_set_notify(call
, func
, p
, NULL
);
107 pa_bluetooth_transport
*pa_bluetooth_transport_new(pa_bluetooth_device
*d
, const char *owner
, const char *path
,
108 pa_bluetooth_profile_t p
, const uint8_t *config
, size_t size
) {
109 pa_bluetooth_transport
*t
;
111 t
= pa_xnew0(pa_bluetooth_transport
, 1);
113 t
->owner
= pa_xstrdup(owner
);
114 t
->path
= pa_xstrdup(path
);
116 t
->config_size
= size
;
119 t
->config
= pa_xnew(uint8_t, size
);
120 memcpy(t
->config
, config
, size
);
123 pa_assert_se(pa_hashmap_put(d
->discovery
->transports
, t
->path
, t
) >= 0);
128 static const char *transport_state_to_string(pa_bluetooth_transport_state_t state
) {
130 case PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED
:
131 return "disconnected";
132 case PA_BLUETOOTH_TRANSPORT_STATE_IDLE
:
134 case PA_BLUETOOTH_TRANSPORT_STATE_PLAYING
:
141 static void transport_state_changed(pa_bluetooth_transport
*t
, pa_bluetooth_transport_state_t state
) {
142 bool old_any_connected
;
146 if (t
->state
== state
)
149 old_any_connected
= pa_bluetooth_device_any_transport_connected(t
->device
);
151 pa_log_debug("Transport %s state changed from %s to %s",
152 t
->path
, transport_state_to_string(t
->state
), transport_state_to_string(state
));
155 if (state
== PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED
)
156 t
->device
->transports
[t
->profile
] = NULL
;
158 pa_hook_fire(&t
->device
->discovery
->hooks
[PA_BLUETOOTH_HOOK_TRANSPORT_STATE_CHANGED
], t
);
160 if (old_any_connected
!= pa_bluetooth_device_any_transport_connected(t
->device
))
161 pa_hook_fire(&t
->device
->discovery
->hooks
[PA_BLUETOOTH_HOOK_DEVICE_CONNECTION_CHANGED
], t
->device
);
164 void pa_bluetooth_transport_put(pa_bluetooth_transport
*t
) {
165 transport_state_changed(t
, PA_BLUETOOTH_TRANSPORT_STATE_IDLE
);
168 void pa_bluetooth_transport_free(pa_bluetooth_transport
*t
) {
171 pa_hashmap_remove(t
->device
->discovery
->transports
, t
->path
);
178 static int bluez5_transport_acquire_cb(pa_bluetooth_transport
*t
, bool optional
, size_t *imtu
, size_t *omtu
) {
183 const char *method
= optional
? "TryAcquire" : "Acquire";
186 pa_assert(t
->device
);
187 pa_assert(t
->device
->discovery
);
189 pa_assert_se(m
= dbus_message_new_method_call(t
->owner
, t
->path
, BLUEZ_MEDIA_TRANSPORT_INTERFACE
, method
));
191 dbus_error_init(&err
);
193 r
= dbus_connection_send_with_reply_and_block(pa_dbus_connection_get(t
->device
->discovery
->connection
), m
, -1, &err
);
195 if (optional
&& pa_streq(err
.name
, "org.bluez.Error.NotAvailable"))
196 pa_log_info("Failed optional acquire of unavailable transport %s", t
->path
);
198 pa_log_error("Transport %s() failed for transport %s (%s)", method
, t
->path
, err
.message
);
200 dbus_error_free(&err
);
204 if (!dbus_message_get_args(r
, &err
, DBUS_TYPE_UNIX_FD
, &ret
, DBUS_TYPE_UINT16
, &i
, DBUS_TYPE_UINT16
, &o
,
205 DBUS_TYPE_INVALID
)) {
206 pa_log_error("Failed to parse %s() reply: %s", method
, err
.message
);
207 dbus_error_free(&err
);
219 dbus_message_unref(r
);
223 static void bluez5_transport_release_cb(pa_bluetooth_transport
*t
) {
228 pa_assert(t
->device
);
229 pa_assert(t
->device
->discovery
);
231 dbus_error_init(&err
);
233 if (t
->state
<= PA_BLUETOOTH_TRANSPORT_STATE_IDLE
) {
234 pa_log_info("Transport %s auto-released by BlueZ or already released", t
->path
);
238 pa_assert_se(m
= dbus_message_new_method_call(t
->owner
, t
->path
, BLUEZ_MEDIA_TRANSPORT_INTERFACE
, "Release"));
239 dbus_connection_send_with_reply_and_block(pa_dbus_connection_get(t
->device
->discovery
->connection
), m
, -1, &err
);
241 if (dbus_error_is_set(&err
)) {
242 pa_log_error("Failed to release transport %s: %s", t
->path
, err
.message
);
243 dbus_error_free(&err
);
245 pa_log_info("Transport %s released", t
->path
);
248 bool pa_bluetooth_device_any_transport_connected(const pa_bluetooth_device
*d
) {
253 if (d
->device_info_valid
!= 1)
256 for (i
= 0; i
< PA_BLUETOOTH_PROFILE_COUNT
; i
++)
257 if (d
->transports
[i
] && d
->transports
[i
]->state
!= PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED
)
263 static pa_bluetooth_device
* device_create(pa_bluetooth_discovery
*y
, const char *path
) {
264 pa_bluetooth_device
*d
;
269 d
= pa_xnew0(pa_bluetooth_device
, 1);
271 d
->path
= pa_xstrdup(path
);
273 pa_hashmap_put(y
->devices
, d
->path
, d
);
278 pa_bluetooth_device
* pa_bluetooth_discovery_get_device_by_path(pa_bluetooth_discovery
*y
, const char *path
) {
279 pa_bluetooth_device
*d
;
282 pa_assert(PA_REFCNT_VALUE(y
) > 0);
285 if ((d
= pa_hashmap_get(y
->devices
, path
)))
286 if (d
->device_info_valid
== 1)
292 pa_bluetooth_device
* pa_bluetooth_discovery_get_device_by_address(pa_bluetooth_discovery
*y
, const char *remote
, const char *local
) {
293 pa_bluetooth_device
*d
;
297 pa_assert(PA_REFCNT_VALUE(y
) > 0);
301 while ((d
= pa_hashmap_iterate(y
->devices
, &state
, NULL
)))
302 if (pa_streq(d
->address
, remote
) && pa_streq(d
->adapter
->address
, local
))
303 return d
->device_info_valid
== 1 ? d
: NULL
;
308 static void device_free(pa_bluetooth_device
*d
) {
313 for (i
= 0; i
< PA_BLUETOOTH_PROFILE_COUNT
; i
++) {
314 pa_bluetooth_transport
*t
;
316 if (!(t
= d
->transports
[i
]))
319 transport_state_changed(t
, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED
);
320 pa_bluetooth_transport_free(t
);
327 pa_xfree(d
->address
);
331 static void device_remove(pa_bluetooth_discovery
*y
, const char *path
) {
332 pa_bluetooth_device
*d
;
334 if (!(d
= pa_hashmap_remove(y
->devices
, path
)))
335 pa_log_warn("Unknown device removed %s", path
);
337 pa_log_debug("Device %s removed", path
);
342 static void device_remove_all(pa_bluetooth_discovery
*y
) {
343 pa_bluetooth_device
*d
;
347 while ((d
= pa_hashmap_steal_first(y
->devices
))) {
348 d
->device_info_valid
= -1;
349 pa_hook_fire(&y
->hooks
[PA_BLUETOOTH_HOOK_DEVICE_CONNECTION_CHANGED
], d
);
354 static pa_bluetooth_adapter
* adapter_create(pa_bluetooth_discovery
*y
, const char *path
) {
355 pa_bluetooth_adapter
*a
;
360 a
= pa_xnew0(pa_bluetooth_adapter
, 1);
362 a
->path
= pa_xstrdup(path
);
364 pa_hashmap_put(y
->adapters
, a
->path
, a
);
369 static void adapter_free(pa_bluetooth_adapter
*a
) {
370 pa_bluetooth_device
*d
;
374 pa_assert(a
->discovery
);
376 PA_HASHMAP_FOREACH(d
, a
->discovery
->devices
, state
)
381 pa_xfree(a
->address
);
385 static void adapter_remove(pa_bluetooth_discovery
*y
, const char *path
) {
386 pa_bluetooth_adapter
*a
;
388 if (!(a
= pa_hashmap_remove(y
->adapters
, path
)))
389 pa_log_warn("Unknown adapter removed %s", path
);
391 pa_log_debug("Adapter %s removed", path
);
396 static void adapter_remove_all(pa_bluetooth_discovery
*y
) {
397 pa_bluetooth_adapter
*a
;
401 /* When this function is called all devices have already been freed */
403 while ((a
= pa_hashmap_steal_first(y
->adapters
)))
407 static void get_managed_objects_reply(DBusPendingCall
*pending
, void *userdata
) {
409 pa_bluetooth_discovery
*y
;
411 DBusMessageIter arg_i
, element_i
;
413 pa_assert_se(p
= userdata
);
414 pa_assert_se(y
= p
->context_data
);
415 pa_assert_se(r
= dbus_pending_call_steal_reply(pending
));
417 if (dbus_message_is_error(r
, DBUS_ERROR_UNKNOWN_METHOD
)) {
418 pa_log_warn("BlueZ D-Bus ObjectManager not available");
422 if (dbus_message_get_type(r
) == DBUS_MESSAGE_TYPE_ERROR
) {
423 pa_log_error("GetManagedObjects() failed: %s: %s", dbus_message_get_error_name(r
), pa_dbus_get_error_message(r
));
427 if (!dbus_message_iter_init(r
, &arg_i
) || !pa_streq(dbus_message_get_signature(r
), "a{oa{sa{sv}}}")) {
428 pa_log_error("Invalid reply signature for GetManagedObjects()");
432 dbus_message_iter_recurse(&arg_i
, &element_i
);
433 while (dbus_message_iter_get_arg_type(&element_i
) == DBUS_TYPE_DICT_ENTRY
) {
434 DBusMessageIter dict_i
;
436 dbus_message_iter_recurse(&element_i
, &dict_i
);
438 /* TODO: parse interfaces and properties */
440 dbus_message_iter_next(&element_i
);
443 y
->objects_listed
= true;
446 dbus_message_unref(r
);
448 PA_LLIST_REMOVE(pa_dbus_pending
, y
->pending
, p
);
449 pa_dbus_pending_free(p
);
452 static void get_managed_objects(pa_bluetooth_discovery
*y
) {
457 pa_assert_se(m
= dbus_message_new_method_call(BLUEZ_SERVICE
, "/", "org.freedesktop.DBus.ObjectManager",
458 "GetManagedObjects"));
459 send_and_add_to_pending(y
, m
, get_managed_objects_reply
, NULL
);
462 pa_hook
* pa_bluetooth_discovery_hook(pa_bluetooth_discovery
*y
, pa_bluetooth_hook_t hook
) {
464 pa_assert(PA_REFCNT_VALUE(y
) > 0);
466 return &y
->hooks
[hook
];
469 static DBusHandlerResult
filter_cb(DBusConnection
*bus
, DBusMessage
*m
, void *userdata
) {
470 pa_bluetooth_discovery
*y
;
475 pa_assert_se(y
= userdata
);
477 dbus_error_init(&err
);
479 if (dbus_message_is_signal(m
, "org.freedesktop.DBus", "NameOwnerChanged")) {
480 const char *name
, *old_owner
, *new_owner
;
482 if (!dbus_message_get_args(m
, &err
,
483 DBUS_TYPE_STRING
, &name
,
484 DBUS_TYPE_STRING
, &old_owner
,
485 DBUS_TYPE_STRING
, &new_owner
,
486 DBUS_TYPE_INVALID
)) {
487 pa_log_error("Failed to parse org.freedesktop.DBus.NameOwnerChanged: %s", err
.message
);
491 if (pa_streq(name
, BLUEZ_SERVICE
)) {
492 if (old_owner
&& *old_owner
) {
493 pa_log_debug("Bluetooth daemon disappeared");
494 device_remove_all(y
);
495 adapter_remove_all(y
);
496 y
->objects_listed
= false;
499 if (new_owner
&& *new_owner
) {
500 pa_log_debug("Bluetooth daemon appeared");
501 get_managed_objects(y
);
505 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
506 } else if (dbus_message_is_signal(m
, "org.freedesktop.DBus.ObjectManager", "InterfacesAdded")) {
507 DBusMessageIter arg_i
;
509 if (!y
->objects_listed
)
510 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
; /* No reply received yet from GetManagedObjects */
512 if (!dbus_message_iter_init(m
, &arg_i
) || !pa_streq(dbus_message_get_signature(m
), "oa{sa{sv}}")) {
513 pa_log_error("Invalid signature found in InterfacesAdded");
517 /* TODO: parse interfaces and properties */
519 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
520 } else if (dbus_message_is_signal(m
, "org.freedesktop.DBus.ObjectManager", "InterfacesRemoved")) {
522 DBusMessageIter arg_i
;
523 DBusMessageIter element_i
;
525 if (!y
->objects_listed
)
526 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
; /* No reply received yet from GetManagedObjects */
528 if (!dbus_message_iter_init(m
, &arg_i
) || !pa_streq(dbus_message_get_signature(m
), "oas")) {
529 pa_log_error("Invalid signature found in InterfacesRemoved");
533 dbus_message_iter_get_basic(&arg_i
, &p
);
535 pa_assert_se(dbus_message_iter_next(&arg_i
));
536 pa_assert(dbus_message_iter_get_arg_type(&arg_i
) == DBUS_TYPE_ARRAY
);
538 dbus_message_iter_recurse(&arg_i
, &element_i
);
540 while (dbus_message_iter_get_arg_type(&element_i
) == DBUS_TYPE_STRING
) {
543 dbus_message_iter_get_basic(&element_i
, &iface
);
545 if (pa_streq(iface
, BLUEZ_DEVICE_INTERFACE
))
547 else if (pa_streq(iface
, BLUEZ_ADAPTER_INTERFACE
))
548 adapter_remove(y
, p
);
550 dbus_message_iter_next(&element_i
);
553 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
558 dbus_error_free(&err
);
560 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
563 static uint8_t a2dp_default_bitpool(uint8_t freq
, uint8_t mode
) {
564 /* These bitpool values were chosen based on the A2DP spec recommendation */
566 case SBC_SAMPLING_FREQ_16000
:
567 case SBC_SAMPLING_FREQ_32000
:
570 case SBC_SAMPLING_FREQ_44100
:
573 case SBC_CHANNEL_MODE_MONO
:
574 case SBC_CHANNEL_MODE_DUAL_CHANNEL
:
577 case SBC_CHANNEL_MODE_STEREO
:
578 case SBC_CHANNEL_MODE_JOINT_STEREO
:
582 pa_log_warn("Invalid channel mode %u", mode
);
585 case SBC_SAMPLING_FREQ_48000
:
588 case SBC_CHANNEL_MODE_MONO
:
589 case SBC_CHANNEL_MODE_DUAL_CHANNEL
:
592 case SBC_CHANNEL_MODE_STEREO
:
593 case SBC_CHANNEL_MODE_JOINT_STEREO
:
597 pa_log_warn("Invalid channel mode %u", mode
);
601 pa_log_warn("Invalid sampling freq %u", freq
);
605 const char *pa_bluetooth_profile_to_string(pa_bluetooth_profile_t profile
) {
607 case PA_BLUETOOTH_PROFILE_A2DP_SINK
:
609 case PA_BLUETOOTH_PROFILE_A2DP_SOURCE
:
610 return "a2dp_source";
611 case PA_BLUETOOTH_PROFILE_OFF
:
618 static DBusMessage
*endpoint_set_configuration(DBusConnection
*conn
, DBusMessage
*m
, void *userdata
) {
619 pa_bluetooth_discovery
*y
= userdata
;
620 pa_bluetooth_device
*d
;
621 pa_bluetooth_transport
*t
;
622 const char *sender
, *path
, *endpoint_path
, *dev_path
= NULL
, *uuid
= NULL
;
623 const uint8_t *config
= NULL
;
625 pa_bluetooth_profile_t p
= PA_BLUETOOTH_PROFILE_OFF
;
626 DBusMessageIter args
, props
;
629 if (!dbus_message_iter_init(m
, &args
) || !pa_streq(dbus_message_get_signature(m
), "oa{sv}")) {
630 pa_log_error("Invalid signature for method SetConfiguration()");
634 dbus_message_iter_get_basic(&args
, &path
);
636 if (pa_hashmap_get(y
->transports
, path
)) {
637 pa_log_error("Endpoint SetConfiguration(): Transport %s is already configured.", path
);
641 pa_assert_se(dbus_message_iter_next(&args
));
643 dbus_message_iter_recurse(&args
, &props
);
644 if (dbus_message_iter_get_arg_type(&props
) != DBUS_TYPE_DICT_ENTRY
)
647 /* Read transport properties */
648 while (dbus_message_iter_get_arg_type(&props
) == DBUS_TYPE_DICT_ENTRY
) {
650 DBusMessageIter value
, entry
;
653 dbus_message_iter_recurse(&props
, &entry
);
654 dbus_message_iter_get_basic(&entry
, &key
);
656 dbus_message_iter_next(&entry
);
657 dbus_message_iter_recurse(&entry
, &value
);
659 var
= dbus_message_iter_get_arg_type(&value
);
661 if (pa_streq(key
, "UUID")) {
662 if (var
!= DBUS_TYPE_STRING
) {
663 pa_log_error("Property %s of wrong type %c", key
, (char)var
);
667 dbus_message_iter_get_basic(&value
, &uuid
);
669 endpoint_path
= dbus_message_get_path(m
);
670 if (pa_streq(endpoint_path
, A2DP_SOURCE_ENDPOINT
)) {
671 if (pa_streq(uuid
, PA_BLUETOOTH_UUID_A2DP_SOURCE
))
672 p
= PA_BLUETOOTH_PROFILE_A2DP_SINK
;
673 } else if (pa_streq(endpoint_path
, A2DP_SINK_ENDPOINT
)) {
674 if (pa_streq(uuid
, PA_BLUETOOTH_UUID_A2DP_SINK
))
675 p
= PA_BLUETOOTH_PROFILE_A2DP_SOURCE
;
678 if (p
== PA_BLUETOOTH_PROFILE_OFF
) {
679 pa_log_error("UUID %s of transport %s incompatible with endpoint %s", uuid
, path
, endpoint_path
);
682 } else if (pa_streq(key
, "Device")) {
683 if (var
!= DBUS_TYPE_OBJECT_PATH
) {
684 pa_log_error("Property %s of wrong type %c", key
, (char)var
);
688 dbus_message_iter_get_basic(&value
, &dev_path
);
689 } else if (pa_streq(key
, "Configuration")) {
690 DBusMessageIter array
;
693 if (var
!= DBUS_TYPE_ARRAY
) {
694 pa_log_error("Property %s of wrong type %c", key
, (char)var
);
698 dbus_message_iter_recurse(&value
, &array
);
699 var
= dbus_message_iter_get_arg_type(&array
);
700 if (var
!= DBUS_TYPE_BYTE
) {
701 pa_log_error("%s is an array of wrong type %c", key
, (char)var
);
705 dbus_message_iter_get_fixed_array(&array
, &config
, &size
);
706 if (size
!= sizeof(a2dp_sbc_t
)) {
707 pa_log_error("Configuration array of invalid size");
711 c
= (a2dp_sbc_t
*) config
;
713 if (c
->frequency
!= SBC_SAMPLING_FREQ_16000
&& c
->frequency
!= SBC_SAMPLING_FREQ_32000
&&
714 c
->frequency
!= SBC_SAMPLING_FREQ_44100
&& c
->frequency
!= SBC_SAMPLING_FREQ_48000
) {
715 pa_log_error("Invalid sampling frequency in configuration");
719 if (c
->channel_mode
!= SBC_CHANNEL_MODE_MONO
&& c
->channel_mode
!= SBC_CHANNEL_MODE_DUAL_CHANNEL
&&
720 c
->channel_mode
!= SBC_CHANNEL_MODE_STEREO
&& c
->channel_mode
!= SBC_CHANNEL_MODE_JOINT_STEREO
) {
721 pa_log_error("Invalid channel mode in configuration");
725 if (c
->allocation_method
!= SBC_ALLOCATION_SNR
&& c
->allocation_method
!= SBC_ALLOCATION_LOUDNESS
) {
726 pa_log_error("Invalid allocation method in configuration");
730 if (c
->subbands
!= SBC_SUBBANDS_4
&& c
->subbands
!= SBC_SUBBANDS_8
) {
731 pa_log_error("Invalid SBC subbands in configuration");
735 if (c
->block_length
!= SBC_BLOCK_LENGTH_4
&& c
->block_length
!= SBC_BLOCK_LENGTH_8
&&
736 c
->block_length
!= SBC_BLOCK_LENGTH_12
&& c
->block_length
!= SBC_BLOCK_LENGTH_16
) {
737 pa_log_error("Invalid block length in configuration");
742 dbus_message_iter_next(&props
);
745 if ((d
= pa_hashmap_get(y
->devices
, dev_path
))) {
746 if (d
->device_info_valid
== -1) {
747 pa_log_error("Information about device %s is invalid", dev_path
);
751 /* InterfacesAdded signal is probably on it's way, device_info_valid is kept as 0. */
752 pa_log_warn("SetConfiguration() received for unknown device %s", dev_path
);
753 d
= device_create(y
, dev_path
);
756 if (d
->transports
[p
] != NULL
) {
757 pa_log_error("Cannot configure transport %s because profile %s is already used", path
, pa_bluetooth_profile_to_string(p
));
761 sender
= dbus_message_get_sender(m
);
763 pa_assert_se(r
= dbus_message_new_method_return(m
));
764 pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y
->connection
), r
, NULL
));
765 dbus_message_unref(r
);
767 d
->transports
[p
] = t
= pa_bluetooth_transport_new(d
, sender
, path
, p
, config
, size
);
768 t
->acquire
= bluez5_transport_acquire_cb
;
769 t
->release
= bluez5_transport_release_cb
;
770 pa_bluetooth_transport_put(t
);
772 pa_log_debug("Transport %s available for profile %s", t
->path
, pa_bluetooth_profile_to_string(t
->profile
));
777 pa_log_error("Endpoint SetConfiguration(): invalid arguments");
780 pa_assert_se(r
= dbus_message_new_error(m
, "org.bluez.Error.InvalidArguments", "Unable to set configuration"));
784 static DBusMessage
*endpoint_select_configuration(DBusConnection
*conn
, DBusMessage
*m
, void *userdata
) {
785 pa_bluetooth_discovery
*y
= userdata
;
786 a2dp_sbc_t
*cap
, config
;
787 uint8_t *pconf
= (uint8_t *) &config
;
792 static const struct {
796 { 16000U, SBC_SAMPLING_FREQ_16000
},
797 { 32000U, SBC_SAMPLING_FREQ_32000
},
798 { 44100U, SBC_SAMPLING_FREQ_44100
},
799 { 48000U, SBC_SAMPLING_FREQ_48000
}
802 dbus_error_init(&err
);
804 if (!dbus_message_get_args(m
, &err
, DBUS_TYPE_ARRAY
, DBUS_TYPE_BYTE
, &cap
, &size
, DBUS_TYPE_INVALID
)) {
805 pa_log_error("Endpoint SelectConfiguration(): %s", err
.message
);
806 dbus_error_free(&err
);
810 if (size
!= sizeof(config
)) {
811 pa_log_error("Capabilities array has invalid size");
817 /* Find the lowest freq that is at least as high as the requested sampling rate */
818 for (i
= 0; (unsigned) i
< PA_ELEMENTSOF(freq_table
); i
++)
819 if (freq_table
[i
].rate
>= y
->core
->default_sample_spec
.rate
&& (cap
->frequency
& freq_table
[i
].cap
)) {
820 config
.frequency
= freq_table
[i
].cap
;
824 if ((unsigned) i
== PA_ELEMENTSOF(freq_table
)) {
825 for (--i
; i
>= 0; i
--) {
826 if (cap
->frequency
& freq_table
[i
].cap
) {
827 config
.frequency
= freq_table
[i
].cap
;
833 pa_log_error("Not suitable sample rate");
838 pa_assert((unsigned) i
< PA_ELEMENTSOF(freq_table
));
840 if (y
->core
->default_sample_spec
.channels
<= 1) {
841 if (cap
->channel_mode
& SBC_CHANNEL_MODE_MONO
)
842 config
.channel_mode
= SBC_CHANNEL_MODE_MONO
;
843 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_JOINT_STEREO
)
844 config
.channel_mode
= SBC_CHANNEL_MODE_JOINT_STEREO
;
845 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_STEREO
)
846 config
.channel_mode
= SBC_CHANNEL_MODE_STEREO
;
847 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_DUAL_CHANNEL
)
848 config
.channel_mode
= SBC_CHANNEL_MODE_DUAL_CHANNEL
;
850 pa_log_error("No supported channel modes");
855 if (y
->core
->default_sample_spec
.channels
>= 2) {
856 if (cap
->channel_mode
& SBC_CHANNEL_MODE_JOINT_STEREO
)
857 config
.channel_mode
= SBC_CHANNEL_MODE_JOINT_STEREO
;
858 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_STEREO
)
859 config
.channel_mode
= SBC_CHANNEL_MODE_STEREO
;
860 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_DUAL_CHANNEL
)
861 config
.channel_mode
= SBC_CHANNEL_MODE_DUAL_CHANNEL
;
862 else if (cap
->channel_mode
& SBC_CHANNEL_MODE_MONO
)
863 config
.channel_mode
= SBC_CHANNEL_MODE_MONO
;
865 pa_log_error("No supported channel modes");
870 if (cap
->block_length
& SBC_BLOCK_LENGTH_16
)
871 config
.block_length
= SBC_BLOCK_LENGTH_16
;
872 else if (cap
->block_length
& SBC_BLOCK_LENGTH_12
)
873 config
.block_length
= SBC_BLOCK_LENGTH_12
;
874 else if (cap
->block_length
& SBC_BLOCK_LENGTH_8
)
875 config
.block_length
= SBC_BLOCK_LENGTH_8
;
876 else if (cap
->block_length
& SBC_BLOCK_LENGTH_4
)
877 config
.block_length
= SBC_BLOCK_LENGTH_4
;
879 pa_log_error("No supported block lengths");
883 if (cap
->subbands
& SBC_SUBBANDS_8
)
884 config
.subbands
= SBC_SUBBANDS_8
;
885 else if (cap
->subbands
& SBC_SUBBANDS_4
)
886 config
.subbands
= SBC_SUBBANDS_4
;
888 pa_log_error("No supported subbands");
892 if (cap
->allocation_method
& SBC_ALLOCATION_LOUDNESS
)
893 config
.allocation_method
= SBC_ALLOCATION_LOUDNESS
;
894 else if (cap
->allocation_method
& SBC_ALLOCATION_SNR
)
895 config
.allocation_method
= SBC_ALLOCATION_SNR
;
897 config
.min_bitpool
= (uint8_t) PA_MAX(MIN_BITPOOL
, cap
->min_bitpool
);
898 config
.max_bitpool
= (uint8_t) PA_MIN(a2dp_default_bitpool(config
.frequency
, config
.channel_mode
), cap
->max_bitpool
);
900 if (config
.min_bitpool
> config
.max_bitpool
)
903 pa_assert_se(r
= dbus_message_new_method_return(m
));
904 pa_assert_se(dbus_message_append_args(r
, DBUS_TYPE_ARRAY
, DBUS_TYPE_BYTE
, &pconf
, size
, DBUS_TYPE_INVALID
));
909 pa_assert_se(r
= dbus_message_new_error(m
, "org.bluez.Error.InvalidArguments", "Unable to select configuration"));
913 static DBusMessage
*endpoint_clear_configuration(DBusConnection
*conn
, DBusMessage
*m
, void *userdata
) {
914 pa_bluetooth_discovery
*y
= userdata
;
915 pa_bluetooth_transport
*t
;
920 dbus_error_init(&err
);
922 if (!dbus_message_get_args(m
, &err
, DBUS_TYPE_OBJECT_PATH
, &path
, DBUS_TYPE_INVALID
)) {
923 pa_log_error("Endpoint ClearConfiguration(): %s", err
.message
);
924 dbus_error_free(&err
);
928 if ((t
= pa_hashmap_get(y
->transports
, path
))) {
929 pa_log_debug("Clearing transport %s profile %s", t
->path
, pa_bluetooth_profile_to_string(t
->profile
));
930 transport_state_changed(t
, PA_BLUETOOTH_TRANSPORT_STATE_DISCONNECTED
);
931 pa_bluetooth_transport_free(t
);
934 pa_assert_se(r
= dbus_message_new_method_return(m
));
939 pa_assert_se(r
= dbus_message_new_error(m
, "org.bluez.Error.InvalidArguments", "Unable to clear configuration"));
943 static DBusMessage
*endpoint_release(DBusConnection
*conn
, DBusMessage
*m
, void *userdata
) {
946 pa_assert_se(r
= dbus_message_new_error(m
, BLUEZ_MEDIA_ENDPOINT_INTERFACE
".Error.NotImplemented",
947 "Method not implemented"));
952 static DBusHandlerResult
endpoint_handler(DBusConnection
*c
, DBusMessage
*m
, void *userdata
) {
953 struct pa_bluetooth_discovery
*y
= userdata
;
954 DBusMessage
*r
= NULL
;
955 const char *path
, *interface
, *member
;
959 path
= dbus_message_get_path(m
);
960 interface
= dbus_message_get_interface(m
);
961 member
= dbus_message_get_member(m
);
963 pa_log_debug("dbus: path=%s, interface=%s, member=%s", path
, interface
, member
);
965 if (!pa_streq(path
, A2DP_SOURCE_ENDPOINT
) && !pa_streq(path
, A2DP_SINK_ENDPOINT
))
966 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
968 if (dbus_message_is_method_call(m
, "org.freedesktop.DBus.Introspectable", "Introspect")) {
969 const char *xml
= ENDPOINT_INTROSPECT_XML
;
971 pa_assert_se(r
= dbus_message_new_method_return(m
));
972 pa_assert_se(dbus_message_append_args(r
, DBUS_TYPE_STRING
, &xml
, DBUS_TYPE_INVALID
));
974 } else if (dbus_message_is_method_call(m
, BLUEZ_MEDIA_ENDPOINT_INTERFACE
, "SetConfiguration"))
975 r
= endpoint_set_configuration(c
, m
, userdata
);
976 else if (dbus_message_is_method_call(m
, BLUEZ_MEDIA_ENDPOINT_INTERFACE
, "SelectConfiguration"))
977 r
= endpoint_select_configuration(c
, m
, userdata
);
978 else if (dbus_message_is_method_call(m
, BLUEZ_MEDIA_ENDPOINT_INTERFACE
, "ClearConfiguration"))
979 r
= endpoint_clear_configuration(c
, m
, userdata
);
980 else if (dbus_message_is_method_call(m
, BLUEZ_MEDIA_ENDPOINT_INTERFACE
, "Release"))
981 r
= endpoint_release(c
, m
, userdata
);
983 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED
;
986 pa_assert_se(dbus_connection_send(pa_dbus_connection_get(y
->connection
), r
, NULL
));
987 dbus_message_unref(r
);
990 return DBUS_HANDLER_RESULT_HANDLED
;
993 static void endpoint_init(pa_bluetooth_discovery
*y
, pa_bluetooth_profile_t profile
) {
994 static const DBusObjectPathVTable vtable_endpoint
= {
995 .message_function
= endpoint_handler
,
1001 case PA_BLUETOOTH_PROFILE_A2DP_SINK
:
1002 pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y
->connection
), A2DP_SOURCE_ENDPOINT
,
1003 &vtable_endpoint
, y
));
1005 case PA_BLUETOOTH_PROFILE_A2DP_SOURCE
:
1006 pa_assert_se(dbus_connection_register_object_path(pa_dbus_connection_get(y
->connection
), A2DP_SINK_ENDPOINT
,
1007 &vtable_endpoint
, y
));
1010 pa_assert_not_reached();
1015 static void endpoint_done(pa_bluetooth_discovery
*y
, pa_bluetooth_profile_t profile
) {
1019 case PA_BLUETOOTH_PROFILE_A2DP_SINK
:
1020 dbus_connection_unregister_object_path(pa_dbus_connection_get(y
->connection
), A2DP_SOURCE_ENDPOINT
);
1022 case PA_BLUETOOTH_PROFILE_A2DP_SOURCE
:
1023 dbus_connection_unregister_object_path(pa_dbus_connection_get(y
->connection
), A2DP_SINK_ENDPOINT
);
1026 pa_assert_not_reached();
1031 pa_bluetooth_discovery
* pa_bluetooth_discovery_get(pa_core
*c
) {
1032 pa_bluetooth_discovery
*y
;
1034 DBusConnection
*conn
;
1037 if ((y
= pa_shared_get(c
, "bluetooth-discovery")))
1038 return pa_bluetooth_discovery_ref(y
);
1040 y
= pa_xnew0(pa_bluetooth_discovery
, 1);
1043 y
->adapters
= pa_hashmap_new(pa_idxset_string_hash_func
, pa_idxset_string_compare_func
);
1044 y
->devices
= pa_hashmap_new(pa_idxset_string_hash_func
, pa_idxset_string_compare_func
);
1045 y
->transports
= pa_hashmap_new(pa_idxset_string_hash_func
, pa_idxset_string_compare_func
);
1046 PA_LLIST_HEAD_INIT(pa_dbus_pending
, y
->pending
);
1048 for (i
= 0; i
< PA_BLUETOOTH_HOOK_MAX
; i
++)
1049 pa_hook_init(&y
->hooks
[i
], y
);
1051 pa_shared_set(c
, "bluetooth-discovery", y
);
1053 dbus_error_init(&err
);
1055 if (!(y
->connection
= pa_dbus_bus_get(y
->core
, DBUS_BUS_SYSTEM
, &err
))) {
1056 pa_log_error("Failed to get D-Bus connection: %s", err
.message
);
1060 conn
= pa_dbus_connection_get(y
->connection
);
1062 /* dynamic detection of bluetooth audio devices */
1063 if (!dbus_connection_add_filter(conn
, filter_cb
, y
, NULL
)) {
1064 pa_log_error("Failed to add filter function");
1067 y
->filter_added
= true;
1069 if (pa_dbus_add_matches(conn
, &err
,
1070 "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged'"
1071 ",arg0='" BLUEZ_SERVICE
"'",
1072 "type='signal',sender='" BLUEZ_SERVICE
"',interface='org.freedesktop.DBus.ObjectManager',member='InterfacesAdded'",
1073 "type='signal',sender='" BLUEZ_SERVICE
"',interface='org.freedesktop.DBus.ObjectManager',"
1074 "member='InterfacesRemoved'",
1076 pa_log_error("Failed to add D-Bus matches: %s", err
.message
);
1079 y
->matches_added
= true;
1081 endpoint_init(y
, PA_BLUETOOTH_PROFILE_A2DP_SINK
);
1082 endpoint_init(y
, PA_BLUETOOTH_PROFILE_A2DP_SOURCE
);
1084 get_managed_objects(y
);
1089 pa_bluetooth_discovery_unref(y
);
1090 dbus_error_free(&err
);
1095 pa_bluetooth_discovery
* pa_bluetooth_discovery_ref(pa_bluetooth_discovery
*y
) {
1097 pa_assert(PA_REFCNT_VALUE(y
) > 0);
1104 void pa_bluetooth_discovery_unref(pa_bluetooth_discovery
*y
) {
1106 pa_assert(PA_REFCNT_VALUE(y
) > 0);
1108 if (PA_REFCNT_DEC(y
) > 0)
1111 pa_dbus_free_pending_list(&y
->pending
);
1114 device_remove_all(y
);
1115 pa_hashmap_free(y
->devices
);
1119 adapter_remove_all(y
);
1120 pa_hashmap_free(y
->adapters
);
1123 if (y
->transports
) {
1124 pa_assert(pa_hashmap_isempty(y
->transports
));
1125 pa_hashmap_free(y
->transports
);
1128 if (y
->connection
) {
1130 if (y
->matches_added
)
1131 pa_dbus_remove_matches(pa_dbus_connection_get(y
->connection
),
1132 "type='signal',sender='org.freedesktop.DBus',interface='org.freedesktop.DBus',member='NameOwnerChanged',"
1133 "arg0='" BLUEZ_SERVICE
"'",
1134 "type='signal',sender='" BLUEZ_SERVICE
"',interface='org.freedesktop.DBus.ObjectManager',"
1135 "member='InterfacesAdded'",
1136 "type='signal',sender='" BLUEZ_SERVICE
"',interface='org.freedesktop.DBus.ObjectManager',"
1137 "member='InterfacesRemoved'",
1140 if (y
->filter_added
)
1141 dbus_connection_remove_filter(pa_dbus_connection_get(y
->connection
), filter_cb
, y
);
1143 endpoint_done(y
, PA_BLUETOOTH_PROFILE_A2DP_SINK
);
1144 endpoint_done(y
, PA_BLUETOOTH_PROFILE_A2DP_SOURCE
);
1146 pa_dbus_connection_unref(y
->connection
);
1149 pa_shared_remove(y
->core
, "bluetooth-discovery");