This function is used to prepare the final eir data from the various list. It returns the updated pointer to the buffer. Signed-off-by: Syam Sidhardhan <s.syam@xxxxxxxxxxx> Tested-by: Chan-yeol Park <chanyeol.park@xxxxxxxxxxx> --- net/bluetooth/mgmt.c | 79 ++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 79 insertions(+) diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c index 0f32986..d2569f8 100644 --- a/net/bluetooth/mgmt.c +++ b/net/bluetooth/mgmt.c @@ -41,6 +41,11 @@ bool enable_hs; #define EIR_TYPE_UUID32 2 #define EIR_TYPE_UUID128 3 +/* UUID128 type */ +typedef struct { + u8 data[16]; +} u128; + static const u16 mgmt_commands[] = { MGMT_OP_READ_INDEX_LIST, MGMT_OP_READ_INFO, @@ -478,6 +483,80 @@ static u16 get_uuid16(u8 *uuid128) return (u16) val; } +static u8 *prepare_eir_from_list(u8 *list, u8 *ptr, u16 type, bool truncated) +{ + int i; + if (type == EIR_TYPE_UUID16) { + u8 *length = ptr; + u16 *uuid16_list = (u16 *) list; + + /* EIR Data type */ + ptr[1] = truncated ? EIR_UUID16_SOME : EIR_UUID16_ALL; + + ptr += 2; + for (i = 0; uuid16_list[i] != 0; i++) { + *ptr++ = (uuid16_list[i] & 0x00ff); + *ptr++ = (uuid16_list[i] & 0xff00) >> 8; + } + + /* EIR Data length */ + *length = (i * sizeof(u16)) + 1; + return ptr; + } + + if (type == EIR_TYPE_UUID32) { + u8 *length = ptr; + u32 *uuid32_list = (u32 *) list; + + /* EIR Data type */ + ptr[1] = truncated ? EIR_UUID32_SOME : EIR_UUID32_ALL; + + ptr += 2; + + for (i = 0; uuid32_list[i] != 0; i++) { + *ptr++ = (uuid32_list[i] & 0x000000ff); + *ptr++ = (uuid32_list[i] & 0x0000ff00) >> 8; + *ptr++ = (uuid32_list[i] & 0x00ff0000) >> 16; + *ptr++ = (uuid32_list[i] & 0xff000000) >> 24; + } + + /* EIR Data length */ + *length = (i * sizeof(u32)) + 1; + + return ptr; + } + + if (type == EIR_TYPE_UUID128) { + + u8 *length = ptr; + u128 *uuid128_list = (u128 *) list; + u128 u; + + memset(u.data, 0, sizeof(u128)); + /* EIR Data type */ + ptr[1] = truncated ? EIR_UUID128_SOME : EIR_UUID128_ALL; + + ptr += 2; + + i = 0; + while (memcmp(uuid128_list[i].data, u.data, sizeof(u128))) { + + memcpy(ptr, uuid128_list[i].data, sizeof(u128)); + + ptr += sizeof(u128); + i++; + } + + /* EIR Data length */ + *length = (i * sizeof(u128)) + 1; + + return ptr; + + } + + return ptr; +} + static void create_eir(struct hci_dev *hdev, u8 *data) { u8 *ptr = data; -- 1.7.9.5 -- To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html