From: Luiz Augusto von Dentz <luiz.von.dentz@xxxxxxxxx> Unix socket support is deprecated by Media API. --- v2: Rebase on top of 4.101 Makefile.am | 1 - audio/a2dp.c | 4 - audio/device.c | 3 - audio/manager.c | 7 - audio/unix.c | 1909 ------------------------------------------------------- audio/unix.h | 30 - 6 files changed, 1954 deletions(-) delete mode 100644 audio/unix.c delete mode 100644 audio/unix.h diff --git a/Makefile.am b/Makefile.am index 1c214c6..aaae42e 100644 --- a/Makefile.am +++ b/Makefile.am @@ -152,7 +152,6 @@ builtin_sources += audio/main.c \ audio/a2dp.h audio/a2dp.c \ audio/avdtp.h audio/avdtp.c \ audio/ipc.h audio/ipc.c \ - audio/unix.h audio/unix.c \ audio/media.h audio/media.c \ audio/transport.h audio/transport.c \ audio/telephony.h audio/a2dp-codecs.h diff --git a/audio/a2dp.c b/audio/a2dp.c index 404be53..753083b 100644 --- a/audio/a2dp.c +++ b/audio/a2dp.c @@ -43,7 +43,6 @@ #include "avdtp.h" #include "sink.h" #include "source.h" -#include "unix.h" #include "a2dp.h" #include "sdpd.h" @@ -1240,15 +1239,12 @@ static gboolean delayreport_ind(struct avdtp *session, uint8_t *err, void *user_data) { struct a2dp_sep *a2dp_sep = user_data; - struct audio_device *dev = a2dp_get_dev(session); if (a2dp_sep->type == AVDTP_SEP_TYPE_SINK) DBG("Sink %p: DelayReport_Ind", sep); else DBG("Source %p: DelayReport_Ind", sep); - unix_delay_report(dev, rseid, delay); - return TRUE; } diff --git a/audio/device.c b/audio/device.c index b7b993e..49bae61 100644 --- a/audio/device.c +++ b/audio/device.c @@ -49,7 +49,6 @@ #include "ipc.h" #include "dbus-common.h" #include "device.h" -#include "unix.h" #include "avdtp.h" #include "control.h" #include "avctp.h" @@ -711,8 +710,6 @@ gboolean audio_device_is_active(struct audio_device *dev, void audio_device_unregister(struct audio_device *device) { - unix_device_removed(device); - if (device->hs_preauth_id) { g_source_remove(device->hs_preauth_id); device->hs_preauth_id = 0; diff --git a/audio/manager.c b/audio/manager.c index d442d1d..306b0dd 100644 --- a/audio/manager.c +++ b/audio/manager.c @@ -69,7 +69,6 @@ #include "manager.h" #include "sdpd.h" #include "telephony.h" -#include "unix.h" typedef enum { HEADSET = 1 << 0, @@ -1235,9 +1234,6 @@ int audio_manager_init(DBusConnection *conn, GKeyFile *conf, max_connected_headsets = i; proceed: - if (enabled.socket) - unix_init(); - if (enabled.media) btd_register_adapter_driver(&media_server_driver); @@ -1274,9 +1270,6 @@ void audio_manager_exit(void) config = NULL; } - if (enabled.socket) - unix_exit(); - if (enabled.media) btd_unregister_adapter_driver(&media_server_driver); diff --git a/audio/unix.c b/audio/unix.c deleted file mode 100644 index 9a10764..0000000 --- a/audio/unix.c +++ /dev/null @@ -1,1909 +0,0 @@ -/* - * - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2006-2010 Nokia Corporation - * Copyright (C) 2004-2010 Marcel Holtmann <marcel@xxxxxxxxxxxx> - * - * - * 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 <stdio.h> -#include <fcntl.h> -#include <sys/socket.h> -#include <sys/un.h> -#include <stdlib.h> -#include <errno.h> -#include <unistd.h> -#include <stdint.h> - -#include <bluetooth/bluetooth.h> -#include <bluetooth/sdp.h> -#include <dbus/dbus.h> -#include <glib.h> - -#include "log.h" -#include "ipc.h" -#include "device.h" -#include "manager.h" -#include "avdtp.h" -#include "media.h" -#include "a2dp.h" -#include "headset.h" -#include "sink.h" -#include "source.h" -#include "gateway.h" -#include "unix.h" - -#define check_nul(str) (str[sizeof(str) - 1] == '\0') - -typedef enum { - TYPE_NONE, - TYPE_HEADSET, - TYPE_GATEWAY, - TYPE_SINK, - TYPE_SOURCE -} service_type_t; - -typedef void (*notify_cb_t) (struct audio_device *dev, void *data); - -struct a2dp_data { - struct avdtp *session; - struct avdtp_stream *stream; - struct a2dp_sep *sep; -}; - -struct headset_data { - gboolean locked; -}; - -struct unix_client { - struct audio_device *dev; - GSList *caps; - service_type_t type; - char *interface; - uint8_t seid; - union { - struct a2dp_data a2dp; - struct headset_data hs; - } d; - int sock; - int lock; - int data_fd; /* To be deleted once two phase configuration is fully implemented */ - unsigned int req_id; - unsigned int cb_id; - gboolean (*cancel) (struct audio_device *dev, unsigned int id); -}; - -static GSList *clients = NULL; - -static int unix_sock = -1; - -static void client_free(void *data) -{ - struct unix_client *client = data; - - DBG("client_free(%p)", client); - - if (client->cancel && client->dev && client->req_id > 0) - client->cancel(client->dev, client->req_id); - - if (client->sock >= 0) - close(client->sock); - - g_slist_free_full(client->caps, g_free); - - g_free(client->interface); - g_free(client); -} - -static int set_nonblocking(int fd) -{ - long arg; - - arg = fcntl(fd, F_GETFL); - if (arg < 0) - return -errno; - - /* Return if already nonblocking */ - if (arg & O_NONBLOCK) - return 0; - - arg |= O_NONBLOCK; - if (fcntl(fd, F_SETFL, arg) < 0) - return -errno; - - return 0; -} - -/* Pass file descriptor through local domain sockets (AF_LOCAL, formerly - * AF_UNIX) and the sendmsg() system call with the cmsg_type field of a "struct - * cmsghdr" set to SCM_RIGHTS and the data being an integer value equal to the - * handle of the file descriptor to be passed. */ -static int unix_sendmsg_fd(int sock, int fd) -{ - char cmsg_b[CMSG_SPACE(sizeof(int))], m = 'm'; - struct cmsghdr *cmsg; - struct iovec iov = { &m, sizeof(m) }; - struct msghdr msgh; - - memset(&msgh, 0, sizeof(msgh)); - msgh.msg_iov = &iov; - msgh.msg_iovlen = 1; - msgh.msg_control = &cmsg_b; - msgh.msg_controllen = CMSG_LEN(sizeof(int)); - - cmsg = CMSG_FIRSTHDR(&msgh); - cmsg->cmsg_level = SOL_SOCKET; - cmsg->cmsg_type = SCM_RIGHTS; - cmsg->cmsg_len = CMSG_LEN(sizeof(int)); - /* Initialize the payload */ - memcpy(CMSG_DATA(cmsg), &fd, sizeof(int)); - - return sendmsg(sock, &msgh, MSG_NOSIGNAL); -} - -static void unix_ipc_sendmsg(struct unix_client *client, - const bt_audio_msg_header_t *msg) -{ - const char *type = bt_audio_strtype(msg->type); - const char *name = bt_audio_strname(msg->name); - - DBG("Audio API: %s -> %s", type, name); - - if (send(client->sock, msg, msg->length, 0) < 0) - error("Error %s(%d)", strerror(errno), errno); -} - -static void unix_ipc_error(struct unix_client *client, uint8_t name, int err) -{ - char buf[BT_SUGGESTED_BUFFER_SIZE]; - bt_audio_error_t *rsp = (void *) buf; - - if (!g_slist_find(clients, client)) - return; - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_ERROR; - rsp->h.name = name; - rsp->h.length = sizeof(*rsp); - - rsp->posix_errno = err; - - DBG("sending error %s(%d)", strerror(err), err); - unix_ipc_sendmsg(client, &rsp->h); -} - -static service_type_t select_service(struct audio_device *dev, const char *interface) -{ - if (!interface) { - if (dev->sink && avdtp_is_connected(&dev->src, &dev->dst)) - return TYPE_SINK; - else if (dev->source && avdtp_is_connected(&dev->src, - &dev->dst)) - return TYPE_SOURCE; - else if (dev->headset && headset_is_active(dev)) - return TYPE_HEADSET; - else if (dev->sink) - return TYPE_SINK; - else if (dev->source) - return TYPE_SOURCE; - else if (dev->headset) - return TYPE_HEADSET; - } else if (!strcmp(interface, AUDIO_SOURCE_INTERFACE) && dev->source) - return TYPE_SOURCE; - else if (!strcmp(interface, AUDIO_SINK_INTERFACE) && dev->sink) - return TYPE_SINK; - else if (!strcmp(interface, AUDIO_HEADSET_INTERFACE) && dev->headset) - return TYPE_HEADSET; - else if (!strcmp(interface, AUDIO_GATEWAY_INTERFACE) && dev->gateway) - return TYPE_GATEWAY; - - return TYPE_NONE; -} - -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 unix_client *client = user_data; - struct a2dp_data *a2dp = &client->d.a2dp; - - switch (new_state) { - case AVDTP_STATE_IDLE: - if (a2dp->sep) { - a2dp_sep_unlock(a2dp->sep, a2dp->session); - a2dp->sep = NULL; - } - if (a2dp->session) { - avdtp_unref(a2dp->session); - a2dp->session = NULL; - } - a2dp->stream = NULL; - client->cb_id = 0; - break; - default: - break; - } -} - -static uint8_t headset_generate_capability(struct audio_device *dev, - codec_capabilities_t *codec) -{ - pcm_capabilities_t *pcm; - - codec->seid = BT_A2DP_SEID_RANGE + 1; - codec->transport = BT_CAPABILITIES_TRANSPORT_SCO; - codec->type = BT_HFP_CODEC_PCM; - codec->length = sizeof(*pcm); - - pcm = (void *) codec; - pcm->sampling_rate = 8000; - if (dev->headset) { - if (headset_get_nrec(dev)) - pcm->flags |= BT_PCM_FLAG_NREC; - if (!headset_get_sco_hci(dev)) - pcm->flags |= BT_PCM_FLAG_PCM_ROUTING; - codec->configured = headset_is_active(dev); - codec->lock = headset_get_lock(dev); - } else { - pcm->flags |= BT_PCM_FLAG_NREC; - codec->configured = TRUE; - codec->lock = 0; - } - - return codec->length; -} - -static void headset_discovery_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_get_capabilities_rsp *rsp = (void *) buf; - uint8_t length; - - client->req_id = 0; - - if (!dev) - goto failed; - - memset(buf, 0, sizeof(buf)); - - length = headset_generate_capability(dev, (void *) rsp->data); - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_GET_CAPABILITIES; - rsp->h.length = sizeof(*rsp) + length; - - ba2str(&dev->src, rsp->source); - ba2str(&dev->dst, rsp->destination); - strncpy(rsp->object, dev->path, sizeof(rsp->object)); - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - error("discovery failed"); - unix_ipc_error(client, BT_SET_CONFIGURATION, EIO); -} - -static void headset_setup_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_set_configuration_rsp *rsp = (void *) buf; - - client->req_id = 0; - - if (!dev) - goto failed; - - memset(buf, 0, sizeof(buf)); - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_SET_CONFIGURATION; - rsp->h.length = sizeof(*rsp); - - rsp->link_mtu = 48; - - client->data_fd = headset_get_sco_fd(dev); - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - error("config failed"); - unix_ipc_error(client, BT_SET_CONFIGURATION, EIO); -} - -static void gateway_setup_complete(struct audio_device *dev, GError *err, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_set_configuration_rsp *rsp = (void *) buf; - - if (err) { - unix_ipc_error(client, BT_SET_CONFIGURATION, err->code); - return; - } - - client->req_id = 0; - - memset(buf, 0, sizeof(buf)); - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_SET_CONFIGURATION; - rsp->h.length = sizeof(*rsp); - - rsp->link_mtu = 48; - - client->data_fd = gateway_get_sco_fd(dev); - - unix_ipc_sendmsg(client, &rsp->h); -} - -static void headset_resume_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_start_stream_rsp *rsp = (void *) buf; - struct bt_new_stream_ind *ind = (void *) buf; - - client->req_id = 0; - - if (!dev) - goto failed; - - client->data_fd = headset_get_sco_fd(dev); - if (client->data_fd < 0) { - error("Unable to get a SCO fd"); - goto failed; - } - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_START_STREAM; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - memset(buf, 0, sizeof(buf)); - ind->h.type = BT_INDICATION; - ind->h.name = BT_NEW_STREAM; - ind->h.length = sizeof(*ind); - - unix_ipc_sendmsg(client, &ind->h); - - if (unix_sendmsg_fd(client->sock, client->data_fd) < 0) { - error("unix_sendmsg_fd: %s(%d)", strerror(errno), errno); - goto failed; - } - - return; - -failed: - error("headset_resume_complete: resume failed"); - unix_ipc_error(client, BT_START_STREAM, EIO); -} - -static void gateway_resume_complete(struct audio_device *dev, GError *err, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_start_stream_rsp *rsp = (void *) buf; - struct bt_new_stream_ind *ind = (void *) buf; - - if (err) { - unix_ipc_error(client, BT_START_STREAM, err->code); - return; - } - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_START_STREAM; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - memset(buf, 0, sizeof(buf)); - ind->h.type = BT_INDICATION; - ind->h.name = BT_NEW_STREAM; - ind->h.length = sizeof(*ind); - - unix_ipc_sendmsg(client, &ind->h); - - client->data_fd = gateway_get_sco_fd(dev); - if (unix_sendmsg_fd(client->sock, client->data_fd) < 0) { - error("unix_sendmsg_fd: %s(%d)", strerror(errno), errno); - unix_ipc_error(client, BT_START_STREAM, EIO); - } - - client->req_id = 0; -} - -static void headset_suspend_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_stop_stream_rsp *rsp = (void *) buf; - - if (!dev) - goto failed; - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_STOP_STREAM; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - error("suspend failed"); - unix_ipc_error(client, BT_STOP_STREAM, EIO); -} - -static void print_mpeg12(struct mpeg_codec_cap *mpeg) -{ - DBG("Media Codec: MPEG12" - " Channel Modes: %s%s%s%s" - " Frequencies: %s%s%s%s%s%s" - " Layers: %s%s%s" - " CRC: %s", - mpeg->channel_mode & MPEG_CHANNEL_MODE_MONO ? "Mono " : "", - mpeg->channel_mode & MPEG_CHANNEL_MODE_DUAL_CHANNEL ? - "DualChannel " : "", - mpeg->channel_mode & MPEG_CHANNEL_MODE_STEREO ? "Stereo " : "", - mpeg->channel_mode & MPEG_CHANNEL_MODE_JOINT_STEREO ? - "JointStereo " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_16000 ? "16Khz " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_22050 ? "22.05Khz " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_24000 ? "24Khz " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_32000 ? "32Khz " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_44100 ? "44.1Khz " : "", - mpeg->frequency & MPEG_SAMPLING_FREQ_48000 ? "48Khz " : "", - mpeg->layer & MPEG_LAYER_MP1 ? "1 " : "", - mpeg->layer & MPEG_LAYER_MP2 ? "2 " : "", - mpeg->layer & MPEG_LAYER_MP3 ? "3 " : "", - mpeg->crc ? "Yes" : "No"); -} - -static void print_sbc(struct sbc_codec_cap *sbc) -{ - DBG("Media Codec: SBC" - " Channel Modes: %s%s%s%s" - " Frequencies: %s%s%s%s" - " Subbands: %s%s" - " Blocks: %s%s%s%s" - " Bitpool: %d-%d", - sbc->channel_mode & SBC_CHANNEL_MODE_MONO ? "Mono " : "", - sbc->channel_mode & SBC_CHANNEL_MODE_DUAL_CHANNEL ? - "DualChannel " : "", - sbc->channel_mode & SBC_CHANNEL_MODE_STEREO ? "Stereo " : "", - sbc->channel_mode & SBC_CHANNEL_MODE_JOINT_STEREO ? "JointStereo" : "", - sbc->frequency & SBC_SAMPLING_FREQ_16000 ? "16Khz " : "", - sbc->frequency & SBC_SAMPLING_FREQ_32000 ? "32Khz " : "", - sbc->frequency & SBC_SAMPLING_FREQ_44100 ? "44.1Khz " : "", - sbc->frequency & SBC_SAMPLING_FREQ_48000 ? "48Khz " : "", - sbc->subbands & SBC_SUBBANDS_4 ? "4 " : "", - sbc->subbands & SBC_SUBBANDS_8 ? "8 " : "", - sbc->block_length & SBC_BLOCK_LENGTH_4 ? "4 " : "", - sbc->block_length & SBC_BLOCK_LENGTH_8 ? "8 " : "", - sbc->block_length & SBC_BLOCK_LENGTH_12 ? "12 " : "", - sbc->block_length & SBC_BLOCK_LENGTH_16 ? "16 " : "", - sbc->min_bitpool, sbc->max_bitpool); -} - -static int a2dp_append_codec(struct bt_get_capabilities_rsp *rsp, - struct avdtp_service_capability *cap, - uint8_t seid, - uint8_t type, - uint8_t configured, - uint8_t lock) -{ - struct avdtp_media_codec_capability *codec_cap = (void *) cap->data; - codec_capabilities_t *codec = (void *) rsp + rsp->h.length; - size_t space_left; - - if (rsp->h.length > BT_SUGGESTED_BUFFER_SIZE) - return -ENOMEM; - - space_left = BT_SUGGESTED_BUFFER_SIZE - rsp->h.length; - - /* endianness prevents direct cast */ - if (codec_cap->media_codec_type == A2DP_CODEC_SBC) { - struct sbc_codec_cap *sbc_cap = (void *) codec_cap; - sbc_capabilities_t *sbc = (void *) codec; - - if (space_left < sizeof(sbc_capabilities_t)) - return -ENOMEM; - - if (type == AVDTP_SEP_TYPE_SINK) - codec->type = BT_A2DP_SBC_SINK; - else if (type == AVDTP_SEP_TYPE_SOURCE) - codec->type = BT_A2DP_SBC_SOURCE; - else - return -EINVAL; - - codec->length = sizeof(sbc_capabilities_t); - - sbc->channel_mode = sbc_cap->channel_mode; - sbc->frequency = sbc_cap->frequency; - sbc->allocation_method = sbc_cap->allocation_method; - sbc->subbands = sbc_cap->subbands; - sbc->block_length = sbc_cap->block_length; - sbc->min_bitpool = sbc_cap->min_bitpool; - sbc->max_bitpool = sbc_cap->max_bitpool; - - print_sbc(sbc_cap); - } else if (codec_cap->media_codec_type == A2DP_CODEC_MPEG12) { - struct mpeg_codec_cap *mpeg_cap = (void *) codec_cap; - mpeg_capabilities_t *mpeg = (void *) codec; - - if (space_left < sizeof(mpeg_capabilities_t)) - return -ENOMEM; - - if (type == AVDTP_SEP_TYPE_SINK) - codec->type = BT_A2DP_MPEG12_SINK; - else if (type == AVDTP_SEP_TYPE_SOURCE) - codec->type = BT_A2DP_MPEG12_SOURCE; - else - return -EINVAL; - - codec->length = sizeof(mpeg_capabilities_t); - - mpeg->channel_mode = mpeg_cap->channel_mode; - mpeg->crc = mpeg_cap->crc; - mpeg->layer = mpeg_cap->layer; - mpeg->frequency = mpeg_cap->frequency; - mpeg->mpf = mpeg_cap->mpf; - mpeg->bitrate = mpeg_cap->bitrate; - - print_mpeg12(mpeg_cap); - } else { - size_t codec_length, type_length, total_length; - - codec_length = cap->length - (sizeof(struct avdtp_service_capability) - + sizeof(struct avdtp_media_codec_capability)); - type_length = sizeof(codec_cap->media_codec_type); - total_length = type_length + codec_length + - sizeof(codec_capabilities_t); - - if (space_left < total_length) - return -ENOMEM; - - if (type == AVDTP_SEP_TYPE_SINK) - codec->type = BT_A2DP_UNKNOWN_SINK; - else if (type == AVDTP_SEP_TYPE_SOURCE) - codec->type = BT_A2DP_UNKNOWN_SOURCE; - else - return -EINVAL; - - codec->length = total_length; - memcpy(codec->data, &codec_cap->media_codec_type, type_length); - memcpy(codec->data + type_length, codec_cap->data, - codec_length); - } - - codec->seid = seid; - codec->configured = configured; - codec->lock = lock; - rsp->h.length += codec->length; - - DBG("Append %s seid %d - length %d - total %d", - configured ? "configured" : "", seid, codec->length, - rsp->h.length); - - return 0; -} - -static void a2dp_discovery_complete(struct avdtp *session, GSList *seps, - struct avdtp_error *err, - void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_get_capabilities_rsp *rsp = (void *) buf; - struct a2dp_data *a2dp = &client->d.a2dp; - - if (!g_slist_find(clients, client)) { - DBG("Client disconnected during discovery"); - return; - } - - if (err) - goto failed; - - memset(buf, 0, sizeof(buf)); - client->req_id = 0; - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_GET_CAPABILITIES; - rsp->h.length = sizeof(*rsp); - ba2str(&client->dev->src, rsp->source); - ba2str(&client->dev->dst, rsp->destination); - strncpy(rsp->object, client->dev->path, sizeof(rsp->object)); - - for (; seps; seps = g_slist_next(seps)) { - struct avdtp_remote_sep *rsep = seps->data; - struct a2dp_sep *sep; - struct avdtp_service_capability *cap; - struct avdtp_stream *stream; - uint8_t type, seid, configured = 0, lock = 0; - GSList *cl; - - type = avdtp_get_type(rsep); - - if (type != AVDTP_SEP_TYPE_SINK && - type != AVDTP_SEP_TYPE_SOURCE) - continue; - - cap = avdtp_get_codec(rsep); - - if (cap->category != AVDTP_MEDIA_CODEC) - continue; - - seid = avdtp_get_seid(rsep); - - if (client->seid != 0 && client->seid != seid) - continue; - - stream = avdtp_get_stream(rsep); - if (stream) { - configured = 1; - if (client->seid == seid) - cap = avdtp_stream_get_codec(stream); - } - - for (cl = clients; cl; cl = cl->next) { - struct unix_client *c = cl->data; - struct a2dp_data *ca2dp = &c->d.a2dp; - - if (ca2dp->session == session && c->seid == seid) { - lock = c->lock; - break; - } - } - - sep = a2dp_get_sep(session, stream); - if (sep && a2dp_sep_get_lock(sep)) - lock = BT_WRITE_LOCK; - - a2dp_append_codec(rsp, cap, seid, type, configured, lock); - } - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - error("discovery failed"); - unix_ipc_error(client, BT_GET_CAPABILITIES, EIO); - - if (a2dp->sep) { - a2dp_sep_unlock(a2dp->sep, a2dp->session); - a2dp->sep = NULL; - } - - avdtp_unref(a2dp->session); - a2dp->session = NULL; - a2dp->stream = NULL; -} - -static void a2dp_config_complete(struct avdtp *session, struct a2dp_sep *sep, - struct avdtp_stream *stream, - struct avdtp_error *err, - void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_set_configuration_rsp *rsp = (void *) buf; - struct a2dp_data *a2dp = &client->d.a2dp; - uint16_t imtu, omtu; - GSList *caps; - - client->req_id = 0; - - if (err) - goto failed; - - memset(buf, 0, sizeof(buf)); - - if (!stream) - goto failed; - - if (client->cb_id > 0) - avdtp_stream_remove_cb(a2dp->session, a2dp->stream, - client->cb_id); - - a2dp->sep = sep; - a2dp->stream = stream; - - if (!avdtp_stream_get_transport(stream, &client->data_fd, &imtu, &omtu, - &caps)) { - error("Unable to get stream transport"); - goto failed; - } - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_SET_CONFIGURATION; - rsp->h.length = sizeof(*rsp); - - /* FIXME: Use imtu when fd_opt is CFG_FD_OPT_READ */ - rsp->link_mtu = omtu; - - unix_ipc_sendmsg(client, &rsp->h); - - client->cb_id = avdtp_stream_add_cb(session, stream, - stream_state_changed, client); - - return; - -failed: - error("config failed"); - - unix_ipc_error(client, BT_SET_CONFIGURATION, EIO); - - avdtp_unref(a2dp->session); - - a2dp->session = NULL; - a2dp->stream = NULL; - a2dp->sep = NULL; -} - -static void a2dp_resume_complete(struct avdtp *session, - struct avdtp_error *err, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_start_stream_rsp *rsp = (void *) buf; - struct bt_new_stream_ind *ind = (void *) buf; - struct a2dp_data *a2dp = &client->d.a2dp; - - if (err) - goto failed; - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_START_STREAM; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - memset(buf, 0, sizeof(buf)); - ind->h.type = BT_RESPONSE; - ind->h.name = BT_NEW_STREAM; - rsp->h.length = sizeof(*ind); - - unix_ipc_sendmsg(client, &ind->h); - - if (unix_sendmsg_fd(client->sock, client->data_fd) < 0) { - error("unix_sendmsg_fd: %s(%d)", strerror(errno), errno); - goto failed; - } - - return; - -failed: - error("resume failed"); - - unix_ipc_error(client, BT_START_STREAM, EIO); - - if (client->cb_id > 0) { - avdtp_stream_remove_cb(a2dp->session, a2dp->stream, - client->cb_id); - client->cb_id = 0; - } - - if (a2dp->sep) { - a2dp_sep_unlock(a2dp->sep, a2dp->session); - a2dp->sep = NULL; - } - - avdtp_unref(a2dp->session); - a2dp->session = NULL; - a2dp->stream = NULL; -} - -static void a2dp_suspend_complete(struct avdtp *session, - struct avdtp_error *err, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_stop_stream_rsp *rsp = (void *) buf; - - if (err) - goto failed; - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_STOP_STREAM; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - error("suspend failed"); - - unix_ipc_error(client, BT_STOP_STREAM, EIO); -} - -static void start_discovery(struct audio_device *dev, struct unix_client *client) -{ - struct a2dp_data *a2dp; - int err = 0; - - switch (client->type) { - case TYPE_SINK: - case TYPE_SOURCE: - a2dp = &client->d.a2dp; - - if (!a2dp->session) - a2dp->session = avdtp_get(&dev->src, &dev->dst); - - if (!a2dp->session) { - error("Unable to get a session"); - goto failed; - } - - err = avdtp_discover(a2dp->session, a2dp_discovery_complete, - client); - if (err) { - if (a2dp->session) { - avdtp_unref(a2dp->session); - a2dp->session = NULL; - } - goto failed; - } - break; - - case TYPE_HEADSET: - case TYPE_GATEWAY: - headset_discovery_complete(dev, client); - break; - - default: - error("No known services for device"); - goto failed; - } - - client->dev = dev; - - return; - -failed: - unix_ipc_error(client, BT_GET_CAPABILITIES, err ? : EIO); -} - -static void open_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_open_rsp *rsp = (void *) buf; - - memset(buf, 0, sizeof(buf)); - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_OPEN; - rsp->h.length = sizeof(*rsp); - - ba2str(&dev->src, rsp->source); - ba2str(&dev->dst, rsp->destination); - strncpy(rsp->object, dev->path, sizeof(rsp->object)); - - unix_ipc_sendmsg(client, &rsp->h); -} - -static void start_open(struct audio_device *dev, struct unix_client *client) -{ - struct a2dp_data *a2dp; - struct headset_data *hs; - struct avdtp_remote_sep *rsep; - gboolean unref_avdtp_on_fail = FALSE; - - switch (client->type) { - case TYPE_SINK: - case TYPE_SOURCE: - a2dp = &client->d.a2dp; - - if (!a2dp->session) { - a2dp->session = avdtp_get(&dev->src, &dev->dst); - unref_avdtp_on_fail = TRUE; - } - - if (!a2dp->session) { - error("Unable to get a session"); - goto failed; - } - - if (a2dp->sep) { - error("Client already has an opened session"); - goto failed; - } - - rsep = avdtp_get_remote_sep(a2dp->session, client->seid); - if (!rsep) { - error("Invalid seid %d", client->seid); - goto failed; - } - - a2dp->sep = a2dp_get(a2dp->session, rsep); - if (!a2dp->sep) { - error("seid %d not available or locked", client->seid); - goto failed; - } - - if (!a2dp_sep_lock(a2dp->sep, a2dp->session)) { - error("Unable to open seid %d", client->seid); - a2dp->sep = NULL; - goto failed; - } - - break; - - case TYPE_HEADSET: - hs = &client->d.hs; - - if (hs->locked) { - error("Client already has an opened session"); - goto failed; - } - - hs->locked = headset_lock(dev, client->lock); - if (!hs->locked) { - error("Unable to open seid %d", client->seid); - goto failed; - } - break; - - case TYPE_GATEWAY: - break; - default: - error("No known services for device"); - goto failed; - } - - client->dev = dev; - - open_complete(dev, client); - - return; - -failed: - if (unref_avdtp_on_fail && a2dp->session) { - avdtp_unref(a2dp->session); - a2dp->session = NULL; - } - unix_ipc_error(client, BT_OPEN, EINVAL); -} - -static void start_config(struct audio_device *dev, struct unix_client *client) -{ - struct a2dp_data *a2dp; - struct headset_data *hs; - unsigned int id; - - switch (client->type) { - case TYPE_SINK: - case TYPE_SOURCE: - a2dp = &client->d.a2dp; - - if (!a2dp->session) - a2dp->session = avdtp_get(&dev->src, &dev->dst); - - if (!a2dp->session) { - error("Unable to get a session"); - goto failed; - } - - if (!a2dp->sep) { - error("seid %d not opened", client->seid); - goto failed; - } - - id = a2dp_config(a2dp->session, a2dp->sep, a2dp_config_complete, - client->caps, client); - client->cancel = a2dp_cancel; - break; - - case TYPE_HEADSET: - hs = &client->d.hs; - - if (!hs->locked) { - error("seid %d not opened", client->seid); - goto failed; - } - - id = headset_config_stream(dev, TRUE, headset_setup_complete, - client); - client->cancel = headset_cancel_stream; - break; - case TYPE_GATEWAY: - id = gateway_config_stream(dev, gateway_setup_complete, client); - client->cancel = gateway_cancel_stream; - break; - - default: - error("No known services for device"); - goto failed; - } - - if (id == 0) { - error("config failed"); - goto failed; - } - - client->req_id = id; - g_slist_free(client->caps); - client->caps = NULL; - - return; - -failed: - unix_ipc_error(client, BT_SET_CONFIGURATION, EIO); -} - -static void start_resume(struct audio_device *dev, struct unix_client *client) -{ - struct a2dp_data *a2dp = NULL; - struct headset_data *hs; - unsigned int id; - struct avdtp *session = NULL; - - switch (client->type) { - case TYPE_SINK: - case TYPE_SOURCE: - a2dp = &client->d.a2dp; - - if (!a2dp->sep) { - error("seid not opened"); - goto failed; - } - - if (!a2dp->session) { - session = avdtp_get(&dev->src, &dev->dst); - if (!session) { - error("Unable to get a session"); - goto failed; - } - a2dp->session = session; - } - - id = a2dp_resume(a2dp->session, a2dp->sep, a2dp_resume_complete, - client); - client->cancel = a2dp_cancel; - - break; - - case TYPE_HEADSET: - hs = &client->d.hs; - - if (!hs->locked) { - error("seid not opened"); - goto failed; - } - - id = headset_request_stream(dev, headset_resume_complete, - client); - client->cancel = headset_cancel_stream; - break; - - case TYPE_GATEWAY: - id = gateway_request_stream(dev, gateway_resume_complete, - client); - client->cancel = gateway_cancel_stream; - break; - - default: - error("No known services for device"); - goto failed; - } - - if (id == 0) { - error("start_resume: resume failed"); - goto failed; - } - - client->req_id = id; - - return; - -failed: - if (session) { - avdtp_unref(session); - a2dp->session = NULL; - } - - unix_ipc_error(client, BT_START_STREAM, EIO); -} - -static void start_suspend(struct audio_device *dev, struct unix_client *client) -{ - struct a2dp_data *a2dp = NULL; - struct headset_data *hs; - unsigned int id; - struct avdtp *session = NULL; - - switch (client->type) { - case TYPE_SINK: - case TYPE_SOURCE: - a2dp = &client->d.a2dp; - - if (!a2dp->sep) { - error("seid not opened"); - goto failed; - } - - if (!a2dp->session) { - session = avdtp_get(&dev->src, &dev->dst); - if (!session) { - error("Unable to get a session"); - goto failed; - } - a2dp->session = session; - } - - if (!a2dp->sep) { - error("Unable to get a sep"); - goto failed; - } - - id = a2dp_suspend(a2dp->session, a2dp->sep, - a2dp_suspend_complete, client); - client->cancel = a2dp_cancel; - break; - - case TYPE_HEADSET: - hs = &client->d.hs; - - if (!hs->locked) { - error("seid not opened"); - goto failed; - } - - id = headset_suspend_stream(dev, headset_suspend_complete, - client); - client->cancel = headset_cancel_stream; - break; - - case TYPE_GATEWAY: - gateway_suspend_stream(dev); - client->cancel = gateway_cancel_stream; - headset_suspend_complete(dev, client); - id = 1; - break; - - default: - error("No known services for device"); - goto failed; - } - - if (id == 0) { - error("suspend failed"); - goto failed; - } - - return; - -failed: - if (session) { - avdtp_unref(session); - a2dp->session = NULL; - } - - unix_ipc_error(client, BT_STOP_STREAM, EIO); -} - -static void close_complete(struct audio_device *dev, void *user_data) -{ - struct unix_client *client = user_data; - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_close_rsp *rsp = (void *) buf; - - memset(buf, 0, sizeof(buf)); - - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_CLOSE; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - return; -} - -static void start_close(struct audio_device *dev, struct unix_client *client, - gboolean reply) -{ - struct a2dp_data *a2dp; - struct headset_data *hs; - - if (!client->dev) - goto failed; - - switch (client->type) { - case TYPE_HEADSET: - hs = &client->d.hs; - - if (client->dev && hs->locked) { - headset_unlock(client->dev, client->lock); - hs->locked = FALSE; - } - break; - case TYPE_GATEWAY: - break; - case TYPE_SOURCE: - case TYPE_SINK: - a2dp = &client->d.a2dp; - - if (client->cb_id > 0) { - avdtp_stream_remove_cb(a2dp->session, a2dp->stream, - client->cb_id); - client->cb_id = 0; - } - if (a2dp->sep) { - a2dp_sep_unlock(a2dp->sep, a2dp->session); - a2dp->sep = NULL; - } - if (a2dp->session) { - avdtp_unref(a2dp->session); - a2dp->session = NULL; - } - a2dp->stream = NULL; - break; - default: - error("No known services for device"); - goto failed; - } - - if (!reply) - return; - - close_complete(dev, client); - client->dev = NULL; - - return; - -failed: - if (reply) - unix_ipc_error(client, BT_STOP_STREAM, EINVAL); -} - -static void handle_getcapabilities_req(struct unix_client *client, - struct bt_get_capabilities_req *req) -{ - struct audio_device *dev; - bdaddr_t src, dst; - int err = EIO; - const char *interface; - - if (!check_nul(req->source) || !check_nul(req->destination) || - !check_nul(req->object)) { - err = EINVAL; - goto failed; - } - - str2ba(req->source, &src); - str2ba(req->destination, &dst); - - if (!manager_find_device(req->object, &src, &dst, NULL, FALSE)) - goto failed; - - if (req->transport == BT_CAPABILITIES_TRANSPORT_SCO) - interface = AUDIO_HEADSET_INTERFACE; - else if (req->transport == BT_CAPABILITIES_TRANSPORT_A2DP) - interface = AUDIO_SINK_INTERFACE; - else - interface = client->interface; - - dev = manager_find_device(req->object, &src, &dst, interface, TRUE); - if (!dev && (req->flags & BT_FLAG_AUTOCONNECT)) - dev = manager_find_device(req->object, &src, &dst, - interface, FALSE); - - if (!dev) { - if (req->transport == BT_CAPABILITIES_TRANSPORT_SCO) - interface = AUDIO_GATEWAY_INTERFACE; - else if (req->transport == BT_CAPABILITIES_TRANSPORT_A2DP) - interface = AUDIO_SOURCE_INTERFACE; - else - interface = NULL; - dev = manager_find_device(req->object, &src, &dst, - interface, TRUE); - if (!dev && (req->flags & BT_FLAG_AUTOCONNECT)) - dev = manager_find_device(req->object, &src, &dst, - interface, FALSE); - } - - if (!dev) { - error("Unable to find a matching device"); - goto failed; - } - - client->type = select_service(dev, interface); - if (client->type == TYPE_NONE) { - error("No matching service found"); - goto failed; - } - - if (g_strcmp0(interface, client->interface) != 0) { - g_free(client->interface); - client->interface = g_strdup(interface); - } - - client->seid = req->seid; - - start_discovery(dev, client); - - return; - -failed: - unix_ipc_error(client, BT_GET_CAPABILITIES, err); -} - -static int handle_sco_open(struct unix_client *client, struct bt_open_req *req) -{ - if (!client->interface) - client->interface = g_strdup(AUDIO_HEADSET_INTERFACE); - else if (!g_str_equal(client->interface, AUDIO_HEADSET_INTERFACE) && - !g_str_equal(client->interface, AUDIO_GATEWAY_INTERFACE)) - return -EIO; - - DBG("open sco - object=%s source=%s destination=%s lock=%s%s", - strcmp(req->object, "") ? req->object : "ANY", - strcmp(req->source, "") ? req->source : "ANY", - strcmp(req->destination, "") ? req->destination : "ANY", - req->lock & BT_READ_LOCK ? "read" : "", - req->lock & BT_WRITE_LOCK ? "write" : ""); - - return 0; -} - -static int handle_a2dp_open(struct unix_client *client, struct bt_open_req *req) -{ - if (!client->interface) - /* FIXME: are we treating a sink or a source? */ - client->interface = g_strdup(AUDIO_SINK_INTERFACE); - else if (!g_str_equal(client->interface, AUDIO_SINK_INTERFACE) && - !g_str_equal(client->interface, AUDIO_SOURCE_INTERFACE)) - return -EIO; - - DBG("open a2dp - object=%s source=%s destination=%s lock=%s%s", - strcmp(req->object, "") ? req->object : "ANY", - strcmp(req->source, "") ? req->source : "ANY", - strcmp(req->destination, "") ? req->destination : "ANY", - req->lock & BT_READ_LOCK ? "read" : "", - req->lock & BT_WRITE_LOCK ? "write" : ""); - - return 0; -} - -static void handle_open_req(struct unix_client *client, struct bt_open_req *req) -{ - struct audio_device *dev; - bdaddr_t src, dst; - int err = 0; - - if (!check_nul(req->source) || !check_nul(req->destination) || - !check_nul(req->object)) { - err = EINVAL; - goto failed; - } - - str2ba(req->source, &src); - str2ba(req->destination, &dst); - - if (req->seid > BT_A2DP_SEID_RANGE) { - err = handle_sco_open(client, req); - if (err < 0) { - err = -err; - goto failed; - } - } else { - err = handle_a2dp_open(client, req); - if (err < 0) { - err = -err; - goto failed; - } - } - - if (!manager_find_device(req->object, &src, &dst, NULL, FALSE)) - goto failed; - - dev = manager_find_device(req->object, &src, &dst, client->interface, - TRUE); - if (!dev) - dev = manager_find_device(req->object, &src, &dst, - client->interface, FALSE); - - if (!dev) - goto failed; - - client->seid = req->seid; - client->lock = req->lock; - - start_open(dev, client); - - return; - -failed: - unix_ipc_error(client, BT_OPEN, err ? : EIO); -} - -static int handle_sco_transport(struct unix_client *client, - struct bt_set_configuration_req *req) -{ - struct audio_device *dev = client->dev; - - if (!client->interface) { - if (dev->headset) - client->interface = g_strdup(AUDIO_HEADSET_INTERFACE); - else if (dev->gateway) - client->interface = g_strdup(AUDIO_GATEWAY_INTERFACE); - else - return -EIO; - } else if (!g_str_equal(client->interface, AUDIO_HEADSET_INTERFACE) && - !g_str_equal(client->interface, AUDIO_GATEWAY_INTERFACE)) - return -EIO; - - return 0; -} - -static int handle_a2dp_transport(struct unix_client *client, - struct bt_set_configuration_req *req) -{ - struct avdtp_service_capability *media_transport, *media_codec; - struct sbc_codec_cap sbc_cap; - struct mpeg_codec_cap mpeg_cap; - - if (!client->interface) - /* FIXME: are we treating a sink or a source? */ - client->interface = g_strdup(AUDIO_SINK_INTERFACE); - else if (!g_str_equal(client->interface, AUDIO_SINK_INTERFACE) && - !g_str_equal(client->interface, AUDIO_SOURCE_INTERFACE)) - return -EIO; - - g_slist_free_full(client->caps, g_free); - client->caps = NULL; - - media_transport = avdtp_service_cap_new(AVDTP_MEDIA_TRANSPORT, - NULL, 0); - - client->caps = g_slist_append(client->caps, media_transport); - - if (req->codec.type == BT_A2DP_MPEG12_SINK || - req->codec.type == BT_A2DP_MPEG12_SOURCE) { - mpeg_capabilities_t *mpeg = (void *) &req->codec; - - memset(&mpeg_cap, 0, sizeof(mpeg_cap)); - - mpeg_cap.cap.media_type = AVDTP_MEDIA_TYPE_AUDIO; - mpeg_cap.cap.media_codec_type = A2DP_CODEC_MPEG12; - mpeg_cap.channel_mode = mpeg->channel_mode; - mpeg_cap.crc = mpeg->crc; - mpeg_cap.layer = mpeg->layer; - mpeg_cap.frequency = mpeg->frequency; - mpeg_cap.mpf = mpeg->mpf; - mpeg_cap.bitrate = mpeg->bitrate; - - media_codec = avdtp_service_cap_new(AVDTP_MEDIA_CODEC, &mpeg_cap, - sizeof(mpeg_cap)); - - print_mpeg12(&mpeg_cap); - } else if (req->codec.type == BT_A2DP_SBC_SINK || - req->codec.type == BT_A2DP_SBC_SOURCE) { - sbc_capabilities_t *sbc = (void *) &req->codec; - - memset(&sbc_cap, 0, sizeof(sbc_cap)); - - sbc_cap.cap.media_type = AVDTP_MEDIA_TYPE_AUDIO; - sbc_cap.cap.media_codec_type = A2DP_CODEC_SBC; - sbc_cap.channel_mode = sbc->channel_mode; - sbc_cap.frequency = sbc->frequency; - sbc_cap.allocation_method = sbc->allocation_method; - sbc_cap.subbands = sbc->subbands; - sbc_cap.block_length = sbc->block_length; - sbc_cap.min_bitpool = sbc->min_bitpool; - sbc_cap.max_bitpool = sbc->max_bitpool; - - media_codec = avdtp_service_cap_new(AVDTP_MEDIA_CODEC, &sbc_cap, - sizeof(sbc_cap)); - - print_sbc(&sbc_cap); - } else - return -EINVAL; - - client->caps = g_slist_append(client->caps, media_codec); - - return 0; -} - -static void handle_setconfiguration_req(struct unix_client *client, - struct bt_set_configuration_req *req) -{ - int err = 0; - - if (req->codec.seid != client->seid) { - error("Unable to set configuration: seid %d not opened", - req->codec.seid); - goto failed; - } - - if (!client->dev) - goto failed; - - if (req->codec.transport == BT_CAPABILITIES_TRANSPORT_SCO) { - err = handle_sco_transport(client, req); - if (err < 0) { - err = -err; - goto failed; - } - } else if (req->codec.transport == BT_CAPABILITIES_TRANSPORT_A2DP) { - err = handle_a2dp_transport(client, req); - if (err < 0) { - err = -err; - goto failed; - } - } - - start_config(client->dev, client); - - return; - -failed: - unix_ipc_error(client, BT_SET_CONFIGURATION, err ? : EIO); -} - -static void handle_streamstart_req(struct unix_client *client, - struct bt_start_stream_req *req) -{ - if (!client->dev) - goto failed; - - start_resume(client->dev, client); - - return; - -failed: - unix_ipc_error(client, BT_START_STREAM, EIO); -} - -static void handle_streamstop_req(struct unix_client *client, - struct bt_stop_stream_req *req) -{ - if (!client->dev) - goto failed; - - start_suspend(client->dev, client); - - return; - -failed: - unix_ipc_error(client, BT_STOP_STREAM, EIO); -} - -static void handle_close_req(struct unix_client *client, - struct bt_close_req *req) -{ - if (!client->dev) - goto failed; - - start_close(client->dev, client, TRUE); - - return; - -failed: - unix_ipc_error(client, BT_CLOSE, EIO); -} - -static void handle_control_req(struct unix_client *client, - struct bt_control_req *req) -{ - /* FIXME: really implement that */ - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_set_configuration_rsp *rsp = (void *) buf; - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_CONTROL; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); -} - -static void handle_delay_report_req(struct unix_client *client, - struct bt_delay_report_req *req) -{ - char buf[BT_SUGGESTED_BUFFER_SIZE]; - struct bt_set_configuration_rsp *rsp = (void *) buf; - struct a2dp_data *a2dp; - int err; - - if (!client->dev) { - err = -ENODEV; - goto failed; - } - - switch (client->type) { - case TYPE_HEADSET: - case TYPE_GATEWAY: - err = -EINVAL; - goto failed; - case TYPE_SOURCE: - case TYPE_SINK: - a2dp = &client->d.a2dp; - if (a2dp->session && a2dp->stream) { - err = avdtp_delay_report(a2dp->session, a2dp->stream, - req->delay); - if (err < 0) - goto failed; - } else { - err = -EINVAL; - goto failed; - } - break; - default: - error("No known services for device"); - err = -EINVAL; - goto failed; - } - - memset(buf, 0, sizeof(buf)); - rsp->h.type = BT_RESPONSE; - rsp->h.name = BT_DELAY_REPORT; - rsp->h.length = sizeof(*rsp); - - unix_ipc_sendmsg(client, &rsp->h); - - return; - -failed: - unix_ipc_error(client, BT_DELAY_REPORT, -err); -} - -static gboolean client_cb(GIOChannel *chan, GIOCondition cond, gpointer data) -{ - char buf[BT_SUGGESTED_BUFFER_SIZE]; - bt_audio_msg_header_t *msghdr = (void *) buf; - struct unix_client *client = data; - int len; - const char *type, *name; - - if (cond & G_IO_NVAL) - return FALSE; - - if (cond & (G_IO_HUP | G_IO_ERR)) { - DBG("Unix client disconnected (fd=%d)", client->sock); - - goto failed; - } - - memset(buf, 0, sizeof(buf)); - - len = recv(client->sock, buf, sizeof(buf), 0); - if (len < 0) { - error("recv: %s (%d)", strerror(errno), errno); - goto failed; - } - - type = bt_audio_strtype(msghdr->type); - name = bt_audio_strname(msghdr->name); - - DBG("Audio API: %s <- %s", type, name); - - if (msghdr->length != len) { - error("Invalid message: length mismatch"); - goto failed; - } - - switch (msghdr->name) { - case BT_GET_CAPABILITIES: - handle_getcapabilities_req(client, - (struct bt_get_capabilities_req *) msghdr); - break; - case BT_OPEN: - handle_open_req(client, - (struct bt_open_req *) msghdr); - break; - case BT_SET_CONFIGURATION: - handle_setconfiguration_req(client, - (struct bt_set_configuration_req *) msghdr); - break; - case BT_START_STREAM: - handle_streamstart_req(client, - (struct bt_start_stream_req *) msghdr); - break; - case BT_STOP_STREAM: - handle_streamstop_req(client, - (struct bt_stop_stream_req *) msghdr); - break; - case BT_CLOSE: - handle_close_req(client, - (struct bt_close_req *) msghdr); - break; - case BT_CONTROL: - handle_control_req(client, - (struct bt_control_req *) msghdr); - break; - case BT_DELAY_REPORT: - handle_delay_report_req(client, - (struct bt_delay_report_req *) msghdr); - break; - default: - error("Audio API: received unexpected message name %d", - msghdr->name); - } - - return TRUE; - -failed: - clients = g_slist_remove(clients, client); - start_close(client->dev, client, FALSE); - client_free(client); - return FALSE; -} - -static gboolean server_cb(GIOChannel *chan, GIOCondition cond, gpointer data) -{ - struct sockaddr_un addr; - socklen_t addrlen; - int sk, cli_sk; - struct unix_client *client; - GIOChannel *io; - - if (cond & G_IO_NVAL) - return FALSE; - - if (cond & (G_IO_HUP | G_IO_ERR)) { - g_io_channel_shutdown(chan, TRUE, NULL); - return FALSE; - } - - sk = g_io_channel_unix_get_fd(chan); - - memset(&addr, 0, sizeof(addr)); - addrlen = sizeof(addr); - - cli_sk = accept(sk, (struct sockaddr *) &addr, &addrlen); - if (cli_sk < 0) { - error("accept: %s (%d)", strerror(errno), errno); - return TRUE; - } - - DBG("Accepted new client connection on unix socket (fd=%d)", cli_sk); - set_nonblocking(cli_sk); - - client = g_new0(struct unix_client, 1); - client->sock = cli_sk; - clients = g_slist_append(clients, client); - - io = g_io_channel_unix_new(cli_sk); - g_io_add_watch(io, G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL, - client_cb, client); - g_io_channel_unref(io); - - return TRUE; -} - -void unix_device_removed(struct audio_device *dev) -{ - GSList *l; - - DBG("unix_device_removed(%p)", dev); - - l = clients; - while (l) { - struct unix_client *client = l->data; - - l = l->next; - - if (client->dev == dev) { - clients = g_slist_remove(clients, client); - start_close(client->dev, client, FALSE); - client_free(client); - } - } -} - -void unix_delay_report(struct audio_device *dev, uint8_t seid, uint16_t delay) -{ - GSList *l; - struct bt_delay_report_ind ind; - - DBG("unix_delay_report(%p): %u.%ums", dev, delay / 10, delay % 10); - - memset(&ind, 0, sizeof(ind)); - ind.h.type = BT_INDICATION; - ind.h.name = BT_DELAY_REPORT; - ind.h.length = sizeof(ind); - ind.delay = delay; - - for (l = clients; l != NULL; l = g_slist_next(l)) { - struct unix_client *client = l->data; - - if (client->dev != dev || client->seid != seid) - continue; - - unix_ipc_sendmsg(client, (void *) &ind); - } -} - -int unix_init(void) -{ - GIOChannel *io; - struct sockaddr_un addr = { - AF_UNIX, BT_IPC_SOCKET_NAME - }; - - int sk, err; - - sk = socket(PF_LOCAL, SOCK_STREAM, 0); - if (sk < 0) { - err = -errno; - error("Can't create unix socket: %s (%d)", strerror(-err), - -err); - return err; - } - - if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) { - err = -errno; - error("Can't bind unix socket: %s (%d)", strerror(-err), - -err); - close(sk); - return err; - } - - set_nonblocking(sk); - - if (listen(sk, 1) < 0) { - err = -errno; - error("Can't listen on unix socket: %s (%d)", strerror(-err), - -err); - close(sk); - return err; - } - - unix_sock = sk; - - io = g_io_channel_unix_new(sk); - g_io_add_watch(io, G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL, - server_cb, NULL); - g_io_channel_unref(io); - - DBG("Unix socket created: %d", sk); - - return 0; -} - -void unix_exit(void) -{ - g_slist_free_full(clients, client_free); - if (unix_sock >= 0) { - close(unix_sock); - unix_sock = -1; - } -} diff --git a/audio/unix.h b/audio/unix.h deleted file mode 100644 index 74ca16d..0000000 --- a/audio/unix.h +++ /dev/null @@ -1,30 +0,0 @@ -/* - * - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2006-2010 Nokia Corporation - * Copyright (C) 2004-2010 Marcel Holtmann <marcel@xxxxxxxxxxxx> - * - * - * 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 - * - */ - -void unix_device_removed(struct audio_device *dev); - -void unix_delay_report(struct audio_device *dev, uint8_t seid, uint16_t delay); - -int unix_init(void); -void unix_exit(void); -- 1.7.10.2 -- To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html