// SPDX-License-Identifier: GPL-2.0-or-later /* * * BlueZ - Bluetooth protocol stack for Linux * * Copyright (C) 2012 Nordic Semiconductor Inc. * Copyright (C) 2012 Instituto Nokia de Tecnologia - INdT * * */ #ifdef HAVE_CONFIG_H #include #endif #include #include #include "lib/bluetooth.h" #include "lib/sdp.h" #include "lib/uuid.h" #include "src/log.h" #include "src/plugin.h" #include "src/adapter.h" #include "src/device.h" #include "src/profile.h" #include "src/service.h" #include "src/shared/util.h" #include "src/shared/att.h" #include "src/shared/queue.h" #include "src/shared/gatt-db.h" #include "src/shared/gatt-client.h" #include "attrib/att.h" #include "src/btd.h" #define SCAN_INTERVAL_WIN_UUID 0x2A4F #define SCAN_REFRESH_UUID 0x2A31 #define SERVER_REQUIRES_REFRESH 0x00 struct scan { struct btd_device *device; struct gatt_db *db; struct bt_gatt_client *client; struct gatt_db_attribute *attr; uint16_t iwhandle; guint refresh_cb_id; }; static void scan_free(struct scan *scan) { bt_gatt_client_unregister_notify(scan->client, scan->refresh_cb_id); gatt_db_unref(scan->db); bt_gatt_client_unref(scan->client); btd_device_unref(scan->device); g_free(scan); } static void write_scan_params(struct scan *scan) { uint8_t value[4]; /* Unless scan parameters are configured, use the known kernel default * parameters */ put_le16(btd_opts.defaults.le.scan_interval_autoconnect ? btd_opts.defaults.le.scan_interval_autoconnect : 0x60, &value[0]); put_le16(btd_opts.defaults.le.scan_win_autoconnect ? btd_opts.defaults.le.scan_win_autoconnect : 0x30, &value[2]); bt_gatt_client_write_without_response(scan->client, scan->iwhandle, false, value, sizeof(value)); } static void refresh_value_cb(uint16_t value_handle, const uint8_t *value, uint16_t length, void *user_data) { struct scan *scan = user_data; DBG("Server requires refresh: %d", value[3]); if (value[3] == SERVER_REQUIRES_REFRESH) write_scan_params(scan); } static void refresh_ccc_written_cb(uint16_t att_ecode, void *user_data) { if (att_ecode != 0) { error("Scan Refresh: notifications not enabled %s", att_ecode2str(att_ecode)); return; } DBG("Scan Refresh: notification enabled"); } static void handle_refresh(struct scan *scan, uint16_t value_handle) { DBG("Scan Refresh handle: 0x%04x", value_handle); scan->refresh_cb_id = bt_gatt_client_register_notify(scan->client, value_handle, refresh_ccc_written_cb, refresh_value_cb, scan, NULL); } static void handle_iwin(struct scan *scan, uint16_t value_handle) { scan->iwhandle = value_handle; DBG("Scan Interval Window handle: 0x%04x", scan->iwhandle); write_scan_params(scan); } static void handle_characteristic(struct gatt_db_attribute *attr, void *user_data) { struct scan *scan = user_data; uint16_t value_handle; bt_uuid_t uuid, scan_interval_wind_uuid, scan_refresh_uuid; if (!gatt_db_attribute_get_char_data(attr, NULL, &value_handle, NULL, NULL, &uuid)) { error("Failed to obtain characteristic data"); return; } bt_uuid16_create(&scan_interval_wind_uuid, SCAN_INTERVAL_WIN_UUID); bt_uuid16_create(&scan_refresh_uuid, SCAN_REFRESH_UUID); if (bt_uuid_cmp(&scan_interval_wind_uuid, &uuid) == 0) handle_iwin(scan, value_handle); else if (bt_uuid_cmp(&scan_refresh_uuid, &uuid) == 0) handle_refresh(scan, value_handle); else { char uuid_str[MAX_LEN_UUID_STR]; bt_uuid_to_string(&uuid, uuid_str, sizeof(uuid_str)); DBG("Unsupported characteristic: %s", uuid_str); } } static void foreach_scan_param_service(struct gatt_db_attribute *attr, void *user_data) { struct scan *scan = user_data; if (scan->attr) { error("More than one scan params service exists for this " "device"); return; } scan->attr = attr; gatt_db_service_foreach_char(scan->attr, handle_characteristic, scan); } static void scan_reset(struct scan *scan) { scan->attr = NULL; gatt_db_unref(scan->db); scan->db = NULL; bt_gatt_client_unref(scan->client); scan->client = NULL; } static int scan_param_accept(struct btd_service *service) { struct btd_device *device = btd_service_get_device(service); struct gatt_db *db = btd_device_get_gatt_db(device); struct bt_gatt_client *client = btd_device_get_gatt_client(device); bt_uuid_t scan_parameters_uuid; struct scan *scan = btd_service_get_user_data(service); char addr[18]; ba2str(device_get_address(device), addr); DBG("Scan Parameters Client Driver profile accept (%s)", addr); if (!scan) { error("Scan Parameters service not handled by profile"); return -1; } scan->db = gatt_db_ref(db); scan->client = bt_gatt_client_clone(client); bt_string_to_uuid(&scan_parameters_uuid, SCAN_PARAMETERS_UUID); gatt_db_foreach_service(db, &scan_parameters_uuid, foreach_scan_param_service, scan); if (!scan->attr) { error("Scan Parameters attribute not found"); scan_reset(scan); return -1; } btd_service_connecting_complete(service, 0); return 0; } static int scan_param_disconnect(struct btd_service *service) { struct scan *scan = btd_service_get_user_data(service); scan_reset(scan); btd_service_disconnecting_complete(service, 0); return 0; } static void scan_param_remove(struct btd_service *service) { struct btd_device *device = btd_service_get_device(service); struct scan *scan; char addr[18]; ba2str(device_get_address(device), addr); DBG("GAP profile remove (%s)", addr); scan = btd_service_get_user_data(service); if (!scan) { error("GAP service not handled by profile"); return; } scan_free(scan); } static int scan_param_probe(struct btd_service *service) { struct btd_device *device = btd_service_get_device(service); struct scan *scan; char addr[18]; ba2str(device_get_address(device), addr); DBG("Scan Parameters Client Driver profile probe (%s)", addr); /* Ignore, if we were probed for this device already */ scan = btd_service_get_user_data(service); if (scan) { error("Profile probed twice for the same service!"); return -1; } scan = g_new0(struct scan, 1); if (!scan) return -1; scan->device = btd_device_ref(device); btd_service_set_user_data(service, scan); return 0; } static struct btd_profile scan_profile = { .name = "Scan Parameters Client Driver", .remote_uuid = SCAN_PARAMETERS_UUID, .device_probe = scan_param_probe, .device_remove = scan_param_remove, .accept = scan_param_accept, .disconnect = scan_param_disconnect, }; static int scan_param_init(void) { return btd_profile_register(&scan_profile); } static void scan_param_exit(void) { btd_profile_unregister(&scan_profile); } BLUETOOTH_PLUGIN_DEFINE(scanparam, VERSION, BLUETOOTH_PLUGIN_PRIORITY_DEFAULT, scan_param_init, scan_param_exit)