Bluetooth: ISO: Copy BASE if service data matches EIR_BAA_SERVICE_UUID
Copy the content of a Periodic Advertisement Report to BASE only if the service UUID is Basic Audio Announcement Service UUID. Signed-off-by: Claudia Draghicescu <claudia.rosu@nxp.com> Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
This commit is contained in:
parent
181a42eddd
commit
f4da3ee15d
|
@ -14,6 +14,7 @@
|
|||
#include <net/bluetooth/bluetooth.h>
|
||||
#include <net/bluetooth/hci_core.h>
|
||||
#include <net/bluetooth/iso.h>
|
||||
#include "eir.h"
|
||||
|
||||
static const struct proto_ops iso_sock_ops;
|
||||
|
||||
|
@ -47,6 +48,7 @@ static void iso_sock_kill(struct sock *sk);
|
|||
|
||||
#define EIR_SERVICE_DATA_LENGTH 4
|
||||
#define BASE_MAX_LENGTH (HCI_MAX_PER_AD_LENGTH - EIR_SERVICE_DATA_LENGTH)
|
||||
#define EIR_BAA_SERVICE_UUID 0x1851
|
||||
|
||||
/* iso_pinfo flags values */
|
||||
enum {
|
||||
|
@ -1460,6 +1462,8 @@ static int iso_sock_getsockopt(struct socket *sock, int level, int optname,
|
|||
len = min_t(unsigned int, len, base_len);
|
||||
if (copy_to_user(optval, base, len))
|
||||
err = -EFAULT;
|
||||
if (put_user(len, optlen))
|
||||
err = -EFAULT;
|
||||
|
||||
break;
|
||||
|
||||
|
@ -1782,12 +1786,16 @@ int iso_connect_ind(struct hci_dev *hdev, bdaddr_t *bdaddr, __u8 *flags)
|
|||
|
||||
ev3 = hci_recv_event_data(hdev, HCI_EV_LE_PER_ADV_REPORT);
|
||||
if (ev3) {
|
||||
size_t base_len = ev3->length;
|
||||
u8 *base;
|
||||
|
||||
sk = iso_get_sock_listen(&hdev->bdaddr, bdaddr,
|
||||
iso_match_sync_handle_pa_report, ev3);
|
||||
|
||||
if (sk) {
|
||||
memcpy(iso_pi(sk)->base, ev3->data, ev3->length);
|
||||
iso_pi(sk)->base_len = ev3->length;
|
||||
base = eir_get_service_data(ev3->data, ev3->length,
|
||||
EIR_BAA_SERVICE_UUID, &base_len);
|
||||
if (base && sk && base_len <= sizeof(iso_pi(sk)->base)) {
|
||||
memcpy(iso_pi(sk)->base, base, base_len);
|
||||
iso_pi(sk)->base_len = base_len;
|
||||
}
|
||||
} else {
|
||||
sk = iso_get_sock_listen(&hdev->bdaddr, BDADDR_ANY, NULL, NULL);
|
||||
|
|
Loading…
Reference in New Issue