| /* |
| * |
| * BlueZ - Bluetooth protocol stack for Linux |
| * |
| * Copyright (C) 2006-2007 Nokia Corporation |
| * Copyright (C) 2004-2008 Marcel Holtmann <marcel@holtmann.org> |
| * |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
| * |
| */ |
| |
| #ifdef HAVE_CONFIG_H |
| #include <config.h> |
| #endif |
| |
| #include <stdint.h> |
| #include <errno.h> |
| |
| #include <bluetooth/bluetooth.h> |
| |
| #include <glib.h> |
| #include <dbus/dbus.h> |
| #include <gdbus.h> |
| |
| #include "logging.h" |
| |
| #include "avdtp.h" |
| #include "device.h" |
| #include "a2dp.h" |
| #include "error.h" |
| #include "sink.h" |
| |
| #define STREAM_SETUP_RETRY_TIMER 2000 |
| |
| struct pending_request { |
| DBusConnection *conn; |
| DBusMessage *msg; |
| unsigned int id; |
| }; |
| |
| struct sink { |
| struct avdtp *session; |
| struct avdtp_stream *stream; |
| unsigned int cb_id; |
| uint8_t state; |
| struct pending_request *connect; |
| struct pending_request *disconnect; |
| DBusConnection *conn; |
| }; |
| |
| static void pending_request_free(struct pending_request *pending) |
| { |
| if (pending->conn) |
| dbus_connection_unref(pending->conn); |
| if (pending->msg) |
| dbus_message_unref(pending->msg); |
| g_free(pending); |
| } |
| |
| static void stream_state_changed(struct avdtp_stream *stream, |
| avdtp_state_t old_state, |
| avdtp_state_t new_state, |
| struct avdtp_error *err, |
| void *user_data) |
| { |
| struct device *dev = user_data; |
| struct sink *sink = dev->sink; |
| |
| if (err) |
| return; |
| |
| switch (new_state) { |
| case AVDTP_STATE_IDLE: |
| dbus_connection_emit_signal(dev->conn, dev->path, |
| AUDIO_SINK_INTERFACE, |
| "Disconnected", |
| DBUS_TYPE_INVALID); |
| if (sink->disconnect) { |
| DBusMessage *reply; |
| struct pending_request *p; |
| |
| p = sink->disconnect; |
| sink->disconnect = NULL; |
| |
| reply = dbus_message_new_method_return(p->msg); |
| send_message_and_unref(p->conn, reply); |
| pending_request_free(p); |
| } |
| |
| if (sink->session) { |
| avdtp_unref(sink->session); |
| sink->session = NULL; |
| } |
| sink->stream = NULL; |
| sink->cb_id = 0; |
| break; |
| case AVDTP_STATE_OPEN: |
| if (old_state == AVDTP_STATE_CONFIGURED) |
| dbus_connection_emit_signal(dev->conn, dev->path, |
| AUDIO_SINK_INTERFACE, |
| "Connected", |
| DBUS_TYPE_INVALID); |
| else if (old_state == AVDTP_STATE_STREAMING) |
| dbus_connection_emit_signal(dev->conn, dev->path, |
| AUDIO_SINK_INTERFACE, |
| "Stopped", |
| DBUS_TYPE_INVALID); |
| break; |
| case AVDTP_STATE_STREAMING: |
| dbus_connection_emit_signal(dev->conn, dev->path, |
| AUDIO_SINK_INTERFACE, |
| "Playing", |
| DBUS_TYPE_INVALID); |
| break; |
| case AVDTP_STATE_CONFIGURED: |
| case AVDTP_STATE_CLOSING: |
| case AVDTP_STATE_ABORTING: |
| default: |
| break; |
| } |
| |
| sink->state = new_state; |
| } |
| |
| static gboolean stream_setup_retry(gpointer user_data) |
| { |
| struct sink *sink = user_data; |
| struct pending_request *pending = sink->connect; |
| |
| if (sink->state >= AVDTP_STATE_OPEN) { |
| DBusMessage *reply; |
| debug("Stream successfully created, after XCASE connect:connect"); |
| reply = dbus_message_new_method_return(pending->msg); |
| send_message_and_unref(pending->conn, reply); |
| } else { |
| debug("Stream setup failed, after XCASE connect:connect"); |
| error_failed(pending->conn, pending->msg, "Stream setup failed"); |
| } |
| |
| sink->connect = NULL; |
| pending_request_free(pending); |
| |
| return FALSE; |
| } |
| |
| static void stream_setup_complete(struct avdtp *session, struct a2dp_sep *sep, |
| struct avdtp_stream *stream, |
| struct avdtp_error *err, void *user_data) |
| { |
| struct sink *sink = user_data; |
| struct pending_request *pending; |
| |
| pending = sink->connect; |
| |
| if (stream) { |
| DBusMessage *reply; |
| sink->connect = NULL; |
| reply = dbus_message_new_method_return(pending->msg); |
| send_message_and_unref(pending->conn, reply); |
| pending_request_free(pending); |
| debug("Stream successfully created"); |
| } else { |
| avdtp_unref(sink->session); |
| sink->session = NULL; |
| if (avdtp_error_type(err) == AVDTP_ERROR_ERRNO |
| && avdtp_error_posix_errno(err) != EHOSTDOWN) { |
| debug("connect:connect XCASE detected"); |
| g_timeout_add(STREAM_SETUP_RETRY_TIMER, |
| stream_setup_retry, sink); |
| } else { |
| sink->connect = NULL; |
| error_failed(pending->conn, pending->msg, "Stream setup failed"); |
| pending_request_free(pending); |
| debug("Stream setup failed : %s", avdtp_strerror(err)); |
| } |
| } |
| } |
| |
| static uint8_t default_bitpool(uint8_t freq, uint8_t mode) |
| { |
| switch (freq) { |
| case SBC_SAMPLING_FREQ_16000: |
| case SBC_SAMPLING_FREQ_32000: |
| return 53; |
| case SBC_SAMPLING_FREQ_44100: |
| switch (mode) { |
| case SBC_CHANNEL_MODE_MONO: |
| case SBC_CHANNEL_MODE_DUAL_CHANNEL: |
| return 31; |
| case SBC_CHANNEL_MODE_STEREO: |
| case SBC_CHANNEL_MODE_JOINT_STEREO: |
| return 53; |
| default: |
| error("Invalid channel mode %u", mode); |
| return 53; |
| } |
| case SBC_SAMPLING_FREQ_48000: |
| switch (mode) { |
| case SBC_CHANNEL_MODE_MONO: |
| case SBC_CHANNEL_MODE_DUAL_CHANNEL: |
| return 29; |
| case SBC_CHANNEL_MODE_STEREO: |
| case SBC_CHANNEL_MODE_JOINT_STEREO: |
| return 51; |
| default: |
| error("Invalid channel mode %u", mode); |
| return 51; |
| } |
| default: |
| error("Invalid sampling freq %u", freq); |
| return 53; |
| } |
| } |
| |
| static gboolean select_sbc_params(struct sbc_codec_cap *cap, |
| struct sbc_codec_cap *supported) |
| { |
| unsigned int max_bitpool, min_bitpool; |
| |
| memset(cap, 0, sizeof(struct sbc_codec_cap)); |
| |
| cap->cap.media_type = AVDTP_MEDIA_TYPE_AUDIO; |
| cap->cap.media_codec_type = A2DP_CODEC_SBC; |
| |
| if (supported->frequency & SBC_SAMPLING_FREQ_44100) |
| cap->frequency = SBC_SAMPLING_FREQ_44100; |
| else if (supported->frequency & SBC_SAMPLING_FREQ_48000) |
| cap->frequency = SBC_SAMPLING_FREQ_48000; |
| else if (supported->frequency & SBC_SAMPLING_FREQ_32000) |
| cap->frequency = SBC_SAMPLING_FREQ_32000; |
| else if (supported->frequency & SBC_SAMPLING_FREQ_16000) |
| cap->frequency = SBC_SAMPLING_FREQ_16000; |
| else { |
| error("No supported frequencies"); |
| return FALSE; |
| } |
| |
| if (supported->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO) |
| cap->channel_mode = SBC_CHANNEL_MODE_JOINT_STEREO; |
| else if (supported->channel_mode & SBC_CHANNEL_MODE_STEREO) |
| cap->channel_mode = SBC_CHANNEL_MODE_STEREO; |
| else if (supported->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL) |
| cap->channel_mode = SBC_CHANNEL_MODE_DUAL_CHANNEL; |
| else if (supported->channel_mode & SBC_CHANNEL_MODE_MONO) |
| cap->channel_mode = SBC_CHANNEL_MODE_MONO; |
| else { |
| error("No supported channel modes"); |
| return FALSE; |
| } |
| |
| if (supported->block_length & SBC_BLOCK_LENGTH_16) |
| cap->block_length = SBC_BLOCK_LENGTH_16; |
| else if (supported->block_length & SBC_BLOCK_LENGTH_12) |
| cap->block_length = SBC_BLOCK_LENGTH_12; |
| else if (supported->block_length & SBC_BLOCK_LENGTH_8) |
| cap->block_length = SBC_BLOCK_LENGTH_8; |
| else if (supported->block_length & SBC_BLOCK_LENGTH_4) |
| cap->block_length = SBC_BLOCK_LENGTH_4; |
| else { |
| error("No supported block lengths"); |
| return FALSE; |
| } |
| |
| if (supported->subbands & SBC_SUBBANDS_8) |
| cap->subbands = SBC_SUBBANDS_8; |
| else if (supported->subbands & SBC_SUBBANDS_4) |
| cap->subbands = SBC_SUBBANDS_4; |
| else { |
| error("No supported subbands"); |
| return FALSE; |
| } |
| |
| if (supported->allocation_method & SBC_ALLOCATION_LOUDNESS) |
| cap->allocation_method = SBC_ALLOCATION_LOUDNESS; |
| else if (supported->allocation_method & SBC_ALLOCATION_SNR) |
| cap->allocation_method = SBC_ALLOCATION_SNR; |
| |
| min_bitpool = MAX(MIN_BITPOOL, supported->min_bitpool); |
| max_bitpool = MIN(default_bitpool(cap->frequency, cap->channel_mode), |
| supported->max_bitpool); |
| |
| cap->min_bitpool = min_bitpool; |
| cap->max_bitpool = max_bitpool; |
| |
| return TRUE; |
| } |
| |
| static gboolean select_capabilities(struct avdtp *session, |
| struct avdtp_remote_sep *rsep, |
| GSList **caps) |
| { |
| struct avdtp_service_capability *media_transport, *media_codec; |
| struct sbc_codec_cap sbc_cap; |
| |
| media_codec = avdtp_get_codec(rsep); |
| if (!media_codec) |
| return FALSE; |
| |
| select_sbc_params(&sbc_cap, (struct sbc_codec_cap *) media_codec->data); |
| |
| media_transport = avdtp_service_cap_new(AVDTP_MEDIA_TRANSPORT, |
| NULL, 0); |
| |
| *caps = g_slist_append(*caps, media_transport); |
| |
| media_codec = avdtp_service_cap_new(AVDTP_MEDIA_CODEC, &sbc_cap, |
| sizeof(sbc_cap)); |
| |
| *caps = g_slist_append(*caps, media_codec); |
| |
| |
| return TRUE; |
| } |
| |
| static void discovery_complete(struct avdtp *session, GSList *seps, struct avdtp_error *err, |
| void *user_data) |
| { |
| struct sink *sink = user_data; |
| struct pending_request *pending; |
| struct avdtp_local_sep *lsep; |
| struct avdtp_remote_sep *rsep; |
| GSList *caps = NULL; |
| int id; |
| |
| pending = sink->connect; |
| |
| if (err) { |
| avdtp_unref(sink->session); |
| sink->session = NULL; |
| if (avdtp_error_type(err) == AVDTP_ERROR_ERRNO |
| && avdtp_error_posix_errno(err) != EHOSTDOWN) { |
| debug("connect:connect XCASE detected"); |
| g_timeout_add(STREAM_SETUP_RETRY_TIMER, |
| stream_setup_retry, sink); |
| } else |
| goto failed; |
| return; |
| } |
| |
| debug("Discovery complete"); |
| |
| if (avdtp_get_seps(session, AVDTP_SEP_TYPE_SINK, AVDTP_MEDIA_TYPE_AUDIO, |
| A2DP_CODEC_SBC, &lsep, &rsep) < 0) { |
| error("No matching ACP and INT SEPs found"); |
| goto failed; |
| } |
| |
| if (!select_capabilities(session, rsep, &caps)) { |
| error("Unable to select remote SEP capabilities"); |
| goto failed; |
| } |
| |
| id = a2dp_source_config(sink->session, stream_setup_complete, |
| caps, sink); |
| if (id == 0) |
| goto failed; |
| |
| pending->id = id; |
| return; |
| |
| failed: |
| pending_request_free(pending); |
| sink->connect = NULL; |
| avdtp_unref(sink->session); |
| sink->session = NULL; |
| error_failed(pending->conn, pending->msg, "Stream setup failed"); |
| } |
| |
| static DBusHandlerResult sink_connect(DBusConnection *conn, |
| DBusMessage *msg, void *data) |
| { |
| struct device *dev = data; |
| struct sink *sink = dev->sink; |
| struct pending_request *pending; |
| |
| if (!sink->session) |
| sink->session = avdtp_get(&dev->src, &dev->dst); |
| |
| if (!sink->session) |
| return error_failed(conn, msg, "Unable to get a session"); |
| |
| if (sink->connect || sink->disconnect) |
| return error_in_progress(conn, msg, "Device connection" |
| "already in progress"); |
| |
| if (sink->state >= AVDTP_STATE_OPEN) |
| return error_already_connected(conn, msg); |
| |
| pending = g_new0(struct pending_request, 1); |
| pending->conn = dbus_connection_ref(conn); |
| pending->msg = dbus_message_ref(msg); |
| sink->connect = pending; |
| |
| avdtp_discover(sink->session, discovery_complete, sink); |
| |
| debug("stream creation in progress"); |
| |
| return DBUS_HANDLER_RESULT_HANDLED; |
| } |
| |
| static DBusHandlerResult sink_disconnect(DBusConnection *conn, |
| DBusMessage *msg, void *data) |
| { |
| struct device *device = data; |
| struct sink *sink = device->sink; |
| struct pending_request *pending; |
| int err; |
| |
| if (!sink->session) |
| return error_not_connected(conn, msg); |
| |
| if (sink->connect || sink->disconnect) |
| return error_failed(conn, msg, strerror(EBUSY)); |
| |
| if (sink->state < AVDTP_STATE_OPEN) { |
| DBusMessage *reply = dbus_message_new_method_return(msg); |
| if (!reply) |
| return DBUS_HANDLER_RESULT_NEED_MEMORY; |
| avdtp_unref(sink->session); |
| sink->session = NULL; |
| return send_message_and_unref(conn, reply); |
| } |
| |
| err = avdtp_close(sink->session, sink->stream); |
| if (err < 0) |
| return error_failed(conn, msg, strerror(-err)); |
| |
| pending = g_new0(struct pending_request, 1); |
| pending->conn = dbus_connection_ref(conn); |
| pending->msg = dbus_message_ref(msg); |
| sink->disconnect = pending; |
| |
| return DBUS_HANDLER_RESULT_HANDLED; |
| } |
| |
| static DBusHandlerResult sink_is_connected(DBusConnection *conn, |
| DBusMessage *msg, |
| void *data) |
| { |
| struct device *device = data; |
| struct sink *sink = device->sink; |
| DBusMessage *reply; |
| dbus_bool_t connected; |
| |
| reply = dbus_message_new_method_return(msg); |
| if (!reply) |
| return DBUS_HANDLER_RESULT_NEED_MEMORY; |
| |
| connected = (sink->state >= AVDTP_STATE_CONFIGURED); |
| |
| dbus_message_append_args(reply, DBUS_TYPE_BOOLEAN, &connected, |
| DBUS_TYPE_INVALID); |
| |
| send_message_and_unref(conn, reply); |
| |
| return DBUS_HANDLER_RESULT_HANDLED; |
| } |
| |
| static DBusMethodVTable sink_methods[] = { |
| { "Connect", sink_connect, "", "" }, |
| { "Disconnect", sink_disconnect, "", "" }, |
| { "IsConnected", sink_is_connected, "", "b" }, |
| { NULL, NULL, NULL, NULL } |
| }; |
| |
| static DBusSignalVTable sink_signals[] = { |
| { "Connected", "" }, |
| { "Disconnected", "" }, |
| { "Playing", "" }, |
| { "Stopped", "" }, |
| { NULL, NULL } |
| }; |
| |
| struct sink *sink_init(struct device *dev) |
| { |
| if (!dbus_connection_register_interface(dev->conn, dev->path, |
| AUDIO_SINK_INTERFACE, |
| sink_methods, |
| sink_signals, NULL)) |
| return NULL; |
| |
| return g_new0(struct sink, 1); |
| } |
| |
| void sink_free(struct device *dev) |
| { |
| struct sink *sink = dev->sink; |
| |
| if (sink->cb_id) |
| avdtp_stream_remove_cb(sink->session, sink->stream, |
| sink->cb_id); |
| |
| if (sink->session) |
| avdtp_unref(sink->session); |
| |
| if (sink->connect) |
| pending_request_free(sink->connect); |
| |
| if (sink->disconnect) |
| pending_request_free(sink->disconnect); |
| |
| g_free(sink); |
| dev->sink = NULL; |
| } |
| |
| gboolean sink_is_active(struct device *dev) |
| { |
| struct sink *sink = dev->sink; |
| |
| if (sink->session) |
| return TRUE; |
| |
| return FALSE; |
| } |
| |
| avdtp_state_t sink_get_state(struct device *dev) |
| { |
| struct sink *sink = dev->sink; |
| |
| return sink->state; |
| } |
| |
| gboolean sink_new_stream(struct device *dev, struct avdtp *session, |
| struct avdtp_stream *stream) |
| { |
| struct sink *sink = dev->sink; |
| |
| if (sink->stream) |
| return FALSE; |
| |
| if (!sink->session) |
| sink->session = avdtp_ref(session); |
| |
| sink->stream = stream; |
| |
| sink->cb_id = avdtp_stream_add_cb(session, stream, |
| stream_state_changed, dev); |
| |
| return TRUE; |
| } |