/* * * 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 #endif #include #include #include #include #include "lib/uuid.h" #include "src/log.h" #include "src/adapter.h" #include "attrib/gattrib.h" #include "attrib/att.h" #include "attrib/gatt.h" #include "attrib/att-database.h" #include "attrib/gatt-service.h" #include "src/attrib-server.h" #include "src/device.h" #include "src/profile.h" #include "src/attio.h" #include "src/dbus-common.h" #include "reporter.h" #include "immalert.h" struct imm_alert_adapter { struct btd_adapter *adapter; GSList *connected_devices; }; struct connected_device { struct btd_device *device; struct imm_alert_adapter *adapter; uint8_t alert_level; guint callback_id; }; static GSList *imm_alert_adapters; static int imdevice_cmp(gconstpointer a, gconstpointer b) { const struct connected_device *condev = a; const struct btd_device *device = b; if (condev->device == device) return 0; return -1; } static struct connected_device * find_connected_device(struct imm_alert_adapter *ia, struct btd_device *device) { GSList *l = g_slist_find_custom(ia->connected_devices, device, imdevice_cmp); if (!l) return NULL; return l->data; } static int imadapter_cmp(gconstpointer a, gconstpointer b) { const struct imm_alert_adapter *imadapter = a; const struct btd_adapter *adapter = b; if (imadapter->adapter == adapter) return 0; return -1; } static struct imm_alert_adapter * find_imm_alert_adapter(struct btd_adapter *adapter) { GSList *l = g_slist_find_custom(imm_alert_adapters, adapter, imadapter_cmp); if (!l) return NULL; return l->data; } const char *imm_alert_get_level(struct btd_device *device) { struct imm_alert_adapter *imadapter; struct connected_device *condev; if (!device) return get_alert_level_string(NO_ALERT); imadapter = find_imm_alert_adapter(device_get_adapter(device)); if (!imadapter) return get_alert_level_string(NO_ALERT); condev = find_connected_device(imadapter, device); if (!condev) return get_alert_level_string(NO_ALERT); return get_alert_level_string(condev->alert_level); } static void imm_alert_emit_alert_signal(struct connected_device *condev, uint8_t alert_level) { const char *path, *alert_level_str; if (!condev) return; path = device_get_path(condev->device); alert_level_str = get_alert_level_string(alert_level); DBG("alert %s remote %s", alert_level_str, path); g_dbus_emit_property_changed(btd_get_dbus_connection(), path, PROXIMITY_REPORTER_INTERFACE, "ImmediateAlertLevel"); } static void imm_alert_remove_condev(struct connected_device *condev) { struct imm_alert_adapter *ia; if (!condev) return; ia = condev->adapter; if (condev->callback_id && condev->device) btd_device_remove_attio_callback(condev->device, condev->callback_id); if (condev->device) btd_device_unref(condev->device); ia->connected_devices = g_slist_remove(ia->connected_devices, condev); g_free(condev); } /* condev can be NULL */ static void imm_alert_disc_cb(gpointer user_data) { struct connected_device *condev = user_data; if (!condev) return; DBG("immediate alert remove device %p", condev->device); imm_alert_emit_alert_signal(condev, NO_ALERT); imm_alert_remove_condev(condev); } static uint8_t imm_alert_alert_lvl_write(struct attribute *a, struct btd_device *device, gpointer user_data) { uint8_t value; struct imm_alert_adapter *ia = user_data; struct connected_device *condev = NULL; if (!device) goto set_error; condev = find_connected_device(ia, 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 = ia; condev->callback_id = btd_device_add_attio_callback(device, NULL, imm_alert_disc_cb, condev); ia->connected_devices = g_slist_append(ia->connected_devices, condev); DBG("added connected dev %p", device); } if (value != NO_ALERT) { condev->alert_level = value; imm_alert_emit_alert_signal(condev, value); } /* * Emit NO_ALERT if the alert level was non-zero before. This is * guaranteed when there's a condev. */ if (value == NO_ALERT && condev) imm_alert_disc_cb(condev); DBG("alert level set to %d by device %p", value, device); return 0; set_error: error("Set immediate alert level for dev %p", device); /* remove alerts by erroneous devices */ imm_alert_disc_cb(condev); return ATT_ECODE_IO; } void imm_alert_register(struct btd_adapter *adapter) { gboolean svc_added; bt_uuid_t uuid; struct imm_alert_adapter *imadapter; bt_uuid16_create(&uuid, IMMEDIATE_ALERT_SVC_UUID); imadapter = g_new0(struct imm_alert_adapter, 1); imadapter->adapter = adapter; imm_alert_adapters = g_slist_append(imm_alert_adapters, imadapter); /* Immediate Alert 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_WRITE_WITHOUT_RESP, GATT_OPT_CHR_VALUE_CB, ATTRIB_WRITE, imm_alert_alert_lvl_write, imadapter, GATT_OPT_INVALID); if (!svc_added) { imm_alert_unregister(adapter); return; } DBG("Immediate Alert service added"); } static void remove_condev_list_item(gpointer data, gpointer user_data) { struct connected_device *condev = data; imm_alert_remove_condev(condev); } void imm_alert_unregister(struct btd_adapter *adapter) { struct imm_alert_adapter *imadapter; imadapter = find_imm_alert_adapter(adapter); if (!imadapter) return; g_slist_foreach(imadapter->connected_devices, remove_condev_list_item, NULL); imm_alert_adapters = g_slist_remove(imm_alert_adapters, imadapter); g_free(imadapter); }