/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2006-2010 Nokia Corporation
* Copyright (C) 2004-2010 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 <stdio.h>
#include <errno.h>
#include <unistd.h>
#include <sys/stat.h>
#include <sys/param.h>
#include <netinet/in.h>
#include <bluetooth/bluetooth.h>
#include <bluetooth/hci.h>
#include <bluetooth/hci_lib.h>
#include <bluetooth/sdp.h>
#include <bluetooth/sdp_lib.h>
#include <glib.h>
#include <dbus/dbus.h>
#include <gdbus.h>
#include "log.h"
#include "textfile.h"
#include "../src/adapter.h"
#include "../src/device.h"
#include "error.h"
#include "ipc.h"
#include "dbus-common.h"
#include "device.h"
#include "unix.h"
#include "avdtp.h"
#include "control.h"
#include "headset.h"
#include "gateway.h"
#include "sink.h"
#include "source.h"
#define AUDIO_INTERFACE "org.bluez.Audio"
#define CONTROL_CONNECT_TIMEOUT 2
#define AVDTP_CONNECT_TIMEOUT 1
#define HEADSET_CONNECT_TIMEOUT 1
typedef enum {
AUDIO_STATE_DISCONNECTED,
AUDIO_STATE_CONNECTING,
AUDIO_STATE_CONNECTED,
} audio_state_t;
struct service_auth {
service_auth_cb cb;
void *user_data;
};
struct dev_priv {
audio_state_t state;
headset_state_t hs_state;
sink_state_t sink_state;
avctp_state_t avctp_state;
GSList *auths;
DBusMessage *conn_req;
DBusMessage *dc_req;
guint control_timer;
guint avdtp_timer;
guint headset_timer;
gboolean authorized;
guint auth_idle_id;
};
static unsigned int sink_callback_id = 0;
static unsigned int avctp_callback_id = 0;
static unsigned int avdtp_callback_id = 0;
static unsigned int headset_callback_id = 0;
static void device_free(struct audio_device *dev)
{
struct dev_priv *priv = dev->priv;
if (dev->conn)
dbus_connection_unref(dev->conn);
btd_device_unref(dev->btd_dev);
if (priv) {
if (priv->control_timer)
g_source_remove(priv->control_timer);
if (priv->avdtp_timer)
g_source_remove(priv->avdtp_timer);
if (priv->headset_timer)
g_source_remove(priv->headset_timer);
if (priv->dc_req)
dbus_message_unref(priv->dc_req);
if (priv->conn_req)
dbus_message_unref(priv->conn_req);
g_free(priv);
}
g_free(dev->path);
g_free(dev);
}
static const char *state2str(audio_state_t state)
{
switch (state) {
case AUDIO_STATE_DISCONNECTED:
return "disconnected";
case AUDIO_STATE_CONNECTING:
return "connecting";
case AUDIO_STATE_CONNECTED:
return "connected";
default:
error("Invalid audio state %d", state);
return NULL;
}
}
static void device_set_state(struct audio_device *dev, audio_state_t new_state)
{
struct dev_priv *priv = dev->priv;
const char *state_str;
DBusMessage *reply = NULL;
state_str = state2str(new_state);
if (!state_str)
return;
if (new_state == AUDIO_STATE_DISCONNECTED)
priv->authorized = FALSE;
if (dev->priv->state == new_state) {
DBG("state change attempted from %s to %s",
state_str, state_str);
return;
}
dev->priv->state = new_state;
if (priv->dc_req && new_state == AUDIO_STATE_DISCONNECTED) {
reply = dbus_message_new_method_return(priv->dc_req);
dbus_message_unref(priv->dc_req);
priv->dc_req = NULL;
g_dbus_send_message(dev->conn, reply);
}
if (priv->conn_req && new_state != AUDIO_STATE_CONNECTING) {
if (new_state == AUDIO_STATE_CONNECTED)
reply = dbus_message_new_method_return(priv->conn_req);
else
reply = g_dbus_create_error(priv->conn_req,
ERROR_INTERFACE
".ConnectFailed",
"Connecting failed");
dbus_message_unref(priv->conn_req);
priv->conn_req = NULL;
g_dbus_send_message(dev->conn, reply);
}
emit_property_changed(dev->conn, dev->path,
AUDIO_INTERFACE, "State",
DBUS_TYPE_STRING, &state_str);
}
static gboolean control_connect_timeout(gpointer user_data)
{
struct audio_device *dev = user_data;
dev->priv->control_timer = 0;
if (dev->control)
avrcp_connect(dev);
return FALSE;
}
static gboolean device_set_control_timer(struct audio_device *dev)
{
struct dev_priv *priv = dev->priv;
if (!dev->control)
return FALSE;
if (priv->control_timer)
return FALSE;
priv->control_timer = g_timeout_add_seconds(CONTROL_CONNECT_TIMEOUT,
control_connect_timeout,
dev);
return TRUE;
}
static void device_remove_control_timer(struct audio_device *dev)
{
if (dev->priv->control_timer)
g_source_remove(dev->priv->control_timer);
dev->priv->control_timer = 0;
}
static gboolean avdtp_connect_timeout(gpointer user_data)
{
struct audio_device *dev = user_data;
dev->priv->avdtp_timer = 0;
if (dev->sink) {
struct avdtp *session = avdtp_get(&dev->src, &dev->dst);
if (!session)
return FALSE;
sink_setup_stream(dev->sink, session);
avdtp_unref(session);
}
return FALSE;
}
static gboolean device_set_avdtp_timer(struct audio_device *dev)
{
struct dev_priv *priv = dev->priv;
if (!dev->sink)
return FALSE;
if (priv->avdtp_timer)
return FALSE;
priv->avdtp_timer = g_timeout_add_seconds(AVDTP_CONNECT_TIMEOUT,
avdtp_connect_timeout,
dev);
return TRUE;
}
static void device_remove_avdtp_timer(struct audio_device *dev)
{
if (dev->priv->avdtp_timer)
g_source_remove(dev->priv->avdtp_timer);
dev->priv->avdtp_timer = 0;
}
static gboolean headset_connect_timeout(gpointer user_data)
{
struct audio_device *dev = user_data;
struct dev_priv *priv = dev->priv;
dev->priv->headset_timer = 0;
if (dev->headset == NULL)
return FALSE;
if (headset_config_stream(dev, FALSE, NULL, NULL) == 0) {
if (priv->state != AUDIO_STATE_CONNECTED &&
(priv->sink_state == SINK_STATE_CONNECTED ||
priv->sink_state == SINK_STATE_PLAYING))
device_set_state(dev, AUDIO_STATE_CONNECTED);
}
return FALSE;
}
static gboolean device_set_headset_timer(struct audio_device *dev)
{
struct dev_priv *priv = dev->priv;
if (!dev->headset)
return FALSE;
if (priv->headset_timer)
return FALSE;
priv->headset_timer = g_timeout_add_seconds(HEADSET_CONNECT_TIMEOUT,
headset_connect_timeout, dev);
return TRUE;
}
static void device_remove_headset_timer(struct audio_device *dev)
{
if (dev->priv->headset_timer)
g_source_remove(dev->priv->headset_timer);
dev->priv->headset_timer = 0;
}
static void device_avdtp_cb(struct audio_device *dev, struct avdtp *session,
avdtp_session_state_t old_state,
avdtp_session_state_t new_state,
void *user_data)
{
if (!dev->sink || !dev->control)
return;
if (new_state == AVDTP_SESSION_STATE_CONNECTED) {
if (avdtp_stream_setup_active(session))
device_set_control_timer(dev);
else
avrcp_connect(dev);
}
}
static void device_sink_cb(struct audio_device *dev,
sink_state_t old_state,
sink_state_t new_state,
void *user_data)
{
struct dev_priv *priv = dev->priv;
if (!dev->sink)
return;
priv->sink_state = new_state;
switch (new_state) {
case SINK_STATE_DISCONNECTED:
if (dev->control) {
device_remove_control_timer(dev);
avrcp_disconnect(dev);
}
if (priv->hs_state != HEADSET_STATE_DISCONNECTED &&
priv->dc_req) {
headset_shutdown(dev);
break;
}
if (priv->hs_state == HEADSET_STATE_DISCONNECTED)
device_set_state(dev, AUDIO_STATE_DISCONNECTED);
else if (old_state == SINK_STATE_CONNECTING) {
switch (priv->hs_state) {
case HEADSET_STATE_CONNECTED:
case HEADSET_STATE_PLAY_IN_PROGRESS:
case HEADSET_STATE_PLAYING:
device_set_state(dev, AUDIO_STATE_CONNECTED);
default:
break;
}
}
break;
case SINK_STATE_CONNECTING:
device_remove_avdtp_timer(dev);
if (priv->hs_state == HEADSET_STATE_DISCONNECTED)
device_set_state(dev, AUDIO_STATE_CONNECTING);
break;
case SINK_STATE_CONNECTED:
if (old_state == SINK_STATE_PLAYING)
break;
#ifdef ANDROID
android_set_high_priority(&dev->dst);
#endif
if (dev->auto_connect) {
if (!dev->headset)
device_set_state(dev, AUDIO_STATE_CONNECTED);
else if (priv->hs_state == HEADSET_STATE_DISCONNECTED)
device_set_headset_timer(dev);
else if (priv->hs_state == HEADSET_STATE_CONNECTED ||
priv->hs_state == HEADSET_STATE_PLAY_IN_PROGRESS ||
priv->hs_state == HEADSET_STATE_PLAYING)
device_set_state(dev, AUDIO_STATE_CONNECTED);
} else if (priv->hs_state == HEADSET_STATE_DISCONNECTED ||
priv->hs_state == HEADSET_STATE_CONNECTING)
device_set_state(dev, AUDIO_STATE_CONNECTED);
break;
case SINK_STATE_PLAYING:
break;
}
}
static void device_avctp_cb(struct audio_device *dev,
avctp_state_t old_state,
avctp_state_t new_state,
void *user_data)
{
if (!dev->control)
return;
dev->priv->avctp_state = new_state;
switch (new_state) {
case AVCTP_STATE_DISCONNECTED:
break;
case AVCTP_STATE_CONNECTING:
device_remove_control_timer(dev);
break;
case AVCTP_STATE_CONNECTED:
break;
}
}
static void device_headset_cb(struct audio_device *dev,
headset_state_t old_state,
headset_state_t new_state,
void *user_data)
{
struct dev_priv *priv = dev->priv;
if (!dev->headset)
return;
priv->hs_state = new_state;
switch (new_state) {
case HEADSET_STATE_DISCONNECTED:
device_remove_avdtp_timer(dev);
if (priv->sink_state != SINK_STATE_DISCONNECTED &&
dev->sink && priv->dc_req) {
sink_shutdown(dev->sink);
break;
}
if (priv->sink_state == SINK_STATE_DISCONNECTED)
device_set_state(dev, AUDIO_STATE_DISCONNECTED);
else if (old_state == HEADSET_STATE_CONNECTING &&
(priv->sink_state == SINK_STATE_CONNECTED ||
priv->sink_state == SINK_STATE_PLAYING))
device_set_state(dev, AUDIO_STATE_CONNECTED);
break;
case HEADSET_STATE_CONNECTING:
device_remove_headset_timer(dev);
if (priv->sink_state == SINK_STATE_DISCONNECTED)
device_set_state(dev, AUDIO_STATE_CONNECTING);
break;
case HEADSET_STATE_CONNECTED:
if (old_state == HEADSET_STATE_CONNECTED ||
old_state == HEADSET_STATE_PLAY_IN_PROGRESS ||
old_state == HEADSET_STATE_PLAYING)
break;
if (dev->auto_connect) {
if (!dev->sink)
device_set_state(dev, AUDIO_STATE_CONNECTED);
else if (priv->sink_state == SINK_STATE_DISCONNECTED)
device_set_avdtp_timer(dev);
else if (priv->sink_state == SINK_STATE_CONNECTED ||
priv->sink_state == SINK_STATE_PLAYING)
device_set_state(dev, AUDIO_STATE_CONNECTED);
} else if (priv->sink_state == SINK_STATE_DISCONNECTED ||
priv->sink_state == SINK_STATE_CONNECTING)
device_set_state(dev, AUDIO_STATE_CONNECTED);
break;
case HEADSET_STATE_PLAY_IN_PROGRESS:
break;
case HEADSET_STATE_PLAYING:
break;
}
}
static DBusMessage *dev_connect(DBusConnection *conn, DBusMessage *msg,
void *data)
{
struct audio_device *dev = data;
struct dev_priv *priv = dev->priv;
if (priv->state == AUDIO_STATE_CONNECTING)
return g_dbus_create_error(msg, ERROR_INTERFACE ".InProgress",
"Connect in Progress");
else if (priv->state == AUDIO_STATE_CONNECTED)
return g_dbus_create_error(msg, ERROR_INTERFACE
".AlreadyConnected",
"Already Connected");
dev->auto_connect = TRUE;
if (dev->headset)
headset_config_stream(dev, FALSE, NULL, NULL);
if (priv->state != AUDIO_STATE_CONNECTING && dev->sink) {
struct avdtp *session = avdtp_get(&dev->src, &dev->dst);
if (!session)
return g_dbus_create_error(msg, ERROR_INTERFACE
".Failed",
"Failed to get AVDTP session");
sink_setup_stream(dev->sink, session);
avdtp_unref(session);
}
/* The previous calls should cause a call to the state callback to
* indicate AUDIO_STATE_CONNECTING */
if (priv->state != AUDIO_STATE_CONNECTING)
return g_dbus_create_error(msg, ERROR_INTERFACE
".ConnectFailed",
"Headset connect failed");
priv->conn_req = dbus_message_ref(msg);
return NULL;
}
static DBusMessage *dev_disconnect(DBusConnection *conn, DBusMessage *msg,
void *data)
{
struct audio_device *dev = data;
struct dev_priv *priv = dev->priv;
if (priv->state == AUDIO_STATE_DISCONNECTED)
return g_dbus_create_error(msg, ERROR_INTERFACE ".NotConnected",
"Not connected");
if (priv->dc_req)
return dbus_message_new_method_return(msg);
priv->dc_req = dbus_message_ref(msg);
if (dev->control) {
device_remove_control_timer(dev);
avrcp_disconnect(dev);
}
if (dev->sink && priv->sink_state != SINK_STATE_DISCONNECTED)
sink_shutdown(dev->sink);
else if (priv->hs_state != HEADSET_STATE_DISCONNECTED)
headset_shutdown(dev);
else {
dbus_message_unref(priv->dc_req);
priv->dc_req = NULL;
return dbus_message_new_method_return(msg);
}
return NULL;
}
static DBusMessage *dev_get_properties(DBusConnection *conn, DBusMessage *msg,
void *data)
{
struct audio_device *device = data;
DBusMessage *reply;
DBusMessageIter iter;
DBusMessageIter dict;
const char *state;
reply = dbus_message_new_method_return(msg);
if (!reply)
return NULL;
dbus_message_iter_init_append(reply, &iter);
dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING
DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
/* State */
state = state2str(device->priv->state);
if (state)
dict_append_entry(&dict, "State", DBUS_TYPE_STRING, &state);
dbus_message_iter_close_container(&iter, &dict);
return reply;
}
static GDBusMethodTable dev_methods[] = {
{ "Connect", "", "", dev_connect,
G_DBUS_METHOD_FLAG_ASYNC },
{ "Disconnect", "", "", dev_disconnect },
{ "GetProperties", "", "a{sv}",dev_get_properties },
{ NULL, NULL, NULL, NULL }
};
static GDBusSignalTable dev_signals[] = {
{ "PropertyChanged", "sv" },
{ NULL, NULL }
};
struct audio_device *audio_device_register(DBusConnection *conn,
struct btd_device *device,
const char *path, const bdaddr_t *src,
const bdaddr_t *dst)
{
struct audio_device *dev;
if (!conn || !path)
return NULL;
dev = g_new0(struct audio_device, 1);
dev->btd_dev = btd_device_ref(device);
dev->path = g_strdup(path);
bacpy(&dev->dst, dst);
bacpy(&dev->src, src);
dev->conn = dbus_connection_ref(conn);
dev->priv = g_new0(struct dev_priv, 1);
dev->priv->state = AUDIO_STATE_DISCONNECTED;
if (!g_dbus_register_interface(dev->conn, dev->path,
AUDIO_INTERFACE,
dev_methods, dev_signals, NULL,
dev, NULL)) {
error("Unable to register %s on %s", AUDIO_INTERFACE,
dev->path);
device_free(dev);
return NULL;
}
DBG("Registered interface %s on path %s", AUDIO_INTERFACE,
dev->path);
if (sink_callback_id == 0)
sink_callback_id = sink_add_state_cb(device_sink_cb, NULL);
if (avdtp_callback_id == 0)
avdtp_callback_id = avdtp_add_state_cb(device_avdtp_cb, NULL);
if (avctp_callback_id == 0)
avctp_callback_id = avctp_add_state_cb(device_avctp_cb, NULL);
if (headset_callback_id == 0)
headset_callback_id = headset_add_state_cb(device_headset_cb,
NULL);
return dev;
}
gboolean audio_device_is_active(struct audio_device *dev,
const char *interface)
{
if (!interface) {
if ((dev->sink || dev->source) &&
avdtp_is_connected(&dev->src, &dev->dst))
return TRUE;
if (dev->headset && headset_is_active(dev))
return TRUE;
} else if (!strcmp(interface, AUDIO_SINK_INTERFACE) && dev->sink &&
avdtp_is_connected(&dev->src, &dev->dst))
return TRUE;
else if (!strcmp(interface, AUDIO_SOURCE_INTERFACE) && dev->source &&
avdtp_is_connected(&dev->src, &dev->dst))
return TRUE;
else if (!strcmp(interface, AUDIO_HEADSET_INTERFACE) && dev->headset &&
headset_is_active(dev))
return TRUE;
else if (!strcmp(interface, AUDIO_CONTROL_INTERFACE) && dev->control &&
control_is_active(dev))
return TRUE;
else if (!strcmp(interface, AUDIO_GATEWAY_INTERFACE) && dev->gateway &&
gateway_is_connected(dev))
return TRUE;
return FALSE;
}
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;
}
if (device->headset)
headset_unregister(device);
if (device->gateway)
gateway_unregister(device);
if (device->sink)
sink_unregister(device);
if (device->source)
source_unregister(device);
if (device->control)
control_unregister(device);
g_dbus_unregister_interface(device->conn, device->path,
AUDIO_INTERFACE);
device_free(device);
}
static void auth_cb(DBusError *derr, void *user_data)
{
struct audio_device *dev = user_data;
struct dev_priv *priv = dev->priv;
if (derr == NULL)
priv->authorized = TRUE;
while (priv->auths) {
struct service_auth *auth = priv->auths->data;
auth->cb(derr, auth->user_data);
priv->auths = g_slist_remove(priv->auths, auth);
g_free(auth);
}
}
static gboolean auth_idle_cb(gpointer user_data)
{
struct audio_device *dev = user_data;
struct dev_priv *priv = dev->priv;
priv->auth_idle_id = 0;
auth_cb(NULL, dev);
return FALSE;
}
static gboolean audio_device_is_connected(struct audio_device *dev)
{
if (dev->headset) {
headset_state_t state = headset_get_state(dev);
if (state == HEADSET_STATE_CONNECTED ||
state == HEADSET_STATE_PLAY_IN_PROGRESS ||
state == HEADSET_STATE_PLAYING)
return TRUE;
}
if (dev->sink) {
sink_state_t state = sink_get_state(dev);
if (state == SINK_STATE_CONNECTED ||
state == SINK_STATE_PLAYING)
return TRUE;
}
if (dev->source) {
source_state_t state = source_get_state(dev);
if (state == SOURCE_STATE_CONNECTED ||
state == SOURCE_STATE_PLAYING)
return TRUE;
}
return FALSE;
}
int audio_device_request_authorization(struct audio_device *dev,
const char *uuid, service_auth_cb cb,
void *user_data)
{
struct dev_priv *priv = dev->priv;
struct service_auth *auth;
int err;
auth = g_try_new0(struct service_auth, 1);
if (!auth)
return -ENOMEM;
auth->cb = cb;
auth->user_data = user_data;
priv->auths = g_slist_append(priv->auths, auth);
if (g_slist_length(priv->auths) > 1)
return 0;
if (priv->authorized || audio_device_is_connected(dev)) {
priv->auth_idle_id = g_idle_add(auth_idle_cb, dev);
return 0;
}
err = btd_request_authorization(&dev->src, &dev->dst, uuid, auth_cb,
dev);
if (err < 0) {
priv->auths = g_slist_remove(priv->auths, auth);
g_free(auth);
}
return err;
}
int audio_device_cancel_authorization(struct audio_device *dev,
authorization_cb cb, void *user_data)
{
struct dev_priv *priv = dev->priv;
GSList *l, *next;
for (l = priv->auths; l != NULL; l = next) {
struct service_auth *auth = l->data;
next = g_slist_next(l);
if (cb && auth->cb != cb)
continue;
if (user_data && auth->user_data != user_data)
continue;
priv->auths = g_slist_remove(priv->auths, auth);
g_free(auth);
}
if (g_slist_length(priv->auths) == 0) {
if (priv->auth_idle_id > 0) {
g_source_remove(priv->auth_idle_id);
priv->auth_idle_id = 0;
} else
btd_cancel_authorization(&dev->src, &dev->dst);
}
return 0;
}
void audio_device_set_authorized(struct audio_device *dev, gboolean auth)
{
struct dev_priv *priv = dev->priv;
priv->authorized = auth;
}