xiaomi-sm8450/android_kernel_xiaomi_sm8450
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Bluetooth: Change eir_has_data_type() to more generic eir_get_data()

Browse Source 
To make the EIR parsing helper more general purpose, make it return
the found data and its length rather than just saying whether the data
was present or not.

Signed-off-by: Johan Hedberg <johan.hedberg@intel.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
Johan Hedberg
2016-01-05 13:19:31 +02:00
committed by Marcel Holtmann
parent 29663b0cc1
commit 0d3b7f64c8
3 changed files with 25 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files

30
include/net/bluetooth/hci_core.h
View File

@@ -1283,31 +1283,41 @@ static inline void hci_role_switch_cfm(struct hci_conn *conn, __u8 status,
mutex_unlock(&hci_cb_list_lock);
}
static inline bool eir_has_data_type(u8 *data, size_t data_len, u8 type)
static inline void *eir_get_data(u8 *eir, size_t eir_len, u8 type,
size_t *data_len)
{
size_t parsed = 0;
if (data_len < 2)
return false;
if (eir_len < 2)
return NULL;
while (parsed < data_len - 1) {
u8 field_len = data[0];
while (parsed < eir_len - 1) {
u8 field_len = eir[0];
if (field_len == 0)
break;
parsed += field_len + 1;
if (parsed > data_len)
if (parsed > eir_len)
break;
if (data[1] == type)
return true;
if (eir[1] != type) {
eir += field_len + 1;
continue;
}
data += field_len + 1;
/* Zero length data */
if (field_len == 1)
return NULL;
if (data_len)
*data_len = field_len - 1;
return &eir[2];
}
return false;
return NULL;
}
static inline bool hci_bdaddr_is_rpa(bdaddr_t *bdaddr, u8 addr_type)