1
2 /*
3 * Copyright (C) 2016 BlueKitchen GmbH
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. Neither the name of the copyright holders nor the names of
15 * contributors may be used to endorse or promote products derived
16 * from this software without specific prior written permission.
17 * 4. Any redistribution, use, or modification is done solely for
18 * personal benefit and not for any commercial purpose or for
19 * monetary gain.
20 *
21 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
22 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
25 * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
28 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
29 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
30 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
31 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
33 *
34 * Please inquire about commercial licensing options at
35 * [email protected]
36 *
37 */
38
39 /**
40 * Supported use cases:
41 * - single incoming connection: sep discovery starts and stream will get setup if remote sink sep with SBC is found
42 * - single outgoing connection: see above
43 * - outgoing and incoming connection to same device:
44 * - if outgoing is triggered first, incoming will get ignored.
45 * - if incoming starts first, start ougoing will fail, but incoming will succeed.
46 * - outgoing and incoming connections to different devices:
47 * - if outgoing is first, incoming gets ignored.
48 * - if incoming starts first SEP discovery will get stopped and outgoing will succeed.
49 */
50
51 #define BTSTACK_FILE__ "a2dp_source.c"
52
53 #include <stdint.h>
54 #include <string.h>
55
56 #include "bluetooth_psm.h"
57 #include "bluetooth_sdp.h"
58 #include "btstack_debug.h"
59 #include "btstack_event.h"
60 #include "classic/a2dp.h"
61 #include "classic/a2dp_source.h"
62 #include "classic/avdtp_source.h"
63 #include "classic/avdtp_util.h"
64 #include "classic/sdp_util.h"
65 #include "l2cap.h"
66 #include "a2dp.h"
67
68 static const char * a2dp_source_default_service_name = "BTstack A2DP Source Service";
69 static const char * a2dp_default_source_service_provider_name = "BTstack A2DP Source Service Provider";
70
71 static uint8_t (*a2dp_source_media_config_validator)(const avdtp_stream_endpoint_t * stream_endpoint, const uint8_t * event, uint16_t size);
72
a2dp_source_create_sdp_record(uint8_t * service,uint32_t service_record_handle,uint16_t supported_features,const char * service_name,const char * service_provider_name)73 void a2dp_source_create_sdp_record(uint8_t * service, uint32_t service_record_handle, uint16_t supported_features, const char * service_name, const char * service_provider_name){
74 if (service_provider_name == NULL){
75 service_provider_name = a2dp_default_source_service_provider_name;
76 }
77 if (service_name == NULL){
78 service_name = a2dp_source_default_service_name;
79 }
80 a2dp_create_sdp_record(service, service_record_handle, BLUETOOTH_SERVICE_CLASS_AUDIO_SOURCE,
81 supported_features, service_name, service_provider_name);
82 }
83
a2dp_source_packet_handler_internal(uint8_t packet_type,uint16_t channel,uint8_t * packet,uint16_t size)84 static void a2dp_source_packet_handler_internal(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
85 UNUSED(channel);
86 UNUSED(size);
87
88 if (packet_type != HCI_EVENT_PACKET) return;
89 if (hci_event_packet_get_type(packet) != HCI_EVENT_AVDTP_META) return;
90
91 switch (hci_event_avdtp_meta_get_subevent_code(packet)){
92
93 case AVDTP_SUBEVENT_SIGNALING_DELAY_REPORT:
94 a2dp_replace_subevent_id_and_emit_source(packet, size, A2DP_SUBEVENT_SIGNALING_DELAY_REPORT);
95 break;
96
97 case AVDTP_SUBEVENT_STREAMING_CAN_SEND_MEDIA_PACKET_NOW:
98 a2dp_replace_subevent_id_and_emit_source(packet, size, A2DP_SUBEVENT_STREAMING_CAN_SEND_MEDIA_PACKET_NOW);
99 break;
100
101 default:
102 // forward events to config process
103 a2dp_config_process_avdtp_event_handler(AVDTP_ROLE_SOURCE, packet, size);
104 break;
105 }
106 }
a2dp_source_register_packet_handler(btstack_packet_handler_t callback)107 void a2dp_source_register_packet_handler(btstack_packet_handler_t callback){
108 btstack_assert(callback != NULL);
109
110 avdtp_source_register_packet_handler(&a2dp_source_packet_handler_internal);
111 a2dp_register_source_packet_handler(callback);
112 }
113
a2dp_source_init(void)114 void a2dp_source_init(void){
115 a2dp_init();
116 avdtp_source_init();
117 }
118
a2dp_source_deinit(void)119 void a2dp_source_deinit(void){
120 a2dp_deinit();
121 avdtp_source_deinit();
122 a2dp_source_media_config_validator = NULL;
123 }
124
a2dp_source_create_stream_endpoint(avdtp_media_type_t media_type,avdtp_media_codec_type_t media_codec_type,const uint8_t * codec_capabilities,uint16_t codec_capabilities_len,uint8_t * codec_configuration,uint16_t codec_configuration_len)125 avdtp_stream_endpoint_t * a2dp_source_create_stream_endpoint(avdtp_media_type_t media_type, avdtp_media_codec_type_t media_codec_type,
126 const uint8_t *codec_capabilities, uint16_t codec_capabilities_len,
127 uint8_t * codec_configuration, uint16_t codec_configuration_len){
128 avdtp_stream_endpoint_t * stream_endpoint = avdtp_source_create_stream_endpoint(AVDTP_SOURCE, media_type);
129 if (!stream_endpoint){
130 return NULL;
131 }
132 avdtp_source_register_media_transport_category(avdtp_stream_endpoint_seid(stream_endpoint));
133 avdtp_source_register_media_codec_category(avdtp_stream_endpoint_seid(stream_endpoint), media_type, media_codec_type,
134 codec_capabilities, codec_capabilities_len);
135 avdtp_source_register_delay_reporting_category(avdtp_stream_endpoint_seid(stream_endpoint));
136
137 // store user codec configuration buffer
138 stream_endpoint->media_codec_type = media_codec_type;
139 stream_endpoint->media_codec_configuration_info = codec_configuration;
140 stream_endpoint->media_codec_configuration_len = codec_configuration_len;
141
142 return stream_endpoint;
143 }
144
a2dp_source_finalize_stream_endpoint(avdtp_stream_endpoint_t * stream_endpoint)145 void a2dp_source_finalize_stream_endpoint(avdtp_stream_endpoint_t * stream_endpoint){
146 avdtp_source_finalize_stream_endpoint(stream_endpoint);
147 }
148
a2dp_source_establish_stream(bd_addr_t remote_addr,uint16_t * avdtp_cid)149 uint8_t a2dp_source_establish_stream(bd_addr_t remote_addr, uint16_t *avdtp_cid) {
150
151 uint16_t outgoing_cid;
152
153 avdtp_connection_t * connection = avdtp_get_connection_for_bd_addr(remote_addr);
154 if (connection == NULL){
155 uint8_t status = avdtp_source_connect(remote_addr, &outgoing_cid);
156 if (status != ERROR_CODE_SUCCESS) {
157 // if there's already a connection for for remote addr, avdtp_source_connect fails,
158 // but the stream will get set-up nevertheless
159 return status;
160 }
161 connection = avdtp_get_connection_for_avdtp_cid(outgoing_cid);
162 btstack_assert(connection != NULL);
163
164 // setup state
165 connection->a2dp_source_config_process.outgoing_active = true;
166 connection->a2dp_source_config_process.state = A2DP_W4_CONNECTED;
167 *avdtp_cid = outgoing_cid;
168
169 } else {
170 if (connection->a2dp_source_config_process.outgoing_active || connection->a2dp_source_config_process.stream_endpoint_configured) {
171 return ERROR_CODE_COMMAND_DISALLOWED;
172 }
173
174 // check state
175 switch (connection->a2dp_source_config_process.state){
176 case A2DP_IDLE:
177 case A2DP_CONNECTED:
178 // restart process e.g. if there no suitable stream endpoints or they had been in use
179 connection->a2dp_source_config_process.outgoing_active = true;
180 *avdtp_cid = connection->avdtp_cid;
181 a2dp_config_process_ready_for_sep_discovery(AVDTP_ROLE_SOURCE, connection);
182 break;
183 default:
184 return ERROR_CODE_COMMAND_DISALLOWED;
185 }
186 }
187 return ERROR_CODE_SUCCESS;
188 }
189
a2dp_source_disconnect(uint16_t avdtp_cid)190 uint8_t a2dp_source_disconnect(uint16_t avdtp_cid){
191 return avdtp_disconnect(avdtp_cid);
192 }
193
a2dp_source_start_stream(uint16_t avdtp_cid,uint8_t local_seid)194 uint8_t a2dp_source_start_stream(uint16_t avdtp_cid, uint8_t local_seid){
195 return avdtp_start_stream(avdtp_cid, local_seid);
196 }
197
a2dp_source_pause_stream(uint16_t avdtp_cid,uint8_t local_seid)198 uint8_t a2dp_source_pause_stream(uint16_t avdtp_cid, uint8_t local_seid){
199 return avdtp_suspend_stream(avdtp_cid, local_seid);
200 }
201
a2dp_source_stream_endpoint_request_can_send_now(uint16_t avdtp_cid,uint8_t local_seid)202 void a2dp_source_stream_endpoint_request_can_send_now(uint16_t avdtp_cid, uint8_t local_seid){
203 avdtp_source_stream_endpoint_request_can_send_now(avdtp_cid, local_seid);
204 }
205
a2dp_max_media_payload_size(uint16_t avdtp_cid,uint8_t local_seid)206 int a2dp_max_media_payload_size(uint16_t avdtp_cid, uint8_t local_seid){
207 return avdtp_max_media_payload_size(avdtp_cid, local_seid);
208 }
209
210 uint8_t
a2dp_source_stream_send_media_payload_rtp(uint16_t a2dp_cid,uint8_t local_seid,uint8_t marker,uint32_t timestamp,uint8_t * payload,uint16_t payload_size)211 a2dp_source_stream_send_media_payload_rtp(uint16_t a2dp_cid, uint8_t local_seid, uint8_t marker, uint32_t timestamp,
212 uint8_t *payload, uint16_t payload_size) {
213 return avdtp_source_stream_send_media_payload_rtp(a2dp_cid, local_seid, marker, timestamp, payload, payload_size);
214 }
215
a2dp_source_stream_send_media_packet(uint16_t a2dp_cid,uint8_t local_seid,const uint8_t * packet,uint16_t size)216 uint8_t a2dp_source_stream_send_media_packet(uint16_t a2dp_cid, uint8_t local_seid, const uint8_t * packet, uint16_t size){
217 return avdtp_source_stream_send_media_packet(a2dp_cid, local_seid, packet, size);
218 }
219
220
a2dp_source_set_config_sbc(uint16_t a2dp_cid,uint8_t local_seid,uint8_t remote_seid,const avdtp_configuration_sbc_t * configuration)221 uint8_t a2dp_source_set_config_sbc(uint16_t a2dp_cid, uint8_t local_seid, uint8_t remote_seid, const avdtp_configuration_sbc_t * configuration){
222 return a2dp_config_process_set_sbc(AVDTP_ROLE_SOURCE, a2dp_cid, local_seid, remote_seid, configuration);
223 }
224
a2dp_source_set_config_mpeg_audio(uint16_t a2dp_cid,uint8_t local_seid,uint8_t remote_seid,const avdtp_configuration_mpeg_audio_t * configuration)225 uint8_t a2dp_source_set_config_mpeg_audio(uint16_t a2dp_cid, uint8_t local_seid, uint8_t remote_seid, const avdtp_configuration_mpeg_audio_t * configuration){
226 return a2dp_config_process_set_mpeg_audio(AVDTP_ROLE_SOURCE, a2dp_cid, local_seid, remote_seid, configuration);
227 }
228
a2dp_source_set_config_mpeg_aac(uint16_t a2dp_cid,uint8_t local_seid,uint8_t remote_seid,const avdtp_configuration_mpeg_aac_t * configuration)229 uint8_t a2dp_source_set_config_mpeg_aac(uint16_t a2dp_cid, uint8_t local_seid, uint8_t remote_seid, const avdtp_configuration_mpeg_aac_t * configuration){
230 return a2dp_config_process_set_mpeg_aac(AVDTP_ROLE_SOURCE, a2dp_cid, local_seid, remote_seid, configuration);
231 }
232
a2dp_source_set_config_atrac(uint16_t a2dp_cid,uint8_t local_seid,uint8_t remote_seid,const avdtp_configuration_atrac_t * configuration)233 uint8_t a2dp_source_set_config_atrac(uint16_t a2dp_cid, uint8_t local_seid, uint8_t remote_seid, const avdtp_configuration_atrac_t * configuration){
234 return a2dp_config_process_set_atrac(AVDTP_ROLE_SOURCE, a2dp_cid, local_seid, remote_seid, configuration);
235 }
236
a2dp_source_set_config_other(uint16_t a2dp_cid,uint8_t local_seid,uint8_t remote_seid,const uint8_t * media_codec_information,uint8_t media_codec_information_len)237 uint8_t a2dp_source_set_config_other(uint16_t a2dp_cid, uint8_t local_seid, uint8_t remote_seid,
238 const uint8_t * media_codec_information, uint8_t media_codec_information_len){
239 return a2dp_config_process_set_other(AVDTP_ROLE_SOURCE, a2dp_cid, local_seid, remote_seid, media_codec_information, media_codec_information_len);
240 }
241
a2dp_source_reconfigure_stream_sampling_frequency(uint16_t avdtp_cid,uint32_t sampling_frequency)242 uint8_t a2dp_source_reconfigure_stream_sampling_frequency(uint16_t avdtp_cid, uint32_t sampling_frequency){
243 avdtp_connection_t * connection = avdtp_get_connection_for_avdtp_cid(avdtp_cid);
244 if (connection == NULL){
245 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
246 }
247
248 if (connection->a2dp_source_config_process.state != A2DP_STREAMING_OPENED) {
249 return ERROR_CODE_COMMAND_DISALLOWED;
250 }
251
252 btstack_assert(connection->a2dp_source_config_process.local_stream_endpoint != NULL);
253
254 log_info("Reconfigure avdtp_cid 0x%02x", avdtp_cid);
255
256 avdtp_media_codec_type_t codec_type = connection->a2dp_source_config_process.local_stream_endpoint->sep.capabilities.media_codec.media_codec_type;
257 uint8_t codec_info_len;
258 uint8_t status;
259 switch (codec_type){
260 case AVDTP_CODEC_SBC:
261 codec_info_len = 4;
262 (void)memcpy(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, connection->a2dp_source_config_process.local_stream_endpoint->remote_sep.configuration.media_codec.media_codec_information, codec_info_len);
263 status = avdtp_config_sbc_set_sampling_frequency(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, sampling_frequency);
264 break;
265 case AVDTP_CODEC_MPEG_1_2_AUDIO:
266 codec_info_len = 4;
267 (void)memcpy(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, connection->a2dp_source_config_process.local_stream_endpoint->remote_sep.configuration.media_codec.media_codec_information, codec_info_len);
268 status = avdtp_config_mpeg_audio_set_sampling_frequency(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, sampling_frequency);
269 break;
270 case AVDTP_CODEC_MPEG_2_4_AAC:
271 codec_info_len = 6;
272 (void)memcpy(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, connection->a2dp_source_config_process.local_stream_endpoint->remote_sep.configuration.media_codec.media_codec_information, codec_info_len);
273 status = avdtp_config_mpeg_aac_set_sampling_frequency(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, sampling_frequency);
274 break;
275 case AVDTP_CODEC_ATRAC_FAMILY:
276 codec_info_len = 7;
277 (void)memcpy(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, connection->a2dp_source_config_process.local_stream_endpoint->remote_sep.configuration.media_codec.media_codec_information, codec_info_len);
278 status = avdtp_config_atrac_set_sampling_frequency(connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info, sampling_frequency);
279 break;
280 default:
281 return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
282 }
283 if (status != ERROR_CODE_SUCCESS){
284 return status;
285 }
286 avdtp_capabilities_t new_configuration;
287 new_configuration.media_codec.media_type = AVDTP_AUDIO;
288 new_configuration.media_codec.media_codec_type = codec_type;
289 new_configuration.media_codec.media_codec_information_len = codec_info_len;
290 new_configuration.media_codec.media_codec_information = connection->a2dp_source_config_process.local_stream_endpoint->media_codec_info;
291
292 // start reconfigure
293 connection->a2dp_source_config_process.state = A2DP_W2_RECONFIGURE_WITH_SEID;
294
295 return avdtp_source_reconfigure(
296 avdtp_cid,
297 avdtp_stream_endpoint_seid(connection->a2dp_source_config_process.local_stream_endpoint),
298 connection->a2dp_source_config_process.local_stream_endpoint->remote_sep.seid,
299 1 << AVDTP_MEDIA_CODEC,
300 new_configuration
301 );
302 }
303
a2dp_source_media_config_validator_callback(const avdtp_stream_endpoint_t * stream_endpoint,const uint8_t * event,uint16_t size)304 static uint8_t a2dp_source_media_config_validator_callback(const avdtp_stream_endpoint_t * stream_endpoint, const uint8_t * event, uint16_t size){
305 uint8_t error = 0;
306 if (a2dp_source_media_config_validator != NULL) {
307 // update subevent id and call validator
308 uint8_t avdtp_subevent_id = event[2];
309 uint8_t a2dp_subevent_id = a2dp_subevent_id_for_avdtp_subevent_id(avdtp_subevent_id);
310 uint8_t * subevent_field = (uint8_t *) &event[2];
311 *subevent_field = a2dp_subevent_id;
312 error = (*a2dp_source_media_config_validator)(stream_endpoint, event, size);
313 *subevent_field = avdtp_subevent_id;
314 }
315 return error;
316 }
317
a2dp_source_register_media_config_validator(uint8_t (* callback)(const avdtp_stream_endpoint_t * stream_endpoint,const uint8_t * event,uint16_t size))318 void a2dp_source_register_media_config_validator(uint8_t (*callback)(const avdtp_stream_endpoint_t * stream_endpoint, const uint8_t * event, uint16_t size)){
319 a2dp_source_media_config_validator = callback;
320 avdtp_source_register_media_config_validator(&a2dp_source_media_config_validator_callback);
321 }
322
323