mirror of
https://github.com/Fishwaldo/linux-bl808.git
synced 2025-06-17 20:25:19 +00:00
Bluetooth: Add support for 128-bit UUIDs in EIR data
This patch adds the necessary code for encoding a list of 128-bit UUIDs into the EIR data. Signed-off-by: Johan Hedberg <johan.hedberg@intel.com> Acked-by: Marcel Holtmann <marcel@holtmann.org> Signed-off-by: Gustavo Padovan <gustavo.padovan@collabora.co.uk>
This commit is contained in:
parent
cdf1963f7b
commit
c00d575bd5
1 changed files with 34 additions and 0 deletions
|
@ -510,6 +510,39 @@ static u8 *create_uuid32_list(struct hci_dev *hdev, u8 *data, ptrdiff_t len)
|
||||||
return ptr;
|
return ptr;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static u8 *create_uuid128_list(struct hci_dev *hdev, u8 *data, ptrdiff_t len)
|
||||||
|
{
|
||||||
|
u8 *ptr = data, *uuids_start = NULL;
|
||||||
|
struct bt_uuid *uuid;
|
||||||
|
|
||||||
|
if (len < 18)
|
||||||
|
return ptr;
|
||||||
|
|
||||||
|
list_for_each_entry(uuid, &hdev->uuids, list) {
|
||||||
|
if (uuid->size != 128)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
if (!uuids_start) {
|
||||||
|
uuids_start = ptr;
|
||||||
|
uuids_start[0] = 1;
|
||||||
|
uuids_start[1] = EIR_UUID128_ALL;
|
||||||
|
ptr += 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Stop if not enough space to put next UUID */
|
||||||
|
if ((ptr - data) + 16 > len) {
|
||||||
|
uuids_start[1] = EIR_UUID128_SOME;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
memcpy(ptr, uuid->uuid, 16);
|
||||||
|
ptr += 16;
|
||||||
|
uuids_start[0] += 16;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ptr;
|
||||||
|
}
|
||||||
|
|
||||||
static void create_eir(struct hci_dev *hdev, u8 *data)
|
static void create_eir(struct hci_dev *hdev, u8 *data)
|
||||||
{
|
{
|
||||||
u8 *ptr = data;
|
u8 *ptr = data;
|
||||||
|
@ -555,6 +588,7 @@ static void create_eir(struct hci_dev *hdev, u8 *data)
|
||||||
|
|
||||||
ptr = create_uuid16_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
|
ptr = create_uuid16_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
|
||||||
ptr = create_uuid32_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
|
ptr = create_uuid32_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
|
||||||
|
ptr = create_uuid128_list(hdev, ptr, HCI_MAX_EIR_LENGTH - (ptr - data));
|
||||||
}
|
}
|
||||||
|
|
||||||
static int update_eir(struct hci_dev *hdev)
|
static int update_eir(struct hci_dev *hdev)
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue