patrick/zephyr
1
0
Fork 0
Code Issues Pull requests Actions 7 Packages Projects Releases Wiki Activity

Bluetooth: host: Periodic adv sync shell support

Browse source 
Added shell support to create and delete a periodic adv sync
object.

Signed-off-by: Emil Gydesen <emil_gydesen@bose.com>
This commit is contained in:
Emil Gydesen 2020-05-14 17:53:53 +02:00 committed by Carles Cufí
parent aea6afe3fa
commit 5580cb4391
1 changed files with 179 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

179
subsys/bluetooth/shell/bt.c
View file

@ -1363,6 +1363,177 @@ static int cmd_per_adv_data(const struct shell *shell, size_t argc,
return 0;
}
#endif /* CONFIG_BT_PER_ADV */
#if defined(CONFIG_BT_PER_ADV_SYNC)
static struct bt_le_per_adv_sync *per_adv_syncs[CONFIG_BT_PER_ADV_SYNC_MAX];
static struct bt_le_per_adv_sync *selected_per_adv_sync;
static void per_adv_sync_sync_cb(struct bt_le_per_adv_sync *sync,
struct bt_le_per_adv_sync_synced_info *info)
{
char le_addr[BT_ADDR_LE_STR_LEN];
if (selected_per_adv_sync != sync) {
shell_error(ctx_shell, "Invalid per adv sync object");
return;
}
bt_addr_le_to_str(info->addr, le_addr, sizeof(le_addr));
shell_print(ctx_shell, "PER_ADV_SYNC[%u]: [DEVICE]: %s synced, "
"Interval 0x%04x (%u ms), PHY %s",
bt_le_per_adv_sync_get_index(sync), le_addr,
info->interval, info->interval * 5 / 4, phy2str(info->phy));
}
static void per_adv_sync_terminated_cb(
struct bt_le_per_adv_sync *sync,
const struct bt_le_per_adv_sync_term_info *info)
{
char le_addr[BT_ADDR_LE_STR_LEN];
if (selected_per_adv_sync != sync) {
shell_error(ctx_shell, "Invalid per adv sync object");
return;
}
bt_addr_le_to_str(info->addr, le_addr, sizeof(le_addr));
shell_print(ctx_shell, "PER_ADV_SYNC[%u]: [DEVICE]: %s sync terminated",
bt_le_per_adv_sync_get_index(sync), le_addr);
selected_per_adv_sync = NULL;
}
static void per_adv_sync_recv_cb(
struct bt_le_per_adv_sync *sync,
const struct bt_le_per_adv_sync_recv_info *info,
struct net_buf_simple *buf)
{
char le_addr[BT_ADDR_LE_STR_LEN];
if (selected_per_adv_sync != sync) {
shell_error(ctx_shell, "Invalid per adv sync object");
return;
}
bt_addr_le_to_str(info->addr, le_addr, sizeof(le_addr));
shell_print(ctx_shell, "PER_ADV_SYNC[%u]: [DEVICE]: %s, tx_power %i, "
"RSSI %i, CTE %u, data length %u",
bt_le_per_adv_sync_get_index(sync), le_addr, info->tx_power,
info->rssi, info->cte_type, buf->len);
}
static struct bt_le_per_adv_sync_cb per_adv_sync_cb = {
.synced = per_adv_sync_sync_cb,
.term = per_adv_sync_terminated_cb,
.recv = per_adv_sync_recv_cb
};
static int cmd_per_adv_sync_create(const struct shell *shell, size_t argc,
char *argv[])
{
int err;
struct bt_le_per_adv_sync_param create_params = { 0 };
uint32_t options = 0;
struct bt_le_per_adv_sync *free_per_adv_sync = NULL;
int i = 0;
for (i = 0; i < ARRAY_SIZE(per_adv_syncs); i++) {
if (per_adv_syncs[i] == NULL) {
free_per_adv_sync = per_adv_syncs[i];
break;
}
}
if (i == ARRAY_SIZE(per_adv_syncs)) {
shell_error(shell, "Cannot create more per adv syncs");
return -ENOEXEC;
}
err = bt_addr_le_from_str(argv[1], argv[2], &create_params.addr);
if (err) {
shell_error(shell, "Invalid peer address (err %d)", err);
return -ENOEXEC;
}
/* Default values */
create_params.timeout = 1000; /* 10 seconds */
create_params.skip = 10;
create_params.sid = strtol(argv[3], NULL, 16);
for (int i = 4; i < argc; i++) {
if (!strcmp(argv[i], "aoa")) {
options |= BT_LE_PER_ADV_SYNC_OPT_DONT_SYNC_AOA;
} else if (!strcmp(argv[i], "aod_1us")) {
options |= BT_LE_PER_ADV_SYNC_OPT_DONT_SYNC_AOD_1US;
} else if (!strcmp(argv[i], "aod_2us")) {
options |= BT_LE_PER_ADV_SYNC_OPT_DONT_SYNC_AOD_2US;
} else if (!strcmp(argv[i], "only_cte")) {
options |=
BT_LE_PER_ADV_SYNC_OPT_SYNC_ONLY_CONST_TONE_EXT;
} else if (!strcmp(argv[i], "timeout")) {
if (++i == argc) {
shell_help(shell);
return SHELL_CMD_HELP_PRINTED;
}
create_params.timeout = strtoul(argv[i], NULL, 16);
} else if (!strcmp(argv[i], "skip")) {
if (++i == argc) {
shell_help(shell);
return SHELL_CMD_HELP_PRINTED;
}
create_params.skip = strtoul(argv[i], NULL, 16);
} else {
shell_help(shell);
return SHELL_CMD_HELP_PRINTED;
}
/* TODO: add support to parse using the per adv list */
}
create_params.options = options;
err = bt_le_per_adv_sync_create(&create_params, &per_adv_sync_cb,
&free_per_adv_sync);
if (err) {
shell_error(shell, "Per adv sync failed (%d)", err);
} else {
shell_print(shell, "Per adv sync pending");
}
return 0;
}
static int cmd_per_adv_sync_delete(const struct shell *shell, size_t argc,
char *argv[])
{
int err;
int index = 0;
struct bt_le_per_adv_sync **per_adv_sync = NULL;
if (argc > 1) {
index = strtol(argv[1], NULL, 10);
}
per_adv_sync = &per_adv_syncs[index];
if (!per_adv_sync) {
return -EINVAL;
}
err = bt_le_per_adv_sync_delete(*per_adv_sync);
if (err) {
shell_error(shell, "Per adv sync delete failed (%d)", err);
} else {
shell_print(shell, "Per adv sync deleted");
*per_adv_sync = NULL;
}
return 0;
}
#endif /* CONFIG_BT_PER_ADV_SYNC */
#endif /* CONFIG_BT_EXT_ADV */
#endif /* CONFIG_BT_BROADCASTER */
@ -2603,6 +2774,14 @@ SHELL_STATIC_SUBCMD_SET_CREATE(bt_cmds,
cmd_per_adv_param, 1, 3),
SHELL_CMD_ARG(per-adv-data, NULL, "<data>", cmd_per_adv_data, 2, 0),
#endif
#if defined(CONFIG_BT_PER_ADV_SYNC)
SHELL_CMD_ARG(per-adv-sync-create, NULL,
HELP_ADDR_LE " <sid> [skip <count>] [timeout <ms>] [aoa] "
"[aod_1us] [aod_2us] [cte_only]",
cmd_per_adv_sync_create, 2, 7),
SHELL_CMD_ARG(per-adv-sync-delete, NULL, "[<index>]",
cmd_per_adv_sync_delete, 1, 0),
#endif /* defined(CONFIG_BT_PER_ADV_SYNC) */
#endif
#endif /* CONFIG_BT_BROADCASTER */
#if defined(CONFIG_BT_CONN)