xref: /btstack/test/le_audio/le_audio_broadcast_assistant.c (revision be81b1591a9ca82ed53ae5c8bd7f477405351e5d)
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