blob: 476803ac45edd498cd5ffe5dc9b6169c881e8e04 [file] [log] [blame] [edit]
/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2012 Texas Instruments Corporation
*
* 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 <stdbool.h>
#include <glib.h>
#include <dbus/dbus.h>
#include <gdbus/gdbus.h>
#include "lib/uuid.h"
#include "src/log.h"
#include "src/adapter.h"
#include "src/device.h"
#include "attrib/att-database.h"
#include "attrib/gattrib.h"
#include "attrib/att.h"
#include "attrib/gatt.h"
#include "attrib/gatt-service.h"
#include "src/attrib-server.h"
#include "src/service.h"
#include "src/profile.h"
#include "src/attio.h"
#include "src/dbus-common.h"
#include "reporter.h"
#include "linkloss.h"
struct link_loss_adapter {
struct btd_adapter *adapter;
uint16_t alert_lvl_value_handle;
GSList *connected_devices;
};
struct connected_device {
struct btd_device *device;
struct link_loss_adapter *adapter;
uint8_t alert_level;
guint callback_id;
guint local_disc_id;
};
static GSList *link_loss_adapters;
static int lldevice_cmp(gconstpointer a, gconstpointer b)
{
const struct connected_device *llcondev = a;
const struct btd_device *device = b;
if (llcondev->device == device)
return 0;
return -1;
}
static struct connected_device *
find_connected_device(struct link_loss_adapter *la, struct btd_device *device)
{
GSList *l = g_slist_find_custom(la->connected_devices, device,
lldevice_cmp);
if (!l)
return NULL;
return l->data;
}
static int lladapter_cmp(gconstpointer a, gconstpointer b)
{
const struct link_loss_adapter *lladapter = a;
const struct btd_adapter *adapter = b;
if (lladapter->adapter == adapter)
return 0;
return -1;
}
static struct link_loss_adapter *
find_link_loss_adapter(struct btd_adapter *adapter)
{
GSList *l = g_slist_find_custom(link_loss_adapters, adapter,
lladapter_cmp);
if (!l)
return NULL;
return l->data;
}
const char *link_loss_get_alert_level(struct btd_device *device)
{
struct link_loss_adapter *lladapter;
struct connected_device *condev;
if (!device)
return get_alert_level_string(NO_ALERT);
lladapter = find_link_loss_adapter(device_get_adapter(device));
if (!lladapter)
return get_alert_level_string(NO_ALERT);
condev = find_connected_device(lladapter, device);
if (!condev)
return get_alert_level_string(NO_ALERT);
return get_alert_level_string(condev->alert_level);
}
static void link_loss_emit_alert_signal(struct connected_device *condev)
{
const char *alert_level_str, *path;
if (!condev->device)
return;
path = device_get_path(condev->device);
alert_level_str = get_alert_level_string(condev->alert_level);
DBG("alert %s remote %s", alert_level_str, path);
g_dbus_emit_property_changed(btd_get_dbus_connection(), path,
PROXIMITY_REPORTER_INTERFACE, "LinkLossAlertLevel");
}
static uint8_t link_loss_alert_lvl_read(struct attribute *a,
struct btd_device *device, gpointer user_data)
{
struct link_loss_adapter *la = user_data;
struct connected_device *condev;
uint8_t alert_level = NO_ALERT;
if (!device)
goto out;
condev = find_connected_device(la, device);
if (!condev)
goto out;
alert_level = condev->alert_level;
out:
DBG("return alert level %d for dev %p", alert_level, device);
/* update the alert level according to the requesting device */
attrib_db_update(la->adapter, a->handle, NULL, &alert_level,
sizeof(alert_level), NULL);
return 0;
}
/* condev can be NULL */
static void link_loss_remove_condev(struct connected_device *condev)
{
struct link_loss_adapter *la;
if (!condev)
return;
la = condev->adapter;
if (condev->callback_id && condev->device)
btd_device_remove_attio_callback(condev->device,
condev->callback_id);
if (condev->local_disc_id && condev->device)
device_remove_disconnect_watch(condev->device,
condev->local_disc_id);
if (condev->device)
btd_device_unref(condev->device);
la->connected_devices = g_slist_remove(la->connected_devices, condev);
g_free(condev);
}
static void link_loss_disc_cb(gpointer user_data)
{
struct connected_device *condev = user_data;
DBG("alert loss disconnect device %p", condev->device);
/* if an alert-level is set, emit a signal */
if (condev->alert_level != NO_ALERT)
link_loss_emit_alert_signal(condev);
/* we are open for more changes now */
link_loss_remove_condev(condev);
}
static void link_loss_local_disc(struct btd_device *device,
gboolean removal, void *user_data)
{
struct connected_device *condev = user_data;
/* no need to alert on this device - we requested disconnection */
link_loss_remove_condev(condev);
DBG("alert level zeroed for locally disconnecting dev %p", device);
}
static uint8_t link_loss_alert_lvl_write(struct attribute *a,
struct btd_device *device, gpointer user_data)
{
uint8_t value;
struct link_loss_adapter *la = user_data;
struct connected_device *condev = NULL;
if (!device)
goto set_error;
/* condev might remain NULL here if nothing is found */
condev = find_connected_device(la, device);
if (a->len == 0) {
DBG("Illegal alert level length");
goto set_error;
}
value = a->data[0];
if (value != NO_ALERT && value != MILD_ALERT && value != HIGH_ALERT) {
DBG("Illegal alert value");
goto set_error;
}
/* Register a disconnect cb if the alert level is non-zero */
if (value != NO_ALERT && !condev) {
condev = g_new0(struct connected_device, 1);
condev->device = btd_device_ref(device);
condev->adapter = la;
condev->callback_id = btd_device_add_attio_callback(device,
NULL, link_loss_disc_cb, condev);
condev->local_disc_id = device_add_disconnect_watch(device,
link_loss_local_disc, condev, NULL);
la->connected_devices = g_slist_append(la->connected_devices,
condev);
} else if (value == NO_ALERT && condev) {
link_loss_remove_condev(condev);
condev = NULL;
}
DBG("alert level set to %d by device %p", value, device);
if (condev)
condev->alert_level = value;
return 0;
set_error:
error("Set link loss alert level for dev %p", device);
/* reset alert level on erroneous devices */
link_loss_remove_condev(condev);
return ATT_ECODE_IO;
}
void link_loss_register(struct btd_adapter *adapter)
{
gboolean svc_added;
bt_uuid_t uuid;
struct link_loss_adapter *lladapter;
bt_uuid16_create(&uuid, LINK_LOSS_SVC_UUID);
lladapter = g_new0(struct link_loss_adapter, 1);
lladapter->adapter = adapter;
link_loss_adapters = g_slist_append(link_loss_adapters, lladapter);
/* Link Loss Service */
svc_added = gatt_service_add(adapter,
GATT_PRIM_SVC_UUID, &uuid,
/* Alert level characteristic */
GATT_OPT_CHR_UUID16, ALERT_LEVEL_CHR_UUID,
GATT_OPT_CHR_PROPS,
GATT_CHR_PROP_READ | GATT_CHR_PROP_WRITE,
GATT_OPT_CHR_VALUE_CB, ATTRIB_READ,
link_loss_alert_lvl_read, lladapter,
GATT_OPT_CHR_VALUE_CB, ATTRIB_WRITE,
link_loss_alert_lvl_write, lladapter,
GATT_OPT_CHR_VALUE_GET_HANDLE,
&lladapter->alert_lvl_value_handle,
GATT_OPT_INVALID);
if (!svc_added)
goto err;
DBG("Link Loss service added");
return;
err:
error("Error adding Link Loss service");
link_loss_unregister(adapter);
}
static void remove_condev_list_item(gpointer data, gpointer user_data)
{
struct connected_device *condev = data;
link_loss_remove_condev(condev);
}
void link_loss_unregister(struct btd_adapter *adapter)
{
struct link_loss_adapter *lladapter;
lladapter = find_link_loss_adapter(adapter);
if (!lladapter)
return;
g_slist_foreach(lladapter->connected_devices, remove_condev_list_item,
NULL);
link_loss_adapters = g_slist_remove(link_loss_adapters, lladapter);
g_free(lladapter);
}