21892eecf1
This adds support to allow advertising PDUs to be linked which is required to send advertising trains, i.e. AUX_CHAIN_IND. PDUs are linked with a simple single-linked list, the pointer to next PDU is stored at the very end of PDU buffer. This prevents it from being overwritten if PDU is modified and allows for build time offset calculation. There are few helpers added to make handling easier, e.g.: - get next linked PDU - get last linked PDU - link one PDU to another - link PDU at the end - release all linked PDUs (except for 1st) Signed-off-by: Andrzej Kaczmarek <andrzej.kaczmarek@codecoup.pl>
87 lines
1.7 KiB
C
87 lines
1.7 KiB
C
/*
|
|
* Copyright (c) 2016-2018 Nordic Semiconductor ASA
|
|
* Copyright (c) 2016 Vinayak Kariappa Chettimada
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
#include <stddef.h>
|
|
#include <string.h>
|
|
|
|
#include <zephyr.h>
|
|
#include <soc.h>
|
|
#include <bluetooth/hci.h>
|
|
#include <bluetooth/controller.h>
|
|
|
|
#include "util/util.h"
|
|
#include "util/memq.h"
|
|
#include "util/mem.h"
|
|
|
|
#include "pdu.h"
|
|
|
|
#include "lll.h"
|
|
#include "lll/lll_adv_types.h"
|
|
#include "lll_adv.h"
|
|
#include "lll/lll_adv_pdu.h"
|
|
#include "lll_scan.h"
|
|
|
|
#include "ull_adv_types.h"
|
|
#include "ull_scan_types.h"
|
|
#include "ull_adv_internal.h"
|
|
#include "ull_scan_internal.h"
|
|
|
|
#include "ll.h"
|
|
|
|
static uint8_t pub_addr[BDADDR_SIZE];
|
|
static uint8_t rnd_addr[BDADDR_SIZE];
|
|
|
|
uint8_t *ll_addr_get(uint8_t addr_type, uint8_t *bdaddr)
|
|
{
|
|
if (addr_type > 1) {
|
|
return NULL;
|
|
}
|
|
|
|
if (addr_type) {
|
|
if (bdaddr) {
|
|
memcpy(bdaddr, rnd_addr, BDADDR_SIZE);
|
|
}
|
|
|
|
return rnd_addr;
|
|
}
|
|
|
|
if (bdaddr) {
|
|
memcpy(bdaddr, pub_addr, BDADDR_SIZE);
|
|
}
|
|
|
|
return pub_addr;
|
|
}
|
|
|
|
uint8_t ll_addr_set(uint8_t addr_type, uint8_t const *const bdaddr)
|
|
{
|
|
if (IS_ENABLED(CONFIG_BT_BROADCASTER)) {
|
|
#if defined(CONFIG_BT_CTLR_ADV_EXT)
|
|
if (ull_adv_is_enabled(0) && !ll_adv_cmds_is_ext()) {
|
|
#else /* !CONFIG_BT_CTLR_ADV_EXT */
|
|
if (ull_adv_is_enabled(0)) {
|
|
#endif /* !CONFIG_BT_CTLR_ADV_EXT */
|
|
return BT_HCI_ERR_CMD_DISALLOWED;
|
|
}
|
|
}
|
|
|
|
if (IS_ENABLED(CONFIG_BT_OBSERVER) &&
|
|
(ull_scan_is_enabled(0) & (BIT(1) | BIT(2)))) {
|
|
return BT_HCI_ERR_CMD_DISALLOWED;
|
|
}
|
|
|
|
if (addr_type) {
|
|
memcpy(rnd_addr, bdaddr, BDADDR_SIZE);
|
|
} else {
|
|
memcpy(pub_addr, bdaddr, BDADDR_SIZE);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void bt_ctlr_set_public_addr(const uint8_t *addr)
|
|
{
|
|
(void)memcpy(pub_addr, addr, sizeof(pub_addr));
|
|
}
|