1 // SPDX-License-Identifier: GPL-2.0
3 * BlueZ - Bluetooth protocol stack for Linux
5 * Copyright (C) 2021 Intel Corporation
8 #include <net/bluetooth/bluetooth.h>
9 #include <net/bluetooth/hci_core.h>
10 #include <net/bluetooth/mgmt.h>
14 #define PNP_INFO_SVCLASS_ID 0x1200
16 u8 eir_append_local_name(struct hci_dev *hdev, u8 *ptr, u8 ad_len)
21 /* no space left for name (+ NULL + type + len) */
22 if ((HCI_MAX_AD_LENGTH - ad_len) < HCI_MAX_SHORT_NAME_LENGTH + 3)
25 /* use complete name if present and fits */
26 complete_len = strlen(hdev->dev_name);
27 if (complete_len && complete_len <= HCI_MAX_SHORT_NAME_LENGTH)
28 return eir_append_data(ptr, ad_len, EIR_NAME_COMPLETE,
29 hdev->dev_name, complete_len + 1);
31 /* use short name if present */
32 short_len = strlen(hdev->short_name);
34 return eir_append_data(ptr, ad_len, EIR_NAME_SHORT,
35 hdev->short_name, short_len + 1);
37 /* use shortened full name if present, we already know that name
38 * is longer then HCI_MAX_SHORT_NAME_LENGTH
41 u8 name[HCI_MAX_SHORT_NAME_LENGTH + 1];
43 memcpy(name, hdev->dev_name, HCI_MAX_SHORT_NAME_LENGTH);
44 name[HCI_MAX_SHORT_NAME_LENGTH] = '\0';
46 return eir_append_data(ptr, ad_len, EIR_NAME_SHORT, name,
53 u8 eir_append_appearance(struct hci_dev *hdev, u8 *ptr, u8 ad_len)
55 return eir_append_le16(ptr, ad_len, EIR_APPEARANCE, hdev->appearance);
58 u8 eir_append_service_data(u8 *eir, u16 eir_len, u16 uuid, u8 *data,
61 eir[eir_len++] = sizeof(u8) + sizeof(uuid) + data_len;
62 eir[eir_len++] = EIR_SERVICE_DATA;
63 put_unaligned_le16(uuid, &eir[eir_len]);
64 eir_len += sizeof(uuid);
65 memcpy(&eir[eir_len], data, data_len);
71 static u8 *create_uuid16_list(struct hci_dev *hdev, u8 *data, ptrdiff_t len)
73 u8 *ptr = data, *uuids_start = NULL;
79 list_for_each_entry(uuid, &hdev->uuids, list) {
85 uuid16 = get_unaligned_le16(&uuid->uuid[12]);
89 if (uuid16 == PNP_INFO_SVCLASS_ID)
95 uuids_start[1] = EIR_UUID16_ALL;
99 /* Stop if not enough space to put next UUID */
100 if ((ptr - data) + sizeof(u16) > len) {
101 uuids_start[1] = EIR_UUID16_SOME;
105 *ptr++ = (uuid16 & 0x00ff);
106 *ptr++ = (uuid16 & 0xff00) >> 8;
107 uuids_start[0] += sizeof(uuid16);
113 static u8 *create_uuid32_list(struct hci_dev *hdev, u8 *data, ptrdiff_t len)
115 u8 *ptr = data, *uuids_start = NULL;
116 struct bt_uuid *uuid;
121 list_for_each_entry(uuid, &hdev->uuids, list) {
122 if (uuid->size != 32)
128 uuids_start[1] = EIR_UUID32_ALL;
132 /* Stop if not enough space to put next UUID */
133 if ((ptr - data) + sizeof(u32) > len) {
134 uuids_start[1] = EIR_UUID32_SOME;
138 memcpy(ptr, &uuid->uuid[12], sizeof(u32));
140 uuids_start[0] += sizeof(u32);
146 static u8 *create_uuid128_list(struct hci_dev *hdev, u8 *data, ptrdiff_t len)
148 u8 *ptr = data, *uuids_start = NULL;
149 struct bt_uuid *uuid;
154 list_for_each_entry(uuid, &hdev->uuids, list) {
155 if (uuid->size != 128)
161 uuids_start[1] = EIR_UUID128_ALL;
165 /* Stop if not enough space to put next UUID */
166 if ((ptr - data) + 16 > len) {
167 uuids_start[1] = EIR_UUID128_SOME;
171 memcpy(ptr, uuid->uuid, 16);
173 uuids_start[0] += 16;
179 void eir_create(struct hci_dev *hdev, u8 *data)
184 name_len = strlen(hdev->dev_name);
190 ptr[1] = EIR_NAME_SHORT;
192 ptr[1] = EIR_NAME_COMPLETE;
195 /* EIR Data length */
196 ptr[0] = name_len + 1;
198 memcpy(ptr + 2, hdev->dev_name, name_len);
200 ptr += (name_len + 2);
203 if (hdev->inq_tx_power != HCI_TX_POWER_INVALID) {
205 ptr[1] = EIR_TX_POWER;
206 ptr[2] = (u8)hdev->inq_tx_power;
211 if (hdev->devid_source > 0) {
213 ptr[1] = EIR_DEVICE_ID;
215 put_unaligned_le16(hdev->devid_source, ptr + 2);
216 put_unaligned_le16(hdev->devid_vendor, ptr + 4);
217 put_unaligned_le16(hdev->devid_product, ptr + 6);
218 put_unaligned_le16(hdev->devid_version, ptr + 8);
223 ptr = create_uuid16_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
224 ptr = create_uuid32_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
225 ptr = create_uuid128_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
228 u8 eir_create_adv_data(struct hci_dev *hdev, u8 instance, u8 *ptr)
230 struct adv_info *adv = NULL;
231 u8 ad_len = 0, flags = 0;
234 /* Return 0 when the current instance identifier is invalid. */
236 adv = hci_find_adv_instance(hdev, instance);
241 instance_flags = hci_adv_instance_flags(hdev, instance);
243 /* If instance already has the flags set skip adding it once
246 if (adv && eir_get_data(adv->adv_data, adv->adv_data_len, EIR_FLAGS,
250 /* The Add Advertising command allows userspace to set both the general
251 * and limited discoverable flags.
253 if (instance_flags & MGMT_ADV_FLAG_DISCOV)
254 flags |= LE_AD_GENERAL;
256 if (instance_flags & MGMT_ADV_FLAG_LIMITED_DISCOV)
257 flags |= LE_AD_LIMITED;
259 if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED))
260 flags |= LE_AD_NO_BREDR;
262 if (flags || (instance_flags & MGMT_ADV_FLAG_MANAGED_FLAGS)) {
263 /* If a discovery flag wasn't provided, simply use the global
267 flags |= mgmt_get_adv_discov_flags(hdev);
269 /* If flags would still be empty, then there is no need to
270 * include the "Flags" AD field".
284 memcpy(ptr, adv->adv_data, adv->adv_data_len);
285 ad_len += adv->adv_data_len;
286 ptr += adv->adv_data_len;
289 if (instance_flags & MGMT_ADV_FLAG_TX_POWER) {
292 if (ext_adv_capable(hdev)) {
294 adv_tx_power = adv->tx_power;
296 adv_tx_power = hdev->adv_tx_power;
298 adv_tx_power = hdev->adv_tx_power;
301 /* Provide Tx Power only if we can provide a valid value for it */
302 if (adv_tx_power != HCI_TX_POWER_INVALID) {
304 ptr[1] = EIR_TX_POWER;
305 ptr[2] = (u8)adv_tx_power;
315 static u8 create_default_scan_rsp(struct hci_dev *hdev, u8 *ptr)
319 if (hdev->appearance)
320 scan_rsp_len = eir_append_appearance(hdev, ptr, scan_rsp_len);
322 return eir_append_local_name(hdev, ptr, scan_rsp_len);
325 u8 eir_create_scan_rsp(struct hci_dev *hdev, u8 instance, u8 *ptr)
327 struct adv_info *adv;
331 return create_default_scan_rsp(hdev, ptr);
333 adv = hci_find_adv_instance(hdev, instance);
337 if ((adv->flags & MGMT_ADV_FLAG_APPEARANCE) && hdev->appearance)
338 scan_rsp_len = eir_append_appearance(hdev, ptr, scan_rsp_len);
340 memcpy(&ptr[scan_rsp_len], adv->scan_rsp_data, adv->scan_rsp_len);
342 scan_rsp_len += adv->scan_rsp_len;
344 if (adv->flags & MGMT_ADV_FLAG_LOCAL_NAME)
345 scan_rsp_len = eir_append_local_name(hdev, ptr, scan_rsp_len);
350 void *eir_get_service_data(u8 *eir, size_t eir_len, u16 uuid, size_t *len)
352 while ((eir = eir_get_data(eir, eir_len, EIR_SERVICE_DATA, len))) {
353 u16 value = get_unaligned_le16(eir);