xref: /btstack/example/a2dp_source_demo.c (revision 1b9946863a521f5bd2d927f705ae1483d0394098)
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