korg/bluez
0
0
Fork 0
mirror of https://git.kernel.org/pub/scm/bluetooth/bluez.git synced 2024-11-15 16:24:28 +08:00
Code Issues Packages Projects Releases Wiki Activity

btdev: Send BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED if remote start pa

Browse Source 
This sends BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED if remote device start
to periodic advertise when BT_HCI_CMD_LE_PERIODIC_ADV_CREATE_SYNC is
pending.
This commit is contained in:
Luiz Augusto von Dentz 2022-03-04 17:22:23 -08:00
parent d07185ff4e
commit 306bc0ca76
1 changed files with 78 additions and 66 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

144
emulator/btdev.c
View File

@ -5044,11 +5044,77 @@ static int cmd_set_per_adv_data(struct btdev *dev, const void *data,
return 0;
}
static void send_per_adv(struct btdev *dev, const struct btdev *remote,
uint8_t offset)
{
struct __packed {
struct bt_hci_le_per_adv_report ev;
uint8_t data[31];
} pdu;
memset(&pdu.ev, 0, sizeof(pdu.ev));
pdu.ev.handle = cpu_to_le16(dev->le_periodic_sync_handle);
pdu.ev.tx_power = 127;
pdu.ev.rssi = 127;
pdu.ev.cte_type = 0x0ff;
if ((size_t) remote->le_periodic_data_len - offset > sizeof(pdu.data)) {
pdu.ev.data_status = 0x01;
pdu.ev.data_len = sizeof(pdu.data);
} else {
pdu.ev.data_status = 0x00;
pdu.ev.data_len = remote->le_periodic_data_len - offset;
}
memcpy(pdu.data, remote->le_periodic_data + offset, pdu.ev.data_len);
le_meta_event(dev, BT_HCI_EVT_LE_PER_ADV_REPORT, &pdu,
sizeof(pdu.ev) + pdu.ev.data_len);
if (pdu.ev.data_status == 0x01) {
offset += pdu.ev.data_len;
send_per_adv(dev, remote, offset);
}
}
static void le_per_adv_sync_estabilished(struct btdev *dev,
struct btdev *remote, uint8_t status)
{
struct bt_hci_evt_le_per_sync_established ev;
struct bt_hci_cmd_le_periodic_adv_create_sync *cmd = &dev->pa_sync_cmd;
memset(&ev, 0, sizeof(ev));
ev.status = status;
if (status) {
memset(&dev->pa_sync_cmd, 0, sizeof(dev->pa_sync_cmd));
dev->le_periodic_sync_handle = 0x0000;
le_meta_event(dev, BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED, &ev,
sizeof(ev));
return;
}
dev->le_periodic_sync_handle = SYC_HANDLE;
ev.handle = cpu_to_le16(dev->le_periodic_sync_handle);
ev.addr_type = cmd->addr_type;
memcpy(ev.addr, cmd->addr, sizeof(ev.addr));
ev.phy = 0x01;
ev.interval = remote->le_periodic_min_interval;
ev.clock_accuracy = 0x07;
memset(&dev->pa_sync_cmd, 0, sizeof(dev->pa_sync_cmd));
le_meta_event(dev, BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED, &ev, sizeof(ev));
send_per_adv(dev, remote, 0);
}
static int cmd_set_per_adv_enable(struct btdev *dev, const void *data,
uint8_t len)
{
const struct bt_hci_cmd_le_set_periodic_adv_enable *cmd = data;
uint8_t status;
int i;
if (dev->le_periodic_adv_enable == cmd->enable) {
status = BT_HCI_ERR_COMMAND_DISALLOWED;
@ -5060,6 +5126,18 @@ static int cmd_set_per_adv_enable(struct btdev *dev, const void *data,
cmd_complete(dev, BT_HCI_CMD_LE_SET_PERIODIC_ADV_ENABLE, &status,
sizeof(status));
for (i = 0; i < MAX_BTDEV_ENTRIES; i++) {
struct btdev *remote = btdev_list[i];
if (!remote || remote == dev)
continue;
if (remote->le_scan_enable &&
remote->le_periodic_sync_handle == INV_HANDLE)
le_per_adv_sync_estabilished(remote, dev,
BT_HCI_ERR_SUCCESS);
}
return 0;
}
@ -5161,78 +5239,12 @@ static void scan_ext_adv(struct btdev *dev, struct btdev *remote)
}
}
static void send_per_adv(struct btdev *dev, const struct btdev *remote,
uint8_t offset)
{
struct __packed {
struct bt_hci_le_per_adv_report ev;
uint8_t data[31];
} pdu;
memset(&pdu.ev, 0, sizeof(pdu.ev));
pdu.ev.handle = cpu_to_le16(dev->le_periodic_sync_handle);
pdu.ev.tx_power = 127;
pdu.ev.rssi = 127;
pdu.ev.cte_type = 0x0ff;
if ((size_t) remote->le_periodic_data_len - offset > sizeof(pdu.data)) {
pdu.ev.data_status = 0x01;
pdu.ev.data_len = sizeof(pdu.data);
} else {
pdu.ev.data_status = 0x00;
pdu.ev.data_len = remote->le_periodic_data_len - offset;
}
memcpy(pdu.data, remote->le_periodic_data + offset, pdu.ev.data_len);
le_meta_event(dev, BT_HCI_EVT_LE_PER_ADV_REPORT, &pdu,
sizeof(pdu.ev) + pdu.ev.data_len);
if (pdu.ev.data_status == 0x01) {
offset += pdu.ev.data_len;
send_per_adv(dev, remote, offset);
}
}
static void le_per_adv_sync_estabilished(struct btdev *dev,
struct btdev *remote, uint8_t status)
{
struct bt_hci_evt_le_per_sync_established ev;
struct bt_hci_cmd_le_periodic_adv_create_sync *cmd = &dev->pa_sync_cmd;
memset(&ev, 0, sizeof(ev));
ev.status = status;
if (status) {
memset(&dev->pa_sync_cmd, 0, sizeof(dev->pa_sync_cmd));
dev->le_periodic_sync_handle = 0x0000;
le_meta_event(dev, BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED, &ev,
sizeof(ev));
return;
}
dev->le_periodic_sync_handle = SYC_HANDLE;
ev.handle = cpu_to_le16(dev->le_periodic_sync_handle);
ev.addr_type = cmd->addr_type;
memcpy(ev.addr, cmd->addr, sizeof(ev.addr));
ev.phy = 0x01;
ev.interval = remote->le_periodic_min_interval;
ev.clock_accuracy = 0x07;
memset(&dev->pa_sync_cmd, 0, sizeof(dev->pa_sync_cmd));
le_meta_event(dev, BT_HCI_EVT_LE_PER_SYNC_ESTABLISHED, &ev, sizeof(ev));
send_per_adv(dev, remote, 0);
}
static void scan_per_adv(struct btdev *dev, struct btdev *remote)
{
if (dev->le_periodic_sync_handle != INV_HANDLE ||
!remote->le_periodic_adv_enable)
return;
if (remote != find_btdev_by_bdaddr_type(dev->pa_sync_cmd.addr,
dev->pa_sync_cmd.addr_type))
return;