blob: 48970d23e08e4fc82944ebef099a8a36caa570d6 [file] [log] [blame]
/*
*
* 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 <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <stdbool.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <errno.h>
#include <bluetooth/bluetooth.h>
#include <bluetooth/uuid.h>
#include <bluetooth/sdp.h>
#include <bluetooth/sdp_lib.h>
#include <bluetooth/mgmt.h>
#include <glib.h>
#include <dbus/dbus.h>
#include <gdbus.h>
#include "log.h"
#include "att.h"
#include "hcid.h"
#include "adapter.h"
#include "gattrib.h"
#include "attio.h"
#include "device.h"
#include "profile.h"
#include "dbus-common.h"
#include "error.h"
#include "glib-helper.h"
#include "sdp-client.h"
#include "gatt.h"
#include "agent.h"
#include "sdp-xml.h"
#include "storage.h"
#include "btio.h"
#include "attrib-server.h"
#include "attrib/client.h"
#define IO_CAPABILITY_DISPLAYONLY 0x00
#define IO_CAPABILITY_DISPLAYYESNO 0x01
#define IO_CAPABILITY_KEYBOARDONLY 0x02
#define IO_CAPABILITY_NOINPUTNOOUTPUT 0x03
#define IO_CAPABILITY_KEYBOARDDISPLAY 0x04
#define IO_CAPABILITY_INVALID 0xFF
#define DISCONNECT_TIMER 2
#define DISCOVERY_TIMER 2
#define INFO_PATH STORAGEDIR "/%s/%s/info"
#define CACHE_PATH STORAGEDIR "/%s/cache/%s"
struct btd_disconnect_data {
guint id;
disconnect_watch watch;
void *user_data;
GDestroyNotify destroy;
};
struct bonding_req {
DBusMessage *msg;
guint listener_id;
struct btd_device *device;
};
typedef enum {
AUTH_TYPE_PINCODE,
AUTH_TYPE_PASSKEY,
AUTH_TYPE_CONFIRM,
AUTH_TYPE_NOTIFY_PASSKEY,
AUTH_TYPE_NOTIFY_PINCODE,
} auth_type_t;
struct authentication_req {
auth_type_t type;
void *cb;
struct agent *agent;
struct btd_device *device;
uint32_t passkey;
char *pincode;
gboolean secure;
};
struct browse_req {
DBusMessage *msg;
struct btd_device *device;
GSList *match_uuids;
GSList *profiles_added;
GSList *profiles_removed;
sdp_list_t *records;
int search_uuid;
int reconnect_attempt;
guint listener_id;
};
struct included_search {
struct browse_req *req;
GSList *services;
GSList *current;
};
struct attio_data {
guint id;
attio_connect_cb cfunc;
attio_disconnect_cb dcfunc;
gpointer user_data;
};
typedef void (*attio_error_cb) (const GError *gerr, gpointer user_data);
typedef void (*attio_success_cb) (gpointer user_data);
struct att_callbacks {
attio_error_cb error; /* Callback for error */
attio_success_cb success; /* Callback for success */
gpointer user_data;
};
struct btd_device {
bdaddr_t bdaddr;
uint8_t bdaddr_type;
gchar *path;
bool svc_resolved;
GSList *eir_uuids;
char name[MAX_NAME_LENGTH + 1];
char *alias;
uint16_t vendor_src;
uint16_t vendor;
uint16_t product;
uint16_t version;
struct btd_adapter *adapter;
GSList *uuids;
GSList *services; /* Primary services path */
GSList *primaries; /* List of primary services */
GSList *profiles; /* Probed profiles */
GSList *pending; /* Pending profiles */
GSList *watches; /* List of disconnect_data */
gboolean temporary;
struct agent *agent;
guint disconn_timer;
guint discov_timer;
struct browse_req *browse; /* service discover request */
struct bonding_req *bonding;
struct authentication_req *authr; /* authentication request */
GSList *disconnects; /* disconnects message */
DBusMessage *connect; /* connect message */
GAttrib *attrib;
GSList *attios;
GSList *attios_offline;
guint attachid; /* Attrib server attach */
guint auto_id; /* Auto connect source id */
gboolean connected;
gboolean profiles_connected; /* Profile level connected */
sdp_list_t *tmp_records;
gboolean trusted;
gboolean paired;
gboolean blocked;
gboolean bonded;
gboolean auto_connect;
bool legacy;
int8_t rssi;
gint ref;
GIOChannel *att_io;
guint cleanup_id;
guint store_id;
};
static uint16_t uuid_list[] = {
L2CAP_UUID,
PNP_INFO_SVCLASS_ID,
PUBLIC_BROWSE_GROUP,
0
};
static gboolean store_device_info_cb(gpointer user_data)
{
struct btd_device *device = user_data;
GKeyFile *key_file;
char filename[PATH_MAX + 1];
char adapter_addr[18];
char device_addr[18];
char *str;
gsize length = 0;
device->store_id = 0;
key_file = g_key_file_new();
g_key_file_set_string(key_file, "General", "Name", device->name);
ba2str(adapter_get_address(device->adapter), adapter_addr);
ba2str(&device->bdaddr, device_addr);
snprintf(filename, PATH_MAX, INFO_PATH, adapter_addr, device_addr);
filename[PATH_MAX] = '\0';
create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
str = g_key_file_to_data(key_file, &length, NULL);
g_file_set_contents(filename, str, length, NULL);
g_free(str);
g_key_file_free(key_file);
return FALSE;
}
static void store_device_info(struct btd_device *device)
{
if (device->temporary || device->store_id > 0)
return;
device->store_id = g_idle_add(store_device_info_cb, device);
}
static void browse_request_free(struct browse_req *req)
{
if (req->listener_id)
g_dbus_remove_watch(btd_get_dbus_connection(),
req->listener_id);
if (req->msg)
dbus_message_unref(req->msg);
if (req->device)
btd_device_unref(req->device);
g_slist_free_full(req->profiles_added, g_free);
g_slist_free(req->profiles_removed);
if (req->records)
sdp_list_free(req->records, (sdp_free_func_t) sdp_record_free);
g_free(req);
}
static void attio_cleanup(struct btd_device *device)
{
if (device->attachid) {
attrib_channel_detach(device->attrib, device->attachid);
device->attachid = 0;
}
if (device->cleanup_id) {
g_source_remove(device->cleanup_id);
device->cleanup_id = 0;
}
if (device->att_io) {
g_io_channel_shutdown(device->att_io, FALSE, NULL);
g_io_channel_unref(device->att_io);
device->att_io = NULL;
}
if (device->attrib) {
g_attrib_unref(device->attrib);
device->attrib = NULL;
}
}
static void browse_request_cancel(struct browse_req *req)
{
struct btd_device *device = req->device;
struct btd_adapter *adapter = device->adapter;
if (device_is_creating(device, NULL))
device_set_temporary(device, TRUE);
bt_cancel_discovery(adapter_get_address(adapter), &device->bdaddr);
attio_cleanup(device);
device->browse = NULL;
browse_request_free(req);
}
static void device_free(gpointer user_data)
{
struct btd_device *device = user_data;
struct btd_adapter *adapter = device->adapter;
struct agent *agent = adapter_get_agent(adapter);
if (device->agent)
agent_free(device->agent);
if (agent && (agent_is_busy(agent, device) ||
agent_is_busy(agent, device->authr)))
agent_cancel(agent);
g_slist_free_full(device->services, g_free);
g_slist_free_full(device->uuids, g_free);
g_slist_free_full(device->primaries, g_free);
g_slist_free_full(device->attios, g_free);
g_slist_free_full(device->attios_offline, g_free);
attio_cleanup(device);
if (device->tmp_records)
sdp_list_free(device->tmp_records,
(sdp_free_func_t) sdp_record_free);
if (device->disconn_timer)
g_source_remove(device->disconn_timer);
if (device->discov_timer)
g_source_remove(device->discov_timer);
if (device->auto_id)
g_source_remove(device->auto_id);
DBG("%p", device);
if (device->authr)
g_free(device->authr->pincode);
g_free(device->authr);
g_free(device->path);
g_free(device->alias);
g_free(device);
}
gboolean device_is_bredr(struct btd_device *device)
{
return (device->bdaddr_type == BDADDR_BREDR);
}
gboolean device_is_le(struct btd_device *device)
{
return (device->bdaddr_type != BDADDR_BREDR);
}
gboolean device_is_paired(struct btd_device *device)
{
return device->paired;
}
gboolean device_is_bonded(struct btd_device *device)
{
return device->bonded;
}
gboolean device_is_trusted(struct btd_device *device)
{
return device->trusted;
}
static gboolean dev_property_get_address(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
char dstaddr[18];
const char *ptr = dstaddr;
ba2str(&device->bdaddr, dstaddr);
dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &ptr);
return TRUE;
}
static gboolean dev_property_get_name(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
const char *empty = "", *ptr;
ptr = device->name ?: empty;
dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &ptr);
return TRUE;
}
static gboolean dev_property_exists_name(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *dev = data;
return device_name_known(dev);
}
static gboolean dev_property_get_alias(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
char dstaddr[18];
const char *ptr;
/* Alias (fallback to name or address) */
if (device->alias != NULL)
ptr = device->alias;
else if (strlen(device->name) > 0) {
ptr = device->name;
} else {
ba2str(&device->bdaddr, dstaddr);
g_strdelimit(dstaddr, ":", '-');
ptr = dstaddr;
}
dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &ptr);
return TRUE;
}
static void set_alias(GDBusPendingPropertySet id, const char *alias,
void *data)
{
struct btd_device *device = data;
struct btd_adapter *adapter = device->adapter;
char srcaddr[18], dstaddr[18];
int err;
/* No change */
if ((device->alias == NULL && g_str_equal(alias, "")) ||
g_strcmp0(device->alias, alias) == 0)
return g_dbus_pending_property_success(id);
ba2str(adapter_get_address(adapter), srcaddr);
ba2str(&device->bdaddr, dstaddr);
/* Remove alias if empty string */
err = write_device_alias(srcaddr, dstaddr, device->bdaddr_type,
g_str_equal(alias, "") ? NULL : alias);
if (err < 0)
return g_dbus_pending_property_error(id,
ERROR_INTERFACE ".Failed", strerror(-err));
g_free(device->alias);
device->alias = g_str_equal(alias, "") ? NULL : g_strdup(alias);
g_dbus_emit_property_changed(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE, "Alias");
g_dbus_pending_property_success(id);
}
static void dev_property_set_alias(const GDBusPropertyTable *property,
DBusMessageIter *value,
GDBusPendingPropertySet id, void *data)
{
const char *alias;
if (dbus_message_iter_get_arg_type(value) != DBUS_TYPE_STRING)
return g_dbus_pending_property_error(id,
ERROR_INTERFACE ".InvalidArguments",
"Invalid arguments in method call");
dbus_message_iter_get_basic(value, &alias);
set_alias(id, alias, data);
}
static gboolean get_class(const GDBusPropertyTable *property, void *data,
uint32_t *class)
{
struct btd_device *device = data;
if (read_remote_class(adapter_get_address(device->adapter),
&device->bdaddr, class) == 0)
return TRUE;
return FALSE;
}
static gboolean dev_property_exists_class(const GDBusPropertyTable *property,
void *data)
{
uint32_t class;
return get_class(property, data, &class);
}
static gboolean dev_property_get_class(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
uint32_t class;
if (!get_class(property, data, &class))
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, &class);
return TRUE;
}
static gboolean get_appearance(const GDBusPropertyTable *property, void *data,
uint16_t *appearance)
{
struct btd_device *device = data;
if (dev_property_exists_class(property, data))
return FALSE;
if (read_remote_appearance(adapter_get_address(device->adapter),
&device->bdaddr, device->bdaddr_type,
appearance) == 0)
return TRUE;
return FALSE;
}
static gboolean dev_property_exists_appearance(
const GDBusPropertyTable *property, void *data)
{
uint16_t appearance;
return get_appearance(property, data, &appearance);
}
static gboolean dev_property_get_appearance(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
uint16_t appearance;
if (!get_appearance(property, data, &appearance))
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16, &appearance);
return TRUE;
}
static const char *get_icon(const GDBusPropertyTable *property, void *data)
{
const char *icon = NULL;
uint32_t class;
uint16_t appearance;
if (get_class(property, data, &class))
icon = class_to_icon(class);
else if (get_appearance(property, data, &appearance))
icon = gap_appearance_to_icon(appearance);
return icon;
}
static gboolean dev_property_exists_icon(
const GDBusPropertyTable *property, void *data)
{
return get_icon(property, data) != NULL;
}
static gboolean dev_property_get_icon(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
const char *icon;
icon = get_icon(property, data);
if (icon == NULL)
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &icon);
return TRUE;
}
static gboolean dev_property_exists_vendor(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *device = data;
return !!device->vendor;
}
static gboolean dev_property_get_vendor(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
if (!device->vendor)
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16,
&device->vendor);
return TRUE;
}
static gboolean dev_property_exists_vendor_src(
const GDBusPropertyTable *property, void *data)
{
struct btd_device *device = data;
return !!device->vendor_src;
}
static gboolean dev_property_get_vendor_src(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
if (!device->vendor_src)
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16,
&device->vendor_src);
return TRUE;
}
static gboolean dev_property_exists_product(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *device = data;
return !!device->product;
}
static gboolean dev_property_get_product(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
if (!device->product)
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16,
&device->product);
return TRUE;
}
static gboolean dev_property_exists_version(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *device = data;
return !!device->version;
}
static gboolean dev_property_get_version(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
if (!device->version)
return FALSE;
dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT16,
&device->version);
return TRUE;
}
static gboolean dev_property_get_paired(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
gboolean val = device_is_paired(device);
dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &val);
return TRUE;
}
static gboolean dev_property_get_legacy(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
dbus_bool_t val = device->legacy;
dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &val);
return TRUE;
}
static gboolean dev_property_get_rssi(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *dev = data;
dbus_int16_t val = dev->rssi;
dbus_message_iter_append_basic(iter, DBUS_TYPE_INT16, &val);
return TRUE;
}
static gboolean dev_property_exists_rssi(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *dev = data;
return dev->rssi ? TRUE : FALSE;
}
static gboolean dev_property_get_trusted(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
gboolean val = device_is_trusted(device);
dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &val);
return TRUE;
}
static void set_trust(GDBusPendingPropertySet id, gboolean value, void *data)
{
struct btd_device *device = data;
struct btd_adapter *adapter = device->adapter;
char srcaddr[18], dstaddr[18];
int err;
if (device->trusted == value)
return g_dbus_pending_property_success(id);
ba2str(adapter_get_address(adapter), srcaddr);
ba2str(&device->bdaddr, dstaddr);
err = write_trust(srcaddr, dstaddr, device->bdaddr_type, value);
if (err < 0)
return g_dbus_pending_property_error(id,
ERROR_INTERFACE ".Failed", strerror(-err));
device->trusted = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE, "Trusted");
g_dbus_pending_property_success(id);
}
static void dev_property_set_trusted(const GDBusPropertyTable *property,
DBusMessageIter *value,
GDBusPendingPropertySet id, void *data)
{
dbus_bool_t b;
if (dbus_message_iter_get_arg_type(value) != DBUS_TYPE_BOOLEAN)
return g_dbus_pending_property_error(id,
ERROR_INTERFACE ".InvalidArguments",
"Invalid arguments in method call");
dbus_message_iter_get_basic(value, &b);
set_trust(id, b, data);
}
static gboolean dev_property_get_blocked(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN,
&device->blocked);
return TRUE;
}
static void set_blocked(GDBusPendingPropertySet id, gboolean value, void *data)
{
struct btd_device *device = data;
int err;
if (value)
err = device_block(device, FALSE);
else
err = device_unblock(device, FALSE, FALSE);
switch (-err) {
case 0:
g_dbus_pending_property_success(id);
break;
case EINVAL:
g_dbus_pending_property_error(id, ERROR_INTERFACE ".Failed",
"Kernel lacks blacklist support");
break;
default:
g_dbus_pending_property_error(id, ERROR_INTERFACE ".Failed",
strerror(-err));
break;
}
}
static void dev_property_set_blocked(const GDBusPropertyTable *property,
DBusMessageIter *value,
GDBusPendingPropertySet id, void *data)
{
dbus_bool_t b;
if (dbus_message_iter_get_arg_type(value) != DBUS_TYPE_BOOLEAN)
return g_dbus_pending_property_error(id,
ERROR_INTERFACE ".InvalidArguments",
"Invalid arguments in method call");
dbus_message_iter_get_basic(value, &b);
set_blocked(id, b, data);
}
static gboolean dev_property_get_connected(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN,
&device->connected);
return TRUE;
}
static gboolean dev_property_get_uuids(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
DBusMessageIter entry;
GSList *l;
dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
DBUS_TYPE_STRING_AS_STRING, &entry);
if (!device->svc_resolved)
l = device->eir_uuids;
else
l = device->uuids;
for (; l != NULL; l = l->next)
dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING,
&l->data);
dbus_message_iter_close_container(iter, &entry);
return TRUE;
}
static gboolean dev_property_exists_uuids(const GDBusPropertyTable *property,
void *data)
{
struct btd_device *dev = data;
if (dev->svc_resolved)
return dev->uuids ? TRUE : FALSE;
else
return dev->eir_uuids ? TRUE : FALSE;
}
static gboolean dev_property_get_services(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
DBusMessageIter entry;
GSList *l;
dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
DBUS_TYPE_OBJECT_PATH_AS_STRING, &entry);
for (l = device->services; l != NULL; l = l->next)
dbus_message_iter_append_basic(&entry, DBUS_TYPE_OBJECT_PATH,
&l->data);
dbus_message_iter_close_container(iter, &entry);
return TRUE;
}
static gboolean dev_property_exists_services(const GDBusPropertyTable *prop,
void *data)
{
struct btd_device *dev = data;
return dev->services ? TRUE : FALSE;
}
static gboolean dev_property_get_adapter(const GDBusPropertyTable *property,
DBusMessageIter *iter, void *data)
{
struct btd_device *device = data;
const char *str = adapter_get_path(device->adapter);
dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &str);
return TRUE;
}
static void profile_remove(struct btd_profile *profile,
struct btd_device *device)
{
profile->device_remove(profile, device);
}
static gboolean do_disconnect(gpointer user_data)
{
struct btd_device *device = user_data;
device->disconn_timer = 0;
btd_adapter_disconnect_device(device->adapter, &device->bdaddr,
device->bdaddr_type);
return FALSE;
}
int device_block(struct btd_device *device, gboolean update_only)
{
int err = 0;
if (device->blocked)
return 0;
if (device->connected)
do_disconnect(device);
g_slist_foreach(device->profiles, (GFunc) profile_remove, device);
g_slist_free(device->profiles);
device->profiles = NULL;
if (!update_only)
err = btd_adapter_block_address(device->adapter,
&device->bdaddr, device->bdaddr_type);
if (err < 0)
return err;
device->blocked = TRUE;
err = write_blocked(adapter_get_address(device->adapter),
&device->bdaddr, device->bdaddr_type, TRUE);
if (err < 0)
error("write_blocked(): %s (%d)", strerror(-err), -err);
device_set_temporary(device, FALSE);
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Blocked");
return 0;
}
int device_unblock(struct btd_device *device, gboolean silent,
gboolean update_only)
{
int err = 0;
if (!device->blocked)
return 0;
if (!update_only)
err = btd_adapter_unblock_address(device->adapter,
&device->bdaddr, device->bdaddr_type);
if (err < 0)
return err;
device->blocked = FALSE;
err = write_blocked(adapter_get_address(device->adapter),
&device->bdaddr, device->bdaddr_type, FALSE);
if (err < 0)
error("write_blocked(): %s (%d)", strerror(-err), -err);
if (!silent) {
g_dbus_emit_property_changed(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE,
"Blocked");
device_probe_profiles(device, device->uuids);
}
return 0;
}
static void discover_services_req_exit(DBusConnection *conn, void *user_data)
{
struct browse_req *req = user_data;
DBG("DiscoverServices requestor exited");
browse_request_cancel(req);
}
static DBusMessage *discover_services(DBusConnection *conn,
DBusMessage *msg, void *user_data)
{
struct btd_device *device = user_data;
const char *pattern;
int err;
if (device->browse)
return btd_error_in_progress(msg);
if (dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &pattern,
DBUS_TYPE_INVALID) == FALSE)
return btd_error_invalid_args(msg);
if (strlen(pattern) == 0) {
err = device_browse_sdp(device, msg, NULL, FALSE);
if (err < 0)
goto fail;
} else {
uuid_t uuid;
if (bt_string2uuid(&uuid, pattern) < 0)
return btd_error_invalid_args(msg);
sdp_uuid128_to_uuid(&uuid);
err = device_browse_sdp(device, msg, &uuid, FALSE);
if (err < 0)
goto fail;
}
return NULL;
fail:
return btd_error_failed(msg, strerror(-err));
}
static const char *browse_request_get_requestor(struct browse_req *req)
{
if (!req->msg)
return NULL;
return dbus_message_get_sender(req->msg);
}
static void iter_append_record(DBusMessageIter *dict, uint32_t handle,
const char *record)
{
DBusMessageIter entry;
dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
NULL, &entry);
dbus_message_iter_append_basic(&entry, DBUS_TYPE_UINT32, &handle);
dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &record);
dbus_message_iter_close_container(dict, &entry);
}
static void discover_services_reply(struct browse_req *req, int err,
sdp_list_t *recs)
{
DBusConnection *conn = btd_get_dbus_connection();
DBusMessage *reply;
DBusMessageIter iter, dict;
sdp_list_t *seq;
if (err) {
const char *err_if;
if (err == -EHOSTDOWN)
err_if = ERROR_INTERFACE ".ConnectionAttemptFailed";
else
err_if = ERROR_INTERFACE ".Failed";
reply = dbus_message_new_error(req->msg, err_if,
strerror(-err));
g_dbus_send_message(conn, reply);
return;
}
reply = dbus_message_new_method_return(req->msg);
if (!reply)
return;
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_UINT32_AS_STRING DBUS_TYPE_STRING_AS_STRING
DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
for (seq = recs; seq; seq = seq->next) {
sdp_record_t *rec = (sdp_record_t *) seq->data;
GString *result;
if (!rec)
break;
result = g_string_new(NULL);
convert_sdp_record_to_xml(rec, result,
(void *) g_string_append);
if (result->len)
iter_append_record(&dict, rec->handle, result->str);
g_string_free(result, TRUE);
}
dbus_message_iter_close_container(&iter, &dict);
g_dbus_send_message(conn, reply);
}
static DBusMessage *cancel_discover(DBusConnection *conn,
DBusMessage *msg, void *user_data)
{
struct btd_device *device = user_data;
const char *sender = dbus_message_get_sender(msg);
const char *requestor;
if (!device->browse)
return btd_error_does_not_exist(msg);
if (!dbus_message_is_method_call(device->browse->msg, DEVICE_INTERFACE,
"DiscoverServices"))
return btd_error_not_authorized(msg);
requestor = browse_request_get_requestor(device->browse);
/* only the discover requestor can cancel the inquiry process */
if (!requestor || !g_str_equal(requestor, sender))
return btd_error_not_authorized(msg);
discover_services_reply(device->browse, -ECANCELED, NULL);
browse_request_cancel(device->browse);
return dbus_message_new_method_return(msg);
}
static void bonding_request_cancel(struct bonding_req *bonding)
{
struct btd_device *device = bonding->device;
struct btd_adapter *adapter = device->adapter;
adapter_cancel_bonding(adapter, &device->bdaddr);
}
static void dev_disconn_profile(gpointer a, gpointer b)
{
struct btd_profile *profile = a;
struct btd_device *dev = b;
if (!profile->disconnect)
return;
profile->disconnect(dev, profile, NULL);
}
void device_request_disconnect(struct btd_device *device, DBusMessage *msg)
{
if (device->bonding)
bonding_request_cancel(device->bonding);
if (device->browse) {
discover_services_reply(device->browse, -ECANCELED, NULL);
browse_request_cancel(device->browse);
}
if (msg)
device->disconnects = g_slist_append(device->disconnects,
dbus_message_ref(msg));
if (device->disconn_timer)
return;
if (device->profiles_connected)
g_slist_foreach(device->profiles, dev_disconn_profile, device);
g_slist_free(device->pending);
device->pending = NULL;
while (device->watches) {
struct btd_disconnect_data *data = device->watches->data;
if (data->watch)
/* temporary is set if device is going to be removed */
data->watch(device, device->temporary,
data->user_data);
/* Check if the watch has been removed by callback function */
if (!g_slist_find(device->watches, data))
continue;
device->watches = g_slist_remove(device->watches, data);
g_free(data);
}
device->disconn_timer = g_timeout_add_seconds(DISCONNECT_TIMER,
do_disconnect, device);
g_dbus_emit_signal(btd_get_dbus_connection(),
device->path,
DEVICE_INTERFACE, "DisconnectRequested",
DBUS_TYPE_INVALID);
}
static DBusMessage *disconnect(DBusConnection *conn, DBusMessage *msg,
void *user_data)
{
struct btd_device *device = user_data;
if (!device->connected)
return btd_error_not_connected(msg);
device_request_disconnect(device, msg);
return NULL;
}
static int connect_next(struct btd_device *dev, btd_profile_cb cb)
{
struct btd_profile *profile;
int err = -ENOENT;
while (dev->pending) {
int err;
profile = dev->pending->data;
err = profile->connect(dev, profile, cb);
if (err == 0)
return 0;
error("Failed to connect %s: %s", profile->name,
strerror(-err));
dev->pending = g_slist_remove(dev->pending, profile);
}
return err;
}
static void dev_profile_connected(struct btd_profile *profile,
struct btd_device *dev, int err)
{
DBG("%s (%d)", strerror(-err), -err);
dev->pending = g_slist_remove(dev->pending, profile);
if (!err) {
if (connect_next(dev, dev_profile_connected) == 0)
return;
dev->profiles_connected = TRUE;
}
if (!dev->connect)
return;
DBG("returning response to %s", dbus_message_get_sender(dev->connect));
if (err)
g_dbus_send_message(btd_get_dbus_connection(),
btd_error_failed(dev->connect, strerror(-err)));
else
g_dbus_send_reply(btd_get_dbus_connection(), dev->connect,
DBUS_TYPE_INVALID);
dbus_message_unref(dev->connect);
dev->connect = NULL;
}
void device_add_eir_uuids(struct btd_device *dev, GSList *uuids)
{
GSList *l;
bool added = false;
if (dev->svc_resolved)
return;
for (l = uuids; l != NULL; l = l->next) {
const char *str = l->data;
if (g_slist_find_custom(dev->eir_uuids, str, bt_uuid_strcmp))
continue;
added = true;
dev->eir_uuids = g_slist_append(dev->eir_uuids, g_strdup(str));
}
if (added)
g_dbus_emit_property_changed(btd_get_dbus_connection(),
dev->path, DEVICE_INTERFACE,
"UUIDs");
}
static int device_resolve_svc(struct btd_device *dev, DBusMessage *msg)
{
if (device_is_bredr(dev))
return device_browse_sdp(dev, msg, NULL, FALSE);
else
return device_browse_primary(dev, msg, FALSE);
}
static struct btd_profile *find_connectable_profile(struct btd_device *dev,
const char *uuid)
{
GSList *l;
for (l = dev->profiles; l != NULL; l = g_slist_next(l)) {
struct btd_profile *p = l->data;
if (!p->connect)
continue;
if (strcasecmp(uuid, p->local_uuid) == 0)
return p;
}
return NULL;
}
static DBusMessage *connect_profiles(struct btd_device *dev, DBusMessage *msg,
const char *uuid)
{
struct btd_profile *p;
GSList *l;
int err;
DBG("%s %s, client %s", dev->path, uuid ? uuid : "(all)",
dbus_message_get_sender(msg));
if (dev->profiles_connected)
return btd_error_already_connected(msg);
if (dev->pending || dev->connect || dev->browse)
return btd_error_in_progress(msg);
device_set_temporary(dev, FALSE);
if (!dev->svc_resolved) {
err = device_resolve_svc(dev, msg);
if (err < 0)
return btd_error_failed(msg, strerror(-err));
return NULL;
}
if (uuid) {
p = find_connectable_profile(dev, uuid);
if (!p)
return btd_error_invalid_args(msg);
dev->pending = g_slist_prepend(dev->pending, p);
goto start_connect;
}
for (l = dev->profiles; l != NULL; l = g_slist_next(l)) {
p = l->data;
if (p->auto_connect)
dev->pending = g_slist_append(dev->pending, p);
}
if (!dev->pending)
return btd_error_not_available(msg);
start_connect:
err = connect_next(dev, dev_profile_connected);
if (err < 0)
return btd_error_failed(msg, strerror(-err));
dev->connect = dbus_message_ref(msg);
return NULL;
}
static DBusMessage *dev_connect(DBusConnection *conn, DBusMessage *msg,
void *user_data)
{
struct btd_device *dev = user_data;
return connect_profiles(dev, msg, NULL);
}
static DBusMessage *connect_profile(DBusConnection *conn, DBusMessage *msg,
void *user_data)
{
struct btd_device *dev = user_data;
const char *pattern;
char *uuid;
DBusMessage *reply;
if (!dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &pattern,
DBUS_TYPE_INVALID))
return btd_error_invalid_args(msg);
uuid = bt_name2string(pattern);
reply = connect_profiles(dev, msg, uuid);
g_free(uuid);
return reply;
}
static void device_svc_resolved(struct btd_device *dev, int err)
{
DBusMessage *reply;
DBusConnection *conn = btd_get_dbus_connection();
struct browse_req *req = dev->browse;
dev->svc_resolved = true;
dev->browse = NULL;
g_slist_free_full(dev->eir_uuids, g_free);
dev->eir_uuids = NULL;
if (!req || !req->msg)
return;
if (dbus_message_is_method_call(req->msg, DEVICE_INTERFACE,
"DiscoverServices")) {
discover_services_reply(req, err, dev->tmp_records);
return;
}
if (dbus_message_is_method_call(req->msg, DEVICE_INTERFACE,
"Pair")) {
reply = dbus_message_new_method_return(req->msg);
g_dbus_send_message(conn, reply);
return;
}
if (err) {
reply = btd_error_failed(req->msg, strerror(-err));
g_dbus_send_message(conn, reply);
return;
}
if (dbus_message_is_method_call(req->msg, DEVICE_INTERFACE, "Connect"))
reply = dev_connect(conn, req->msg, dev);
else if (dbus_message_is_method_call(req->msg, DEVICE_INTERFACE,
"ConnectProfile"))
reply = connect_profile(conn, req->msg, dev);
else
return;
if (reply)
g_dbus_send_message(conn, reply);
else
req->msg = NULL;
}
static uint8_t parse_io_capability(const char *capability)
{
if (g_str_equal(capability, ""))
return IO_CAPABILITY_DISPLAYYESNO;
if (g_str_equal(capability, "DisplayOnly"))
return IO_CAPABILITY_DISPLAYONLY;
if (g_str_equal(capability, "DisplayYesNo"))
return IO_CAPABILITY_DISPLAYYESNO;
if (g_str_equal(capability, "KeyboardOnly"))
return IO_CAPABILITY_KEYBOARDONLY;
if (g_str_equal(capability, "NoInputNoOutput"))
return IO_CAPABILITY_NOINPUTNOOUTPUT;
if (g_str_equal(capability, "KeyboardDisplay"))
return IO_CAPABILITY_KEYBOARDDISPLAY;
return IO_CAPABILITY_INVALID;
}
static DBusMessage *pair_device(DBusConnection *conn, DBusMessage *msg,
void *data)
{
struct btd_device *device = data;
const char *agent_path, *capability;
uint8_t io_cap;
device_set_temporary(device, FALSE);
if (!dbus_message_get_args(msg, NULL,
DBUS_TYPE_OBJECT_PATH, &agent_path,
DBUS_TYPE_STRING, &capability,
DBUS_TYPE_INVALID))
return btd_error_invalid_args(msg);
io_cap = parse_io_capability(capability);
if (io_cap == IO_CAPABILITY_INVALID)
return btd_error_invalid_args(msg);
return device_create_bonding(device, msg, agent_path, io_cap);
}
static DBusMessage *cancel_pairing(DBusConnection *conn, DBusMessage *msg,
void *data)
{
struct btd_device *device = data;
struct bonding_req *req = device->bonding;
DBG("");
if (!req)
return btd_error_does_not_exist(msg);
device_cancel_bonding(device, MGMT_STATUS_CANCELLED);
return dbus_message_new_method_return(msg);
}
static const GDBusMethodTable device_methods[] = {
{ GDBUS_ASYNC_METHOD("DiscoverServices",
GDBUS_ARGS({ "pattern", "s" }),
GDBUS_ARGS({ "services", "a{us}" }),
discover_services) },
{ GDBUS_METHOD("CancelDiscovery", NULL, NULL, cancel_discover) },
{ GDBUS_ASYNC_METHOD("Disconnect", NULL, NULL, disconnect) },
{ GDBUS_ASYNC_METHOD("Connect", NULL, NULL, dev_connect) },
{ GDBUS_ASYNC_METHOD("ConnectProfile", GDBUS_ARGS({ "UUID", "s" }),
NULL, connect_profile) },
{ GDBUS_ASYNC_METHOD("Pair",
GDBUS_ARGS({ "agent", "o" }, { "capability", "s" }),
NULL, pair_device) },
{ GDBUS_METHOD("CancelPairing", NULL, NULL, cancel_pairing) },
{ }
};
static const GDBusSignalTable device_signals[] = {
{ GDBUS_SIGNAL("DisconnectRequested", NULL) },
{ }
};
static const GDBusPropertyTable device_properties[] = {
{ "Address", "s", dev_property_get_address },
{ "Name", "s", dev_property_get_name, NULL, dev_property_exists_name },
{ "Alias", "s", dev_property_get_alias, dev_property_set_alias },
{ "Class", "u", dev_property_get_class, NULL,
dev_property_exists_class },
{ "Appearance", "q", dev_property_get_appearance, NULL,
dev_property_exists_appearance },
{ "Icon", "s", dev_property_get_icon, NULL,
dev_property_exists_icon },
{ "Vendor", "q", dev_property_get_vendor, NULL,
dev_property_exists_vendor },
{ "VendorSource", "q", dev_property_get_vendor_src, NULL,
dev_property_exists_vendor_src },
{ "Product", "q", dev_property_get_product, NULL,
dev_property_exists_product },
{ "Version", "q", dev_property_get_version, NULL,
dev_property_exists_version },
{ "Paired", "b", dev_property_get_paired },
{ "Trusted", "b", dev_property_get_trusted, dev_property_set_trusted },
{ "Blocked", "b", dev_property_get_blocked, dev_property_set_blocked },
{ "LegacyPairing", "b", dev_property_get_legacy },
{ "RSSI", "n", dev_property_get_rssi, NULL, dev_property_exists_rssi },
{ "Connected", "b", dev_property_get_connected },
{ "UUIDs", "as", dev_property_get_uuids, NULL,
dev_property_exists_uuids },
{ "Services", "ao", dev_property_get_services, NULL,
dev_property_exists_services },
{ "Adapter", "o", dev_property_get_adapter },
{ }
};
gboolean device_is_connected(struct btd_device *device)
{
return device->connected;
}
void device_add_connection(struct btd_device *device)
{
if (device->connected) {
char addr[18];
ba2str(&device->bdaddr, addr);
error("Device %s is already connected", addr);
return;
}
device_set_temporary(device, FALSE);
device->connected = TRUE;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Connected");
}
void device_remove_connection(struct btd_device *device)
{
if (!device->connected) {
char addr[18];
ba2str(&device->bdaddr, addr);
error("Device %s isn't connected", addr);
return;
}
device->connected = FALSE;
device->profiles_connected = FALSE;
if (device->disconn_timer > 0) {
g_source_remove(device->disconn_timer);
device->disconn_timer = 0;
}
while (device->disconnects) {
DBusMessage *msg = device->disconnects->data;
g_dbus_send_reply(btd_get_dbus_connection(),
msg, DBUS_TYPE_INVALID);
device->disconnects = g_slist_remove(device->disconnects, msg);
dbus_message_unref(msg);
}
if (device_is_paired(device) && !device_is_bonded(device))
device_set_paired(device, FALSE);
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Connected");
}
guint device_add_disconnect_watch(struct btd_device *device,
disconnect_watch watch, void *user_data,
GDestroyNotify destroy)
{
struct btd_disconnect_data *data;
static guint id = 0;
data = g_new0(struct btd_disconnect_data, 1);
data->id = ++id;
data->watch = watch;
data->user_data = user_data;
data->destroy = destroy;
device->watches = g_slist_append(device->watches, data);
return data->id;
}
void device_remove_disconnect_watch(struct btd_device *device, guint id)
{
GSList *l;
for (l = device->watches; l; l = l->next) {
struct btd_disconnect_data *data = l->data;
if (data->id == id) {
device->watches = g_slist_remove(device->watches,
data);
if (data->destroy)
data->destroy(data->user_data);
g_free(data);
return;
}
}
}
static void device_set_vendor(struct btd_device *device, uint16_t value)
{
if (device->vendor == value)
return;
device->vendor = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Vendor");
}
static void device_set_vendor_src(struct btd_device *device, uint16_t value)
{
if (device->vendor_src == value)
return;
device->vendor_src = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "VendorSource");
}
static void device_set_product(struct btd_device *device, uint16_t value)
{
if (device->product == value)
return;
device->product = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Product");
}
static void device_set_version(struct btd_device *device, uint16_t value)
{
if (device->version == value)
return;
device->version = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Version");
}
static char *load_cached_name(struct btd_device *device, const char *local,
const gchar *peer)
{
char filename[PATH_MAX + 1];
GKeyFile *key_file;
char *str = NULL;
int len;
snprintf(filename, PATH_MAX, CACHE_PATH, local, peer);
filename[PATH_MAX] = '\0';
key_file = g_key_file_new();
if (!g_key_file_load_from_file(key_file, filename, 0, NULL))
goto failed;
str = g_key_file_get_string(key_file, "General", "Name", NULL);
if (str) {
len = strlen(str);
if (len > HCI_MAX_NAME_LENGTH)
str[HCI_MAX_NAME_LENGTH] = '\0';
}
failed:
g_key_file_free(key_file);
return str;
}
static void load_info(struct btd_device *device, const gchar *local,
const gchar *peer)
{
char filename[PATH_MAX + 1];
GKeyFile *key_file;
char *str;
gboolean store_needed = FALSE;
snprintf(filename, PATH_MAX, INFO_PATH, local, peer);
filename[PATH_MAX] = '\0';
key_file = g_key_file_new();
g_key_file_load_from_file(key_file, filename, 0, NULL);
/* Load device name from storage info file, if that fails fall back to
* the cache.
*/
str = g_key_file_get_string(key_file, "General", "Name", NULL);
if (str == NULL) {
str = load_cached_name(device, local, peer);
if (str)
store_needed = TRUE;
}
if (str) {
strcpy(device->name, str);
g_free(str);
}
if (store_needed)
store_device_info(device);
g_key_file_free(key_file);
}
struct btd_device *device_create(struct btd_adapter *adapter,
const gchar *address, uint8_t bdaddr_type)
{
gchar *address_up;
struct btd_device *device;
const gchar *adapter_path = adapter_get_path(adapter);
const bdaddr_t *src;
char srcaddr[18], alias[MAX_NAME_LENGTH + 1];
uint16_t vendor, product, version;
device = g_try_malloc0(sizeof(struct btd_device));
if (device == NULL)
return NULL;
address_up = g_ascii_strup(address, -1);
device->path = g_strdup_printf("%s/dev_%s", adapter_path, address_up);
g_strdelimit(device->path, ":", '_');
g_free(address_up);
DBG("Creating device %s", device->path);
if (g_dbus_register_interface(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE,
device_methods, device_signals,
device_properties, device,
device_free) == FALSE) {
device_free(device);
return NULL;
}
str2ba(address, &device->bdaddr);
device->adapter = adapter;
device->bdaddr_type = bdaddr_type;
src = adapter_get_address(adapter);
ba2str(src, srcaddr);
load_info(device, srcaddr, address);
if (read_device_alias(srcaddr, address, bdaddr_type, alias,
sizeof(alias)) == 0)
device->alias = g_strdup(alias);
device->trusted = read_trust(src, address, device->bdaddr_type);
if (read_blocked(src, &device->bdaddr, device->bdaddr_type))
device_block(device, FALSE);
if (read_link_key(src, &device->bdaddr, device->bdaddr_type, NULL,
NULL) == 0) {
device_set_paired(device, TRUE);
device_set_bonded(device, TRUE);
}
if (device_is_le(device) && has_longtermkeys(src, &device->bdaddr,
device->bdaddr_type)) {
device_set_paired(device, TRUE);
device_set_bonded(device, TRUE);
}
if (read_device_id(srcaddr, address, bdaddr_type, NULL, &vendor,
&product, &version) == 0) {
device_set_vendor(device, vendor);
device_set_product(device, product);
device_set_version(device, version);
}
return btd_device_ref(device);
}
void device_set_name(struct btd_device *device, const char *name)
{
if (strncmp(name, device->name, MAX_NAME_LENGTH) == 0)
return;
DBG("%s %s", device->path, name);
strncpy(device->name, name, MAX_NAME_LENGTH);
store_device_info(device);
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Name");
if (device->alias != NULL)
return;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Alias");
}
void device_get_name(struct btd_device *device, char *name, size_t len)
{
strncpy(name, device->name, len);
}
bool device_name_known(struct btd_device *device)
{
return device->name[0] != '\0';
}
uint16_t btd_device_get_vendor(struct btd_device *device)
{
return device->vendor;
}
uint16_t btd_device_get_vendor_src(struct btd_device *device)
{
return device->vendor_src;
}
uint16_t btd_device_get_product(struct btd_device *device)
{
return device->product;
}
uint16_t btd_device_get_version(struct btd_device *device)
{
return device->version;
}
static void device_remove_stored(struct btd_device *device)
{
const bdaddr_t *src = adapter_get_address(device->adapter);
uint8_t dst_type = device->bdaddr_type;
delete_entry(src, "profiles", &device->bdaddr, dst_type);
delete_entry(src, "trusts", &device->bdaddr, dst_type);
if (device_is_bonded(device)) {
delete_entry(src, "linkkeys", &device->bdaddr, dst_type);
delete_entry(src, "aliases", &device->bdaddr, dst_type);
delete_entry(src, "longtermkeys", &device->bdaddr, dst_type);
device_set_bonded(device, FALSE);
device->paired = FALSE;
btd_adapter_remove_bonding(device->adapter, &device->bdaddr,
dst_type);
}
delete_all_records(src, &device->bdaddr, dst_type);
delete_device_service(src, &device->bdaddr, dst_type);
if (device->blocked)
device_unblock(device, TRUE, FALSE);
}
void device_remove(struct btd_device *device, gboolean remove_stored)
{
DBG("Removing device %s", device->path);
if (device->agent)
agent_free(device->agent);
if (device->bonding) {
uint8_t status;
if (device->connected)
status = MGMT_STATUS_DISCONNECTED;
else
status = MGMT_STATUS_CONNECT_FAILED;
device_cancel_bonding(device, status);
}
if (device->browse) {
discover_services_reply(device->browse, -ECANCELED, NULL);
browse_request_cancel(device->browse);
}
if (device->profiles_connected)
g_slist_foreach(device->profiles, dev_disconn_profile, device);
g_slist_free(device->pending);
device->pending = NULL;
if (device->connected)
do_disconnect(device);
if (device->store_id > 0) {
if (!remove_stored)
store_device_info_cb(device);
g_source_remove(device->store_id);
device->store_id = 0;
}
if (remove_stored)
device_remove_stored(device);
g_slist_foreach(device->profiles, (GFunc) profile_remove, device);
g_slist_free(device->profiles);
device->profiles = NULL;
attrib_client_unregister(device->services);
btd_device_unref(device);
}
gint device_address_cmp(struct btd_device *device, const gchar *address)
{
char addr[18];
ba2str(&device->bdaddr, addr);
return strcasecmp(addr, address);
}
gint device_bdaddr_cmp(struct btd_device *device, bdaddr_t *bdaddr)
{
return bacmp(&device->bdaddr, bdaddr);
}
static gboolean record_has_uuid(const sdp_record_t *rec,
const char *profile_uuid)
{
sdp_list_t *pat;
for (pat = rec->pattern; pat != NULL; pat = pat->next) {
char *uuid;
int ret;
uuid = bt_uuid2string(pat->data);
if (!uuid)
continue;
ret = strcasecmp(uuid, profile_uuid);
g_free(uuid);
if (ret == 0)
return TRUE;
}
return FALSE;
}
static GSList *device_match_profile(struct btd_device *device,
struct btd_profile *profile,
GSList *uuids)
{
const char **uuid;
GSList *match_uuids = NULL;
for (uuid = profile->remote_uuids; *uuid; uuid++) {
GSList *match;
/* skip duplicated uuids */
if (g_slist_find_custom(match_uuids, *uuid, bt_uuid_strcmp))
continue;
/* match profile uuid */
match = g_slist_find_custom(uuids, *uuid, bt_uuid_strcmp);
if (match)
match_uuids = g_slist_append(match_uuids, match->data);
}
return match_uuids;
}
struct probe_data {
struct btd_device *dev;
GSList *uuids;
char addr[18];
};
static void dev_probe(struct btd_profile *p, void *user_data)
{
struct probe_data *d = user_data;
GSList *probe_uuids;
int err;
if (p->device_probe == NULL)
return;
probe_uuids = device_match_profile(d->dev, p, d->uuids);
if (!probe_uuids)
return;
err = p->device_probe(p, d->dev, probe_uuids);
if (err < 0) {
error("%s profile probe failed for %s", p->name, d->addr);
g_slist_free(probe_uuids);
return;
}
d->dev->profiles = g_slist_append(d->dev->profiles, p);
g_slist_free(probe_uuids);
}
void device_probe_profile(gpointer a, gpointer b)
{
struct btd_device *device = a;
struct btd_profile *profile = b;
GSList *probe_uuids;
char addr[18];
int err;
if (profile->device_probe == NULL)
return;
probe_uuids = device_match_profile(device, profile, device->uuids);
if (!probe_uuids)
return;
ba2str(&device->bdaddr, addr);
err = profile->device_probe(profile, device, probe_uuids);
if (err < 0)
error("%s profile probe failed for %s", profile->name, addr);
else
device->profiles = g_slist_append(device->profiles, profile);
g_slist_free(probe_uuids);
}
void device_remove_profile(gpointer a, gpointer b)
{
struct btd_device *device = a;
struct btd_profile *profile = b;
if (!g_slist_find(device->profiles, profile))
return;
device->profiles = g_slist_remove(device->profiles, profile);
profile->device_remove(profile, device);
}
void device_probe_profiles(struct btd_device *device, GSList *uuids)
{
struct probe_data d = { device, uuids };
GSList *l;
ba2str(&device->bdaddr, d.addr);
if (device->blocked) {
DBG("Skipping profiles for blocked device %s", d.addr);
goto add_uuids;
}
DBG("Probing profiles for device %s", d.addr);
btd_profile_foreach(dev_probe, &d);
add_uuids:
for (l = uuids; l != NULL; l = g_slist_next(l)) {
GSList *match = g_slist_find_custom(device->uuids, l->data,
bt_uuid_strcmp);
if (match)
continue;
device->uuids = g_slist_insert_sorted(device->uuids,
g_strdup(l->data),
bt_uuid_strcmp);
}
device->svc_resolved = true;
g_dbus_emit_property_changed(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE,
"UUIDs");
}
static void device_remove_profiles(struct btd_device *device, GSList *uuids)
{
char srcaddr[18], dstaddr[18];
sdp_list_t *records;
GSList *l, *next;
ba2str(adapter_get_address(device->adapter), srcaddr);
ba2str(&device->bdaddr, dstaddr);
records = read_records(adapter_get_address(device->adapter),
&device->bdaddr);
DBG("Removing profiles for %s", dstaddr);
for (l = uuids; l != NULL; l = g_slist_next(l)) {
sdp_record_t *rec;
device->uuids = g_slist_remove(device->uuids, l->data);
rec = find_record_in_list(records, l->data);
if (!rec)
continue;
delete_record(srcaddr, dstaddr, device->bdaddr_type,
rec->handle);
records = sdp_list_remove(records, rec);
sdp_record_free(rec);
}
if (records)
sdp_list_free(records, (sdp_free_func_t) sdp_record_free);
for (l = device->profiles; l != NULL; l = next) {
struct btd_profile *profile = l->data;
GSList *probe_uuids;
next = l->next;
probe_uuids = device_match_profile(device, profile,
device->uuids);
if (probe_uuids != NULL) {
g_slist_free(probe_uuids);
continue;
}
profile->device_remove(profile, device);
device->profiles = g_slist_remove(device->profiles, profile);
}
}
static void uuids_changed(struct btd_device *device)
{
char **uuids;
GSList *l;
int i;
uuids = g_new0(char *, g_slist_length(device->uuids) + 1);
for (i = 0, l = device->uuids; l; l = l->next, i++)
uuids[i] = l->data;
emit_array_property_changed(device->path,
DEVICE_INTERFACE, "UUIDs",
DBUS_TYPE_STRING, &uuids, i);
g_free(uuids);
}
static int rec_cmp(const void *a, const void *b)
{
const sdp_record_t *r1 = a;
const sdp_record_t *r2 = b;
return r1->handle - r2->handle;
}
static void update_bredr_services(struct browse_req *req, sdp_list_t *recs)
{
struct btd_device *device = req->device;
sdp_list_t *seq;
char srcaddr[18], dstaddr[18];
ba2str(adapter_get_address(device->adapter), srcaddr);
ba2str(&device->bdaddr, dstaddr);
for (seq = recs; seq; seq = seq->next) {
sdp_record_t *rec = (sdp_record_t *) seq->data;
sdp_list_t *svcclass = NULL;
gchar *profile_uuid;
GSList *l;
if (!rec)
break;
if (sdp_get_service_classes(rec, &svcclass) < 0)
continue;
/* Check for empty service classes list */
if (svcclass == NULL) {
DBG("Skipping record with no service classes");
continue;
}
/* Extract the first element and skip the remainning */
profile_uuid = bt_uuid2string(svcclass->data);
if (!profile_uuid) {
sdp_list_free(svcclass, free);
continue;
}
if (bt_uuid_strcmp(profile_uuid, PNP_UUID) == 0) {
uint16_t source, vendor, product, version;
sdp_data_t *pdlist;
pdlist = sdp_data_get(rec, SDP_ATTR_VENDOR_ID_SOURCE);
source = pdlist ? pdlist->val.uint16 : 0x0000;
pdlist = sdp_data_get(rec, SDP_ATTR_VENDOR_ID);
vendor = pdlist ? pdlist->val.uint16 : 0x0000;
device_set_vendor(device, vendor);
pdlist = sdp_data_get(rec, SDP_ATTR_PRODUCT_ID);
product = pdlist ? pdlist->val.uint16 : 0x0000;
device_set_product(device, product);
pdlist = sdp_data_get(rec, SDP_ATTR_VERSION);
version = pdlist ? pdlist->val.uint16 : 0x0000;
device_set_version(device, version);
if (source || vendor || product || version)
store_device_id(srcaddr, dstaddr,
device->bdaddr_type, source,
vendor, product, version);
}
/* Check for duplicates */
if (sdp_list_find(req->records, rec, rec_cmp)) {
g_free(profile_uuid);
sdp_list_free(svcclass, free);
continue;
}
store_record(srcaddr, dstaddr, device->bdaddr_type, rec);
/* Copy record */
req->records = sdp_list_append(req->records,
sdp_copy_record(rec));
l = g_slist_find_custom(device->uuids, profile_uuid,
(GCompareFunc) strcmp);
if (!l)
req->profiles_added =
g_slist_append(req->profiles_added,
profile_uuid);
else {
req->profiles_removed =
g_slist_remove(req->profiles_removed,
l->data);
g_free(profile_uuid);
}
sdp_list_free(svcclass, free);
}
}
static gint primary_cmp(gconstpointer a, gconstpointer b)
{
return memcmp(a, b, sizeof(struct gatt_primary));
}
static void update_gatt_services(struct browse_req *req, GSList *current,
GSList *found)
{
GSList *l, *lmatch, *left = g_slist_copy(current);
/* Added Profiles */
for (l = found; l; l = g_slist_next(l)) {
struct gatt_primary *prim = l->data;
/* Entry found ? */
lmatch = g_slist_find_custom(current, prim, primary_cmp);
if (lmatch) {
left = g_slist_remove(left, lmatch->data);
continue;
}
/* New entry */
req->profiles_added = g_slist_append(req->profiles_added,
g_strdup(prim->uuid));
DBG("UUID Added: %s", prim->uuid);
}
/* Removed Profiles */
for (l = left; l; l = g_slist_next(l)) {
struct gatt_primary *prim = l->data;
req->profiles_removed = g_slist_append(req->profiles_removed,
g_strdup(prim->uuid));
DBG("UUID Removed: %s", prim->uuid);
}
g_slist_free(left);
}
static void store_profiles(struct btd_device *device)
{
struct btd_adapter *adapter = device->adapter;
char *str;
if (!device->uuids) {
write_device_profiles(adapter_get_address(adapter),
&device->bdaddr, device->bdaddr_type,
"");
return;
}
str = bt_list2string(device->uuids);
write_device_profiles(adapter_get_address(adapter), &device->bdaddr,
device->bdaddr_type, str);
g_free(str);
}
GSList *device_services_from_record(struct btd_device *device, GSList *profiles)
{
GSList *l, *prim_list = NULL;
char *att_uuid;
uuid_t proto_uuid;
sdp_uuid16_create(&proto_uuid, ATT_UUID);
att_uuid = bt_uuid2string(&proto_uuid);
for (l = profiles; l; l = l->next) {
const char *profile_uuid = l->data;
const sdp_record_t *rec;
struct gatt_primary *prim;
uint16_t start = 0, end = 0, psm = 0;
uuid_t prim_uuid;
rec = btd_device_get_record(device, profile_uuid);
if (!rec)
continue;
if (!record_has_uuid(rec, att_uuid))
continue;
if (!gatt_parse_record(rec, &prim_uuid, &psm, &start, &end))
continue;
prim = g_new0(struct gatt_primary, 1);
prim->range.start = start;
prim->range.end = end;
sdp_uuid2strn(&prim_uuid, prim->uuid, sizeof(prim->uuid));
prim_list = g_slist_append(prim_list, prim);
}
g_free(att_uuid);
return prim_list;
}
static void search_cb(sdp_list_t *recs, int err, gpointer user_data)
{
struct browse_req *req = user_data;
struct btd_device *device = req->device;
char addr[18];
ba2str(&device->bdaddr, addr);
if (err < 0) {
error("%s: error updating services: %s (%d)",
addr, strerror(-err), -err);
goto send_reply;
}
update_bredr_services(req, recs);
if (device->tmp_records)
sdp_list_free(device->tmp_records,
(sdp_free_func_t) sdp_record_free);
device->tmp_records = req->records;
req->records = NULL;
if (!req->profiles_added && !req->profiles_removed) {
DBG("%s: No service update", addr);
goto send_reply;
}
/* Probe matching profiles for services added */
if (req->profiles_added) {
GSList *list;
list = device_services_from_record(device, req->profiles_added);
if (list)
device_register_services(device, list, ATT_PSM);
device_probe_profiles(device, req->profiles_added);
}
/* Remove profiles for services removed */
if (req->profiles_removed)
device_remove_profiles(device, req->profiles_removed);
/* Propagate services changes */
uuids_changed(req->device);
send_reply:
device_svc_resolved(device, err);
if (!device->temporary)
store_profiles(device);
browse_request_free(req);
}
static void browse_cb(sdp_list_t *recs, int err, gpointer user_data)
{
struct browse_req *req = user_data;
struct btd_device *device = req->device;
struct btd_adapter *adapter = device->adapter;
uuid_t uuid;
/* If we have a valid response and req->search_uuid == 2, then L2CAP
* UUID & PNP searching was successful -- we are done */
if (err < 0 || (req->search_uuid == 2 && req->records)) {
if (err == -ECONNRESET && req->reconnect_attempt < 1) {
req->search_uuid--;
req->reconnect_attempt++;
} else
goto done;
}
update_bredr_services(req, recs);
/* Search for mandatory uuids */
if (uuid_list[req->search_uuid]) {
sdp_uuid16_create(&uuid, uuid_list[req->search_uuid++]);
bt_search_service(adapter_get_address(adapter),
&device->bdaddr, &uuid,
browse_cb, user_data, NULL);
return;
}
done:
search_cb(recs, err, user_data);
}
static void init_browse(struct browse_req *req, gboolean reverse)
{
GSList *l;
/* If we are doing reverse-SDP don't try to detect removed profiles
* since some devices hide their service records while they are
* connected
*/
if (reverse)
return;
for (l = req->device->uuids; l; l = l->next)
req->profiles_removed = g_slist_append(req->profiles_removed,
l->data);
}
static char *primary_list_to_string(GSList *primary_list)
{
GString *services;
GSList *l;
services = g_string_new(NULL);
for (l = primary_list; l; l = l->next) {
struct gatt_primary *primary = l->data;
char service[64];
memset(service, 0, sizeof(service));
snprintf(service, sizeof(service), "%04X#%04X#%s ",
primary->range.start, primary->range.end, primary->uuid);
services = g_string_append(services, service);
}
return g_string_free(services, FALSE);
}
static void store_services(struct btd_device *device)
{
struct btd_adapter *adapter = device->adapter;
char *str = primary_list_to_string(device->primaries);
write_device_services(adapter_get_address(adapter), &device->bdaddr,
device->bdaddr_type, str);
g_free(str);
}
static void attio_connected(gpointer data, gpointer user_data)
{
struct attio_data *attio = data;
GAttrib *attrib = user_data;
if (attio->cfunc)
attio->cfunc(attrib, attio->user_data);
}
static void attio_disconnected(gpointer data, gpointer user_data)
{
struct attio_data *attio = data;
if (attio->dcfunc)
attio->dcfunc(attio->user_data);
}
static gboolean attrib_disconnected_cb(GIOChannel *io, GIOCondition cond,
gpointer user_data)
{
struct btd_device *device = user_data;
int sock, err = 0;
socklen_t len;
if (device->browse)
goto done;
sock = g_io_channel_unix_get_fd(io);
len = sizeof(err);
getsockopt(sock, SOL_SOCKET, SO_ERROR, &err, &len);
g_slist_foreach(device->attios, attio_disconnected, NULL);
if (device->auto_connect == FALSE) {
DBG("Automatic connection disabled");
goto done;
}
/*
* Keep scanning/re-connection active if disconnection reason
* is connection timeout, remote user terminated connection or local
* initiated disconnection.
*/
if (err == ETIMEDOUT || err == ECONNRESET || err == ECONNABORTED)
adapter_connect_list_add(device->adapter, device);
done:
attio_cleanup(device);
return FALSE;
}
static void device_unregister_services(struct btd_device *device)
{
attrib_client_unregister(device->services);
g_slist_free_full(device->services, g_free);
device->services = NULL;
}
static void register_all_services(struct browse_req *req, GSList *services)
{
struct btd_device *device = req->device;
device_set_temporary(device, FALSE);
if (device->services)
device_unregister_services(device);
update_gatt_services(req, device->primaries, services);
g_slist_free_full(device->primaries, g_free);
device->primaries = NULL;
device_register_services(device, g_slist_copy(services), -1);
if (req->profiles_removed)
device_remove_profiles(device, req->profiles_removed);
device_probe_profiles(device, req->profiles_added);
if (device->attios == NULL && device->attios_offline == NULL)
attio_cleanup(device);
uuids_changed(device);
device_svc_resolved(device, 0);
store_services(device);
browse_request_free(req);
}
static int service_by_range_cmp(gconstpointer a, gconstpointer b)
{
const struct gatt_primary *prim = a;
const struct att_range *range = b;
return memcmp(&prim->range, range, sizeof(*range));
}
static void find_included_cb(GSList *includes, uint8_t status,
gpointer user_data)
{
struct included_search *search = user_data;
struct btd_device *device = search->req->device;
struct gatt_primary *prim;
GSList *l;
if (includes == NULL)
goto done;
for (l = includes; l; l = l->next) {
struct gatt_included *incl = l->data;
if (g_slist_find_custom(search->services, &incl->range,
service_by_range_cmp))
continue;
prim = g_new0(struct gatt_primary, 1);
memcpy(prim->uuid, incl->uuid, sizeof(prim->uuid));
memcpy(&prim->range, &incl->range, sizeof(prim->range));
search->services = g_slist_append(search->services, prim);
}
done:
search->current = search->current->next;
if (search->current == NULL) {
register_all_services(search->req, search->services);
g_slist_free(search->services);
g_free(search);
return;
}
prim = search->current->data;
gatt_find_included(device->attrib, prim->range.start, prim->range.end,
find_included_cb, search);
}
static void find_included_services(struct browse_req *req, GSList *services)
{
struct btd_device *device = req->device;
struct included_search *search;
struct gatt_primary *prim;
if (services == NULL)
return;
search = g_new0(struct included_search, 1);
search->req = req;
search->services = g_slist_copy(services);
search->current = search->services;
prim = search->current->data;
gatt_find_included(device->attrib, prim->range.start, prim->range.end,
find_included_cb, search);
}
static void primary_cb(GSList *services, guint8 status, gpointer user_data)
{
struct browse_req *req = user_data;
if (status) {
struct btd_device *device = req->device;
if (req->msg) {
DBusMessage *reply;
reply = btd_error_failed(req->msg,
att_ecode2str(status));
g_dbus_send_message(btd_get_dbus_connection(), reply);
}
device->browse = NULL;
browse_request_free(req);
return;
}
find_included_services(req, services);
}
static void bonding_request_free(struct bonding_req *bonding)
{
struct btd_device *device;
if (!bonding)
return;
if (bonding->listener_id)
g_dbus_remove_watch(btd_get_dbus_connection(),
bonding->listener_id);
if (bonding->msg)
dbus_message_unref(bonding->msg);
device = bonding->device;
g_free(bonding);
if (!device)
return;
device->bonding = NULL;
if (!device->agent)
return;
agent_cancel(device->agent);
agent_free(device->agent);
device->agent = NULL;
}
static void att_connect_cb(GIOChannel *io, GError *gerr, gpointer user_data)
{
struct att_callbacks *attcb = user_data;
struct btd_device *device = attcb->user_data;
GAttrib *attrib;
int err;
g_io_channel_unref(device->att_io);
device->att_io = NULL;
if (gerr) {
DBG("%s", gerr->message);
if (attcb->error)
attcb->error(gerr, user_data);
goto done;
}
attrib = g_attrib_new(io);
device->attachid = attrib_channel_attach(attrib);
if (device->attachid == 0)
error("Attribute server attach failure!");
device->attrib = attrib;
device->cleanup_id = g_io_add_watch(io, G_IO_HUP,
attrib_disconnected_cb, device);
if (attcb->success)
attcb->success(user_data);
if (!device->bonding)
goto done;
/* this is a LE device during pairing */
err = adapter_create_bonding(device->adapter,
&device->bdaddr, device->bdaddr_type,
agent_get_io_capability(device->agent));
if (err < 0) {
DBusMessage *reply = btd_error_failed(device->bonding->msg,
strerror(-err));
g_dbus_send_message(btd_get_dbus_connection(), reply);
bonding_request_cancel(device->bonding);
bonding_request_free(device->bonding);
}
done:
g_free(attcb);
}
static void att_error_cb(const GError *gerr, gpointer user_data)
{
struct att_callbacks *attcb = user_data;
struct btd_device *device = attcb->user_data;
if (g_error_matches(gerr, BT_IO_ERROR, ECONNABORTED))
return;
if (device->auto_connect == FALSE)
return;
adapter_connect_list_add(device->adapter, device);
DBG("Enabling automatic connections");
}
static void att_success_cb(gpointer user_data)
{
struct att_callbacks *attcb = user_data;
struct btd_device *device = attcb->user_data;
if (device->attios == NULL)
return;
g_slist_foreach(device->attios, attio_connected, device->attrib);
}
GIOChannel *device_att_connect(gpointer user_data)
{
struct btd_device *device = user_data;
struct btd_adapter *adapter = device->adapter;
struct att_callbacks *attcb;
GIOChannel *io;
GError *gerr = NULL;
char addr[18];
ba2str(&device->bdaddr, addr);
DBG("Connection attempt to: %s", addr);
attcb = g_new0(struct att_callbacks, 1);
attcb->error = att_error_cb;
attcb->success = att_success_cb;
attcb->user_data = device;
if (device_is_bredr(device)) {
io = bt_io_connect(att_connect_cb,
attcb, NULL, &gerr,
BT_IO_OPT_SOURCE_BDADDR,
adapter_get_address(adapter),
BT_IO_OPT_DEST_BDADDR, &device->bdaddr,
BT_IO_OPT_PSM, ATT_PSM,
BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_MEDIUM,
BT_IO_OPT_INVALID);
} else if (device->bonding) {
/* this is a LE device during pairing, using low sec level */
io = bt_io_connect(att_connect_cb,
attcb, NULL, &gerr,
BT_IO_OPT_SOURCE_BDADDR,
adapter_get_address(adapter),
BT_IO_OPT_DEST_BDADDR, &device->bdaddr,
BT_IO_OPT_DEST_TYPE, device->bdaddr_type,
BT_IO_OPT_CID, ATT_CID,
BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_LOW,
BT_IO_OPT_INVALID);
if (io == NULL) {
DBusMessage *reply = btd_error_failed(
device->bonding->msg, gerr->message);
g_dbus_send_message(btd_get_dbus_connection(), reply);
bonding_request_cancel(device->bonding);
bonding_request_free(device->bonding);
}
} else {
BtIOSecLevel sec_level;
if (device->paired)
sec_level = BT_IO_SEC_MEDIUM;
else
sec_level = BT_IO_SEC_LOW;
io = bt_io_connect(att_connect_cb,
attcb, NULL, &gerr,
BT_IO_OPT_SOURCE_BDADDR,
adapter_get_address(adapter),
BT_IO_OPT_DEST_BDADDR, &device->bdaddr,
BT_IO_OPT_DEST_TYPE, device->bdaddr_type,
BT_IO_OPT_CID, ATT_CID,
BT_IO_OPT_SEC_LEVEL, sec_level,
BT_IO_OPT_INVALID);
}
if (io == NULL) {
error("ATT bt_io_connect(%s): %s", addr, gerr->message);
g_error_free(gerr);
g_free(attcb);
return NULL;
}
device->att_io = io;
return g_io_channel_ref(io);
}
static void att_browse_error_cb(const GError *gerr, gpointer user_data)
{
struct att_callbacks *attcb = user_data;
struct btd_device *device = attcb->user_data;
struct browse_req *req = device->browse;
if (req->msg) {
DBusMessage *reply;
reply = btd_error_failed(req->msg, gerr->message);
g_dbus_send_message(btd_get_dbus_connection(), reply);
}
device->browse = NULL;
browse_request_free(req);
}
static void att_browse_cb(gpointer user_data)
{
struct att_callbacks *attcb = user_data;
struct btd_device *device = attcb->user_data;
gatt_discover_primary(device->attrib, NULL, primary_cb,
device->browse);
}
int device_browse_primary(struct btd_device *device, DBusMessage *msg,
gboolean secure)
{
struct btd_adapter *adapter = device->adapter;
struct att_callbacks *attcb;
struct browse_req *req;
BtIOSecLevel sec_level;
if (device->browse)
return -EBUSY;
req = g_new0(struct browse_req, 1);
req->device = btd_device_ref(device);
device->browse = req;
if (device->attrib) {
gatt_discover_primary(device->attrib, NULL, primary_cb, req);
goto done;
}
sec_level = secure ? BT_IO_SEC_HIGH : BT_IO_SEC_LOW;
attcb = g_new0(struct att_callbacks, 1);
attcb->error = att_browse_error_cb;
attcb->success = att_browse_cb;
attcb->user_data = device;
device->att_io = bt_io_connect(att_connect_cb,
attcb, NULL, NULL,
BT_IO_OPT_SOURCE_BDADDR,
adapter_get_address(adapter),
BT_IO_OPT_DEST_BDADDR, &device->bdaddr,
BT_IO_OPT_DEST_TYPE, device->bdaddr_type,
BT_IO_OPT_CID, ATT_CID,
BT_IO_OPT_SEC_LEVEL, sec_level,
BT_IO_OPT_INVALID);
if (device->att_io == NULL) {
device->browse = NULL;
browse_request_free(req);
g_free(attcb);
return -EIO;
}
done:
if (msg) {
const char *sender = dbus_message_get_sender(msg);
req->msg = dbus_message_ref(msg);
/* Track the request owner to cancel it
* automatically if the owner exits */
req->listener_id = g_dbus_add_disconnect_watch(
btd_get_dbus_connection(),
sender,
discover_services_req_exit,
req, NULL);
}
return 0;
}
int device_browse_sdp(struct btd_device *device, DBusMessage *msg,
uuid_t *search, gboolean reverse)
{
struct btd_adapter *adapter = device->adapter;
struct browse_req *req;
bt_callback_t cb;
uuid_t uuid;
int err;
if (device->browse)
return -EBUSY;
req = g_new0(struct browse_req, 1);
req->device = btd_device_ref(device);
if (search) {
memcpy(&uuid, search, sizeof(uuid_t));
cb = search_cb;
} else {
sdp_uuid16_create(&uuid, uuid_list[req->search_uuid++]);
init_browse(req, reverse);
cb = browse_cb;
}
err = bt_search_service(adapter_get_address(adapter), &device->bdaddr,
&uuid, cb, req, NULL);
if (err < 0) {
browse_request_free(req);
return err;
}
device->browse = req;
if (msg) {
const char *sender = dbus_message_get_sender(msg);
req->msg = dbus_message_ref(msg);
/* Track the request owner to cancel it
* automatically if the owner exits */
req->listener_id = g_dbus_add_disconnect_watch(
btd_get_dbus_connection(),
sender,
discover_services_req_exit,
req, NULL);
}
return err;
}
struct btd_adapter *device_get_adapter(struct btd_device *device)
{
if (!device)
return NULL;
return device->adapter;
}
const bdaddr_t *device_get_address(struct btd_device *device)
{
return &device->bdaddr;
}
void device_set_addr_type(struct btd_device *device, uint8_t bdaddr_type)
{
if (device == NULL)
return;
device->bdaddr_type = bdaddr_type;
}
uint8_t device_get_addr_type(struct btd_device *device)
{
return device->bdaddr_type;
}
const gchar *device_get_path(struct btd_device *device)
{
if (!device)
return NULL;
return device->path;
}
struct agent *device_get_agent(struct btd_device *device)
{
if (!device)
return NULL;
if (device->agent)
return device->agent;
return adapter_get_agent(device->adapter);
}
gboolean device_is_busy(struct btd_device *device)
{
return device->browse ? TRUE : FALSE;
}
gboolean device_is_temporary(struct btd_device *device)
{
return device->temporary;
}
void device_set_temporary(struct btd_device *device, gboolean temporary)
{
if (!device)
return;
if (device->temporary == temporary)
return;
DBG("temporary %d", temporary);
if (temporary)
adapter_connect_list_remove(device->adapter, device);
device->temporary = temporary;
}
void device_set_bonded(struct btd_device *device, gboolean bonded)
{
if (!device)
return;
DBG("bonded %d", bonded);
device->bonded = bonded;
}
void device_set_legacy(struct btd_device *device, bool legacy)
{
if (!device)
return;
DBG("legacy %d", legacy);
if (device->legacy == legacy)
return;
device->legacy = legacy;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "LegacyPairing");
}
void device_set_rssi(struct btd_device *device, int8_t rssi)
{
if (!device)
return;
DBG("rssi %d", rssi);
if (device->rssi == rssi)
return;
device->rssi = rssi;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "RSSI");
}
void device_set_auto_connect(struct btd_device *device, gboolean enable)
{
char addr[18];
if (!device)
return;
ba2str(&device->bdaddr, addr);
DBG("%s auto connect: %d", addr, enable);
device->auto_connect = enable;
/* Disabling auto connect */
if (enable == FALSE) {
adapter_connect_list_remove(device->adapter, device);
return;
}
if (device->attrib) {
DBG("Already connected");
return;
}
if (device->attios == NULL && device->attios_offline == NULL)
return;
/* Enabling auto connect */
adapter_connect_list_add(device->adapter, device);
}
static gboolean start_discovery(gpointer user_data)
{
struct btd_device *device = user_data;
if (device_is_bredr(device))
device_browse_sdp(device, NULL, NULL, TRUE);
else
device_browse_primary(device, NULL, FALSE);
device->discov_timer = 0;
return FALSE;
}
static DBusMessage *new_authentication_return(DBusMessage *msg, uint8_t status)
{
switch (status) {
case MGMT_STATUS_SUCCESS:
return dbus_message_new_method_return(msg);
case MGMT_STATUS_CONNECT_FAILED:
return dbus_message_new_error(msg,
ERROR_INTERFACE ".ConnectionAttemptFailed",
"Page Timeout");
case MGMT_STATUS_TIMEOUT:
return dbus_message_new_error(msg,
ERROR_INTERFACE ".AuthenticationTimeout",
"Authentication Timeout");
case MGMT_STATUS_BUSY:
case MGMT_STATUS_REJECTED:
return dbus_message_new_error(msg,
ERROR_INTERFACE ".AuthenticationRejected",
"Authentication Rejected");
case MGMT_STATUS_CANCELLED:
case MGMT_STATUS_NO_RESOURCES:
case MGMT_STATUS_DISCONNECTED:
return dbus_message_new_error(msg,
ERROR_INTERFACE ".AuthenticationCanceled",
"Authentication Canceled");
default:
return dbus_message_new_error(msg,
ERROR_INTERFACE ".AuthenticationFailed",
"Authentication Failed");
}
}
void device_set_paired(struct btd_device *device, gboolean value)
{
if (device->paired == value)
return;
if (!value)
btd_adapter_remove_bonding(device->adapter, &device->bdaddr,
device->bdaddr_type);
device->paired = value;
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Paired");
}
static void device_agent_removed(struct agent *agent, void *user_data)
{
struct btd_device *device = user_data;
device->agent = NULL;
if (device->authr)
device->authr->agent = NULL;
}
static struct bonding_req *bonding_request_new(DBusMessage *msg,
struct btd_device *device,
const char *agent_path,
uint8_t capability)
{
struct bonding_req *bonding;
const char *name = dbus_message_get_sender(msg);
char addr[18];
ba2str(&device->bdaddr, addr);
DBG("Requesting bonding for %s", addr);
if (!agent_path)
goto proceed;
device->agent = agent_create(device->adapter, name, agent_path,
capability,
device_agent_removed,
device);
DBG("Temporary agent registered for %s at %s:%s",
addr, name, agent_path);
proceed:
bonding = g_new0(struct bonding_req, 1);
bonding->msg = dbus_message_ref(msg);
return bonding;
}
static void create_bond_req_exit(DBusConnection *conn, void *user_data)
{
struct btd_device *device = user_data;
char addr[18];
ba2str(&device->bdaddr, addr);
DBG("%s: requestor exited before bonding was completed", addr);
if (device->authr)
device_cancel_authentication(device, FALSE);
if (device->bonding) {
device->bonding->listener_id = 0;
device_request_disconnect(device, NULL);
}
}
DBusMessage *device_create_bonding(struct btd_device *device,
DBusMessage *msg,
const char *agent_path,
uint8_t capability)
{
struct btd_adapter *adapter = device->adapter;
struct bonding_req *bonding;
int err;
if (device->bonding)
return btd_error_in_progress(msg);
if (device_is_bonded(device))
return btd_error_already_exists(msg);
bonding = bonding_request_new(msg, device, agent_path,
capability);
bonding->listener_id = g_dbus_add_disconnect_watch(
btd_get_dbus_connection(),
dbus_message_get_sender(msg),
create_bond_req_exit, device,
NULL);
device->bonding = bonding;
bonding->device = device;
if (device_is_le(device) && !device_is_connected(device)) {
adapter_connect_list_add(adapter, device);
return NULL;
}
err = adapter_create_bonding(adapter, &device->bdaddr,
device->bdaddr_type, capability);
if (err < 0)
return btd_error_failed(msg, strerror(-err));
return NULL;
}
void device_simple_pairing_complete(struct btd_device *device, uint8_t status)
{
struct authentication_req *auth = device->authr;
if (auth && (auth->type == AUTH_TYPE_NOTIFY_PASSKEY
|| auth->type == AUTH_TYPE_NOTIFY_PINCODE) && auth->agent)
agent_cancel(auth->agent);
}
static void device_auth_req_free(struct btd_device *device)
{
if (device->authr)
g_free(device->authr->pincode);
g_free(device->authr);
device->authr = NULL;
}
void device_bonding_complete(struct btd_device *device, uint8_t status)
{
struct bonding_req *bonding = device->bonding;
struct authentication_req *auth = device->authr;
DBG("bonding %p status 0x%02x", bonding, status);
if (auth && (auth->type == AUTH_TYPE_NOTIFY_PASSKEY
|| auth->type == AUTH_TYPE_NOTIFY_PINCODE) && auth->agent)
agent_cancel(auth->agent);
if (status) {
device_cancel_authentication(device, TRUE);
device_cancel_bonding(device, status);
return;
}
device_auth_req_free(device);
/* If we're already paired nothing more is needed */
if (device->paired)
return;
device_set_paired(device, TRUE);
/* If we were initiators start service discovery immediately.
* However if the other end was the initator wait a few seconds
* before SDP. This is due to potential IOP issues if the other
* end starts doing SDP at the same time as us */
if (bonding) {
DBG("Proceeding with service discovery");
/* If we are initiators remove any discovery timer and just
* start discovering services directly */
if (device->discov_timer) {
g_source_remove(device->discov_timer);
device->discov_timer = 0;
}
if (device_is_bredr(device))
device_browse_sdp(device, bonding->msg, NULL, FALSE);
else
device_browse_primary(device, bonding->msg, FALSE);
bonding_request_free(bonding);
} else {
if (!device->browse && !device->discov_timer &&
main_opts.reverse_sdp) {
/* If we are not initiators and there is no currently
* active discovery or discovery timer, set discovery
* timer */
DBG("setting timer for reverse service discovery");
device->discov_timer = g_timeout_add_seconds(
DISCOVERY_TIMER,
start_discovery,
device);
}
}
}
gboolean device_is_creating(struct btd_device *device, const char *sender)
{
DBusMessage *msg;
if (device->bonding && device->bonding->msg)
msg = device->bonding->msg;
else if (device->browse && device->browse->msg)
msg = device->browse->msg;
else
return FALSE;
if (!dbus_message_is_method_call(msg, ADAPTER_INTERFACE,
"CreatePairedDevice") &&
!dbus_message_is_method_call(msg, ADAPTER_INTERFACE,
"CreateDevice"))
return FALSE;
if (sender == NULL)
return TRUE;
return g_str_equal(sender, dbus_message_get_sender(msg));
}
gboolean device_is_bonding(struct btd_device *device, const char *sender)
{
struct bonding_req *bonding = device->bonding;
if (!device->bonding)
return FALSE;
if (!sender)
return TRUE;
return g_str_equal(sender, dbus_message_get_sender(bonding->msg));
}
void device_cancel_bonding(struct btd_device *device, uint8_t status)
{
struct bonding_req *bonding = device->bonding;
DBusMessage *reply;
char addr[18];
if (!bonding)
return;
ba2str(&device->bdaddr, addr);
DBG("Canceling bonding request for %s", addr);
if (device->authr)
device_cancel_authentication(device, FALSE);
reply = new_authentication_return(bonding->msg, status);
g_dbus_send_message(btd_get_dbus_connection(), reply);
bonding_request_cancel(bonding);
bonding_request_free(bonding);
}
static void pincode_cb(struct agent *agent, DBusError *err,
const char *pincode, void *data)
{
struct authentication_req *auth = data;
struct btd_device *device = auth->device;
struct agent *adapter_agent = adapter_get_agent(device->adapter);
if (err && (g_str_equal(DBUS_ERROR_UNKNOWN_METHOD, err->name) ||
g_str_equal(DBUS_ERROR_NO_REPLY, err->name))) {
if (auth->agent == adapter_agent || adapter_agent == NULL)
goto done;
if (agent_request_pincode(adapter_agent, device, pincode_cb,
auth->secure, auth, NULL) < 0)
goto done;
auth->agent = adapter_agent;
return;
}
done:
/* No need to reply anything if the authentication already failed */
if (auth->cb == NULL)
return;
((agent_pincode_cb) auth->cb)(agent, err, pincode, device);
device->authr->cb = NULL;
device->authr->agent = NULL;
}
static void confirm_cb(struct agent *agent, DBusError *err, void *data)
{
struct authentication_req *auth = data;
struct btd_device *device = auth->device;
struct agent *adapter_agent = adapter_get_agent(device->adapter);
if (err && (g_str_equal(DBUS_ERROR_UNKNOWN_METHOD, err->name) ||
g_str_equal(DBUS_ERROR_NO_REPLY, err->name))) {
if (auth->agent == adapter_agent || adapter_agent == NULL)
goto done;
if (agent_request_confirmation(adapter_agent, device,
auth->passkey, confirm_cb,
auth, NULL) < 0)
goto done;
auth->agent = adapter_agent;
return;
}
done:
/* No need to reply anything if the authentication already failed */
if (auth->cb == NULL)
return;
((agent_cb) auth->cb)(agent, err, device);
device->authr->cb = NULL;
device->authr->agent = NULL;
}
static void passkey_cb(struct agent *agent, DBusError *err,
uint32_t passkey, void *data)
{
struct authentication_req *auth = data;
struct btd_device *device = auth->device;
struct agent *adapter_agent = adapter_get_agent(device->adapter);
if (err && (g_str_equal(DBUS_ERROR_UNKNOWN_METHOD, err->name) ||
g_str_equal(DBUS_ERROR_NO_REPLY, err->name))) {
if (auth->agent == adapter_agent || adapter_agent == NULL)
goto done;
if (agent_request_passkey(adapter_agent, device, passkey_cb,
auth, NULL) < 0)
goto done;
auth->agent = adapter_agent;
return;
}
done:
/* No need to reply anything if the authentication already failed */
if (auth->cb == NULL)
return;
((agent_passkey_cb) auth->cb)(agent, err, passkey, device);
device->authr->cb = NULL;
device->authr->agent = NULL;
}
static void display_pincode_cb(struct agent *agent, DBusError *err, void *data)
{
struct authentication_req *auth = data;
struct btd_device *device = auth->device;
struct agent *adapter_agent = adapter_get_agent(device->adapter);
if (err && (g_str_equal(DBUS_ERROR_UNKNOWN_METHOD, err->name) ||
g_str_equal(DBUS_ERROR_NO_REPLY, err->name))) {
/* Request a pincode if we fail to display one */
if (auth->agent == adapter_agent || adapter_agent == NULL) {
if (agent_request_pincode(agent, device, pincode_cb,
auth->secure, auth, NULL) < 0)
goto done;
return;
}
if (agent_display_pincode(adapter_agent, device, auth->pincode,
display_pincode_cb, auth, NULL) < 0)
goto done;
auth->agent = adapter_agent;
return;
}
done:
/* No need to reply anything if the authentication already failed */
if (auth->cb == NULL)
return;
((agent_pincode_cb) auth->cb)(agent, err, auth->pincode, device);
g_free(device->authr->pincode);
device->authr->pincode = NULL;
device->authr->cb = NULL;
device->authr->agent = NULL;
}
static struct authentication_req *new_auth(struct btd_device *device,
auth_type_t type, gboolean secure,
void *cb)
{
struct authentication_req *auth;
struct agent *agent;
char addr[18];
ba2str(&device->bdaddr, addr);
DBG("Requesting agent authentication for %s", addr);
if (device->authr) {
error("Authentication already requested for %s", addr);
return NULL;
}
agent = device_get_agent(device);
if (!agent) {
error("No agent available for request type %d", type);
return NULL;
}
auth = g_new0(struct authentication_req, 1);
auth->agent = agent;
auth->device = device;
auth->cb = cb;
auth->type = type;
auth->secure = secure;
device->authr = auth;
return auth;
}
int device_request_pincode(struct btd_device *device, gboolean secure,
void *cb)
{
struct authentication_req *auth;
int err;
auth = new_auth(device, AUTH_TYPE_PINCODE, secure, cb);
if (!auth)
return -EPERM;
err = agent_request_pincode(auth->agent, device, pincode_cb, secure,
auth, NULL);
if (err < 0) {
error("Failed requesting authentication");
device_auth_req_free(device);
}
return err;
}
int device_request_passkey(struct btd_device *device, void *cb)
{
struct authentication_req *auth;
int err;
auth = new_auth(device, AUTH_TYPE_PASSKEY, FALSE, cb);
if (!auth)
return -EPERM;
err = agent_request_passkey(auth->agent, device, passkey_cb, auth,
NULL);
if (err < 0) {
error("Failed requesting authentication");
device_auth_req_free(device);
}
return err;
}
int device_confirm_passkey(struct btd_device *device, uint32_t passkey,
void *cb)
{
struct authentication_req *auth;
int err;
auth = new_auth(device, AUTH_TYPE_CONFIRM, FALSE, cb);
if (!auth)
return -EPERM;
auth->passkey = passkey;
err = agent_request_confirmation(auth->agent, device, passkey,
confirm_cb, auth, NULL);
if (err < 0) {
error("Failed requesting authentication");
device_auth_req_free(device);
}
return err;
}
int device_notify_passkey(struct btd_device *device, uint32_t passkey,
uint8_t entered)
{
struct authentication_req *auth;
int err;
if (device->authr) {
auth = device->authr;
if (auth->type != AUTH_TYPE_NOTIFY_PASSKEY)
return -EPERM;
} else {
auth = new_auth(device, AUTH_TYPE_NOTIFY_PASSKEY, FALSE, NULL);
if (!auth)
return -EPERM;
}
err = agent_display_passkey(auth->agent, device, passkey, entered);
if (err < 0) {
error("Failed requesting authentication");
device_auth_req_free(device);
}
return err;
}
int device_notify_pincode(struct btd_device *device, gboolean secure,
const char *pincode, void *cb)
{
struct authentication_req *auth;
int err;
auth = new_auth(device, AUTH_TYPE_NOTIFY_PINCODE, secure, cb);
if (!auth)
return -EPERM;
auth->pincode = g_strdup(pincode);
err = agent_display_pincode(auth->agent, device, pincode,
display_pincode_cb, auth, NULL);
if (err < 0) {
error("Failed requesting authentication");
device_auth_req_free(device);
}
return err;
}
static void cancel_authentication(struct authentication_req *auth)
{
struct btd_device *device;
struct agent *agent;
DBusError err;
if (!auth || !auth->cb)
return;
device = auth->device;
agent = auth->agent;
dbus_error_init(&err);
dbus_set_error_const(&err, "org.bluez.Error.Canceled", NULL);
switch (auth->type) {
case AUTH_TYPE_PINCODE:
((agent_pincode_cb) auth->cb)(agent, &err, NULL, device);
break;
case AUTH_TYPE_CONFIRM:
((agent_cb) auth->cb)(agent, &err, device);
break;
case AUTH_TYPE_PASSKEY:
((agent_passkey_cb) auth->cb)(agent, &err, 0, device);
break;
case AUTH_TYPE_NOTIFY_PASSKEY:
/* User Notify doesn't require any reply */
break;
case AUTH_TYPE_NOTIFY_PINCODE:
((agent_pincode_cb) auth->cb)(agent, &err, NULL, device);
break;
}
dbus_error_free(&err);
auth->cb = NULL;
}
void device_cancel_authentication(struct btd_device *device, gboolean aborted)
{
struct authentication_req *auth = device->authr;
char addr[18];
if (!auth)
return;
ba2str(&device->bdaddr, addr);
DBG("Canceling authentication request for %s", addr);
if (auth->agent)
agent_cancel(auth->agent);
if (!aborted)
cancel_authentication(auth);
device_auth_req_free(device);
}
gboolean device_is_authenticating(struct btd_device *device)
{
return (device->authr != NULL);
}
void device_register_services(struct btd_device *device,
GSList *prim_list, int psm)
{
device->primaries = g_slist_concat(device->primaries, prim_list);
device->services = attrib_client_register(device, psm, NULL, prim_list);
}
GSList *btd_device_get_primaries(struct btd_device *device)
{
return device->primaries;
}
void btd_device_gatt_set_service_changed(struct btd_device *device,
uint16_t start, uint16_t end)
{
GSList *l;
for (l = device->primaries; l; l = g_slist_next(l)) {
struct gatt_primary *prim = l->data;
if (start <= prim->range.end && end >= prim->range.start)
prim->changed = TRUE;
}
device_browse_primary(device, NULL, FALSE);
}
void btd_device_add_uuid(struct btd_device *device, const char *uuid)
{
GSList *uuid_list;
char *new_uuid;
if (g_slist_find_custom(device->uuids, uuid, bt_uuid_strcmp))
return;
new_uuid = g_strdup(uuid);
uuid_list = g_slist_append(NULL, new_uuid);
device_probe_profiles(device, uuid_list);
g_free(new_uuid);
g_slist_free(uuid_list);
store_profiles(device);
uuids_changed(device);
}
const sdp_record_t *btd_device_get_record(struct btd_device *device,
const char *uuid)
{
if (device->tmp_records) {
const sdp_record_t *record;
record = find_record_in_list(device->tmp_records, uuid);
if (record != NULL)
return record;
sdp_list_free(device->tmp_records,
(sdp_free_func_t) sdp_record_free);
device->tmp_records = NULL;
}
device->tmp_records = read_records(adapter_get_address(device->adapter),
&device->bdaddr);
if (!device->tmp_records)
return NULL;
return find_record_in_list(device->tmp_records, uuid);
}
struct btd_device *btd_device_ref(struct btd_device *device)
{
device->ref++;
DBG("%p: ref=%d", device, device->ref);
return device;
}
void btd_device_unref(struct btd_device *device)
{
gchar *path;
device->ref--;
DBG("%p: ref=%d", device, device->ref);
if (device->ref > 0)
return;
path = g_strdup(device->path);
g_dbus_unregister_interface(btd_get_dbus_connection(),
path, DEVICE_INTERFACE);
g_free(path);
}
int device_get_appearance(struct btd_device *device, uint16_t *value)
{
uint16_t app;
int err;
err = read_remote_appearance(adapter_get_address(device->adapter),
&device->bdaddr, device->bdaddr_type,
&app);
if (err < 0)
return err;
if (value)
*value = app;
return 0;
}
void device_set_appearance(struct btd_device *device, uint16_t value)
{
const char *icon = gap_appearance_to_icon(value);
g_dbus_emit_property_changed(btd_get_dbus_connection(), device->path,
DEVICE_INTERFACE, "Appearance");
if (icon)
g_dbus_emit_property_changed(btd_get_dbus_connection(),
device->path, DEVICE_INTERFACE, "Icon");
write_remote_appearance(adapter_get_address(device->adapter),
&device->bdaddr, device->bdaddr_type, value);
}
static gboolean notify_attios(gpointer user_data)
{
struct btd_device *device = user_data;
if (device->attrib == NULL)
return FALSE;
g_slist_foreach(device->attios_offline, attio_connected, device->attrib);
device->attios = g_slist_concat(device->attios, device->attios_offline);
device->attios_offline = NULL;
return FALSE;
}
guint btd_device_add_attio_callback(struct btd_device *device,
attio_connect_cb cfunc,
attio_disconnect_cb dcfunc,
gpointer user_data)
{
struct attio_data *attio;
static guint attio_id = 0;
DBG("%p registered ATT connection callback", device);
attio = g_new0(struct attio_data, 1);
attio->id = ++attio_id;
attio->cfunc = cfunc;
attio->dcfunc = dcfunc;
attio->user_data = user_data;
if (device->attrib && cfunc) {
device->attios_offline = g_slist_append(device->attios_offline,
attio);
g_idle_add(notify_attios, device);
return attio->id;
}
device->attios = g_slist_append(device->attios, attio);
adapter_connect_list_add(device->adapter, device);
return attio->id;
}
static int attio_id_cmp(gconstpointer a, gconstpointer b)
{
const struct attio_data *attio = a;
guint id = GPOINTER_TO_UINT(b);
return attio->id - id;
}
gboolean btd_device_remove_attio_callback(struct btd_device *device, guint id)
{
struct attio_data *attio;
GSList *l;
l = g_slist_find_custom(device->attios, GUINT_TO_POINTER(id),
attio_id_cmp);
if (l) {
attio = l->data;
device->attios = g_slist_remove(device->attios, attio);
} else {
l = g_slist_find_custom(device->attios_offline,
GUINT_TO_POINTER(id), attio_id_cmp);
if (!l)
return FALSE;
attio = l->data;
device->attios_offline = g_slist_remove(device->attios_offline,
attio);
}
g_free(attio);
if (device->attios != NULL || device->attios_offline != NULL)
return TRUE;
if (device->auto_id) {
g_source_remove(device->auto_id);
device->auto_id = 0;
}
attio_cleanup(device);
return TRUE;
}
void device_set_pnpid(struct btd_device *device, uint8_t vendor_id_src,
uint16_t vendor_id, uint16_t product_id,
uint16_t product_ver)
{
device_set_vendor(device, vendor_id);
device_set_vendor_src(device, vendor_id_src);
device_set_product(device, product_id);
device_set_version(device, product_ver);
}