GitHub-Mirror/Star64_linux
2
0
Fork 0
mirror of https://github.com/Fishwaldo/Star64_linux.git synced 2025-06-05 22:28:00 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

Bluetooth: Support the "discoverable" adv flag

Browse source 
This patch adds support for the "discoverable" flag of the
Add Advertising command.

Signed-off-by: Arman Uguray <armansito@chromium.org>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
Arman Uguray 2015-03-25 18:53:41 -07:00 • committed by Marcel Holtmann
parent e7a685d316
commit b44133ff03
1 changed files with 30 additions and 8 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

38
net/bluetooth/mgmt.c
View file

@ -975,13 +975,28 @@ static u8 create_default_adv_data(struct hci_dev *hdev, u8 *ptr)
static u8 create_instance_adv_data(struct hci_dev *hdev, u8 *ptr) static u8 create_instance_adv_data(struct hci_dev *hdev, u8 *ptr)
{ {
/* TODO: Set the appropriate entries based on advertising instance flags u8 ad_len = 0, flags = 0;
* here once flags other than 0 are supported.
*/ if (hdev->adv_instance.flags & MGMT_ADV_FLAG_DISCOV)
flags |= LE_AD_GENERAL;
if (flags) {
if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED))
flags |= LE_AD_NO_BREDR;
ptr[0] = 0x02;
ptr[1] = EIR_FLAGS;
ptr[2] = flags;
ad_len += 3;
ptr += 3;
}
memcpy(ptr, hdev->adv_instance.adv_data, memcpy(ptr, hdev->adv_instance.adv_data,
hdev->adv_instance.adv_data_len); hdev->adv_instance.adv_data_len);
ad_len += hdev->adv_instance.adv_data_len;
return hdev->adv_instance.adv_data_len; return ad_len;
} }
static void update_adv_data_for_instance(struct hci_request *req, u8 instance) static void update_adv_data_for_instance(struct hci_request *req, u8 instance)
@ -6556,12 +6571,16 @@ static int read_adv_features(struct sock *sk, struct hci_dev *hdev,
} }
static bool tlv_data_is_valid(struct hci_dev *hdev, u32 adv_flags, u8 *data, static bool tlv_data_is_valid(struct hci_dev *hdev, u32 adv_flags, u8 *data,
u8 len) u8 len, bool is_adv_data)
{ {
u8 max_len = HCI_MAX_AD_LENGTH; u8 max_len = HCI_MAX_AD_LENGTH;
int i, cur_len; int i, cur_len;
bool flags_managed = false;
/* TODO: Correctly reduce len based on adv_flags. */ if (is_adv_data && (adv_flags & MGMT_ADV_FLAG_DISCOV)) {
flags_managed = true;
max_len -= 3;
}
if (len > max_len) if (len > max_len)
return false; return false;
@ -6570,6 +6589,9 @@ static bool tlv_data_is_valid(struct hci_dev *hdev, u32 adv_flags, u8 *data,
for (i = 0, cur_len = 0; i < len; i += (cur_len + 1)) { for (i = 0, cur_len = 0; i < len; i += (cur_len + 1)) {
cur_len = data[i]; cur_len = data[i];
if (flags_managed && data[i + 1] == EIR_FLAGS)
return false;
/* If the current field length would exceed the total data /* If the current field length would exceed the total data
* length, then it's invalid. * length, then it's invalid.
*/ */
@ -6671,9 +6693,9 @@ static int add_advertising(struct sock *sk, struct hci_dev *hdev,
goto unlock; goto unlock;
} }
if (!tlv_data_is_valid(hdev, flags, cp->data, cp->adv_data_len) || if (!tlv_data_is_valid(hdev, flags, cp->data, cp->adv_data_len, true) ||
!tlv_data_is_valid(hdev, flags, cp->data + cp->adv_data_len, !tlv_data_is_valid(hdev, flags, cp->data + cp->adv_data_len,
cp->scan_rsp_len)) { cp->scan_rsp_len, false)) {
err = mgmt_cmd_status(sk, hdev->id, MGMT_OP_ADD_ADVERTISING, err = mgmt_cmd_status(sk, hdev->id, MGMT_OP_ADD_ADVERTISING,
MGMT_STATUS_INVALID_PARAMS); MGMT_STATUS_INVALID_PARAMS);
goto unlock; goto unlock;