1d15b3374SMatthias Ringwald /* 2d15b3374SMatthias Ringwald * Copyright (C) 2022 BlueKitchen GmbH 3d15b3374SMatthias Ringwald * 4d15b3374SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 5d15b3374SMatthias Ringwald * modification, are permitted provided that the following conditions 6d15b3374SMatthias Ringwald * are met: 7d15b3374SMatthias Ringwald * 8d15b3374SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 9d15b3374SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 10d15b3374SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 11d15b3374SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 12d15b3374SMatthias Ringwald * documentation and/or other materials provided with the distribution. 13d15b3374SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 14d15b3374SMatthias Ringwald * contributors may be used to endorse or promote products derived 15d15b3374SMatthias Ringwald * from this software without specific prior written permission. 16d15b3374SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 17d15b3374SMatthias Ringwald * personal benefit and not for any commercial purpose or for 18d15b3374SMatthias Ringwald * monetary gain. 19d15b3374SMatthias Ringwald * 20d15b3374SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21d15b3374SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22d15b3374SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23d15b3374SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24d15b3374SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25d15b3374SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26d15b3374SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27d15b3374SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28d15b3374SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29d15b3374SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30d15b3374SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31d15b3374SMatthias Ringwald * SUCH DAMAGE. 32d15b3374SMatthias Ringwald * 33d15b3374SMatthias Ringwald * Please inquire about commercial licensing options at 34d15b3374SMatthias Ringwald * [email protected] 35d15b3374SMatthias Ringwald * 36d15b3374SMatthias Ringwald */ 37d15b3374SMatthias Ringwald 38d15b3374SMatthias Ringwald #define BTSTACK_FILE__ "le_audio_broadcast_assistant.c" 39d15b3374SMatthias Ringwald 40d15b3374SMatthias Ringwald /* 41d15b3374SMatthias Ringwald * LE Audio Broadcast Assistant 42d15b3374SMatthias Ringwald */ 43d15b3374SMatthias Ringwald 44d15b3374SMatthias Ringwald 45d15b3374SMatthias Ringwald #include "btstack_config.h" 46d15b3374SMatthias Ringwald 47d15b3374SMatthias Ringwald #include <stdint.h> 48d15b3374SMatthias Ringwald #include <stdio.h> 49d15b3374SMatthias Ringwald #include <stdlib.h> 50d15b3374SMatthias Ringwald #include <string.h> 51d15b3374SMatthias Ringwald #include <inttypes.h> 52d15b3374SMatthias Ringwald 53d15b3374SMatthias Ringwald #include "ad_parser.h" 54d15b3374SMatthias Ringwald #include "ble/gatt-service/broadcast_audio_scan_service_client.h" 5532089ce4SMatthias Ringwald #include "ble/sm.h" 56d15b3374SMatthias Ringwald #include "bluetooth_data_types.h" 57d15b3374SMatthias Ringwald #include "bluetooth_gatt.h" 58d15b3374SMatthias Ringwald #include "btstack_audio.h" 59a22ed910SMatthias Ringwald #include "btstack_debug.h" 60d15b3374SMatthias Ringwald #include "btstack_event.h" 61d15b3374SMatthias Ringwald #include "btstack_lc3.h" 62d15b3374SMatthias Ringwald #include "btstack_run_loop.h" 63d15b3374SMatthias Ringwald #include "btstack_stdin.h" 64d15b3374SMatthias Ringwald #include "btstack_util.h" 65d15b3374SMatthias Ringwald #include "gap.h" 66d15b3374SMatthias Ringwald #include "hci.h" 6732089ce4SMatthias Ringwald #include "l2cap.h" 68*be81b159SMatthias Ringwald #include "le-audio/le_audio_base_parser.h" 69d15b3374SMatthias Ringwald 70d15b3374SMatthias Ringwald static void show_usage(void); 71d15b3374SMatthias Ringwald 72d15b3374SMatthias Ringwald static enum { 73d15b3374SMatthias Ringwald APP_W4_WORKING, 74d15b3374SMatthias Ringwald APP_W4_BROADCAST_SINK_AND_SCAN_DELEGATOR_ADV, 75d15b3374SMatthias Ringwald APP_W4_PA_AND_BIG_INFO, 76d15b3374SMatthias Ringwald APP_W4_BIG_SYNC_ESTABLISHED, 77d15b3374SMatthias Ringwald APP_W4_SCAN_DELEGATOR_CONNECTION, 78d15b3374SMatthias Ringwald APP_IDLE 79d15b3374SMatthias Ringwald } app_state = APP_W4_WORKING; 80d15b3374SMatthias Ringwald 81d15b3374SMatthias Ringwald // 82d15b3374SMatthias Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 8332089ce4SMatthias Ringwald static btstack_packet_callback_registration_t sm_event_callback_registration; 84d15b3374SMatthias Ringwald 85d15b3374SMatthias Ringwald static bool have_scan_delegator; 86d15b3374SMatthias Ringwald static bool have_broadcast_source; 87d15b3374SMatthias Ringwald static bool have_base; 88d15b3374SMatthias Ringwald static bool have_big_info; 89c3d56f70SMatthias Ringwald static bool manual_mode; 90d15b3374SMatthias Ringwald 91d15b3374SMatthias Ringwald // broadcast sink info 92d15b3374SMatthias Ringwald static char broadcast_source_name[20]; 93d15b3374SMatthias Ringwald static bd_addr_t broadcast_source; 94d15b3374SMatthias Ringwald static bd_addr_type_t broadcast_source_type; 95d15b3374SMatthias Ringwald static uint8_t broadcast_source_sid; 96d15b3374SMatthias Ringwald static uint32_t broadcast_id; 97d15b3374SMatthias Ringwald static uint16_t broadcast_source_pa_interval; 98d15b3374SMatthias Ringwald 99d15b3374SMatthias Ringwald // broadcast info 100d15b3374SMatthias Ringwald static hci_con_handle_t sync_handle; 101d15b3374SMatthias Ringwald static uint8_t encryption; 102166aee19SMatthias Ringwald static uint8_t broadcast_code [] = {0x01, 0x02, 0x68, 0x05, 0x53, 0xF1, 0x41, 0x5A, 0xA2, 0x65, 0xBB, 0xAF, 0xC6, 0xEA, 0x03, 0xB8, }; 103d15b3374SMatthias Ringwald static uint8_t num_bis; 1046b11d590SMatthias Ringwald static uint32_t bis_sync_mask; 105d15b3374SMatthias Ringwald static uint32_t sampling_frequency_hz; 106d15b3374SMatthias Ringwald static btstack_lc3_frame_duration_t frame_duration; 107d15b3374SMatthias Ringwald static uint16_t octets_per_frame; 108d15b3374SMatthias Ringwald 109d15b3374SMatthias Ringwald // scan delegator info 110d15b3374SMatthias Ringwald static char scan_delegator_name[20]; 111d15b3374SMatthias Ringwald static bd_addr_t scan_delegator; 112d15b3374SMatthias Ringwald static bd_addr_type_t scan_delegator_type; 113d15b3374SMatthias Ringwald static hci_con_handle_t scan_delegator_handle; 114d15b3374SMatthias Ringwald 115d15b3374SMatthias Ringwald // BASS 116d15b3374SMatthias Ringwald #define BASS_CLIENT_NUM_SOURCES 1 117d15b3374SMatthias Ringwald static bass_client_connection_t bass_connection; 118d15b3374SMatthias Ringwald static bass_client_source_t bass_sources[BASS_CLIENT_NUM_SOURCES]; 119d0b1d302SMatthias Ringwald static bass_source_data_t bass_source_data; 120d15b3374SMatthias Ringwald static uint16_t bass_cid; 1216216cd2aSMatthias Ringwald static uint8_t bass_source_id; 122d15b3374SMatthias Ringwald 123d15b3374SMatthias Ringwald static void handle_periodic_advertisement(const uint8_t * packet, uint16_t size){ 124d15b3374SMatthias Ringwald 125d15b3374SMatthias Ringwald // periodic advertisement contains the BASE 126d15b3374SMatthias Ringwald // TODO: BASE might be split across multiple advertisements 127d15b3374SMatthias Ringwald const uint8_t * adv_data = hci_subevent_le_periodic_advertising_report_get_data(packet); 128d15b3374SMatthias Ringwald uint16_t adv_size = hci_subevent_le_periodic_advertising_report_get_data_length(packet); 129d15b3374SMatthias Ringwald uint8_t adv_status = hci_subevent_le_periodic_advertising_report_get_data_status(packet); 130d15b3374SMatthias Ringwald 131d15b3374SMatthias Ringwald if (adv_status != 0) { 132d15b3374SMatthias Ringwald printf("Periodic Advertisement (status %u): ", adv_status); 133d15b3374SMatthias Ringwald printf_hexdump(adv_data, adv_size); 134d15b3374SMatthias Ringwald return; 135d15b3374SMatthias Ringwald } 136d15b3374SMatthias Ringwald 137*be81b159SMatthias Ringwald le_audio_base_parser_t parser; 138*be81b159SMatthias Ringwald bool ok = le_audio_base_parser_init(&parser, adv_data, adv_size); 139*be81b159SMatthias Ringwald if (ok == false){ 140*be81b159SMatthias Ringwald return; 141*be81b159SMatthias Ringwald } 142d15b3374SMatthias Ringwald have_base = true; 143*be81b159SMatthias Ringwald 144d15b3374SMatthias Ringwald printf("BASE:\n"); 145*be81b159SMatthias Ringwald uint32_t presentation_delay = le_audio_base_parser_get_presentation_delay(&parser); 146d15b3374SMatthias Ringwald printf("- presentation delay: %"PRIu32" us\n", presentation_delay); 147*be81b159SMatthias Ringwald uint8_t num_subgroups = le_audio_base_parser_get_num_subgroups(&parser); 148d15b3374SMatthias Ringwald // Cache in new source struct 149d0b1d302SMatthias Ringwald bass_source_data.subgroups_num = num_subgroups; 150d15b3374SMatthias Ringwald printf("- num subgroups: %u\n", num_subgroups); 151d15b3374SMatthias Ringwald uint8_t i; 152d15b3374SMatthias Ringwald for (i=0;i<num_subgroups;i++){ 153d15b3374SMatthias Ringwald 154d15b3374SMatthias Ringwald // Cache in new source struct 155d0b1d302SMatthias Ringwald bass_source_data.subgroups[i].bis_sync = 0; 156d15b3374SMatthias Ringwald 157d15b3374SMatthias Ringwald // Level 2: Subgroup Level 158*be81b159SMatthias Ringwald num_bis = le_audio_base_parser_subgroup_get_num_bis(&parser); 159d15b3374SMatthias Ringwald printf(" - num bis[%u]: %u\n", i, num_bis); 160*be81b159SMatthias Ringwald uint8_t codec_specific_configuration_length = le_audio_base_parser_bis_get_codec_specific_configuration_length(&parser); 161*be81b159SMatthias Ringwald const uint8_t * codec_specific_configuration = le_audio_base_parser_subgroup_get_codec_specific_configuration(&parser); 162d15b3374SMatthias Ringwald printf(" - codec specific config[%u]: ", i); 163d15b3374SMatthias Ringwald printf_hexdump(codec_specific_configuration, codec_specific_configuration_length); 164d15b3374SMatthias Ringwald // parse config to get sampling frequency and frame duration 165d15b3374SMatthias Ringwald uint8_t codec_offset = 0; 166d15b3374SMatthias Ringwald while ((codec_offset + 1) < codec_specific_configuration_length){ 167d15b3374SMatthias Ringwald uint8_t ltv_len = codec_specific_configuration[codec_offset++]; 168d15b3374SMatthias Ringwald uint8_t ltv_type = codec_specific_configuration[codec_offset]; 169d15b3374SMatthias Ringwald const uint32_t sampling_frequency_map[] = { 8000, 11025, 16000, 22050, 24000, 32000, 44100, 48000, 88200, 96000, 176400, 192000, 384000 }; 170d15b3374SMatthias Ringwald uint8_t sampling_frequency_index; 171d15b3374SMatthias Ringwald uint8_t frame_duration_index; 172d15b3374SMatthias Ringwald switch (ltv_type){ 173d15b3374SMatthias Ringwald case 0x01: // sampling frequency 174d15b3374SMatthias Ringwald sampling_frequency_index = codec_specific_configuration[codec_offset+1]; 175d15b3374SMatthias Ringwald // TODO: check range 176d15b3374SMatthias Ringwald sampling_frequency_hz = sampling_frequency_map[sampling_frequency_index - 1]; 177d15b3374SMatthias Ringwald printf(" - sampling frequency[%u]: %u\n", i, sampling_frequency_hz); 178d15b3374SMatthias Ringwald break; 179d15b3374SMatthias Ringwald case 0x02: // 0 = 7.5, 1 = 10 ms 180d15b3374SMatthias Ringwald frame_duration_index = codec_specific_configuration[codec_offset+1]; 181d15b3374SMatthias Ringwald frame_duration = (frame_duration_index == 0) ? BTSTACK_LC3_FRAME_DURATION_7500US : BTSTACK_LC3_FRAME_DURATION_10000US; 182d15b3374SMatthias Ringwald printf(" - frame duration[%u]: %s ms\n", i, (frame_duration == BTSTACK_LC3_FRAME_DURATION_7500US) ? "7.5" : "10"); 183d15b3374SMatthias Ringwald break; 184d15b3374SMatthias Ringwald case 0x04: // octets per coding frame 185d15b3374SMatthias Ringwald octets_per_frame = little_endian_read_16(codec_specific_configuration, codec_offset+1); 186d15b3374SMatthias Ringwald printf(" - octets per codec frame[%u]: %u\n", i, octets_per_frame); 187d15b3374SMatthias Ringwald break; 188d15b3374SMatthias Ringwald default: 189d15b3374SMatthias Ringwald break; 190d15b3374SMatthias Ringwald } 191d15b3374SMatthias Ringwald codec_offset += ltv_len; 192d15b3374SMatthias Ringwald } 193*be81b159SMatthias Ringwald uint8_t metadata_length = le_audio_base_parser_subgroup_get_metadata_length(&parser); 194*be81b159SMatthias Ringwald const uint8_t * meta_data = le_audio_base_subgroup_parser_get_metadata(&parser); 195d15b3374SMatthias Ringwald printf(" - meta data[%u]: ", i); 196d15b3374SMatthias Ringwald printf_hexdump(meta_data, metadata_length); 197d15b3374SMatthias Ringwald uint8_t k; 198d15b3374SMatthias Ringwald for (k=0;k<num_bis;k++){ 199d15b3374SMatthias Ringwald // Level 3: BIS Level 200*be81b159SMatthias Ringwald uint8_t bis_index = le_audio_base_parser_bis_get_index(&parser); 201d15b3374SMatthias Ringwald 2026216cd2aSMatthias Ringwald // check value 2036216cd2aSMatthias Ringwald // double check message 2046216cd2aSMatthias Ringwald 205d15b3374SMatthias Ringwald // Cache in new source struct 2066b11d590SMatthias Ringwald bis_sync_mask |= 1 << (bis_index-1); 2076b11d590SMatthias Ringwald 208d0b1d302SMatthias Ringwald bass_source_data.subgroups[i].metadata_length = 0; 209d0b1d302SMatthias Ringwald memset(&bass_source_data.subgroups[i].metadata, 0, sizeof(le_audio_metadata_t)); 210d15b3374SMatthias Ringwald 211d15b3374SMatthias Ringwald printf(" - bis index[%u][%u]: %u\n", i, k, bis_index); 212*be81b159SMatthias Ringwald codec_specific_configuration_length = le_audio_base_parser_bis_get_codec_specific_configuration_length(&parser); 213*be81b159SMatthias Ringwald codec_specific_configuration = le_audio_base_bis_parser_get_codec_specific_configuration(&parser); 214d15b3374SMatthias Ringwald printf(" - codec specific config[%u][%u]: ", i, k); 215*be81b159SMatthias Ringwald printf_hexdump(codec_specific_configuration, codec_specific_configuration_length); 216*be81b159SMatthias Ringwald 217*be81b159SMatthias Ringwald // parse next BIS 218*be81b159SMatthias Ringwald le_audio_base_parser_bis_next(&parser); 219d15b3374SMatthias Ringwald } 220*be81b159SMatthias Ringwald 221*be81b159SMatthias Ringwald // parse next subgroup 222*be81b159SMatthias Ringwald le_audio_base_parser_subgroup_next(&parser); 223d15b3374SMatthias Ringwald } 224d15b3374SMatthias Ringwald } 225d15b3374SMatthias Ringwald 226d15b3374SMatthias Ringwald static void start_scanning() { 227d15b3374SMatthias Ringwald app_state = APP_W4_BROADCAST_SINK_AND_SCAN_DELEGATOR_ADV; 228d15b3374SMatthias Ringwald have_base = false; 229d15b3374SMatthias Ringwald have_big_info = false; 230d15b3374SMatthias Ringwald gap_set_scan_params(1, 0x30, 0x30, 0); 231d15b3374SMatthias Ringwald gap_start_scan(); 232d15b3374SMatthias Ringwald printf("Start scan..\n"); 233d15b3374SMatthias Ringwald } 234d15b3374SMatthias Ringwald 235d15b3374SMatthias Ringwald static void have_base_and_big_info(void){ 23632089ce4SMatthias Ringwald printf("Connecting to Scan Delegator/Sink!\n"); 237d15b3374SMatthias Ringwald 238d15b3374SMatthias Ringwald // todo: connect to scan delegator 239d15b3374SMatthias Ringwald app_state = APP_W4_SCAN_DELEGATOR_CONNECTION; 240d15b3374SMatthias Ringwald gap_connect(scan_delegator, scan_delegator_type); 241d15b3374SMatthias Ringwald } 242d15b3374SMatthias Ringwald 243d15b3374SMatthias Ringwald static void handle_big_info(const uint8_t * packet, uint16_t size){ 244d15b3374SMatthias Ringwald printf("BIG Info advertising report\n"); 245d15b3374SMatthias Ringwald sync_handle = hci_subevent_le_biginfo_advertising_report_get_sync_handle(packet); 246d15b3374SMatthias Ringwald encryption = hci_subevent_le_biginfo_advertising_report_get_encryption(packet); 247d15b3374SMatthias Ringwald if (encryption) { 248d15b3374SMatthias Ringwald printf("Stream is encrypted\n"); 249d15b3374SMatthias Ringwald } 250d15b3374SMatthias Ringwald have_big_info = true; 251d15b3374SMatthias Ringwald } 252c3d56f70SMatthias Ringwald 253c3d56f70SMatthias Ringwald static void add_source() {// setup bass source info 254d0b1d302SMatthias Ringwald printf("BASS Client: add source with BIS Sync 0x%04x\n", bass_source_data.subgroups[0].bis_sync_state); 255d0b1d302SMatthias Ringwald bass_source_data.address_type = broadcast_source_type; 256d0b1d302SMatthias Ringwald memcpy(bass_source_data.address, broadcast_source, 6); 257d0b1d302SMatthias Ringwald bass_source_data.adv_sid = broadcast_source_sid; 258d0b1d302SMatthias Ringwald bass_source_data.broadcast_id = broadcast_id; 259d0b1d302SMatthias Ringwald bass_source_data.pa_sync = LE_AUDIO_PA_SYNC_SYNCHRONIZE_TO_PA_PAST_AVAILABLE; 260d0b1d302SMatthias Ringwald bass_source_data.pa_interval = broadcast_source_pa_interval; 261c3d56f70SMatthias Ringwald // bass_source_new.subgroups_num set in BASE parser 262c3d56f70SMatthias Ringwald // bass_source_new.subgroup[i].* set in BASE parser 263c3d56f70SMatthias Ringwald 264c3d56f70SMatthias Ringwald // add bass source 265d0b1d302SMatthias Ringwald broadcast_audio_scan_service_client_add_source(bass_cid, &bass_source_data); 266c3d56f70SMatthias Ringwald } 267c3d56f70SMatthias Ringwald 268d15b3374SMatthias Ringwald static void bass_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 269d15b3374SMatthias Ringwald UNUSED(channel); 270d15b3374SMatthias Ringwald UNUSED(size); 271d15b3374SMatthias Ringwald 272d15b3374SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 273d15b3374SMatthias Ringwald if (hci_event_packet_get_type(packet) != HCI_EVENT_GATTSERVICE_META) return; 274d15b3374SMatthias Ringwald 275e8a39bfbSMatthias Ringwald const bass_source_data_t * source_data; 276e8a39bfbSMatthias Ringwald 277d15b3374SMatthias Ringwald switch (hci_event_gattservice_meta_get_subevent_code(packet)) { 278d15b3374SMatthias Ringwald case GATTSERVICE_SUBEVENT_BASS_CONNECTED: 279d15b3374SMatthias Ringwald if (gattservice_subevent_bass_connected_get_status(packet) != ERROR_CODE_SUCCESS){ 280d15b3374SMatthias Ringwald printf("BASS client connection failed, cid 0x%02x, con_handle 0x%02x, status 0x%02x\n", 281d15b3374SMatthias Ringwald bass_cid, scan_delegator_handle, 282d15b3374SMatthias Ringwald gattservice_subevent_bass_connected_get_status(packet)); 283d15b3374SMatthias Ringwald return; 284d15b3374SMatthias Ringwald } 285d15b3374SMatthias Ringwald printf("BASS client connected, cid 0x%02x\n", bass_cid); 286d15b3374SMatthias Ringwald 28737d87e7fSMatthias Ringwald if ((have_big_info == false) || (have_base == false)) break; 288c3d56f70SMatthias Ringwald if (manual_mode) return; 28937d87e7fSMatthias Ringwald 290d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync_state = bis_sync_mask; 291d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync = bis_sync_mask; 2926b11d590SMatthias Ringwald add_source(); 293d15b3374SMatthias Ringwald break; 294d15b3374SMatthias Ringwald case GATTSERVICE_SUBEVENT_BASS_SOURCE_OPERATION_COMPLETE: 295d15b3374SMatthias Ringwald if (gattservice_subevent_bass_source_operation_complete_get_status(packet) != ERROR_CODE_SUCCESS){ 296d15b3374SMatthias Ringwald printf("BASS client source operation failed, status 0x%02x\n", gattservice_subevent_bass_source_operation_complete_get_status(packet)); 297d15b3374SMatthias Ringwald return; 298d15b3374SMatthias Ringwald } 299d15b3374SMatthias Ringwald 300d15b3374SMatthias Ringwald if ( gattservice_subevent_bass_source_operation_complete_get_opcode(packet) == (uint8_t)BASS_OPCODE_ADD_SOURCE ){ 3016216cd2aSMatthias Ringwald // TODO: set state to 'wait for source_id" 3026216cd2aSMatthias Ringwald printf("BASS client add source operation completed, wait for source_id\n"); 3036216cd2aSMatthias Ringwald } 3046216cd2aSMatthias Ringwald break; 3056216cd2aSMatthias Ringwald case GATTSERVICE_SUBEVENT_BASS_NOTIFICATION_COMPLETE: 3066216cd2aSMatthias Ringwald // store source_id 3076216cd2aSMatthias Ringwald bass_source_id = gattservice_subevent_bass_notification_complete_get_source_id(packet); 3086216cd2aSMatthias Ringwald printf("BASS client notification, source_id = 0x%02x\n", bass_source_id); 309a22ed910SMatthias Ringwald source_data = broadcast_audio_scan_service_client_get_source_data(bass_cid, bass_source_id); 310a22ed910SMatthias Ringwald btstack_assert(source_data != NULL); 311d15b3374SMatthias Ringwald 312e8a39bfbSMatthias Ringwald switch (source_data->pa_sync_state){ 313e8a39bfbSMatthias Ringwald case LE_AUDIO_PA_SYNC_STATE_SYNCINFO_REQUEST: 314e8a39bfbSMatthias Ringwald // start pa sync transfer 3156216cd2aSMatthias Ringwald printf("LE_AUDIO_PA_SYNC_STATE_SYNCINFO_REQUEST -> Start PAST\n"); 316e8a39bfbSMatthias Ringwald // TODO: unclear why this needs to be shifted for PAST with TS to get test green 317e8a39bfbSMatthias Ringwald uint16_t service_data = bass_source_id << 8; 318d15b3374SMatthias Ringwald gap_periodic_advertising_sync_transfer_send(scan_delegator_handle, service_data, sync_handle); 319e8a39bfbSMatthias Ringwald break; 320e8a39bfbSMatthias Ringwald default: 321e8a39bfbSMatthias Ringwald break; 322d15b3374SMatthias Ringwald } 323e8a39bfbSMatthias Ringwald 324a934fe9bSMatthias Ringwald // check if Broadcast Code is requested 325a934fe9bSMatthias Ringwald if (manual_mode == false){ 326a934fe9bSMatthias Ringwald le_audio_big_encryption_t big_encryption; 327a934fe9bSMatthias Ringwald uint8_t bad_code[16]; 328a934fe9bSMatthias Ringwald broadcast_audio_scan_service_client_get_encryption_state(bass_cid, bass_source_id, &big_encryption, bad_code); 329a934fe9bSMatthias Ringwald if (big_encryption == LE_AUDIO_BIG_ENCRYPTION_BROADCAST_CODE_REQUIRED){ 330a934fe9bSMatthias Ringwald printf("LE_AUDIO_BIG_ENCRYPTION_BROADCAST_CODE_REQUIRED -> send Broadcast Code\n"); 331a934fe9bSMatthias Ringwald broadcast_audio_scan_service_client_set_broadcast_code(bass_cid, bass_source_id, broadcast_code); 332a934fe9bSMatthias Ringwald } 333a934fe9bSMatthias Ringwald } 334d15b3374SMatthias Ringwald break; 335d15b3374SMatthias Ringwald default: 336d15b3374SMatthias Ringwald break; 337d15b3374SMatthias Ringwald } 338d15b3374SMatthias Ringwald } 339d15b3374SMatthias Ringwald 340d15b3374SMatthias Ringwald static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 341d15b3374SMatthias Ringwald UNUSED(channel); 342d15b3374SMatthias Ringwald if (packet_type != HCI_EVENT_PACKET) return; 343d15b3374SMatthias Ringwald switch (packet[0]) { 344d15b3374SMatthias Ringwald case BTSTACK_EVENT_STATE: 345d15b3374SMatthias Ringwald switch(btstack_event_state_get_state(packet)) { 346d15b3374SMatthias Ringwald case HCI_STATE_WORKING: 347d15b3374SMatthias Ringwald app_state = APP_IDLE; 348d15b3374SMatthias Ringwald #ifdef ENABLE_DEMO_MODE 349d15b3374SMatthias Ringwald start_scanning(); 350d15b3374SMatthias Ringwald #else 351d15b3374SMatthias Ringwald show_usage(); 352d15b3374SMatthias Ringwald #endif 353d15b3374SMatthias Ringwald break; 354d15b3374SMatthias Ringwald case HCI_STATE_OFF: 355d15b3374SMatthias Ringwald printf("Goodbye\n"); 356d15b3374SMatthias Ringwald exit(0); 357d15b3374SMatthias Ringwald break; 358d15b3374SMatthias Ringwald default: 359d15b3374SMatthias Ringwald break; 360d15b3374SMatthias Ringwald } 361d15b3374SMatthias Ringwald break; 362d15b3374SMatthias Ringwald case GAP_EVENT_EXTENDED_ADVERTISING_REPORT: 363d15b3374SMatthias Ringwald { 364d15b3374SMatthias Ringwald if (app_state != APP_W4_BROADCAST_SINK_AND_SCAN_DELEGATOR_ADV) break; 365d15b3374SMatthias Ringwald 366d15b3374SMatthias Ringwald uint8_t adv_size = gap_event_extended_advertising_report_get_data_length(packet); 367d15b3374SMatthias Ringwald const uint8_t * adv_data = gap_event_extended_advertising_report_get_data(packet); 368d15b3374SMatthias Ringwald 369d15b3374SMatthias Ringwald ad_context_t context; 370d15b3374SMatthias Ringwald bool found_scan_delegator = false; 371d15b3374SMatthias Ringwald bool found_broadcast_source = false; 372d15b3374SMatthias Ringwald bool found_name = false; 373d15b3374SMatthias Ringwald uint8_t adv_name[31]; 374d15b3374SMatthias Ringwald 375d15b3374SMatthias Ringwald uint16_t uuid; 376d15b3374SMatthias Ringwald for (ad_iterator_init(&context, adv_size, adv_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)) { 377d15b3374SMatthias Ringwald uint8_t data_type = ad_iterator_get_data_type(&context); 378d15b3374SMatthias Ringwald uint8_t size = ad_iterator_get_data_len(&context); 379d15b3374SMatthias Ringwald const uint8_t *data = ad_iterator_get_data(&context); 380d15b3374SMatthias Ringwald switch (data_type){ 381d15b3374SMatthias Ringwald case BLUETOOTH_DATA_TYPE_SERVICE_DATA_16_BIT_UUID: 382d15b3374SMatthias Ringwald uuid = little_endian_read_16(data, 0); 383d15b3374SMatthias Ringwald switch (uuid){ 384d15b3374SMatthias Ringwald case ORG_BLUETOOTH_SERVICE_BROADCAST_AUDIO_ANNOUNCEMENT_SERVICE: 385d15b3374SMatthias Ringwald broadcast_id = little_endian_read_24(data, 2); 386d15b3374SMatthias Ringwald found_broadcast_source = true; 387d15b3374SMatthias Ringwald break; 388d15b3374SMatthias Ringwald case ORG_BLUETOOTH_SERVICE_BROADCAST_AUDIO_SCAN_SERVICE: 389d15b3374SMatthias Ringwald found_scan_delegator = true; 390d15b3374SMatthias Ringwald break; 391d15b3374SMatthias Ringwald default: 392d15b3374SMatthias Ringwald break; 393d15b3374SMatthias Ringwald } 394d15b3374SMatthias Ringwald break; 395d15b3374SMatthias Ringwald case BLUETOOTH_DATA_TYPE_SHORTENED_LOCAL_NAME: 396d15b3374SMatthias Ringwald case BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME: 397d15b3374SMatthias Ringwald size = btstack_min(sizeof(adv_name) - 1, size); 398d15b3374SMatthias Ringwald memcpy(adv_name, data, size); 399d15b3374SMatthias Ringwald adv_name[size] = 0; 400d15b3374SMatthias Ringwald found_name = true; 401d15b3374SMatthias Ringwald break; 402d15b3374SMatthias Ringwald default: 403d15b3374SMatthias Ringwald break; 404d15b3374SMatthias Ringwald } 405d15b3374SMatthias Ringwald } 40632089ce4SMatthias Ringwald 407d15b3374SMatthias Ringwald if ((found_scan_delegator == false) && (found_broadcast_source == false)) break; 40832089ce4SMatthias Ringwald 409d15b3374SMatthias Ringwald if ((have_scan_delegator == false) && found_scan_delegator){ 410d15b3374SMatthias Ringwald have_scan_delegator = true; 411d15b3374SMatthias Ringwald gap_event_extended_advertising_report_get_address(packet, scan_delegator); 412d15b3374SMatthias Ringwald scan_delegator_type = gap_event_extended_advertising_report_get_address_type(packet); 413d15b3374SMatthias Ringwald if (found_name){ 414d15b3374SMatthias Ringwald btstack_strcpy(scan_delegator_name, sizeof(scan_delegator_name), (const char *) adv_name); 415d15b3374SMatthias Ringwald } else { 416d15b3374SMatthias Ringwald scan_delegator_name[0] = 0; 417d15b3374SMatthias Ringwald } 418d15b3374SMatthias Ringwald printf("Broadcast sink found, addr %s, name: '%s'\n", bd_addr_to_str(scan_delegator), scan_delegator_name); 419d15b3374SMatthias Ringwald gap_whitelist_add(scan_delegator_type, scan_delegator); 420d15b3374SMatthias Ringwald } 421d15b3374SMatthias Ringwald 422d15b3374SMatthias Ringwald if ((have_broadcast_source == false) && found_broadcast_source){ 423d15b3374SMatthias Ringwald have_broadcast_source = true; 424d15b3374SMatthias Ringwald gap_event_extended_advertising_report_get_address(packet, broadcast_source); 425d15b3374SMatthias Ringwald broadcast_source_type = gap_event_extended_advertising_report_get_address_type(packet); 426d15b3374SMatthias Ringwald broadcast_source_sid = gap_event_extended_advertising_report_get_advertising_sid(packet); 427d15b3374SMatthias Ringwald if (found_name){ 428d15b3374SMatthias Ringwald btstack_strcpy(broadcast_source_name, sizeof(broadcast_source_name), (const char *) adv_name); 429d15b3374SMatthias Ringwald } else { 430d15b3374SMatthias Ringwald broadcast_source_name[0] = 0; 431d15b3374SMatthias Ringwald } 43232089ce4SMatthias Ringwald printf("Broadcast source found, addr %s, name: '%s'\n", bd_addr_to_str(broadcast_source), broadcast_source_name); 433d15b3374SMatthias Ringwald gap_whitelist_add(broadcast_source_type, broadcast_source); 434d15b3374SMatthias Ringwald } 435d15b3374SMatthias Ringwald 436d15b3374SMatthias Ringwald if ((have_broadcast_source && have_scan_delegator) == false) break; 437d15b3374SMatthias Ringwald 438d15b3374SMatthias Ringwald printf("Start Periodic Advertising Sync\n"); 439d15b3374SMatthias Ringwald 440d15b3374SMatthias Ringwald // ignore other advertisements 441d15b3374SMatthias Ringwald gap_set_scan_params(1, 0x30, 0x30, 1); 442d15b3374SMatthias Ringwald // sync to PA 443d15b3374SMatthias Ringwald gap_periodic_advertiser_list_clear(); 444d15b3374SMatthias Ringwald gap_periodic_advertiser_list_add(broadcast_source_type, broadcast_source, broadcast_source_sid); 445d15b3374SMatthias Ringwald app_state = APP_W4_PA_AND_BIG_INFO; 446d15b3374SMatthias Ringwald gap_periodic_advertising_create_sync(0x01, broadcast_source_sid, broadcast_source_type, broadcast_source, 0, 1000, 0); 447d15b3374SMatthias Ringwald break; 448d15b3374SMatthias Ringwald } 449d15b3374SMatthias Ringwald 450d15b3374SMatthias Ringwald case HCI_EVENT_LE_META: 451d15b3374SMatthias Ringwald switch(hci_event_le_meta_get_subevent_code(packet)) { 452d15b3374SMatthias Ringwald case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_SYNC_ESTABLISHMENT: 453d15b3374SMatthias Ringwald sync_handle = hci_subevent_le_periodic_advertising_sync_establishment_get_sync_handle(packet); 454d15b3374SMatthias Ringwald broadcast_source_pa_interval = hci_subevent_le_periodic_advertising_sync_establishment_get_periodic_advertising_interval(packet); 455d15b3374SMatthias Ringwald printf("Periodic advertising sync with handle 0x%04x established\n", sync_handle); 456d15b3374SMatthias Ringwald break; 457d15b3374SMatthias Ringwald case HCI_SUBEVENT_LE_PERIODIC_ADVERTISING_REPORT: 458d15b3374SMatthias Ringwald if (have_base) break; 459d15b3374SMatthias Ringwald handle_periodic_advertisement(packet, size); 460d15b3374SMatthias Ringwald if (have_base & have_big_info){ 461d15b3374SMatthias Ringwald have_base_and_big_info(); 462d15b3374SMatthias Ringwald } 463d15b3374SMatthias Ringwald break; 464d15b3374SMatthias Ringwald case HCI_SUBEVENT_LE_BIGINFO_ADVERTISING_REPORT: 465d15b3374SMatthias Ringwald if (have_big_info) break; 466d15b3374SMatthias Ringwald handle_big_info(packet, size); 467d15b3374SMatthias Ringwald if (have_base & have_big_info){ 468d15b3374SMatthias Ringwald have_base_and_big_info(); 469d15b3374SMatthias Ringwald } 470d15b3374SMatthias Ringwald break; 471d15b3374SMatthias Ringwald case HCI_SUBEVENT_LE_BIG_SYNC_LOST: 472d15b3374SMatthias Ringwald printf("BIG Sync Lost\n"); 473d15b3374SMatthias Ringwald { 474d15b3374SMatthias Ringwald const btstack_audio_sink_t * sink = btstack_audio_sink_get_instance(); 475d15b3374SMatthias Ringwald if (sink != NULL) { 476d15b3374SMatthias Ringwald sink->stop_stream(); 477d15b3374SMatthias Ringwald sink->close(); 478d15b3374SMatthias Ringwald } 479d15b3374SMatthias Ringwald } 480d15b3374SMatthias Ringwald // start over 481d15b3374SMatthias Ringwald start_scanning(); 482d15b3374SMatthias Ringwald break; 483d15b3374SMatthias Ringwald case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: 484d15b3374SMatthias Ringwald if (hci_subevent_le_connection_complete_get_status(packet) != ERROR_CODE_SUCCESS) break; 485d15b3374SMatthias Ringwald scan_delegator_handle = hci_subevent_le_connection_complete_get_connection_handle(packet); 486d15b3374SMatthias Ringwald printf("Connection complete, handle 0x%04x\n", scan_delegator_handle); 487d15b3374SMatthias Ringwald broadcast_audio_scan_service_client_connect(&bass_connection, 488d15b3374SMatthias Ringwald bass_sources, 489d15b3374SMatthias Ringwald BASS_CLIENT_NUM_SOURCES, 490d15b3374SMatthias Ringwald scan_delegator_handle, 491d15b3374SMatthias Ringwald &bass_cid); 492d15b3374SMatthias Ringwald break; 493d15b3374SMatthias Ringwald default: 494d15b3374SMatthias Ringwald break; 495d15b3374SMatthias Ringwald } 496d15b3374SMatthias Ringwald break; 49732089ce4SMatthias Ringwald case SM_EVENT_JUST_WORKS_REQUEST: 49832089ce4SMatthias Ringwald printf("Just Works requested\n"); 49932089ce4SMatthias Ringwald sm_just_works_confirm(sm_event_just_works_request_get_handle(packet)); 50032089ce4SMatthias Ringwald break; 501d15b3374SMatthias Ringwald default: 502d15b3374SMatthias Ringwald break; 503d15b3374SMatthias Ringwald } 504d15b3374SMatthias Ringwald } 505d15b3374SMatthias Ringwald 506d15b3374SMatthias Ringwald static void show_usage(void){ 507d15b3374SMatthias Ringwald printf("\n--- LE Audio Broadcast Assistant Test Console ---\n"); 508c3d56f70SMatthias Ringwald printf("s - setup LE Broadcast Sink with Broadcast Source via Scan Delegator\n"); 509c3d56f70SMatthias Ringwald printf("c - scan and connect to Scan Delegator\n"); 5106b11d590SMatthias Ringwald printf("a - add source with BIS Sync 0x%08x\n", bis_sync_mask); 5116b11d590SMatthias Ringwald printf("A - add source with BIS Sync 0x00000000 (do not sync)\n"); 5126b11d590SMatthias Ringwald printf("m - modify source to PA Sync = 0, bis sync = 0x00000000\n"); 513222be8a8SMatthias Ringwald printf("b - send Broadcast Code: "); 514222be8a8SMatthias Ringwald printf_hexdump(broadcast_code, sizeof(broadcast_code)); 515c3d56f70SMatthias Ringwald printf("r - remove source\n"); 516d15b3374SMatthias Ringwald printf("---\n"); 517d15b3374SMatthias Ringwald } 518d15b3374SMatthias Ringwald 519d15b3374SMatthias Ringwald static void stdin_process(char c){ 520d15b3374SMatthias Ringwald switch (c){ 521d15b3374SMatthias Ringwald case 's': 522d15b3374SMatthias Ringwald if (app_state != APP_IDLE) break; 523c3d56f70SMatthias Ringwald manual_mode = false; 524d15b3374SMatthias Ringwald start_scanning(); 525d15b3374SMatthias Ringwald break; 52637d87e7fSMatthias Ringwald case 'c': 527c3d56f70SMatthias Ringwald manual_mode = true; 528c3d56f70SMatthias Ringwald start_scanning(); 52937d87e7fSMatthias Ringwald break; 530c3d56f70SMatthias Ringwald case 'a': 531d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync_state = bis_sync_mask; 532d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync = bis_sync_mask; 5336b11d590SMatthias Ringwald add_source(); 5346b11d590SMatthias Ringwald break; 5356b11d590SMatthias Ringwald case 'A': 536d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync_state = 0; 537d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync = 0; 538c3d56f70SMatthias Ringwald add_source(); 53937d87e7fSMatthias Ringwald break; 5406216cd2aSMatthias Ringwald case 'm': 541d0b1d302SMatthias Ringwald bass_source_data.pa_sync = LE_AUDIO_PA_SYNC_DO_NOT_SYNCHRONIZE_TO_PA; 542d0b1d302SMatthias Ringwald bass_source_data.subgroups[0].bis_sync_state = 0; 543d0b1d302SMatthias Ringwald broadcast_audio_scan_service_client_modify_source(bass_cid, bass_source_id, &bass_source_data); 544c3d56f70SMatthias Ringwald break; 545c3d56f70SMatthias Ringwald case 'r': 546585f85feSMatthias Ringwald broadcast_audio_scan_service_client_remove_source(bass_cid, bass_source_id); 547c3d56f70SMatthias Ringwald break; 548222be8a8SMatthias Ringwald case 'b': 549e8a39bfbSMatthias Ringwald broadcast_audio_scan_service_client_set_broadcast_code(bass_cid, bass_source_id, broadcast_code); 550222be8a8SMatthias Ringwald break; 551d15b3374SMatthias Ringwald case '\n': 552d15b3374SMatthias Ringwald case '\r': 553d15b3374SMatthias Ringwald break; 554d15b3374SMatthias Ringwald default: 555d15b3374SMatthias Ringwald show_usage(); 556d15b3374SMatthias Ringwald break; 557d15b3374SMatthias Ringwald 558d15b3374SMatthias Ringwald } 559d15b3374SMatthias Ringwald } 560d15b3374SMatthias Ringwald 561d15b3374SMatthias Ringwald int btstack_main(int argc, const char * argv[]); 562d15b3374SMatthias Ringwald int btstack_main(int argc, const char * argv[]){ 563d15b3374SMatthias Ringwald (void) argv; 564d15b3374SMatthias Ringwald (void) argc; 565d15b3374SMatthias Ringwald 56632089ce4SMatthias Ringwald l2cap_init(); 56732089ce4SMatthias Ringwald sm_init(); 56832089ce4SMatthias Ringwald gatt_client_init(); 56932089ce4SMatthias Ringwald 570d15b3374SMatthias Ringwald // register for HCI events 571d15b3374SMatthias Ringwald hci_event_callback_registration.callback = &packet_handler; 572d15b3374SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 573d15b3374SMatthias Ringwald 57432089ce4SMatthias Ringwald // register for SM events 57532089ce4SMatthias Ringwald sm_event_callback_registration.callback = &packet_handler; 57632089ce4SMatthias Ringwald sm_add_event_handler(&sm_event_callback_registration); 57732089ce4SMatthias Ringwald 57832089ce4SMatthias Ringwald broadcast_audio_scan_service_client_init(&bass_packet_handler); 579d15b3374SMatthias Ringwald 580d15b3374SMatthias Ringwald // turn on! 581d15b3374SMatthias Ringwald hci_power_control(HCI_POWER_ON); 582d15b3374SMatthias Ringwald 583d15b3374SMatthias Ringwald btstack_stdin_setup(stdin_process); 584d15b3374SMatthias Ringwald return 0; 585d15b3374SMatthias Ringwald } 586