xref: /btstack/src/classic/avdtp_initiator.c (revision 1b464e99afd70ddaf6b75be1ba7cc563a5f5dfd8)
1 /*
2  * Copyright (C) 2016 BlueKitchen GmbH
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions
6  * are met:
7  *
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. Neither the name of the copyright holders nor the names of
14  *    contributors may be used to endorse or promote products derived
15  *    from this software without specific prior written permission.
16  * 4. Any redistribution, use, or modification is done solely for
17  *    personal benefit and not for any commercial purpose or for
18  *    monetary gain.
19  *
20  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
21  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
23  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
24  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
25  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
26  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
27  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
28  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
29  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
30  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  * Please inquire about commercial licensing options at
34  * [email protected]
35  *
36  */
37 
38 #define BTSTACK_FILE__ "avdtp_initiator.c"
39 
40 #include <stdint.h>
41 #include <string.h>
42 
43 #include "bluetooth_psm.h"
44 #include "bluetooth_sdp.h"
45 #include "btstack_debug.h"
46 #include "btstack_event.h"
47 #include "l2cap.h"
48 #include "classic/avdtp.h"
49 #include "classic/avdtp_util.h"
50 #include "classic/avdtp_initiator.h"
51 
52 static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){
53     uint8_t command[2];
54     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
55     command[1] = (uint8_t)identifier;
56     return l2cap_send(cid, command, sizeof(command));
57 }
58 
59 static int avdtp_initiator_send_signaling_cmd_with_seid(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label, uint8_t sep_id){
60     uint8_t command[3];
61     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
62     command[1] = (uint8_t)identifier;
63     command[2] = sep_id << 2;
64     return l2cap_send(cid, command, sizeof(command));
65 }
66 
67 static int avdtp_initiator_send_signaling_cmd_delay_report(uint16_t cid, uint8_t transaction_label, uint8_t sep_id, uint16_t delay_ms){
68     uint8_t command[5];
69     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
70     command[1] = AVDTP_SI_DELAYREPORT;
71     command[2] = sep_id << 2;
72     big_endian_store_16(command, 3, delay_ms);
73     return l2cap_send(cid, command, sizeof(command));
74 }
75 
76 void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){
77     // int status = 0;
78     avdtp_stream_endpoint_t * stream_endpoint = NULL;
79 
80     avdtp_sep_t sep;
81     if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) {
82         connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE;
83     } else {
84         stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid, context);
85         if (!stream_endpoint){
86             stream_endpoint = avdtp_stream_endpoint_with_seid(connection->initiator_local_seid, context);
87         }
88         if (!stream_endpoint) return;
89         sep.seid = connection->initiator_remote_seid;
90 
91         if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) return;
92         stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE;
93     }
94 
95     switch (connection->initiator_signaling_packet.message_type){
96         case AVDTP_RESPONSE_ACCEPT_MSG:
97             switch (connection->initiator_signaling_packet.signal_identifier){
98                 case AVDTP_SI_DISCOVER:{
99                     if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){
100                         log_info("    unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label);
101                         // status = BAD_HEADER_FORMAT;
102                         break;
103                     }
104 
105                     if (size == 3){
106                         log_info("    ERROR code %02x", packet[offset]);
107                         break;
108                     }
109 
110                     int i;
111                     for (i = offset; i < size; i += 2){
112                         sep.seid = packet[i] >> 2;
113                         offset++;
114                         if ((sep.seid < 0x01) || (sep.seid > 0x3E)){
115                             log_info("    invalid sep id");
116                             // status = BAD_ACP_SEID;
117                             break;
118                         }
119                         sep.in_use = (packet[i] >> 1) & 0x01;
120                         sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4);
121                         sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01);
122                         avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep);
123                     }
124                     avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid);
125                     break;
126                 }
127 
128                 case AVDTP_SI_GET_CAPABILITIES:
129                 case AVDTP_SI_GET_ALL_CAPABILITIES:
130                     sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset);
131                     avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, &sep.capabilities, sep.registered_service_categories);
132                     break;
133                 case AVDTP_SI_DELAYREPORT:
134                     avdtp_signaling_emit_delay(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, little_endian_read_16(packet, offset));
135                     break;
136                 case AVDTP_SI_GET_CONFIGURATION:
137                     // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset);
138                     // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){
139                     //     switch (sep.configuration.media_codec.media_codec_type){
140                     //         case AVDTP_CODEC_SBC:
141                     //             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid,
142                     //                 sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information);
143                     //             break;
144                     //         default:
145                     //             avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid,  connection->remote_seid, sep.configuration.media_codec);
146                     //             break;
147                     //     }
148                     // }
149                     break;
150 
151                 case AVDTP_SI_RECONFIGURE:
152                     if (!stream_endpoint){
153                         log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null");
154                         break;
155                     }
156                     // copy sbc media codec info
157                     stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap;
158                     stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration;
159                     (void)memcpy(stream_endpoint->media_codec_sbc_info,
160                                  stream_endpoint->remote_configuration.media_codec.media_codec_information,
161                                  4);
162                     stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info;
163                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
164                     break;
165 
166                 case AVDTP_SI_SET_CONFIGURATION:{
167                     if (!stream_endpoint){
168                         log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null");
169                         break;
170                     }
171                     sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap;
172                     sep.configuration = stream_endpoint->remote_configuration;
173                     sep.in_use = 1;
174 
175                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED;
176                     stream_endpoint->remote_sep = sep;
177                     stream_endpoint->connection = connection;
178                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED;
179 
180                     log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint);
181 
182                     switch (stream_endpoint->media_codec_type){
183                         case AVDTP_CODEC_SBC:
184                             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid,
185                                 stream_endpoint->media_type, stream_endpoint->media_codec_sbc_info);
186                             break;
187                         default:
188                             // TODO: we don\t have codec info to emit config
189                             avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid,  connection->initiator_remote_seid, sep.configuration.media_codec);
190                             break;
191                     }
192                     break;
193                 }
194 
195                 case AVDTP_SI_OPEN:
196                     if (!stream_endpoint){
197                         log_error("AVDTP_SI_OPEN: stream endpoint is null");
198                         break;
199                     }
200                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) {
201                         log_error("AVDTP_SI_OPEN in wrong stream endpoint state");
202                         return;
203                     }
204                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED;
205                     connection->initiator_local_seid = stream_endpoint->sep.seid;
206                     l2cap_create_channel(context->packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL);
207                     return;
208                 case AVDTP_SI_START:
209                     if (!stream_endpoint){
210                         log_error("AVDTP_SI_START: stream endpoint is null");
211                         break;
212                     }
213                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) {
214                         log_error("AVDTP_SI_START in wrong stream endpoint state");
215                         return;
216                     }
217                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
218                     break;
219                 case AVDTP_SI_SUSPEND:
220                     if (!stream_endpoint){
221                         log_error("AVDTP_SI_SUSPEND: stream endpoint is null");
222                         break;
223                     }
224                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) {
225                         log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state");
226                         return;
227                     }
228                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
229                     break;
230                 case AVDTP_SI_CLOSE:
231                     if (!stream_endpoint){
232                         log_error("AVDTP_SI_CLOSE: stream endpoint is null");
233                         break;
234                     }
235                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING;
236                     break;
237                 case AVDTP_SI_ABORT:
238                     if (!stream_endpoint){
239                         log_error("AVDTP_SI_ABORT: stream endpoint is null");
240                         break;
241                     }
242                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
243                     break;
244                 default:
245                     log_info("    AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier);
246                     break;
247             }
248             avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true);
249             connection->initiator_transaction_label++;
250             break;
251         case AVDTP_RESPONSE_REJECT_MSG:
252             switch (connection->initiator_signaling_packet.signal_identifier){
253                 case AVDTP_SI_SET_CONFIGURATION:
254                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE;
255                     log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry.");
256                     break;
257                 default:
258                     break;
259             }
260             log_info("    AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
261             avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
262             return;
263         case AVDTP_GENERAL_REJECT_MSG:
264             log_info("    AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
265             avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
266             return;
267         default:
268             break;
269     }
270 }
271 
272 void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){
273     int sent = 1;
274     switch (connection->initiator_connection_state){
275         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS:
276             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS");
277             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
278             avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label);
279             break;
280         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES:
281             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES");
282             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
283             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
284             break;
285         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES:
286             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES");
287             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
288             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
289             break;
290         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION:
291             log_info("INT: AVDTP_INITIATOR_W4_GET_CONFIGURATION");
292             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
293             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid);
294             break;
295         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT:
296             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_DELAY_REPORT");
297             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
298             avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label,
299                 connection->initiator_remote_seid, connection->delay_ms);
300             break;
301         default:
302             sent = 0;
303             break;
304     }
305 
306     if (sent) return;
307     sent = 1;
308 
309     avdtp_stream_endpoint_t * stream_endpoint = NULL;
310 
311     stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid, context);
312     if (!stream_endpoint){
313         stream_endpoint = avdtp_stream_endpoint_with_seid(connection->initiator_local_seid, context);
314     }
315     if (!stream_endpoint) return;
316 
317     avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state;
318     stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER;
319 
320     if (stream_endpoint->start_stream){
321         stream_endpoint->start_stream = 0;
322         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){
323             connection->initiator_local_seid = stream_endpoint->sep.seid;
324             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
325             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid);
326             return;
327         }
328         return;
329     }
330 
331     if (stream_endpoint->stop_stream){
332         stream_endpoint->stop_stream = 0;
333         if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){
334             connection->initiator_local_seid = stream_endpoint->sep.seid;
335             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
336             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid);
337             return;
338         }
339     }
340 
341     if (stream_endpoint->abort_stream){
342         stream_endpoint->abort_stream = 0;
343         switch (stream_endpoint->state){
344             case AVDTP_STREAM_ENDPOINT_CONFIGURED:
345             case AVDTP_STREAM_ENDPOINT_CLOSING:
346             case AVDTP_STREAM_ENDPOINT_OPENED:
347             case AVDTP_STREAM_ENDPOINT_STREAMING:
348                 connection->initiator_local_seid = stream_endpoint->sep.seid;
349                 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
350                 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
351                 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid);
352                 return;
353             default:
354                 break;
355         }
356     }
357 
358     if (stream_endpoint->suspend_stream){
359         stream_endpoint->suspend_stream = 0;
360         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
361             connection->initiator_local_seid = stream_endpoint->sep.seid;
362             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
363             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
364             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid);
365             return;
366         }
367     }
368 
369     if (stream_endpoint->send_stream){
370         stream_endpoint->send_stream = 0;
371         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
372             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
373             avdtp_streaming_emit_can_send_media_packet_now(context->avdtp_callback, connection->avdtp_cid, avdtp_local_seid(stream_endpoint), stream_endpoint->sequence_number);
374             return;
375         }
376     }
377 
378     switch (stream_endpoint_state){
379         case AVDTP_INITIATOR_W2_SET_CONFIGURATION:
380         case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{
381             if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){
382                 log_info("initiator SM stop sending SET_CONFIGURATION cmd:");
383                 break;
384             }
385             log_info("INT: AVDTP_INITIATOR_W2_(RE)CONFIGURATION bitmap, int seid %d, acp seid %d", connection->initiator_local_seid, connection->initiator_remote_seid);
386             // log_info_hexdump(  connection->remote_capabilities.media_codec.media_codec_information,  connection->remote_capabilities.media_codec.media_codec_information_len);
387             connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid;
388             connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid;
389 
390             connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION;
391             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE;
392             if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){
393                 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE;
394             }
395 
396             avdtp_prepare_capabilities(&connection->initiator_signaling_packet, connection->initiator_transaction_label, stream_endpoint->remote_configuration_bitmap, stream_endpoint->remote_configuration, connection->initiator_signaling_packet.signal_identifier);
397             l2cap_reserve_packet_buffer();
398             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
399             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
400             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
401                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
402                 log_info("INT: fragmented");
403             }
404             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
405             break;
406         }
407         case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{
408             l2cap_reserve_packet_buffer();
409             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
410             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
411             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
412                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
413                 log_info("INT: fragmented");
414             }
415             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
416             break;
417         }
418         case AVDTP_INITIATOR_W2_OPEN_STREAM:
419             switch (stream_endpoint->state){
420                 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM:
421                     log_info("INT: AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM");
422                     avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid);
423                     break;
424                 default:
425                     sent = 0;
426                     break;
427             }
428             break;
429         default:
430             sent = 0;
431             break;
432     }
433 
434     // check fragmentation
435     if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
436         avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid);
437     }
438 }
439