michaelh/zephyr
1
0
Fork 0
Code Releases Activity

tests: bluetooth: tester: Add support for advertising with target RPA

Browse source 
This allows to do directed advertising with peer address set to RPA.
To do this according to specification IUT must first read Central
Address Resolution characteristic to check if peer supports it.

This is affecting GAP/CONN/DCON/BV-05-C qualification test.

Signed-off-by: Szymon Janc <szymon.janc@codecoup.pl>
This commit is contained in:
Szymon Janc 2021-11-04 17:18:46 +01:00 • committed by Christopher Friedt
commit d80e480f20
2 changed files with 74 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

6
tests/bluetooth/tester/src/bttester.h
View file

@ -228,9 +228,9 @@ struct gap_passkey_confirm_cmd {
uint8_t match;
} __packed;
#define GAP_START_DIRECTED_ADV_HD 0x0001
#define GAP_START_DIRECTED_ADV_OWN_ID 0x0002
#define GAP_START_DIRECTED_ADV_PEER_RPA 0x0004
#define GAP_START_DIRECTED_ADV_HD BIT(0)
#define GAP_START_DIRECTED_ADV_OWN_ID BIT(1)
#define GAP_START_DIRECTED_ADV_PEER_RPA BIT(2)
#define GAP_START_DIRECTED_ADV 0x15
struct gap_start_directed_adv_cmd {

71
tests/bluetooth/tester/src/gap.c
View file

@ -13,6 +13,7 @@
#include <toolchain.h>
#include <bluetooth/bluetooth.h>
#include <bluetooth/conn.h>
#include <bluetooth/gatt.h>
#include <bluetooth/hci.h>
#include <sys/byteorder.h>
@ -41,6 +42,52 @@ static struct bt_le_oob oob_sc_local = { 0 };
static struct bt_le_oob oob_sc_remote = { 0 };
#endif /* !defined(CONFIG_BT_SMP_OOB_LEGACY_PAIR_ONLY) */
#if defined(CONFIG_BT_PRIVACY)
static struct {
bt_addr_le_t addr;
bool supported;
} cars[CONFIG_BT_MAX_PAIRED];
static uint8_t read_car_cb(struct bt_conn *conn, uint8_t err,
struct bt_gatt_read_params *params, const void *data,
uint16_t length);
static struct bt_gatt_read_params read_car_params = {
.func = read_car_cb,
.by_uuid.uuid = BT_UUID_CENTRAL_ADDR_RES,
.by_uuid.start_handle = BT_ATT_FIRST_ATTRIBUTE_HANDLE,
.by_uuid.end_handle = BT_ATT_LAST_ATTRIBUTE_HANDLE,
};
static uint8_t read_car_cb(struct bt_conn *conn, uint8_t err,
struct bt_gatt_read_params *params, const void *data,
uint16_t length)
{
struct bt_conn_info info;
bool supported = false;
if (!err && data && length == 1) {
const uint8_t *tmp = data;
/* only 0 or 1 are valid values */
if (tmp[0] == 1) {
supported = true;
}
}
bt_conn_get_info(conn, &info);
for (int i = 0; i < CONFIG_BT_MAX_PAIRED; i++) {
if (bt_addr_le_cmp(info.le.dst, &cars[i].addr) == 0) {
cars[i].supported = supported;
break;
}
}
return BT_GATT_ITER_STOP;
}
#endif
static void le_connected(struct bt_conn *conn, uint8_t err)
{
struct gap_device_connected_ev ev;
@ -505,6 +552,19 @@ static void start_directed_advertising(const uint8_t *data, uint16_t len)
adv_param.interval_min = BT_GAP_ADV_FAST_INT_MIN_2;
}
if (options & GAP_START_DIRECTED_ADV_PEER_RPA) {
#if defined(CONFIG_BT_PRIVACY)
/* check if peer supports Central Address Resolution */
for (int i = 0; i < CONFIG_BT_MAX_PAIRED; i++) {
if (bt_addr_le_cmp(peer, &cars[i].addr) == 0) {
if (cars[i].supported) {
adv_param.options |= BT_LE_ADV_OPT_DIR_ADDR_RPA;
}
}
}
#endif
}
if (bt_le_adv_start(&adv_param, NULL, 0, NULL, 0) < 0) {
LOG_ERR("Failed to start advertising");
goto fail;
@ -840,6 +900,16 @@ void auth_pairing_failed(struct bt_conn *conn, enum bt_security_err reason)
(uint8_t *)&ev, sizeof(ev));
}
static void auth_pairing_complete(struct bt_conn *conn, bool bonded)
{
#if defined(CONFIG_BT_PRIVACY)
/* Read peer's Central Address Resolution if bonded */
if (bonded) {
bt_gatt_read(conn, &read_car_params);
}
#endif
}
static void set_io_cap(const uint8_t *data, uint16_t len)
{
const struct gap_set_io_cap_cmd *cmd = (void *) data;
@ -878,6 +948,7 @@ static void set_io_cap(const uint8_t *data, uint16_t len)
cb.pairing_accept = auth_pairing_accept;
cb.pairing_failed = auth_pairing_failed;
cb.pairing_complete = auth_pairing_complete;
if (bt_conn_auth_cb_register(&cb)) {
status = BTP_STATUS_FAILED;