| /* |
| * Copyright (c) 2021-2022 Nordic Semiconductor ASA |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #if defined(CONFIG_BT_AUDIO_UNICAST_SERVER) |
| |
| #include <zephyr/bluetooth/bluetooth.h> |
| #include <zephyr/bluetooth/audio/audio.h> |
| #include <zephyr/bluetooth/audio/capabilities.h> |
| #include "common.h" |
| #include "unicast_common.h" |
| |
| extern enum bst_result_t bst_result; |
| |
| #define CHANNEL_COUNT_1 BIT(0) |
| |
| static struct bt_codec lc3_codec = |
| BT_CODEC_LC3(BT_CODEC_LC3_FREQ_16KHZ, BT_CODEC_LC3_DURATION_10, CHANNEL_COUNT_1, 40u, 40u, |
| 1u, (BT_AUDIO_CONTEXT_TYPE_CONVERSATIONAL | BT_AUDIO_CONTEXT_TYPE_MEDIA)); |
| |
| static struct bt_audio_stream streams[CONFIG_BT_ASCS_ASE_SNK_COUNT + CONFIG_BT_ASCS_ASE_SRC_COUNT]; |
| |
| /* TODO: Expand with BAP data */ |
| static const struct bt_data unicast_server_ad[] = { |
| BT_DATA_BYTES(BT_DATA_FLAGS, (BT_LE_AD_GENERAL | BT_LE_AD_NO_BREDR)), |
| BT_DATA_BYTES(BT_DATA_UUID16_ALL, BT_UUID_16_ENCODE(BT_UUID_ASCS_VAL)), |
| }; |
| |
| CREATE_FLAG(flag_connected); |
| CREATE_FLAG(flag_stream_configured); |
| |
| static struct bt_audio_stream *lc3_config(struct bt_conn *conn, |
| struct bt_audio_ep *ep, |
| enum bt_audio_dir dir, |
| struct bt_audio_capability *cap, |
| struct bt_codec *codec) |
| { |
| printk("ASE Codec Config: conn %p ep %p dir %u, cap %p\n", |
| conn, ep, dir, cap); |
| |
| print_codec(codec); |
| |
| for (size_t i = 0; i < ARRAY_SIZE(streams); i++) { |
| struct bt_audio_stream *stream = &streams[i]; |
| |
| if (stream->conn == NULL) { |
| printk("ASE Codec Config stream %p\n", stream); |
| SET_FLAG(flag_stream_configured); |
| return stream; |
| } |
| } |
| |
| FAIL("No streams available\n"); |
| |
| return NULL; |
| } |
| |
| static int lc3_reconfig(struct bt_audio_stream *stream, |
| struct bt_audio_capability *cap, |
| struct bt_codec *codec) |
| { |
| printk("ASE Codec Reconfig: stream %p cap %p\n", stream, cap); |
| |
| print_codec(codec); |
| |
| /* We only support one QoS at the moment, reject changes */ |
| return -ENOEXEC; |
| } |
| |
| static int lc3_qos(struct bt_audio_stream *stream, struct bt_codec_qos *qos) |
| { |
| printk("QoS: stream %p qos %p\n", stream, qos); |
| |
| print_qos(qos); |
| |
| return 0; |
| } |
| |
| static int lc3_enable(struct bt_audio_stream *stream, |
| struct bt_codec_data *meta, |
| size_t meta_count) |
| { |
| printk("Enable: stream %p meta_count %zu\n", stream, meta_count); |
| |
| return 0; |
| } |
| |
| static int lc3_start(struct bt_audio_stream *stream) |
| { |
| printk("Start: stream %p\n", stream); |
| |
| return 0; |
| } |
| |
| static bool valid_metadata_type(uint8_t type, uint8_t len) |
| { |
| switch (type) { |
| case BT_AUDIO_METADATA_TYPE_PREF_CONTEXT: |
| case BT_AUDIO_METADATA_TYPE_STREAM_CONTEXT: |
| if (len != 2) { |
| return false; |
| } |
| |
| return true; |
| case BT_AUDIO_METADATA_TYPE_STREAM_LANG: |
| if (len != 3) { |
| return false; |
| } |
| |
| return true; |
| case BT_AUDIO_METADATA_TYPE_PARENTAL_RATING: |
| if (len != 1) { |
| return false; |
| } |
| |
| return true; |
| case BT_AUDIO_METADATA_TYPE_EXTENDED: /* 1 - 255 octets */ |
| case BT_AUDIO_METADATA_TYPE_VENDOR: /* 1 - 255 octets */ |
| if (len < 1) { |
| return false; |
| } |
| |
| return true; |
| case BT_AUDIO_METADATA_TYPE_CCID_LIST: /* 2 - 254 octets */ |
| if (len < 2) { |
| return false; |
| } |
| |
| return true; |
| case BT_AUDIO_METADATA_TYPE_PROGRAM_INFO: /* 0 - 255 octets */ |
| case BT_AUDIO_METADATA_TYPE_PROGRAM_INFO_URI: /* 0 - 255 octets */ |
| return true; |
| default: |
| return false; |
| } |
| } |
| |
| static int lc3_metadata(struct bt_audio_stream *stream, |
| struct bt_codec_data *meta, |
| size_t meta_count) |
| { |
| printk("Metadata: stream %p meta_count %zu\n", stream, meta_count); |
| |
| for (size_t i = 0; i < meta_count; i++) { |
| if (!valid_metadata_type(meta->data.type, meta->data.data_len)) { |
| printk("Invalid metadata type %u or length %u\n", |
| meta->data.type, meta->data.data_len); |
| |
| return -EINVAL; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int lc3_disable(struct bt_audio_stream *stream) |
| { |
| printk("Disable: stream %p\n", stream); |
| |
| return 0; |
| } |
| |
| static int lc3_stop(struct bt_audio_stream *stream) |
| { |
| printk("Stop: stream %p\n", stream); |
| |
| return 0; |
| } |
| |
| static int lc3_release(struct bt_audio_stream *stream) |
| { |
| printk("Release: stream %p\n", stream); |
| |
| return 0; |
| } |
| |
| static struct bt_audio_capability_ops lc3_ops = { |
| .config = lc3_config, |
| .reconfig = lc3_reconfig, |
| .qos = lc3_qos, |
| .enable = lc3_enable, |
| .start = lc3_start, |
| .metadata = lc3_metadata, |
| .disable = lc3_disable, |
| .stop = lc3_stop, |
| .release = lc3_release, |
| }; |
| |
| static void stream_recv(struct bt_audio_stream *stream, |
| const struct bt_iso_recv_info *info, |
| struct net_buf *buf) |
| { |
| printk("Incoming audio on stream %p len %u\n", stream, buf->len); |
| } |
| |
| static struct bt_audio_stream_ops stream_ops = { |
| .recv = stream_recv |
| }; |
| |
| static void connected(struct bt_conn *conn, uint8_t err) |
| { |
| char addr[BT_ADDR_LE_STR_LEN]; |
| |
| bt_addr_le_to_str(bt_conn_get_dst(conn), addr, sizeof(addr)); |
| |
| if (err != 0) { |
| FAIL("Failed to connect to %s (%u)\n", addr, err); |
| return; |
| } |
| |
| printk("Connected to %s\n", addr); |
| SET_FLAG(flag_connected); |
| } |
| |
| BT_CONN_CB_DEFINE(conn_callbacks) = { |
| .connected = connected, |
| .disconnected = disconnected, |
| }; |
| |
| static void init(void) |
| { |
| static struct bt_audio_capability caps = { |
| .dir = BT_AUDIO_DIR_SINK, |
| .pref = BT_AUDIO_CAPABILITY_PREF( |
| BT_AUDIO_CAPABILITY_UNFRAMED_SUPPORTED, |
| BT_GAP_LE_PHY_2M, 0x02, 10, 40000, 40000, 40000, 40000), |
| .codec = &lc3_codec, |
| .ops = &lc3_ops, |
| }; |
| int err; |
| |
| err = bt_enable(NULL); |
| if (err != 0) { |
| FAIL("Bluetooth enable failed (err %d)\n", err); |
| return; |
| } |
| |
| printk("Bluetooth initialized\n"); |
| |
| err = bt_audio_capability_register(&caps); |
| if (err != 0) { |
| FAIL("Failed to register capabilities: %d", err); |
| return; |
| } |
| |
| for (size_t i = 0; i < ARRAY_SIZE(streams); i++) { |
| bt_audio_stream_cb_register(&streams[i], &stream_ops); |
| } |
| |
| |
| err = bt_le_adv_start(BT_LE_ADV_CONN_NAME, unicast_server_ad, |
| ARRAY_SIZE(unicast_server_ad), NULL, 0); |
| if (err != 0) { |
| FAIL("Advertising failed to start (err %d)\n", err); |
| return; |
| } |
| } |
| |
| static void set_location(void) |
| { |
| int err; |
| |
| if (IS_ENABLED(CONFIG_BT_PAC_SNK_LOC)) { |
| err = bt_audio_capability_set_location(BT_AUDIO_DIR_SINK, |
| BT_AUDIO_LOCATION_FRONT_CENTER); |
| if (err != 0) { |
| FAIL("Failed to set sink location (err %d)\n", err); |
| return; |
| } |
| } |
| |
| if (IS_ENABLED(CONFIG_BT_PAC_SRC_LOC)) { |
| err = bt_audio_capability_set_location(BT_AUDIO_DIR_SOURCE, |
| (BT_AUDIO_LOCATION_FRONT_LEFT | |
| BT_AUDIO_LOCATION_FRONT_RIGHT)); |
| if (err != 0) { |
| FAIL("Failed to set source location (err %d)\n", err); |
| return; |
| } |
| } |
| |
| printk("Location successfully set\n"); |
| } |
| |
| static void set_available_contexts(void) |
| { |
| int err; |
| |
| err = bt_audio_capability_set_available_contexts(BT_AUDIO_DIR_SINK, |
| BT_AUDIO_CONTEXT_TYPE_MEDIA | |
| BT_AUDIO_CONTEXT_TYPE_CONVERSATIONAL); |
| if (IS_ENABLED(CONFIG_BT_PAC_SNK) && err != 0) { |
| FAIL("Failed to set sink available contexts (err %d)\n", err); |
| return; |
| } |
| |
| err = bt_audio_capability_set_available_contexts(BT_AUDIO_DIR_SOURCE, |
| BT_AUDIO_CONTEXT_TYPE_NOTIFICATIONS); |
| if (IS_ENABLED(CONFIG_BT_PAC_SRC) && err != 0) { |
| FAIL("Failed to set source available contexts (err %d)\n", err); |
| return; |
| } |
| |
| printk("Available contexts successfully set\n"); |
| } |
| |
| static void test_main(void) |
| { |
| init(); |
| |
| set_location(); |
| set_available_contexts(); |
| |
| /* TODO: When babblesim supports ISO, wait for audio stream to pass */ |
| |
| WAIT_FOR_FLAG(flag_connected); |
| WAIT_FOR_FLAG(flag_stream_configured); |
| PASS("Unicast server passed\n"); |
| } |
| |
| static const struct bst_test_instance test_unicast_server[] = { |
| { |
| .test_id = "unicast_server", |
| .test_post_init_f = test_init, |
| .test_tick_f = test_tick, |
| .test_main_f = test_main |
| }, |
| BSTEST_END_MARKER |
| }; |
| |
| struct bst_test_list *test_unicast_server_install(struct bst_test_list *tests) |
| { |
| return bst_add_tests(tests, test_unicast_server); |
| } |
| |
| #else /* !(CONFIG_BT_AUDIO_UNICAST_SERVER) */ |
| |
| struct bst_test_list *test_unicast_server_install(struct bst_test_list *tests) |
| { |
| return tests; |
| } |
| |
| #endif /* CONFIG_BT_AUDIO_UNICAST_SERVER */ |