13fb2c90bSMilanka Ringwald /* 23fb2c90bSMilanka Ringwald * Copyright (C) 2016 BlueKitchen GmbH 33fb2c90bSMilanka Ringwald * 43fb2c90bSMilanka Ringwald * Redistribution and use in source and binary forms, with or without 53fb2c90bSMilanka Ringwald * modification, are permitted provided that the following conditions 63fb2c90bSMilanka Ringwald * are met: 73fb2c90bSMilanka Ringwald * 83fb2c90bSMilanka Ringwald * 1. Redistributions of source code must retain the above copyright 93fb2c90bSMilanka Ringwald * notice, this list of conditions and the following disclaimer. 103fb2c90bSMilanka Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113fb2c90bSMilanka Ringwald * notice, this list of conditions and the following disclaimer in the 123fb2c90bSMilanka Ringwald * documentation and/or other materials provided with the distribution. 133fb2c90bSMilanka Ringwald * 3. Neither the name of the copyright holders nor the names of 143fb2c90bSMilanka Ringwald * contributors may be used to endorse or promote products derived 153fb2c90bSMilanka Ringwald * from this software without specific prior written permission. 163fb2c90bSMilanka Ringwald * 4. Any redistribution, use, or modification is done solely for 173fb2c90bSMilanka Ringwald * personal benefit and not for any commercial purpose or for 183fb2c90bSMilanka Ringwald * monetary gain. 193fb2c90bSMilanka Ringwald * 203fb2c90bSMilanka Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213fb2c90bSMilanka Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223fb2c90bSMilanka Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 233fb2c90bSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 243fb2c90bSMilanka Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253fb2c90bSMilanka Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263fb2c90bSMilanka Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273fb2c90bSMilanka Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283fb2c90bSMilanka Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293fb2c90bSMilanka Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303fb2c90bSMilanka Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313fb2c90bSMilanka Ringwald * SUCH DAMAGE. 323fb2c90bSMilanka Ringwald * 333fb2c90bSMilanka Ringwald * Please inquire about commercial licensing options at 343fb2c90bSMilanka Ringwald * [email protected] 353fb2c90bSMilanka Ringwald * 363fb2c90bSMilanka Ringwald */ 373fb2c90bSMilanka Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "a2dp_source_demo.c" 394dc98401SMilanka Ringwald 404dc98401SMilanka Ringwald /* 414dc98401SMilanka Ringwald * a2dp_source_demo.c 424dc98401SMilanka Ringwald */ 434dc98401SMilanka Ringwald 444dc98401SMilanka Ringwald // ***************************************************************************** 456fa8d4c7SMilanka Ringwald /* EXAMPLE_START(a2dp_source_demo): Serve audio stream and handle remote playback control and queries. 464dc98401SMilanka Ringwald * 476fa8d4c7SMilanka Ringwald * @text This A2DP Source example demonstrates how to send an audio data stream 486fa8d4c7SMilanka Ringwald * to a remote A2DP Sink device and how to switch between two audio data sources. 496fa8d4c7SMilanka Ringwald * In addition, the AVRCP Target is used to answer queries on currently played media, 5069f3ffd7SMilanka Ringwald * as well as to handle remote playback control, i.e. play, stop, repeat, etc. If HAVE_BTSTACK_STDIN 5169f3ffd7SMilanka Ringwald * is set, press SPACE on the console to show the available AVDTP and AVRCP commands. 52d5e631f6SMilanka Ringwald * 5369f3ffd7SMilanka Ringwald * @text To test with a remote device, e.g. a Bluetooth speaker, 54d5e631f6SMilanka Ringwald * set the device_addr_string to the Bluetooth address of your 55d5e631f6SMilanka Ringwald * remote device in the code, and use the UI to connect and start playback. 566ff556f6SMilanka Ringwald * 5769f3ffd7SMilanka Ringwald * @text For more info on BTstack audio, see our blog post 586ff556f6SMilanka Ringwald * [A2DP Sink and Source on STM32 F4 Discovery Board](http://bluekitchen-gmbh.com/a2dp-sink-and-source-on-stm32-f4-discovery-board/). 596ff556f6SMilanka Ringwald * 604dc98401SMilanka Ringwald */ 614dc98401SMilanka Ringwald // ***************************************************************************** 624dc98401SMilanka Ringwald 633fb2c90bSMilanka Ringwald 643fb2c90bSMilanka Ringwald #include <stdint.h> 653fb2c90bSMilanka Ringwald #include <stdio.h> 663fb2c90bSMilanka Ringwald #include <stdlib.h> 673fb2c90bSMilanka Ringwald #include <string.h> 683fb2c90bSMilanka Ringwald 693fb2c90bSMilanka Ringwald #include "btstack.h" 703fb2c90bSMilanka Ringwald #include "hxcmod.h" 713fb2c90bSMilanka Ringwald #include "mods/mod.h" 723fb2c90bSMilanka Ringwald 737d09721aSMatthias Ringwald // logarithmic volume reduction, samples are divided by 2^x 747d09721aSMatthias Ringwald // #define VOLUME_REDUCTION 3 75292a51b3SMilanka Ringwald // #undef HAVE_BTSTACK_STDIN 767d09721aSMatthias Ringwald 774f0111ebSMilanka Ringwald //#define AVRCP_BROWSING_ENABLED 786fa8d4c7SMilanka Ringwald 793fb2c90bSMilanka Ringwald #define NUM_CHANNELS 2 803fb2c90bSMilanka Ringwald #define BYTES_PER_AUDIO_SAMPLE (2*NUM_CHANNELS) 8167673f1cSMilanka Ringwald #define AUDIO_TIMEOUT_MS 10 823fb2c90bSMilanka Ringwald #define TABLE_SIZE_441HZ 100 833fb2c90bSMilanka Ringwald 842c65c004SMatthias Ringwald #define SBC_STORAGE_SIZE 1030 852c65c004SMatthias Ringwald 863fb2c90bSMilanka Ringwald typedef enum { 87d1207cd8SMilanka Ringwald STREAM_SINE = 0, 88d1207cd8SMilanka Ringwald STREAM_MOD, 89d1207cd8SMilanka Ringwald STREAM_PTS_TEST 903fb2c90bSMilanka Ringwald } stream_data_source_t; 913fb2c90bSMilanka Ringwald 9267673f1cSMilanka Ringwald typedef struct { 9367673f1cSMilanka Ringwald uint16_t a2dp_cid; 9467673f1cSMilanka Ringwald uint8_t local_seid; 95b12cd5a6SMilanka Ringwald uint8_t remote_seid; 9663331bf4SMilanka Ringwald uint8_t stream_opened; 97292a51b3SMilanka Ringwald uint16_t avrcp_cid; 9867673f1cSMilanka Ringwald 9967673f1cSMilanka Ringwald uint32_t time_audio_data_sent; // ms 10067673f1cSMilanka Ringwald uint32_t acc_num_missed_samples; 10167673f1cSMilanka Ringwald uint32_t samples_ready; 10267673f1cSMilanka Ringwald btstack_timer_source_t audio_timer; 10367673f1cSMilanka Ringwald uint8_t streaming; 10467673f1cSMilanka Ringwald int max_media_payload_size; 10567673f1cSMilanka Ringwald 1062c65c004SMatthias Ringwald uint8_t sbc_storage[SBC_STORAGE_SIZE]; 10767673f1cSMilanka Ringwald uint16_t sbc_storage_count; 10867673f1cSMilanka Ringwald uint8_t sbc_ready_to_send; 10930bfaab1SMilanka Ringwald 11030bfaab1SMilanka Ringwald uint16_t volume; 11167673f1cSMilanka Ringwald } a2dp_media_sending_context_t; 11267673f1cSMilanka Ringwald 1133fb2c90bSMilanka Ringwald static uint8_t media_sbc_codec_capabilities[] = { 1143fb2c90bSMilanka Ringwald (AVDTP_SBC_44100 << 4) | AVDTP_SBC_STEREO, 1153fb2c90bSMilanka Ringwald 0xFF,//(AVDTP_SBC_BLOCK_LENGTH_16 << 4) | (AVDTP_SBC_SUBBANDS_8 << 2) | AVDTP_SBC_ALLOCATION_METHOD_LOUDNESS, 1163fb2c90bSMilanka Ringwald 2, 53 1173fb2c90bSMilanka Ringwald }; 1183fb2c90bSMilanka Ringwald 11944547c84SMilanka Ringwald // input signal: pre-computed int16 sine wave, 44100 Hz at 441 Hz 12044547c84SMilanka Ringwald static const int16_t sine_int16_44100[] = { 1213fb2c90bSMilanka Ringwald 0, 2057, 4107, 6140, 8149, 10126, 12062, 13952, 15786, 17557, 1223fb2c90bSMilanka Ringwald 19260, 20886, 22431, 23886, 25247, 26509, 27666, 28714, 29648, 30466, 1233fb2c90bSMilanka Ringwald 31163, 31738, 32187, 32509, 32702, 32767, 32702, 32509, 32187, 31738, 1243fb2c90bSMilanka Ringwald 31163, 30466, 29648, 28714, 27666, 26509, 25247, 23886, 22431, 20886, 1253fb2c90bSMilanka Ringwald 19260, 17557, 15786, 13952, 12062, 10126, 8149, 6140, 4107, 2057, 1263fb2c90bSMilanka Ringwald 0, -2057, -4107, -6140, -8149, -10126, -12062, -13952, -15786, -17557, 1273fb2c90bSMilanka Ringwald -19260, -20886, -22431, -23886, -25247, -26509, -27666, -28714, -29648, -30466, 1283fb2c90bSMilanka Ringwald -31163, -31738, -32187, -32509, -32702, -32767, -32702, -32509, -32187, -31738, 1293fb2c90bSMilanka Ringwald -31163, -30466, -29648, -28714, -27666, -26509, -25247, -23886, -22431, -20886, 1303fb2c90bSMilanka Ringwald -19260, -17557, -15786, -13952, -12062, -10126, -8149, -6140, -4107, -2057, 1313fb2c90bSMilanka Ringwald }; 1323fb2c90bSMilanka Ringwald 13344547c84SMilanka Ringwald static const int num_samples_sine_int16_44100 = sizeof(sine_int16_44100) / 2; 13444547c84SMilanka Ringwald 13544547c84SMilanka Ringwald // input signal: pre-computed int16 sine wave, 48000 Hz at 441 Hz 13644547c84SMilanka Ringwald static const int16_t sine_int16_48000[] = { 13744547c84SMilanka Ringwald 0, 1905, 3804, 5690, 7557, 9398, 11207, 12978, 14706, 16383, 13844547c84SMilanka Ringwald 18006, 19567, 21062, 22486, 23834, 25101, 26283, 27376, 28377, 29282, 13944547c84SMilanka Ringwald 30087, 30791, 31390, 31884, 32269, 32545, 32712, 32767, 32712, 32545, 14044547c84SMilanka Ringwald 32269, 31884, 31390, 30791, 30087, 29282, 28377, 27376, 26283, 25101, 14144547c84SMilanka Ringwald 23834, 22486, 21062, 19567, 18006, 16383, 14706, 12978, 11207, 9398, 14244547c84SMilanka Ringwald 7557, 5690, 3804, 1905, 0, -1905, -3804, -5690, -7557, -9398, 14344547c84SMilanka Ringwald -11207, -12978, -14706, -16384, -18006, -19567, -21062, -22486, -23834, -25101, 14444547c84SMilanka Ringwald -26283, -27376, -28377, -29282, -30087, -30791, -31390, -31884, -32269, -32545, 14544547c84SMilanka Ringwald -32712, -32767, -32712, -32545, -32269, -31884, -31390, -30791, -30087, -29282, 14644547c84SMilanka Ringwald -28377, -27376, -26283, -25101, -23834, -22486, -21062, -19567, -18006, -16384, 14744547c84SMilanka Ringwald -14706, -12978, -11207, -9398, -7557, -5690, -3804, -1905, }; 14844547c84SMilanka Ringwald 14944547c84SMilanka Ringwald static const int num_samples_sine_int16_48000 = sizeof(sine_int16_48000) / 2; 15044547c84SMilanka Ringwald 15110b7d8c3SMilanka Ringwald typedef struct { 15210b7d8c3SMilanka Ringwald int reconfigure; 15310b7d8c3SMilanka Ringwald int num_channels; 15410b7d8c3SMilanka Ringwald int sampling_frequency; 15510b7d8c3SMilanka Ringwald int channel_mode; 15610b7d8c3SMilanka Ringwald int block_length; 15710b7d8c3SMilanka Ringwald int subbands; 15810b7d8c3SMilanka Ringwald int allocation_method; 15910b7d8c3SMilanka Ringwald int min_bitpool_value; 16010b7d8c3SMilanka Ringwald int max_bitpool_value; 16110b7d8c3SMilanka Ringwald int frames_per_buffer; 16210b7d8c3SMilanka Ringwald } avdtp_media_codec_configuration_sbc_t; 16310b7d8c3SMilanka Ringwald 16405d93378SMilanka Ringwald static btstack_packet_callback_registration_t hci_event_callback_registration; 1653fb2c90bSMilanka Ringwald 166adaba9f3SMatthias Ringwald // pts: static const char * device_addr_string = "00:1B:DC:08:0A:A5"; 16762faac7eSMilanka Ringwald // pts: static const char * device_addr_string = "00:1B:DC:08:E2:72"; 16867673f1cSMilanka Ringwald // mac 2013: static const char * device_addr_string = "84:38:35:65:d1:15"; 16967673f1cSMilanka Ringwald // phone 2013: static const char * device_addr_string = "D8:BB:2C:DF:F0:F2"; 17044547c84SMilanka Ringwald // Minijambox: 17144547c84SMilanka Ringwald static const char * device_addr_string = "00:21:3C:AC:F7:38"; 1723b70da21SMatthias Ringwald // Philips SHB9100: static const char * device_addr_string = "00:22:37:05:FD:E8"; 173694666f2SMilanka Ringwald // RT-B6: static const char * device_addr_string = "00:75:58:FF:C9:7D"; 174578eda3eSMilanka Ringwald // BT dongle: static const char * device_addr_string = "00:1A:7D:DA:71:0A"; 17544547c84SMilanka Ringwald // Sony MDR-ZX330BT static const char * device_addr_string = "00:18:09:28:50:18"; 1767d09721aSMatthias Ringwald // Panda (BM6) static const char * device_addr_string = "4F:3F:66:52:8B:E0"; 177b299d06eSMilanka Ringwald // BeatsX: static const char * device_addr_string = "DC:D3:A2:89:57:FB"; 178f3eb7114SMilanka Ringwald // Green mushroom: static const char * device_addr_string = "41:42:2A:ED:D6:F3"; 179f3eb7114SMilanka Ringwald 18067673f1cSMilanka Ringwald static bd_addr_t device_addr; 18169f3ffd7SMilanka Ringwald 18267673f1cSMilanka Ringwald static uint8_t sdp_a2dp_source_service_buffer[150]; 1836fa8d4c7SMilanka Ringwald static uint8_t sdp_avrcp_target_service_buffer[200]; 18450259306SMilanka Ringwald static uint8_t sdp_avrcp_controller_service_buffer[200]; 185*1b994686SMilanka Ringwald static uint8_t device_id_sdp_service_buffer[100]; 18650259306SMilanka Ringwald 18710b7d8c3SMilanka Ringwald static avdtp_media_codec_configuration_sbc_t sbc_configuration; 18810b7d8c3SMilanka Ringwald static btstack_sbc_encoder_state_t sbc_encoder_state; 1896fa8d4c7SMilanka Ringwald 1903fb2c90bSMilanka Ringwald static uint8_t media_sbc_codec_configuration[4]; 1913fb2c90bSMilanka Ringwald static a2dp_media_sending_context_t media_tracker; 1923fb2c90bSMilanka Ringwald 19367673f1cSMilanka Ringwald static stream_data_source_t data_source; 1943fb2c90bSMilanka Ringwald 19567673f1cSMilanka Ringwald static int sine_phase; 196f3eb7114SMilanka Ringwald static int current_sample_rate = 44100; 197f3eb7114SMilanka Ringwald static int new_sample_rate = 44100; 19867673f1cSMilanka Ringwald 19967673f1cSMilanka Ringwald static int hxcmod_initialized; 2003fb2c90bSMilanka Ringwald static modcontext mod_context; 2013fb2c90bSMilanka Ringwald static tracker_buffer_state trkbuf; 2023fb2c90bSMilanka Ringwald 203c045af99SMilanka Ringwald /* AVRCP Target context START */ 204c045af99SMilanka Ringwald static const uint8_t subunit_info[] = { 205c045af99SMilanka Ringwald 0,0,0,0, 206c045af99SMilanka Ringwald 1,1,1,1, 207c045af99SMilanka Ringwald 2,2,2,2, 208c045af99SMilanka Ringwald 3,3,3,3, 209c045af99SMilanka Ringwald 4,4,4,4, 210c045af99SMilanka Ringwald 5,5,5,5, 211c045af99SMilanka Ringwald 6,6,6,6, 212c045af99SMilanka Ringwald 7,7,7,7 213c045af99SMilanka Ringwald }; 214c045af99SMilanka Ringwald 2154b338011SMilanka Ringwald static uint32_t company_id = 0x112233; 216e0bbf3edSMilanka Ringwald static uint8_t companies_num = 1; 217e0bbf3edSMilanka Ringwald static uint8_t companies[] = { 218e0bbf3edSMilanka Ringwald 0x00, 0x19, 0x58 //BT SIG registered CompanyID 219e0bbf3edSMilanka Ringwald }; 220e0bbf3edSMilanka Ringwald 2212ea2c5e5SMilanka Ringwald static uint8_t events_num = 6; 222e0bbf3edSMilanka Ringwald static uint8_t events[] = { 223e0bbf3edSMilanka Ringwald AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED, 224e0bbf3edSMilanka Ringwald AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED, 225e0bbf3edSMilanka Ringwald AVRCP_NOTIFICATION_EVENT_PLAYER_APPLICATION_SETTING_CHANGED, 226e0bbf3edSMilanka Ringwald AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED, 227e0bbf3edSMilanka Ringwald AVRCP_NOTIFICATION_EVENT_AVAILABLE_PLAYERS_CHANGED, 2282ea2c5e5SMilanka Ringwald AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED 229e0bbf3edSMilanka Ringwald }; 230e0bbf3edSMilanka Ringwald 231c045af99SMilanka Ringwald typedef struct { 232d1207cd8SMilanka Ringwald uint8_t track_id[8]; 2335e3d4d2bSMilanka Ringwald uint32_t song_length_ms; 234d1207cd8SMilanka Ringwald avrcp_playback_status_t status; 235c045af99SMilanka Ringwald uint32_t song_position_ms; // 0xFFFFFFFF if not supported 236c045af99SMilanka Ringwald } avrcp_play_status_info_t; 237c045af99SMilanka Ringwald 238d1207cd8SMilanka Ringwald // python -c "print('a'*512)" 239d1207cd8SMilanka Ringwald static const char title[] = "aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa"; 240d1207cd8SMilanka Ringwald 241d1207cd8SMilanka Ringwald avrcp_track_t tracks[] = { 242cfd2437eSMatthias Ringwald {{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01}, 1, "Sine", "Generated", "A2DP Source Demo", "monotone", 12345}, 243cfd2437eSMatthias Ringwald {{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02}, 2, "Nao-deceased", "Decease", "A2DP Source Demo", "vivid", 12345}, 244cfd2437eSMatthias Ringwald {{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03}, 3, (char *)title, "Decease", "A2DP Source Demo", "vivid", 12345}, 245d1207cd8SMilanka Ringwald }; 246d1207cd8SMilanka Ringwald int current_track_index; 247c045af99SMilanka Ringwald avrcp_play_status_info_t play_info; 248c045af99SMilanka Ringwald 249c045af99SMilanka Ringwald /* AVRCP Target context END */ 250c045af99SMilanka Ringwald 2516fa8d4c7SMilanka Ringwald /* @section Main Application Setup 2526fa8d4c7SMilanka Ringwald * 25369f3ffd7SMilanka Ringwald * @text The Listing MainConfiguration shows how to setup AD2P Source and AVRCP services. 25469f3ffd7SMilanka Ringwald * Besides calling init() method for each service, you'll also need to register several packet handlers: 25569f3ffd7SMilanka Ringwald * - hci_packet_handler - handles legacy pairing, here by using fixed '0000' pin code. 25669f3ffd7SMilanka Ringwald * - a2dp_source_packet_handler - handles events on stream connection status (established, released), the media codec configuration, and, the commands on stream itself (open, pause, stopp). 25769f3ffd7SMilanka Ringwald * - avrcp_packet_handler - receives connect/disconnect event. 25869f3ffd7SMilanka Ringwald * - avrcp_controller_packet_handler - receives answers for sent AVRCP commands. 25969f3ffd7SMilanka Ringwald * - avrcp_target_packet_handler - receives AVRCP commands, and registered notifications. 26069f3ffd7SMilanka Ringwald * - stdin_process - used to trigger AVRCP commands to the A2DP Source device, such are get now playing info, start, stop, volume control. Requires HAVE_BTSTACK_STDIN. 26169f3ffd7SMilanka Ringwald * 26269f3ffd7SMilanka Ringwald * @text To announce A2DP Source and AVRCP services, you need to create corresponding 26369f3ffd7SMilanka Ringwald * SDP records and register them with the SDP service. 2646fa8d4c7SMilanka Ringwald */ 2656fa8d4c7SMilanka Ringwald 2666fa8d4c7SMilanka Ringwald /* LISTING_START(MainConfiguration): Setup Audio Source and AVRCP Target services */ 26769f3ffd7SMilanka Ringwald static void hci_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 2686fa8d4c7SMilanka Ringwald static void a2dp_source_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * event, uint16_t event_size); 269cee0e5b6SMilanka Ringwald static void avrcp_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 2706fa8d4c7SMilanka Ringwald static void avrcp_target_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 27150259306SMilanka Ringwald static void avrcp_controller_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); 2726fa8d4c7SMilanka Ringwald #ifdef HAVE_BTSTACK_STDIN 2736fa8d4c7SMilanka Ringwald static void stdin_process(char cmd); 2746fa8d4c7SMilanka Ringwald #endif 2756fa8d4c7SMilanka Ringwald 276f3eb7114SMilanka Ringwald static void a2dp_demo_hexcmod_configure_sample_rate(int sample_rate); 27744547c84SMilanka Ringwald 2786fa8d4c7SMilanka Ringwald static int a2dp_source_and_avrcp_services_init(void){ 279b299d06eSMilanka Ringwald // request role change on reconnecting headset to always use them in slave mode 280b299d06eSMilanka Ringwald hci_set_master_slave_policy(0); 281b299d06eSMilanka Ringwald 2826fa8d4c7SMilanka Ringwald l2cap_init(); 2836fa8d4c7SMilanka Ringwald // Initialize A2DP Source. 2846fa8d4c7SMilanka Ringwald a2dp_source_init(); 2856fa8d4c7SMilanka Ringwald a2dp_source_register_packet_handler(&a2dp_source_packet_handler); 2866fa8d4c7SMilanka Ringwald 2876fa8d4c7SMilanka Ringwald // Create stream endpoint. 2887078e434SMilanka Ringwald avdtp_stream_endpoint_t * local_stream_endpoint = a2dp_source_create_stream_endpoint(AVDTP_AUDIO, AVDTP_CODEC_SBC, media_sbc_codec_capabilities, sizeof(media_sbc_codec_capabilities), media_sbc_codec_configuration, sizeof(media_sbc_codec_configuration)); 2897078e434SMilanka Ringwald if (!local_stream_endpoint){ 290292a51b3SMilanka Ringwald printf("A2DP Source: not enough memory to create local stream endpoint\n"); 2916fa8d4c7SMilanka Ringwald return 1; 2926fa8d4c7SMilanka Ringwald } 2937078e434SMilanka Ringwald media_tracker.local_seid = avdtp_local_seid(local_stream_endpoint); 29462faac7eSMilanka Ringwald avdtp_source_register_delay_reporting_category(media_tracker.local_seid); 29562faac7eSMilanka Ringwald 29669f3ffd7SMilanka Ringwald // Initialize AVRCP Service. 29719691e0aSMilanka Ringwald avrcp_init(); 298cee0e5b6SMilanka Ringwald avrcp_register_packet_handler(&avrcp_packet_handler); 2996fa8d4c7SMilanka Ringwald // Initialize AVRCP Target. 3006fa8d4c7SMilanka Ringwald avrcp_target_init(); 3016fa8d4c7SMilanka Ringwald avrcp_target_register_packet_handler(&avrcp_target_packet_handler); 30250259306SMilanka Ringwald // Initialize AVRCP Controller 30350259306SMilanka Ringwald avrcp_controller_init(); 30450259306SMilanka Ringwald avrcp_controller_register_packet_handler(&avrcp_controller_packet_handler); 3056fa8d4c7SMilanka Ringwald 3066fa8d4c7SMilanka Ringwald // Initialize SDP, 3076fa8d4c7SMilanka Ringwald sdp_init(); 3086fa8d4c7SMilanka Ringwald 30963331bf4SMilanka Ringwald // Create A2DP Source service record and register it with SDP. 3106fa8d4c7SMilanka Ringwald memset(sdp_a2dp_source_service_buffer, 0, sizeof(sdp_a2dp_source_service_buffer)); 3111904e5a1SMilanka Ringwald a2dp_source_create_sdp_record(sdp_a2dp_source_service_buffer, 0x10001, AVDTP_SOURCE_FEATURE_MASK_PLAYER, NULL, NULL); 3126fa8d4c7SMilanka Ringwald sdp_register_service(sdp_a2dp_source_service_buffer); 3136fa8d4c7SMilanka Ringwald 3146fa8d4c7SMilanka Ringwald // Create AVRCP target service record and register it with SDP. 3156fa8d4c7SMilanka Ringwald memset(sdp_avrcp_target_service_buffer, 0, sizeof(sdp_avrcp_target_service_buffer)); 316e2f25417SMilanka Ringwald uint16_t supported_features = AVRCP_FEATURE_MASK_CATEGORY_PLAYER_OR_RECORDER; 3174f0111ebSMilanka Ringwald #ifdef AVRCP_BROWSING_ENABLED 318e2f25417SMilanka Ringwald supported_features |= AVRCP_FEATURE_MASK_BROWSING; 3194f0111ebSMilanka Ringwald #endif 320b4505971SMilanka Ringwald avrcp_target_create_sdp_record(sdp_avrcp_target_service_buffer, 0x10002, supported_features, NULL, NULL); 3216fa8d4c7SMilanka Ringwald sdp_register_service(sdp_avrcp_target_service_buffer); 3226fa8d4c7SMilanka Ringwald 32350259306SMilanka Ringwald // setup AVRCP Controller 32450259306SMilanka Ringwald memset(sdp_avrcp_controller_service_buffer, 0, sizeof(sdp_avrcp_controller_service_buffer)); 325e2f25417SMilanka Ringwald uint16_t controller_supported_features = AVRCP_FEATURE_MASK_CATEGORY_PLAYER_OR_RECORDER; 326b4505971SMilanka Ringwald avrcp_controller_create_sdp_record(sdp_avrcp_controller_service_buffer, 0x10003, controller_supported_features, NULL, NULL); 32750259306SMilanka Ringwald sdp_register_service(sdp_avrcp_controller_service_buffer); 32850259306SMilanka Ringwald 329*1b994686SMilanka Ringwald device_id_create_sdp_record(device_id_sdp_service_buffer, 0x10004, DEVICE_ID_VENDOR_ID_SOURCE_BLUETOOTH, BLUETOOTH_COMPANY_ID_BLUEKITCHEN_GMBH, 1, 1); 330*1b994686SMilanka Ringwald sdp_register_service(device_id_sdp_service_buffer); 331*1b994686SMilanka Ringwald 3326fa8d4c7SMilanka Ringwald // Set local name with a template Bluetooth address, that will be automatically 3336fa8d4c7SMilanka Ringwald // replaced with a actual address once it is available, i.e. when BTstack boots 3346fa8d4c7SMilanka Ringwald // up and starts talking to a Bluetooth module. 335292a51b3SMilanka Ringwald gap_set_local_name("A2DP Source 00:00:00:00:00:00"); 3366fa8d4c7SMilanka Ringwald gap_discoverable_control(1); 3376fa8d4c7SMilanka Ringwald gap_set_class_of_device(0x200408); 3386fa8d4c7SMilanka Ringwald 339a4fe6467SMatthias Ringwald // Register for HCI events. 34069f3ffd7SMilanka Ringwald hci_event_callback_registration.callback = &hci_packet_handler; 341a4fe6467SMatthias Ringwald hci_add_event_handler(&hci_event_callback_registration); 342a4fe6467SMatthias Ringwald 343f3eb7114SMilanka Ringwald a2dp_demo_hexcmod_configure_sample_rate(current_sample_rate); 3448963e613SMatthias Ringwald 34569f3ffd7SMilanka Ringwald #ifdef HAVE_BTSTACK_STDIN 3466fa8d4c7SMilanka Ringwald // Parse human readable Bluetooth address. 3476fa8d4c7SMilanka Ringwald sscanf_bd_addr(device_addr_string, device_addr); 3486fa8d4c7SMilanka Ringwald btstack_stdin_setup(stdin_process); 3496fa8d4c7SMilanka Ringwald #endif 3506fa8d4c7SMilanka Ringwald return 0; 3516fa8d4c7SMilanka Ringwald } 3526fa8d4c7SMilanka Ringwald /* LISTING_END */ 3536fa8d4c7SMilanka Ringwald 354f3eb7114SMilanka Ringwald static void a2dp_demo_hexcmod_configure_sample_rate(int sample_rate){ 35569f3ffd7SMilanka Ringwald if (!hxcmod_initialized){ 35669f3ffd7SMilanka Ringwald hxcmod_initialized = hxcmod_init(&mod_context); 35769f3ffd7SMilanka Ringwald if (!hxcmod_initialized) { 35869f3ffd7SMilanka Ringwald printf("could not initialize hxcmod\n"); 35969f3ffd7SMilanka Ringwald return; 36069f3ffd7SMilanka Ringwald } 36169f3ffd7SMilanka Ringwald } 362f3eb7114SMilanka Ringwald current_sample_rate = sample_rate; 36369f3ffd7SMilanka Ringwald media_tracker.sbc_storage_count = 0; 36469f3ffd7SMilanka Ringwald media_tracker.samples_ready = 0; 36569f3ffd7SMilanka Ringwald hxcmod_unload(&mod_context); 366f3eb7114SMilanka Ringwald hxcmod_setcfg(&mod_context, current_sample_rate, 16, 1, 1, 1); 36769f3ffd7SMilanka Ringwald hxcmod_load(&mod_context, (void *) &mod_data, mod_len); 36869f3ffd7SMilanka Ringwald } 36969f3ffd7SMilanka Ringwald 37067673f1cSMilanka Ringwald static void a2dp_demo_send_media_packet(void){ 3713fb2c90bSMilanka Ringwald int num_bytes_in_frame = btstack_sbc_encoder_sbc_buffer_length(); 3723fb2c90bSMilanka Ringwald int bytes_in_storage = media_tracker.sbc_storage_count; 3733fb2c90bSMilanka Ringwald uint8_t num_frames = bytes_in_storage / num_bytes_in_frame; 37488132161SMilanka Ringwald a2dp_source_stream_send_media_payload(media_tracker.a2dp_cid, media_tracker.local_seid, media_tracker.sbc_storage, bytes_in_storage, num_frames, 0); 3753fb2c90bSMilanka Ringwald media_tracker.sbc_storage_count = 0; 3763fb2c90bSMilanka Ringwald media_tracker.sbc_ready_to_send = 0; 3773fb2c90bSMilanka Ringwald } 3783fb2c90bSMilanka Ringwald 37967673f1cSMilanka Ringwald static void produce_sine_audio(int16_t * pcm_buffer, int num_samples_to_write){ 3803fb2c90bSMilanka Ringwald int count; 3813fb2c90bSMilanka Ringwald for (count = 0; count < num_samples_to_write ; count++){ 382f3eb7114SMilanka Ringwald switch (current_sample_rate){ 38344547c84SMilanka Ringwald case 44100: 38444547c84SMilanka Ringwald pcm_buffer[count * 2] = sine_int16_44100[sine_phase]; 38544547c84SMilanka Ringwald pcm_buffer[count * 2 + 1] = sine_int16_44100[sine_phase]; 38667673f1cSMilanka Ringwald sine_phase++; 38744547c84SMilanka Ringwald if (sine_phase >= num_samples_sine_int16_44100){ 38844547c84SMilanka Ringwald sine_phase -= num_samples_sine_int16_44100; 3893fb2c90bSMilanka Ringwald } 39044547c84SMilanka Ringwald break; 39144547c84SMilanka Ringwald case 48000: 39244547c84SMilanka Ringwald pcm_buffer[count * 2] = sine_int16_48000[sine_phase]; 39344547c84SMilanka Ringwald pcm_buffer[count * 2 + 1] = sine_int16_48000[sine_phase]; 39444547c84SMilanka Ringwald sine_phase++; 39544547c84SMilanka Ringwald if (sine_phase >= num_samples_sine_int16_48000){ 39644547c84SMilanka Ringwald sine_phase -= num_samples_sine_int16_48000; 39744547c84SMilanka Ringwald } 39844547c84SMilanka Ringwald break; 39944547c84SMilanka Ringwald default: 40044547c84SMilanka Ringwald break; 40144547c84SMilanka Ringwald } 40244547c84SMilanka Ringwald 40344547c84SMilanka Ringwald 4043fb2c90bSMilanka Ringwald } 4053fb2c90bSMilanka Ringwald } 4063fb2c90bSMilanka Ringwald 4073fb2c90bSMilanka Ringwald static void produce_mod_audio(int16_t * pcm_buffer, int num_samples_to_write){ 4083fb2c90bSMilanka Ringwald hxcmod_fillbuffer(&mod_context, (unsigned short *) &pcm_buffer[0], num_samples_to_write, &trkbuf); 4093fb2c90bSMilanka Ringwald } 4103fb2c90bSMilanka Ringwald 4113fb2c90bSMilanka Ringwald static void produce_audio(int16_t * pcm_buffer, int num_samples){ 4123fb2c90bSMilanka Ringwald switch (data_source){ 4133fb2c90bSMilanka Ringwald case STREAM_SINE: 41467673f1cSMilanka Ringwald produce_sine_audio(pcm_buffer, num_samples); 4153fb2c90bSMilanka Ringwald break; 4163fb2c90bSMilanka Ringwald case STREAM_MOD: 4173fb2c90bSMilanka Ringwald produce_mod_audio(pcm_buffer, num_samples); 4183fb2c90bSMilanka Ringwald break; 419d1207cd8SMilanka Ringwald default: 420d1207cd8SMilanka Ringwald break; 4213fb2c90bSMilanka Ringwald } 4227d09721aSMatthias Ringwald #ifdef VOLUME_REDUCTION 4237d09721aSMatthias Ringwald int i; 4247d09721aSMatthias Ringwald for (i=0;i<num_samples*2;i++){ 4257d09721aSMatthias Ringwald if (pcm_buffer[i] > 0){ 4267d09721aSMatthias Ringwald pcm_buffer[i] = pcm_buffer[i] >> VOLUME_REDUCTION; 4277d09721aSMatthias Ringwald } else { 4287d09721aSMatthias Ringwald pcm_buffer[i] = -((-pcm_buffer[i]) >> VOLUME_REDUCTION); 4297d09721aSMatthias Ringwald } 4307d09721aSMatthias Ringwald } 4317d09721aSMatthias Ringwald #endif 4323fb2c90bSMilanka Ringwald } 4333fb2c90bSMilanka Ringwald 434319b19ccSMilanka Ringwald static int a2dp_demo_fill_sbc_audio_buffer(a2dp_media_sending_context_t * context){ 4353fb2c90bSMilanka Ringwald // perform sbc encodin 4363fb2c90bSMilanka Ringwald int total_num_bytes_read = 0; 437249d94cfSMatthias Ringwald unsigned int num_audio_samples_per_sbc_buffer = btstack_sbc_encoder_num_audio_frames(); 4383fb2c90bSMilanka Ringwald while (context->samples_ready >= num_audio_samples_per_sbc_buffer 4393fb2c90bSMilanka Ringwald && (context->max_media_payload_size - context->sbc_storage_count) >= btstack_sbc_encoder_sbc_buffer_length()){ 4403fb2c90bSMilanka Ringwald 441adaba9f3SMatthias Ringwald int16_t pcm_frame[256*NUM_CHANNELS]; 4423fb2c90bSMilanka Ringwald 443adaba9f3SMatthias Ringwald produce_audio(pcm_frame, num_audio_samples_per_sbc_buffer); 444adaba9f3SMatthias Ringwald btstack_sbc_encoder_process_data(pcm_frame); 4453fb2c90bSMilanka Ringwald 4463fb2c90bSMilanka Ringwald uint16_t sbc_frame_size = btstack_sbc_encoder_sbc_buffer_length(); 4473fb2c90bSMilanka Ringwald uint8_t * sbc_frame = btstack_sbc_encoder_sbc_buffer(); 4483fb2c90bSMilanka Ringwald 4493fb2c90bSMilanka Ringwald total_num_bytes_read += num_audio_samples_per_sbc_buffer; 4503fb2c90bSMilanka Ringwald memcpy(&context->sbc_storage[context->sbc_storage_count], sbc_frame, sbc_frame_size); 4513fb2c90bSMilanka Ringwald context->sbc_storage_count += sbc_frame_size; 4523fb2c90bSMilanka Ringwald context->samples_ready -= num_audio_samples_per_sbc_buffer; 4533fb2c90bSMilanka Ringwald } 4543fb2c90bSMilanka Ringwald return total_num_bytes_read; 4553fb2c90bSMilanka Ringwald } 4563fb2c90bSMilanka Ringwald 457319b19ccSMilanka Ringwald static void a2dp_demo_audio_timeout_handler(btstack_timer_source_t * timer){ 4583fb2c90bSMilanka Ringwald a2dp_media_sending_context_t * context = (a2dp_media_sending_context_t *) btstack_run_loop_get_timer_context(timer); 45967673f1cSMilanka Ringwald btstack_run_loop_set_timer(&context->audio_timer, AUDIO_TIMEOUT_MS); 46067673f1cSMilanka Ringwald btstack_run_loop_add_timer(&context->audio_timer); 4613fb2c90bSMilanka Ringwald uint32_t now = btstack_run_loop_get_time_ms(); 4623fb2c90bSMilanka Ringwald 46367673f1cSMilanka Ringwald uint32_t update_period_ms = AUDIO_TIMEOUT_MS; 4643fb2c90bSMilanka Ringwald if (context->time_audio_data_sent > 0){ 4653fb2c90bSMilanka Ringwald update_period_ms = now - context->time_audio_data_sent; 4663fb2c90bSMilanka Ringwald } 4673fb2c90bSMilanka Ringwald 468f3eb7114SMilanka Ringwald uint32_t num_samples = (update_period_ms * current_sample_rate) / 1000; 469f3eb7114SMilanka Ringwald context->acc_num_missed_samples += (update_period_ms * current_sample_rate) % 1000; 4703fb2c90bSMilanka Ringwald 4713fb2c90bSMilanka Ringwald while (context->acc_num_missed_samples >= 1000){ 4723fb2c90bSMilanka Ringwald num_samples++; 4733fb2c90bSMilanka Ringwald context->acc_num_missed_samples -= 1000; 4743fb2c90bSMilanka Ringwald } 4753fb2c90bSMilanka Ringwald context->time_audio_data_sent = now; 4763fb2c90bSMilanka Ringwald context->samples_ready += num_samples; 4773fb2c90bSMilanka Ringwald 4783fb2c90bSMilanka Ringwald if (context->sbc_ready_to_send) return; 4793fb2c90bSMilanka Ringwald 480319b19ccSMilanka Ringwald a2dp_demo_fill_sbc_audio_buffer(context); 4813fb2c90bSMilanka Ringwald 4823fb2c90bSMilanka Ringwald if ((context->sbc_storage_count + btstack_sbc_encoder_sbc_buffer_length()) > context->max_media_payload_size){ 4833fb2c90bSMilanka Ringwald // schedule sending 4843fb2c90bSMilanka Ringwald context->sbc_ready_to_send = 1; 48588132161SMilanka Ringwald a2dp_source_stream_endpoint_request_can_send_now(context->a2dp_cid, context->local_seid); 4863fb2c90bSMilanka Ringwald } 4873fb2c90bSMilanka Ringwald } 4883fb2c90bSMilanka Ringwald 48967673f1cSMilanka Ringwald static void a2dp_demo_timer_start(a2dp_media_sending_context_t * context){ 4902c65c004SMatthias Ringwald context->max_media_payload_size = btstack_min(a2dp_max_media_payload_size(context->a2dp_cid, context->local_seid), SBC_STORAGE_SIZE); 4913fb2c90bSMilanka Ringwald context->sbc_storage_count = 0; 4923fb2c90bSMilanka Ringwald context->sbc_ready_to_send = 0; 4933fb2c90bSMilanka Ringwald context->streaming = 1; 49467673f1cSMilanka Ringwald btstack_run_loop_remove_timer(&context->audio_timer); 495319b19ccSMilanka Ringwald btstack_run_loop_set_timer_handler(&context->audio_timer, a2dp_demo_audio_timeout_handler); 49667673f1cSMilanka Ringwald btstack_run_loop_set_timer_context(&context->audio_timer, context); 49767673f1cSMilanka Ringwald btstack_run_loop_set_timer(&context->audio_timer, AUDIO_TIMEOUT_MS); 49867673f1cSMilanka Ringwald btstack_run_loop_add_timer(&context->audio_timer); 4993fb2c90bSMilanka Ringwald } 5003fb2c90bSMilanka Ringwald 50167673f1cSMilanka Ringwald static void a2dp_demo_timer_stop(a2dp_media_sending_context_t * context){ 5023fb2c90bSMilanka Ringwald context->time_audio_data_sent = 0; 5033fb2c90bSMilanka Ringwald context->acc_num_missed_samples = 0; 5043fb2c90bSMilanka Ringwald context->samples_ready = 0; 5053fb2c90bSMilanka Ringwald context->streaming = 1; 5063fb2c90bSMilanka Ringwald context->sbc_storage_count = 0; 5073fb2c90bSMilanka Ringwald context->sbc_ready_to_send = 0; 50867673f1cSMilanka Ringwald btstack_run_loop_remove_timer(&context->audio_timer); 5093fb2c90bSMilanka Ringwald } 5103fb2c90bSMilanka Ringwald 511b5858f2dSMilanka Ringwald static void dump_sbc_configuration(avdtp_media_codec_configuration_sbc_t * configuration){ 512b5858f2dSMilanka Ringwald printf("Received media codec configuration:\n"); 513b5858f2dSMilanka Ringwald printf(" - num_channels: %d\n", configuration->num_channels); 514b5858f2dSMilanka Ringwald printf(" - sampling_frequency: %d\n", configuration->sampling_frequency); 515b5858f2dSMilanka Ringwald printf(" - channel_mode: %d\n", configuration->channel_mode); 516b5858f2dSMilanka Ringwald printf(" - block_length: %d\n", configuration->block_length); 517b5858f2dSMilanka Ringwald printf(" - subbands: %d\n", configuration->subbands); 518b5858f2dSMilanka Ringwald printf(" - allocation_method: %d\n", configuration->allocation_method); 519b5858f2dSMilanka Ringwald printf(" - bitpool_value [%d, %d] \n", configuration->min_bitpool_value, configuration->max_bitpool_value); 520b5858f2dSMilanka Ringwald } 521b5858f2dSMilanka Ringwald 52269f3ffd7SMilanka Ringwald static void hci_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 52369f3ffd7SMilanka Ringwald UNUSED(channel); 52469f3ffd7SMilanka Ringwald UNUSED(size); 52569f3ffd7SMilanka Ringwald if (packet_type != HCI_EVENT_PACKET) return; 52669f3ffd7SMilanka Ringwald 52769f3ffd7SMilanka Ringwald #ifndef HAVE_BTSTACK_STDIN 52869f3ffd7SMilanka Ringwald if (hci_event_packet_get_type(packet) == BTSTACK_EVENT_STATE){ 52969f3ffd7SMilanka Ringwald if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) return; 53069f3ffd7SMilanka Ringwald printf("Create A2DP Source connection to addr %s.\n", bd_addr_to_str(device_addr)); 53169f3ffd7SMilanka Ringwald uint8_t status = a2dp_source_establish_stream(device_addr, media_tracker.local_seid, &media_tracker.a2dp_cid); 53269f3ffd7SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 53369f3ffd7SMilanka Ringwald printf("Could not perform command, status 0x%2x\n", status); 53469f3ffd7SMilanka Ringwald } 53569f3ffd7SMilanka Ringwald return; 53669f3ffd7SMilanka Ringwald } 53769f3ffd7SMilanka Ringwald #endif 53869f3ffd7SMilanka Ringwald 53969f3ffd7SMilanka Ringwald if (hci_event_packet_get_type(packet) == HCI_EVENT_PIN_CODE_REQUEST) { 54069f3ffd7SMilanka Ringwald bd_addr_t address; 54169f3ffd7SMilanka Ringwald printf("Pin code request - using '0000'\n"); 54269f3ffd7SMilanka Ringwald hci_event_pin_code_request_get_bd_addr(packet, address); 54369f3ffd7SMilanka Ringwald gap_pin_code_response(address, "0000"); 54469f3ffd7SMilanka Ringwald } 54569f3ffd7SMilanka Ringwald } 54669f3ffd7SMilanka Ringwald 5476fa8d4c7SMilanka Ringwald static void a2dp_source_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 54867673f1cSMilanka Ringwald UNUSED(channel); 54967673f1cSMilanka Ringwald UNUSED(size); 55067673f1cSMilanka Ringwald uint8_t status; 55167673f1cSMilanka Ringwald uint8_t local_seid; 552ef5ad9d6SMilanka Ringwald bd_addr_t address; 553d1207cd8SMilanka Ringwald uint16_t cid; 55467673f1cSMilanka Ringwald 555ef5ad9d6SMilanka Ringwald if (packet_type != HCI_EVENT_PACKET) return; 556ef5ad9d6SMilanka Ringwald if (hci_event_packet_get_type(packet) != HCI_EVENT_A2DP_META) return; 557cfd2437eSMatthias Ringwald 558cfd2437eSMatthias Ringwald switch (hci_event_a2dp_meta_get_subevent_code(packet)){ 55963331bf4SMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_CONNECTION_ESTABLISHED: 56063331bf4SMilanka Ringwald a2dp_subevent_signaling_connection_established_get_bd_addr(packet, address); 56163331bf4SMilanka Ringwald cid = a2dp_subevent_signaling_connection_established_get_a2dp_cid(packet); 562292a51b3SMilanka Ringwald status = a2dp_subevent_signaling_connection_established_get_status(packet); 56310b7d8c3SMilanka Ringwald 564292a51b3SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 565292a51b3SMilanka Ringwald printf("A2DP Source: Connection failed, status 0x%02x, cid 0x%02x, a2dp_cid 0x%02x \n", status, cid, media_tracker.a2dp_cid); 566292a51b3SMilanka Ringwald media_tracker.a2dp_cid = 0; 56710b7d8c3SMilanka Ringwald break; 56810b7d8c3SMilanka Ringwald } 569292a51b3SMilanka Ringwald media_tracker.a2dp_cid = cid; 570f3eb7114SMilanka Ringwald media_tracker.volume = 32; 57130bfaab1SMilanka Ringwald 572f3eb7114SMilanka Ringwald printf("A2DP Source: Connected to address %s, a2dp cid 0x%02x, local seid 0x%02x.\n", bd_addr_to_str(address), media_tracker.a2dp_cid, media_tracker.local_seid); 5735448c259SMilanka Ringwald break; 57410b7d8c3SMilanka Ringwald 57510b7d8c3SMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_MEDIA_CODEC_SBC_CONFIGURATION:{ 57662faac7eSMilanka Ringwald cid = avdtp_subevent_signaling_media_codec_sbc_configuration_get_avdtp_cid(packet); 57762faac7eSMilanka Ringwald if (cid != media_tracker.a2dp_cid) return; 578f3eb7114SMilanka Ringwald 579b12cd5a6SMilanka Ringwald media_tracker.remote_seid = a2dp_subevent_signaling_media_codec_sbc_configuration_get_acp_seid(packet); 58062faac7eSMilanka Ringwald 58110b7d8c3SMilanka Ringwald sbc_configuration.reconfigure = a2dp_subevent_signaling_media_codec_sbc_configuration_get_reconfigure(packet); 58210b7d8c3SMilanka Ringwald sbc_configuration.num_channels = a2dp_subevent_signaling_media_codec_sbc_configuration_get_num_channels(packet); 58310b7d8c3SMilanka Ringwald sbc_configuration.sampling_frequency = a2dp_subevent_signaling_media_codec_sbc_configuration_get_sampling_frequency(packet); 58410b7d8c3SMilanka Ringwald sbc_configuration.channel_mode = a2dp_subevent_signaling_media_codec_sbc_configuration_get_channel_mode(packet); 58510b7d8c3SMilanka Ringwald sbc_configuration.block_length = a2dp_subevent_signaling_media_codec_sbc_configuration_get_block_length(packet); 58610b7d8c3SMilanka Ringwald sbc_configuration.subbands = a2dp_subevent_signaling_media_codec_sbc_configuration_get_subbands(packet); 58710b7d8c3SMilanka Ringwald sbc_configuration.allocation_method = a2dp_subevent_signaling_media_codec_sbc_configuration_get_allocation_method(packet); 58810b7d8c3SMilanka Ringwald sbc_configuration.min_bitpool_value = a2dp_subevent_signaling_media_codec_sbc_configuration_get_min_bitpool_value(packet); 58910b7d8c3SMilanka Ringwald sbc_configuration.max_bitpool_value = a2dp_subevent_signaling_media_codec_sbc_configuration_get_max_bitpool_value(packet); 59010b7d8c3SMilanka Ringwald sbc_configuration.frames_per_buffer = sbc_configuration.subbands * sbc_configuration.block_length; 591f3eb7114SMilanka Ringwald printf("A2DP Source: Received SBC codec configuration, sampling frequency %u, a2dp_cid 0x%02x, local seid 0x%02x, remote seid 0x%02x.\n", 592ab97bf5bSMilanka Ringwald sbc_configuration.sampling_frequency, cid, 593ab97bf5bSMilanka Ringwald a2dp_subevent_signaling_media_codec_sbc_configuration_get_int_seid(packet), 594f3eb7114SMilanka Ringwald a2dp_subevent_signaling_media_codec_sbc_configuration_get_acp_seid(packet)); 59510b7d8c3SMilanka Ringwald 596b5858f2dSMilanka Ringwald // Adapt Bluetooth spec definition to SBC Encoder expected input 597b5858f2dSMilanka Ringwald sbc_configuration.allocation_method -= 1; 598b5858f2dSMilanka Ringwald sbc_configuration.num_channels = 2; 599b5858f2dSMilanka Ringwald switch (sbc_configuration.channel_mode){ 600b5858f2dSMilanka Ringwald case AVDTP_SBC_JOINT_STEREO: 601b5858f2dSMilanka Ringwald sbc_configuration.channel_mode = 3; 602b5858f2dSMilanka Ringwald break; 603b5858f2dSMilanka Ringwald case AVDTP_SBC_STEREO: 604b5858f2dSMilanka Ringwald sbc_configuration.channel_mode = 2; 605b5858f2dSMilanka Ringwald break; 606b5858f2dSMilanka Ringwald case AVDTP_SBC_DUAL_CHANNEL: 607b5858f2dSMilanka Ringwald sbc_configuration.channel_mode = 1; 608b5858f2dSMilanka Ringwald break; 609b5858f2dSMilanka Ringwald case AVDTP_SBC_MONO: 610b5858f2dSMilanka Ringwald sbc_configuration.channel_mode = 0; 611b5858f2dSMilanka Ringwald sbc_configuration.num_channels = 1; 612b5858f2dSMilanka Ringwald break; 613b5858f2dSMilanka Ringwald } 614b5858f2dSMilanka Ringwald dump_sbc_configuration(&sbc_configuration); 615b5858f2dSMilanka Ringwald 61610b7d8c3SMilanka Ringwald btstack_sbc_encoder_init(&sbc_encoder_state, SBC_MODE_STANDARD, 61710b7d8c3SMilanka Ringwald sbc_configuration.block_length, sbc_configuration.subbands, 61810b7d8c3SMilanka Ringwald sbc_configuration.allocation_method, sbc_configuration.sampling_frequency, 61910b7d8c3SMilanka Ringwald sbc_configuration.max_bitpool_value, 62010b7d8c3SMilanka Ringwald sbc_configuration.channel_mode); 62110b7d8c3SMilanka Ringwald break; 62210b7d8c3SMilanka Ringwald } 62310b7d8c3SMilanka Ringwald 62462faac7eSMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_DELAY_REPORTING_CAPABILITY: 625b12cd5a6SMilanka Ringwald printf("A2DP Source: remote supports delay report, remote seid %d\n", 626b12cd5a6SMilanka Ringwald avdtp_subevent_signaling_delay_reporting_capability_get_remote_seid(packet)); 62762faac7eSMilanka Ringwald break; 62862faac7eSMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_CAPABILITIES_DONE: 629b12cd5a6SMilanka Ringwald printf("A2DP Source: All capabilities reported, remote seid %d\n", 630b12cd5a6SMilanka Ringwald avdtp_subevent_signaling_capabilities_done_get_remote_seid(packet)); 63162faac7eSMilanka Ringwald break; 63262faac7eSMilanka Ringwald 6338b94010eSMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_DELAY_REPORT: 63462faac7eSMilanka Ringwald printf("A2DP Source: Received delay report of %d.%0d ms, local seid %d\n", 6358b94010eSMilanka Ringwald avdtp_subevent_signaling_delay_report_get_delay_100us(packet)/10, avdtp_subevent_signaling_delay_report_get_delay_100us(packet)%10, 6368b94010eSMilanka Ringwald avdtp_subevent_signaling_delay_report_get_local_seid(packet)); 6378b94010eSMilanka Ringwald break; 6388b94010eSMilanka Ringwald 63967673f1cSMilanka Ringwald case A2DP_SUBEVENT_STREAM_ESTABLISHED: 640ef5ad9d6SMilanka Ringwald a2dp_subevent_stream_established_get_bd_addr(packet, address); 64167673f1cSMilanka Ringwald status = a2dp_subevent_stream_established_get_status(packet); 64267673f1cSMilanka Ringwald if (status){ 643292a51b3SMilanka Ringwald printf("A2DP Source: Stream failed, status 0x%02x.\n", status); 64467673f1cSMilanka Ringwald break; 64567673f1cSMilanka Ringwald } 646ab97bf5bSMilanka Ringwald 64767673f1cSMilanka Ringwald local_seid = a2dp_subevent_stream_established_get_local_seid(packet); 648ab97bf5bSMilanka Ringwald cid = a2dp_subevent_stream_established_get_a2dp_cid(packet); 649ab97bf5bSMilanka Ringwald 650f3eb7114SMilanka Ringwald printf("A2DP Source: Stream established a2dp_cid 0x%02x, local_seid 0x%02x, remote_seid 0x%02x\n", cid, local_seid, a2dp_subevent_stream_established_get_remote_seid(packet)); 651f3eb7114SMilanka Ringwald 652f3eb7114SMilanka Ringwald a2dp_demo_hexcmod_configure_sample_rate(current_sample_rate); 65363331bf4SMilanka Ringwald media_tracker.stream_opened = 1; 6545448c259SMilanka Ringwald data_source = STREAM_MOD; 6555448c259SMilanka Ringwald status = a2dp_source_start_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 65667673f1cSMilanka Ringwald break; 65767673f1cSMilanka Ringwald 658cfd2437eSMatthias Ringwald case A2DP_SUBEVENT_STREAM_RECONFIGURED: 659cfd2437eSMatthias Ringwald status = a2dp_subevent_stream_reconfigured_get_status(packet); 660ab97bf5bSMilanka Ringwald local_seid = a2dp_subevent_stream_reconfigured_get_local_seid(packet); 661ab97bf5bSMilanka Ringwald cid = a2dp_subevent_stream_reconfigured_get_a2dp_cid(packet); 662ab97bf5bSMilanka Ringwald 663f3eb7114SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 664f3eb7114SMilanka Ringwald printf("A2DP Source: Stream reconfiguration failed with status 0x%02x\n", status); 665f3eb7114SMilanka Ringwald break; 666f3eb7114SMilanka Ringwald } 667f3eb7114SMilanka Ringwald 668f3eb7114SMilanka Ringwald printf("A2DP Source: Stream reconfigured a2dp_cid 0x%02x, local_seid 0x%02x\n", cid, local_seid); 669f3eb7114SMilanka Ringwald a2dp_demo_hexcmod_configure_sample_rate(new_sample_rate); 670f3eb7114SMilanka Ringwald status = a2dp_source_start_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 671cfd2437eSMatthias Ringwald break; 672cfd2437eSMatthias Ringwald 67367673f1cSMilanka Ringwald case A2DP_SUBEVENT_STREAM_STARTED: 674ab97bf5bSMilanka Ringwald local_seid = a2dp_subevent_stream_started_get_local_seid(packet); 675ab97bf5bSMilanka Ringwald cid = a2dp_subevent_stream_started_get_a2dp_cid(packet); 676ab97bf5bSMilanka Ringwald 677d1207cd8SMilanka Ringwald play_info.status = AVRCP_PLAYBACK_STATUS_PLAYING; 678292a51b3SMilanka Ringwald if (media_tracker.avrcp_cid){ 679292a51b3SMilanka Ringwald avrcp_target_set_now_playing_info(media_tracker.avrcp_cid, &tracks[data_source], sizeof(tracks)/sizeof(avrcp_track_t)); 680292a51b3SMilanka Ringwald avrcp_target_set_playback_status(media_tracker.avrcp_cid, AVRCP_PLAYBACK_STATUS_PLAYING); 68163331bf4SMilanka Ringwald } 68267673f1cSMilanka Ringwald a2dp_demo_timer_start(&media_tracker); 683f3eb7114SMilanka Ringwald printf("A2DP Source: Stream started, a2dp_cid 0x%02x, local_seid 0x%02x\n", cid, local_seid); 68467673f1cSMilanka Ringwald break; 68567673f1cSMilanka Ringwald 68667673f1cSMilanka Ringwald case A2DP_SUBEVENT_STREAMING_CAN_SEND_MEDIA_PACKET_NOW: 687ab97bf5bSMilanka Ringwald local_seid = a2dp_subevent_streaming_can_send_media_packet_now_get_local_seid(packet); 688ab97bf5bSMilanka Ringwald cid = a2dp_subevent_signaling_media_codec_sbc_configuration_get_a2dp_cid(packet); 68967673f1cSMilanka Ringwald a2dp_demo_send_media_packet(); 69067673f1cSMilanka Ringwald break; 69167673f1cSMilanka Ringwald 69267673f1cSMilanka Ringwald case A2DP_SUBEVENT_STREAM_SUSPENDED: 693ab97bf5bSMilanka Ringwald local_seid = a2dp_subevent_stream_suspended_get_local_seid(packet); 694ab97bf5bSMilanka Ringwald cid = a2dp_subevent_stream_suspended_get_a2dp_cid(packet); 695ab97bf5bSMilanka Ringwald 696d1207cd8SMilanka Ringwald play_info.status = AVRCP_PLAYBACK_STATUS_PAUSED; 697292a51b3SMilanka Ringwald if (media_tracker.avrcp_cid){ 698292a51b3SMilanka Ringwald avrcp_target_set_playback_status(media_tracker.avrcp_cid, AVRCP_PLAYBACK_STATUS_PAUSED); 69963331bf4SMilanka Ringwald } 700f3eb7114SMilanka Ringwald printf("A2DP Source: Stream paused, a2dp_cid 0x%02x, local_seid 0x%02x\n", cid, local_seid); 701ab97bf5bSMilanka Ringwald 702b583bd52SMilanka Ringwald a2dp_demo_timer_stop(&media_tracker); 70367673f1cSMilanka Ringwald break; 70467673f1cSMilanka Ringwald 70567673f1cSMilanka Ringwald case A2DP_SUBEVENT_STREAM_RELEASED: 706d1207cd8SMilanka Ringwald play_info.status = AVRCP_PLAYBACK_STATUS_STOPPED; 70763331bf4SMilanka Ringwald cid = a2dp_subevent_stream_released_get_a2dp_cid(packet); 708ab97bf5bSMilanka Ringwald local_seid = a2dp_subevent_stream_released_get_local_seid(packet); 709ab97bf5bSMilanka Ringwald 710f3eb7114SMilanka Ringwald printf("A2DP Source: Stream released, a2dp_cid 0x%02x, local_seid 0x%02x\n", cid, local_seid); 711ab97bf5bSMilanka Ringwald 71263331bf4SMilanka Ringwald if (cid == media_tracker.a2dp_cid) { 71363331bf4SMilanka Ringwald media_tracker.stream_opened = 0; 714292a51b3SMilanka Ringwald printf("A2DP Source: Stream released.\n"); 71563331bf4SMilanka Ringwald } 716292a51b3SMilanka Ringwald if (media_tracker.avrcp_cid){ 717292a51b3SMilanka Ringwald avrcp_target_set_now_playing_info(media_tracker.avrcp_cid, NULL, sizeof(tracks)/sizeof(avrcp_track_t)); 718292a51b3SMilanka Ringwald avrcp_target_set_playback_status(media_tracker.avrcp_cid, AVRCP_PLAYBACK_STATUS_STOPPED); 71963331bf4SMilanka Ringwald } 72067673f1cSMilanka Ringwald a2dp_demo_timer_stop(&media_tracker); 72167673f1cSMilanka Ringwald break; 72204cd6488SMilanka Ringwald case A2DP_SUBEVENT_SIGNALING_CONNECTION_RELEASED: 723d1207cd8SMilanka Ringwald cid = a2dp_subevent_signaling_connection_released_get_a2dp_cid(packet); 724d1207cd8SMilanka Ringwald if (cid == media_tracker.a2dp_cid) { 725292a51b3SMilanka Ringwald media_tracker.avrcp_cid = 0; 726d1207cd8SMilanka Ringwald media_tracker.a2dp_cid = 0; 727292a51b3SMilanka Ringwald printf("A2DP Source: Signaling released.\n\n"); 728d1207cd8SMilanka Ringwald } 72904cd6488SMilanka Ringwald break; 73067673f1cSMilanka Ringwald default: 73167673f1cSMilanka Ringwald break; 73267673f1cSMilanka Ringwald } 7333fb2c90bSMilanka Ringwald } 7343fb2c90bSMilanka Ringwald 735cee0e5b6SMilanka Ringwald static void avrcp_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 73601dc6e35SMilanka Ringwald UNUSED(channel); 73701dc6e35SMilanka Ringwald UNUSED(size); 73801dc6e35SMilanka Ringwald bd_addr_t event_addr; 73901dc6e35SMilanka Ringwald uint16_t local_cid; 740d1207cd8SMilanka Ringwald uint8_t status = ERROR_CODE_SUCCESS; 7413fb2c90bSMilanka Ringwald 74201dc6e35SMilanka Ringwald if (packet_type != HCI_EVENT_PACKET) return; 74301dc6e35SMilanka Ringwald if (hci_event_packet_get_type(packet) != HCI_EVENT_AVRCP_META) return; 744831d3fd5SMilanka Ringwald 74501dc6e35SMilanka Ringwald switch (packet[2]){ 746cee0e5b6SMilanka Ringwald case AVRCP_SUBEVENT_CONNECTION_ESTABLISHED: 74701dc6e35SMilanka Ringwald local_cid = avrcp_subevent_connection_established_get_avrcp_cid(packet); 748d1207cd8SMilanka Ringwald status = avrcp_subevent_connection_established_get_status(packet); 749d1207cd8SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 750b4505971SMilanka Ringwald printf("AVRCP: Connection failed, local cid 0x%02x, status 0x%02x\n", local_cid, status); 75101dc6e35SMilanka Ringwald return; 75201dc6e35SMilanka Ringwald } 753292a51b3SMilanka Ringwald media_tracker.avrcp_cid = local_cid; 75401dc6e35SMilanka Ringwald avrcp_subevent_connection_established_get_bd_addr(packet, event_addr); 755d1207cd8SMilanka Ringwald 756292a51b3SMilanka Ringwald avrcp_target_set_now_playing_info(media_tracker.avrcp_cid, NULL, sizeof(tracks)/sizeof(avrcp_track_t)); 757292a51b3SMilanka Ringwald avrcp_target_set_unit_info(media_tracker.avrcp_cid, AVRCP_SUBUNIT_TYPE_AUDIO, company_id); 758292a51b3SMilanka Ringwald avrcp_target_set_subunit_info(media_tracker.avrcp_cid, AVRCP_SUBUNIT_TYPE_AUDIO, (uint8_t *)subunit_info, sizeof(subunit_info)); 759cee0e5b6SMilanka Ringwald 7602ea2c5e5SMilanka Ringwald avrcp_controller_get_supported_events(media_tracker.avrcp_cid); 7612ea2c5e5SMilanka Ringwald 762cee0e5b6SMilanka Ringwald printf("AVRCP: Channel successfully opened: media_tracker.avrcp_cid 0x%02x\n", media_tracker.avrcp_cid); 76301dc6e35SMilanka Ringwald return; 764cee0e5b6SMilanka Ringwald 765cee0e5b6SMilanka Ringwald case AVRCP_SUBEVENT_CONNECTION_RELEASED: 766cee0e5b6SMilanka Ringwald printf("AVRCP Target: Disconnected, avrcp_cid 0x%02x\n", avrcp_subevent_connection_released_get_avrcp_cid(packet)); 767cee0e5b6SMilanka Ringwald media_tracker.avrcp_cid = 0; 768cee0e5b6SMilanka Ringwald return; 769cee0e5b6SMilanka Ringwald default: 770cee0e5b6SMilanka Ringwald break; 77101dc6e35SMilanka Ringwald } 772cee0e5b6SMilanka Ringwald 773cee0e5b6SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 774cee0e5b6SMilanka Ringwald printf("Responding to event 0x%02x failed with status 0x%02x\n", packet[2], status); 775cee0e5b6SMilanka Ringwald } 776cee0e5b6SMilanka Ringwald } 777cee0e5b6SMilanka Ringwald 778cee0e5b6SMilanka Ringwald static void avrcp_target_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 779cee0e5b6SMilanka Ringwald UNUSED(channel); 780cee0e5b6SMilanka Ringwald UNUSED(size); 781cee0e5b6SMilanka Ringwald uint8_t status = ERROR_CODE_SUCCESS; 782cee0e5b6SMilanka Ringwald 783cee0e5b6SMilanka Ringwald if (packet_type != HCI_EVENT_PACKET) return; 784cee0e5b6SMilanka Ringwald if (hci_event_packet_get_type(packet) != HCI_EVENT_AVRCP_META) return; 785cee0e5b6SMilanka Ringwald 786cee0e5b6SMilanka Ringwald switch (packet[2]){ 78750259306SMilanka Ringwald case AVRCP_SUBEVENT_NOTIFICATION_VOLUME_CHANGED: 78830bfaab1SMilanka Ringwald media_tracker.volume = avrcp_subevent_notification_volume_changed_get_absolute_volume(packet); 78930bfaab1SMilanka Ringwald printf("AVRCP Target: Volume set to %d%% (%d)\n", media_tracker.volume * 127/100, media_tracker.volume); 79050259306SMilanka Ringwald break; 791e0bbf3edSMilanka Ringwald case AVRCP_SUBEVENT_EVENT_IDS_QUERY: 792292a51b3SMilanka Ringwald status = avrcp_target_supported_events(media_tracker.avrcp_cid, events_num, events, sizeof(events)); 793e0bbf3edSMilanka Ringwald break; 794e0bbf3edSMilanka Ringwald case AVRCP_SUBEVENT_COMPANY_IDS_QUERY: 795292a51b3SMilanka Ringwald status = avrcp_target_supported_companies(media_tracker.avrcp_cid, companies_num, companies, sizeof(companies)); 796e0bbf3edSMilanka Ringwald break; 797c045af99SMilanka Ringwald case AVRCP_SUBEVENT_PLAY_STATUS_QUERY: 798292a51b3SMilanka Ringwald status = avrcp_target_play_status(media_tracker.avrcp_cid, play_info.song_length_ms, play_info.song_position_ms, play_info.status); 799c045af99SMilanka Ringwald break; 800d1207cd8SMilanka Ringwald // case AVRCP_SUBEVENT_NOW_PLAYING_INFO_QUERY: 801d1207cd8SMilanka Ringwald // status = avrcp_target_now_playing_info(avrcp_cid); 802d1207cd8SMilanka Ringwald // break; 803831d3fd5SMilanka Ringwald case AVRCP_SUBEVENT_OPERATION:{ 804831d3fd5SMilanka Ringwald avrcp_operation_id_t operation_id = avrcp_subevent_operation_get_operation_id(packet); 805831d3fd5SMilanka Ringwald switch (operation_id){ 806831d3fd5SMilanka Ringwald case AVRCP_OPERATION_ID_PLAY: 807292a51b3SMilanka Ringwald printf("AVRCP Target: PLAY\n"); 808d1207cd8SMilanka Ringwald status = a2dp_source_start_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 809831d3fd5SMilanka Ringwald break; 810831d3fd5SMilanka Ringwald case AVRCP_OPERATION_ID_PAUSE: 811292a51b3SMilanka Ringwald printf("AVRCP Target: PAUSE\n"); 812d1207cd8SMilanka Ringwald status = a2dp_source_pause_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 813831d3fd5SMilanka Ringwald break; 814831d3fd5SMilanka Ringwald case AVRCP_OPERATION_ID_STOP: 815292a51b3SMilanka Ringwald printf("AVRCP Target: STOP\n"); 816d1207cd8SMilanka Ringwald status = a2dp_source_disconnect(media_tracker.a2dp_cid); 817d1207cd8SMilanka Ringwald break; 818d1207cd8SMilanka Ringwald default: 819292a51b3SMilanka Ringwald printf("AVRCP Target: operation 0x%2x is not handled\n", operation_id); 820831d3fd5SMilanka Ringwald return; 821831d3fd5SMilanka Ringwald } 822831d3fd5SMilanka Ringwald break; 823831d3fd5SMilanka Ringwald } 824cee0e5b6SMilanka Ringwald 82501dc6e35SMilanka Ringwald default: 82601dc6e35SMilanka Ringwald break; 82701dc6e35SMilanka Ringwald } 828d1207cd8SMilanka Ringwald 829d1207cd8SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 830d1207cd8SMilanka Ringwald printf("Responding to event 0x%02x failed with status 0x%02x\n", packet[2], status); 831d1207cd8SMilanka Ringwald } 83201dc6e35SMilanka Ringwald } 83301dc6e35SMilanka Ringwald 83450259306SMilanka Ringwald static void avrcp_controller_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 83550259306SMilanka Ringwald UNUSED(channel); 83650259306SMilanka Ringwald UNUSED(size); 83750259306SMilanka Ringwald uint8_t status = 0xFF; 83850259306SMilanka Ringwald 83950259306SMilanka Ringwald if (packet_type != HCI_EVENT_PACKET) return; 84050259306SMilanka Ringwald if (hci_event_packet_get_type(packet) != HCI_EVENT_AVRCP_META) return; 84150259306SMilanka Ringwald 84250259306SMilanka Ringwald status = packet[5]; 843cee0e5b6SMilanka Ringwald if (!media_tracker.avrcp_cid) return; 84450259306SMilanka Ringwald 84550259306SMilanka Ringwald // ignore INTERIM status 84650259306SMilanka Ringwald if (status == AVRCP_CTYPE_RESPONSE_INTERIM) return; 84750259306SMilanka Ringwald 84850259306SMilanka Ringwald switch (packet[2]){ 8492ea2c5e5SMilanka Ringwald case AVRCP_SUBEVENT_NOTIFICATION_VOLUME_CHANGED: 8502ea2c5e5SMilanka Ringwald printf("AVRCP Controller: notification absolute volume changed %d %%\n", avrcp_subevent_notification_volume_changed_get_absolute_volume(packet) * 100 / 127); 8512ea2c5e5SMilanka Ringwald break; 8522ea2c5e5SMilanka Ringwald case AVRCP_SUBEVENT_GET_CAPABILITY_EVENT_ID: 8532ea2c5e5SMilanka Ringwald printf("Remote supports EVENT_ID 0x%02x\n", avrcp_subevent_get_capability_event_id_get_event_id(packet)); 8542ea2c5e5SMilanka Ringwald break; 8552ea2c5e5SMilanka Ringwald case AVRCP_SUBEVENT_GET_CAPABILITY_EVENT_ID_DONE: 8562ea2c5e5SMilanka Ringwald printf("automatically enable notifications\n"); 8572ea2c5e5SMilanka Ringwald avrcp_controller_enable_notification(media_tracker.avrcp_cid, AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED); 8582ea2c5e5SMilanka Ringwald break; 85950259306SMilanka Ringwald default: 86050259306SMilanka Ringwald break; 86150259306SMilanka Ringwald } 86250259306SMilanka Ringwald } 86350259306SMilanka Ringwald 86401dc6e35SMilanka Ringwald #ifdef HAVE_BTSTACK_STDIN 8653fb2c90bSMilanka Ringwald static void show_usage(void){ 8663fb2c90bSMilanka Ringwald bd_addr_t iut_address; 8673fb2c90bSMilanka Ringwald gap_local_bd_addr(iut_address); 868fe10780bSMilanka Ringwald printf("\n--- Bluetooth A2DP Source/AVRCP Demo %s ---\n", bd_addr_to_str(iut_address)); 869cfd2437eSMatthias Ringwald printf("b - A2DP Source create connection to addr %s\n", device_addr_string); 870cfd2437eSMatthias Ringwald printf("B - A2DP Source disconnect\n"); 871fe10780bSMilanka Ringwald printf("c - AVRCP create connection to addr %s\n", device_addr_string); 872fe10780bSMilanka Ringwald printf("C - AVRCP disconnect\n"); 87301dc6e35SMilanka Ringwald 8743fb2c90bSMilanka Ringwald printf("x - start streaming sine\n"); 8753fb2c90bSMilanka Ringwald if (hxcmod_initialized){ 8763fb2c90bSMilanka Ringwald printf("z - start streaming '%s'\n", mod_name); 8773fb2c90bSMilanka Ringwald } 8783fb2c90bSMilanka Ringwald printf("p - pause streaming\n"); 879cfd2437eSMatthias Ringwald printf("w - reconfigure stream for 44100 Hz\n"); 880cfd2437eSMatthias Ringwald printf("e - reconfigure stream for 48000 Hz\n"); 88150259306SMilanka Ringwald printf("t - volume up\n"); 88250259306SMilanka Ringwald printf("T - volume down\n"); 88330bfaab1SMilanka Ringwald printf("v - volume up (via set absolute volume)\n"); 88430bfaab1SMilanka Ringwald printf("V - volume down (via set absolute volume)\n"); 88501dc6e35SMilanka Ringwald 8863fb2c90bSMilanka Ringwald printf("---\n"); 8873fb2c90bSMilanka Ringwald } 8883fb2c90bSMilanka Ringwald 8893fb2c90bSMilanka Ringwald static void stdin_process(char cmd){ 8904567cc17SMilanka Ringwald uint8_t status = ERROR_CODE_SUCCESS; 8913fb2c90bSMilanka Ringwald switch (cmd){ 89201dc6e35SMilanka Ringwald case 'b': 8934567cc17SMilanka Ringwald status = a2dp_source_establish_stream(device_addr, media_tracker.local_seid, &media_tracker.a2dp_cid); 894cfd2437eSMatthias Ringwald printf("%c - Create A2DP Source connection to addr %s, cid 0x%02x.\n", cmd, bd_addr_to_str(device_addr), media_tracker.a2dp_cid); 8953fb2c90bSMilanka Ringwald break; 89601dc6e35SMilanka Ringwald case 'B': 897cfd2437eSMatthias Ringwald printf("%c - A2DP Source Disconnect from cid 0x%2x\n", cmd, media_tracker.a2dp_cid); 8984567cc17SMilanka Ringwald status = a2dp_source_disconnect(media_tracker.a2dp_cid); 89901dc6e35SMilanka Ringwald break; 90001dc6e35SMilanka Ringwald case 'c': 901fe10780bSMilanka Ringwald printf("%c - Create AVRCP connection to addr %s.\n", cmd, bd_addr_to_str(device_addr)); 902fe10780bSMilanka Ringwald status = avrcp_connect(device_addr, &media_tracker.avrcp_cid); 90301dc6e35SMilanka Ringwald break; 90401dc6e35SMilanka Ringwald case 'C': 905fe10780bSMilanka Ringwald printf("%c - AVRCP disconnect\n", cmd); 906fe10780bSMilanka Ringwald status = avrcp_disconnect(media_tracker.avrcp_cid); 90701dc6e35SMilanka Ringwald break; 90801dc6e35SMilanka Ringwald 90901dc6e35SMilanka Ringwald case '\n': 91001dc6e35SMilanka Ringwald case '\r': 91101dc6e35SMilanka Ringwald break; 91201dc6e35SMilanka Ringwald 91350259306SMilanka Ringwald case 't': 91450259306SMilanka Ringwald printf(" - volume up\n"); 915cee0e5b6SMilanka Ringwald status = avrcp_controller_volume_up(media_tracker.avrcp_cid); 91650259306SMilanka Ringwald break; 91750259306SMilanka Ringwald case 'T': 91850259306SMilanka Ringwald printf(" - volume down\n"); 919cee0e5b6SMilanka Ringwald status = avrcp_controller_volume_down(media_tracker.avrcp_cid); 92050259306SMilanka Ringwald break; 92130bfaab1SMilanka Ringwald 922f55e1e38SMilanka Ringwald case 'v': 92330bfaab1SMilanka Ringwald if (media_tracker.volume > 117){ 92430bfaab1SMilanka Ringwald media_tracker.volume = 127; 92530bfaab1SMilanka Ringwald } else { 92630bfaab1SMilanka Ringwald media_tracker.volume += 10; 92730bfaab1SMilanka Ringwald } 92830bfaab1SMilanka Ringwald printf(" - volume up (via set absolute volume) %d%% (%d)\n", media_tracker.volume * 127/100, media_tracker.volume); 92930bfaab1SMilanka Ringwald status = avrcp_controller_set_absolute_volume(media_tracker.avrcp_cid, media_tracker.volume); 93030bfaab1SMilanka Ringwald break; 93130bfaab1SMilanka Ringwald case 'V': 93230bfaab1SMilanka Ringwald if (media_tracker.volume < 10){ 93330bfaab1SMilanka Ringwald media_tracker.volume = 0; 93430bfaab1SMilanka Ringwald } else { 93530bfaab1SMilanka Ringwald media_tracker.volume -= 10; 93630bfaab1SMilanka Ringwald } 93730bfaab1SMilanka Ringwald printf(" - volume down (via set absolute volume) %d%% (%d)\n", media_tracker.volume * 127/100, media_tracker.volume); 93830bfaab1SMilanka Ringwald status = avrcp_controller_set_absolute_volume(media_tracker.avrcp_cid, media_tracker.volume); 939f55e1e38SMilanka Ringwald break; 94050259306SMilanka Ringwald 9413fb2c90bSMilanka Ringwald case 'x': 942292a51b3SMilanka Ringwald if (media_tracker.avrcp_cid){ 943292a51b3SMilanka Ringwald avrcp_target_set_now_playing_info(media_tracker.avrcp_cid, &tracks[data_source], sizeof(tracks)/sizeof(avrcp_track_t)); 94463331bf4SMilanka Ringwald } 945bae8745cSMilanka Ringwald printf("%c - Play sine.\n", cmd); 9463fb2c90bSMilanka Ringwald data_source = STREAM_SINE; 94763331bf4SMilanka Ringwald if (!media_tracker.stream_opened) break; 9484567cc17SMilanka Ringwald status = a2dp_source_start_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 9493fb2c90bSMilanka Ringwald break; 9503fb2c90bSMilanka Ringwald case 'z': 951292a51b3SMilanka Ringwald if (media_tracker.avrcp_cid){ 952292a51b3SMilanka Ringwald avrcp_target_set_now_playing_info(media_tracker.avrcp_cid, &tracks[data_source], sizeof(tracks)/sizeof(avrcp_track_t)); 95363331bf4SMilanka Ringwald } 954bae8745cSMilanka Ringwald printf("%c - Play mod.\n", cmd); 9553fb2c90bSMilanka Ringwald data_source = STREAM_MOD; 95663331bf4SMilanka Ringwald if (!media_tracker.stream_opened) break; 9574567cc17SMilanka Ringwald status = a2dp_source_start_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 9583fb2c90bSMilanka Ringwald break; 959578eda3eSMilanka Ringwald 9603fb2c90bSMilanka Ringwald case 'p': 961578eda3eSMilanka Ringwald if (!media_tracker.stream_opened) break; 962bae8745cSMilanka Ringwald printf("%c - Pause stream.\n", cmd); 9634567cc17SMilanka Ringwald status = a2dp_source_pause_stream(media_tracker.a2dp_cid, media_tracker.local_seid); 9643fb2c90bSMilanka Ringwald break; 965578eda3eSMilanka Ringwald 966cfd2437eSMatthias Ringwald case 'w': 967cfd2437eSMatthias Ringwald if (!media_tracker.stream_opened) break; 968cfd2437eSMatthias Ringwald if (play_info.status == AVRCP_PLAYBACK_STATUS_PLAYING){ 969cfd2437eSMatthias Ringwald printf("Stream cannot be reconfigured while playing, please pause stream first\n"); 970cfd2437eSMatthias Ringwald break; 971cfd2437eSMatthias Ringwald } 972f3eb7114SMilanka Ringwald new_sample_rate = 44100; 973f3eb7114SMilanka Ringwald if (current_sample_rate == new_sample_rate){ 974f3eb7114SMilanka Ringwald printf("%c - Stream already configured for %d Hz.\n", cmd, new_sample_rate); 975f3eb7114SMilanka Ringwald } else { 976f3eb7114SMilanka Ringwald printf("%c - Reconfigure for %d Hz.\n", cmd, new_sample_rate); 977f3eb7114SMilanka Ringwald status = a2dp_source_reconfigure_stream_sampling_frequency(media_tracker.a2dp_cid, new_sample_rate); 97844547c84SMilanka Ringwald } 979cfd2437eSMatthias Ringwald break; 980cfd2437eSMatthias Ringwald 981cfd2437eSMatthias Ringwald case 'e': 982cfd2437eSMatthias Ringwald if (!media_tracker.stream_opened) break; 983cfd2437eSMatthias Ringwald if (play_info.status == AVRCP_PLAYBACK_STATUS_PLAYING){ 984cfd2437eSMatthias Ringwald printf("Stream cannot be reconfigured while playing, please pause stream first\n"); 985cfd2437eSMatthias Ringwald break; 986cfd2437eSMatthias Ringwald } 987f3eb7114SMilanka Ringwald new_sample_rate = 48000; 988f3eb7114SMilanka Ringwald if (current_sample_rate == new_sample_rate){ 989f3eb7114SMilanka Ringwald printf("%c - Stream already configured for %d Hz.\n", cmd, new_sample_rate); 990f3eb7114SMilanka Ringwald } else { 991f3eb7114SMilanka Ringwald printf("%c - Reconfigure for %d Hz.\n", cmd, new_sample_rate); 992f3eb7114SMilanka Ringwald status = a2dp_source_reconfigure_stream_sampling_frequency(media_tracker.a2dp_cid, new_sample_rate); 99344547c84SMilanka Ringwald } 994cfd2437eSMatthias Ringwald break; 995cfd2437eSMatthias Ringwald 9963fb2c90bSMilanka Ringwald default: 9973fb2c90bSMilanka Ringwald show_usage(); 9984567cc17SMilanka Ringwald return; 9994567cc17SMilanka Ringwald } 10004567cc17SMilanka Ringwald if (status != ERROR_CODE_SUCCESS){ 1001b4505971SMilanka Ringwald printf("Could not perform command \'%c\', status 0x%02x\n", cmd, status); 10023fb2c90bSMilanka Ringwald } 10033fb2c90bSMilanka Ringwald } 10043fb2c90bSMilanka Ringwald #endif 10053fb2c90bSMilanka Ringwald 10063fb2c90bSMilanka Ringwald 10073fb2c90bSMilanka Ringwald int btstack_main(int argc, const char * argv[]); 10083fb2c90bSMilanka Ringwald int btstack_main(int argc, const char * argv[]){ 10094dc98401SMilanka Ringwald (void)argc; 10103fb2c90bSMilanka Ringwald (void)argv; 10113fb2c90bSMilanka Ringwald 10126fa8d4c7SMilanka Ringwald int err = a2dp_source_and_avrcp_services_init(); 10136fa8d4c7SMilanka Ringwald if (err) return err; 101467673f1cSMilanka Ringwald // turn on! 101567673f1cSMilanka Ringwald hci_power_control(HCI_POWER_ON); 10163fb2c90bSMilanka Ringwald return 0; 10173fb2c90bSMilanka Ringwald } 10184dc98401SMilanka Ringwald /* EXAMPLE_END */ 1019