xref: /btstack/src/classic/avdtp_initiator.c (revision 32c78405d221acf98c549342ba4eb9bfbb8b56f9)
18ef7100fSMilanka Ringwald /*
28ef7100fSMilanka Ringwald  * Copyright (C) 2016 BlueKitchen GmbH
38ef7100fSMilanka Ringwald  *
48ef7100fSMilanka Ringwald  * Redistribution and use in source and binary forms, with or without
58ef7100fSMilanka Ringwald  * modification, are permitted provided that the following conditions
68ef7100fSMilanka Ringwald  * are met:
78ef7100fSMilanka Ringwald  *
88ef7100fSMilanka Ringwald  * 1. Redistributions of source code must retain the above copyright
98ef7100fSMilanka Ringwald  *    notice, this list of conditions and the following disclaimer.
108ef7100fSMilanka Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
118ef7100fSMilanka Ringwald  *    notice, this list of conditions and the following disclaimer in the
128ef7100fSMilanka Ringwald  *    documentation and/or other materials provided with the distribution.
138ef7100fSMilanka Ringwald  * 3. Neither the name of the copyright holders nor the names of
148ef7100fSMilanka Ringwald  *    contributors may be used to endorse or promote products derived
158ef7100fSMilanka Ringwald  *    from this software without specific prior written permission.
168ef7100fSMilanka Ringwald  * 4. Any redistribution, use, or modification is done solely for
178ef7100fSMilanka Ringwald  *    personal benefit and not for any commercial purpose or for
188ef7100fSMilanka Ringwald  *    monetary gain.
198ef7100fSMilanka Ringwald  *
208ef7100fSMilanka Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
218ef7100fSMilanka Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
228ef7100fSMilanka Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
238ef7100fSMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
248ef7100fSMilanka Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
258ef7100fSMilanka Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
268ef7100fSMilanka Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
278ef7100fSMilanka Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
288ef7100fSMilanka Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
298ef7100fSMilanka Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
308ef7100fSMilanka Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
318ef7100fSMilanka Ringwald  * SUCH DAMAGE.
328ef7100fSMilanka Ringwald  *
338ef7100fSMilanka Ringwald  * Please inquire about commercial licensing options at
348ef7100fSMilanka Ringwald  * [email protected]
358ef7100fSMilanka Ringwald  *
368ef7100fSMilanka Ringwald  */
378ef7100fSMilanka Ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avdtp_initiator.c"
39ab2c6ae4SMatthias Ringwald 
408ef7100fSMilanka Ringwald #include <stdint.h>
418ef7100fSMilanka Ringwald #include <stdio.h>
428ef7100fSMilanka Ringwald #include <stdlib.h>
438ef7100fSMilanka Ringwald #include <string.h>
448ef7100fSMilanka Ringwald 
458ef7100fSMilanka Ringwald #include "btstack.h"
464cb889a5SMilanka Ringwald #include "classic/avdtp.h"
474cb889a5SMilanka Ringwald #include "classic/avdtp_util.h"
484cb889a5SMilanka Ringwald #include "classic/avdtp_initiator.h"
498ef7100fSMilanka Ringwald 
508ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){
518ef7100fSMilanka Ringwald     uint8_t command[2];
528ef7100fSMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
538ef7100fSMilanka Ringwald     command[1] = (uint8_t)identifier;
548ef7100fSMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
558ef7100fSMilanka Ringwald }
568ef7100fSMilanka Ringwald 
578ef7100fSMilanka Ringwald 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){
588ef7100fSMilanka Ringwald     uint8_t command[3];
598ef7100fSMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
608ef7100fSMilanka Ringwald     command[1] = (uint8_t)identifier;
618ef7100fSMilanka Ringwald     command[2] = sep_id << 2;
628ef7100fSMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
638ef7100fSMilanka Ringwald }
648ef7100fSMilanka Ringwald 
6519af95b4SMilanka Ringwald static int avdtp_initiator_send_signaling_cmd_delay_report(uint16_t cid, uint8_t transaction_label, uint8_t sep_id, uint16_t delay_ms){
6619af95b4SMilanka Ringwald     uint8_t command[5];
6719af95b4SMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
6819af95b4SMilanka Ringwald     command[1] = AVDTP_SI_DELAYREPORT;
6919af95b4SMilanka Ringwald     command[2] = sep_id << 2;
7019af95b4SMilanka Ringwald     big_endian_store_16(command, 3, delay_ms);
7119af95b4SMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
7219af95b4SMilanka Ringwald }
7319af95b4SMilanka Ringwald 
74747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){
75319b19ccSMilanka Ringwald     // int status = 0;
768ef7100fSMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = NULL;
77747ec646SMilanka Ringwald 
788ef7100fSMilanka Ringwald     avdtp_sep_t sep;
798ef7100fSMilanka Ringwald     if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) {
808ef7100fSMilanka Ringwald         connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE;
818ef7100fSMilanka Ringwald     } else {
829413b167SMilanka Ringwald         stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->remote_seid, context);
838ef7100fSMilanka Ringwald         if (!stream_endpoint){
844ccacc40SMilanka Ringwald             stream_endpoint = avdtp_stream_endpoint_with_seid(connection->local_seid, context);
858ef7100fSMilanka Ringwald         }
868ef7100fSMilanka Ringwald         if (!stream_endpoint) return;
879413b167SMilanka Ringwald         sep.seid = connection->remote_seid;
888ef7100fSMilanka Ringwald 
898ef7100fSMilanka Ringwald         if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) return;
908ef7100fSMilanka Ringwald         stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE;
918ef7100fSMilanka Ringwald     }
928ef7100fSMilanka Ringwald 
938ef7100fSMilanka Ringwald     switch (connection->signaling_packet.message_type){
948ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_ACCEPT_MSG:
958ef7100fSMilanka Ringwald             switch (connection->signaling_packet.signal_identifier){
968ef7100fSMilanka Ringwald                 case AVDTP_SI_DISCOVER:{
978ef7100fSMilanka Ringwald                     if (connection->signaling_packet.transaction_label != connection->initiator_transaction_label){
988587e32cSMilanka Ringwald                         log_info("    unexpected transaction label, got %d, expected %d", connection->signaling_packet.transaction_label, connection->initiator_transaction_label);
99319b19ccSMilanka Ringwald                         // status = BAD_HEADER_FORMAT;
1008ef7100fSMilanka Ringwald                         break;
1018ef7100fSMilanka Ringwald                     }
1028ef7100fSMilanka Ringwald 
1038ef7100fSMilanka Ringwald                     if (size == 3){
1048587e32cSMilanka Ringwald                         log_info("    ERROR code %02x", packet[offset]);
1058ef7100fSMilanka Ringwald                         break;
1068ef7100fSMilanka Ringwald                     }
1078ef7100fSMilanka Ringwald 
1088ef7100fSMilanka Ringwald                     int i;
1098ef7100fSMilanka Ringwald                     for (i = offset; i < size; i += 2){
1108ef7100fSMilanka Ringwald                         sep.seid = packet[i] >> 2;
1118ef7100fSMilanka Ringwald                         offset++;
1128ef7100fSMilanka Ringwald                         if (sep.seid < 0x01 || sep.seid > 0x3E){
1138587e32cSMilanka Ringwald                             log_info("    invalid sep id");
114319b19ccSMilanka Ringwald                             // status = BAD_ACP_SEID;
1158ef7100fSMilanka Ringwald                             break;
1168ef7100fSMilanka Ringwald                         }
1178ef7100fSMilanka Ringwald                         sep.in_use = (packet[i] >> 1) & 0x01;
1188ef7100fSMilanka Ringwald                         sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4);
1198ef7100fSMilanka Ringwald                         sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01);
1204ccacc40SMilanka Ringwald                         avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep);
1218ef7100fSMilanka Ringwald                     }
122485c0a4cSMilanka Ringwald                     avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid);
1238ef7100fSMilanka Ringwald                     break;
1248ef7100fSMilanka Ringwald                 }
1258ef7100fSMilanka Ringwald 
1268ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_CAPABILITIES:
1278ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_ALL_CAPABILITIES:
1288ef7100fSMilanka Ringwald                     sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, &sep.capabilities, packet+offset, size-offset);
12967ae582dSMilanka Ringwald                     avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid, &sep.capabilities, sep.registered_service_categories);
1308ef7100fSMilanka Ringwald                     break;
13119af95b4SMilanka Ringwald                 case AVDTP_SI_DELAYREPORT:
132*32c78405SMilanka Ringwald                     avdtp_signaling_emit_delay(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, little_endian_read_16(packet, offset));
13319af95b4SMilanka Ringwald                     break;
1348ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_CONFIGURATION:
135ffa6c160SMilanka Ringwald                     // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset);
136ffa6c160SMilanka Ringwald                     // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){
137ffa6c160SMilanka Ringwald                     //     switch (sep.configuration.media_codec.media_codec_type){
138ffa6c160SMilanka Ringwald                     //         case AVDTP_CODEC_SBC:
139ffa6c160SMilanka Ringwald                     //             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid,
140ffa6c160SMilanka Ringwald                     //                 sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information);
141ffa6c160SMilanka Ringwald                     //             break;
142ffa6c160SMilanka Ringwald                     //         default:
143ffa6c160SMilanka Ringwald                     //             avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid,  connection->remote_seid, sep.configuration.media_codec);
144ffa6c160SMilanka Ringwald                     //             break;
145ffa6c160SMilanka Ringwald                     //     }
146ffa6c160SMilanka Ringwald                     // }
1478ef7100fSMilanka Ringwald                     break;
1488ef7100fSMilanka Ringwald 
1498ef7100fSMilanka Ringwald                 case AVDTP_SI_RECONFIGURE:
150e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
151e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null");
152e8c2501fSMilanka Ringwald                         break;
153e8c2501fSMilanka Ringwald                     }
1548d254f09SMilanka Ringwald                     // copy sbc media codec info
155c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap;
156c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration;
1578d254f09SMilanka Ringwald                     memcpy(stream_endpoint->media_codec_sbc_info, stream_endpoint->remote_configuration.media_codec.media_codec_information, 4);
158c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info;
1598d254f09SMilanka Ringwald 
160b308acf6SMatthias Ringwald #if 0
1618ef7100fSMilanka Ringwald                     sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, connection->signaling_packet.command+4, connection->signaling_packet.size-4);
1628ef7100fSMilanka Ringwald                     // TODO check if configuration is supported
1638ef7100fSMilanka Ringwald 
164485c0a4cSMilanka Ringwald                     if (!is_avdtp_remote_seid_registered(stream_endpoint)){
165485c0a4cSMilanka Ringwald                         stream_endpoint->remote_sep = sep;
166485c0a4cSMilanka Ringwald                         log_info("INT: update seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint);
1678ef7100fSMilanka Ringwald                     }
168b308acf6SMatthias Ringwald #endif
1692bb3471fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
1708ef7100fSMilanka Ringwald                     break;
1718ef7100fSMilanka Ringwald 
1728ef7100fSMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:{
173d8b859a2SMilanka Ringwald                     avdtp_configuration_timer_stop(connection);
174e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
175e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null");
176e8c2501fSMilanka Ringwald                         break;
177e8c2501fSMilanka Ringwald                     }
178ffa6c160SMilanka Ringwald                     sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap;
179ffa6c160SMilanka Ringwald                     sep.configuration = stream_endpoint->remote_configuration;
1808ef7100fSMilanka Ringwald                     sep.in_use = 1;
1818ef7100fSMilanka Ringwald 
1828ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED;
183485c0a4cSMilanka Ringwald                     stream_endpoint->remote_sep = sep;
184485c0a4cSMilanka Ringwald                     stream_endpoint->connection = connection;
185485c0a4cSMilanka Ringwald 
186485c0a4cSMilanka Ringwald                     log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint);
187ffa6c160SMilanka Ringwald 
188ffa6c160SMilanka Ringwald                     switch (stream_endpoint->media_codec_type){
189ffa6c160SMilanka Ringwald                         case AVDTP_CODEC_SBC:
190ffa6c160SMilanka Ringwald                             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid,
191ffa6c160SMilanka Ringwald                                 stream_endpoint->media_type, stream_endpoint->media_codec_sbc_info);
192ffa6c160SMilanka Ringwald                             break;
193ffa6c160SMilanka Ringwald                         default:
194ffa6c160SMilanka Ringwald                             // TODO: we don\t have codec info to emit config
195485c0a4cSMilanka Ringwald                             avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid,  connection->remote_seid, sep.configuration.media_codec);
196ffa6c160SMilanka Ringwald                             break;
197ffa6c160SMilanka Ringwald                     }
1988ef7100fSMilanka Ringwald                     break;
1998ef7100fSMilanka Ringwald                 }
2008ef7100fSMilanka Ringwald 
2018ef7100fSMilanka Ringwald                 case AVDTP_SI_OPEN:
202e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
203e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_OPEN: stream endpoint is null");
204e8c2501fSMilanka Ringwald                         break;
205e8c2501fSMilanka Ringwald                     }
206747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) {
207747ec646SMilanka Ringwald                         log_error("AVDTP_SI_OPEN in wrong stream endpoint state");
208747ec646SMilanka Ringwald                         return;
209747ec646SMilanka Ringwald                     }
210747ec646SMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED;
2116b0ee1d0SMilanka Ringwald                     connection->local_seid = stream_endpoint->sep.seid;
212235946f1SMatthias Ringwald                     l2cap_create_channel(context->packet_handler, connection->remote_addr, BLUETOOTH_PROTOCOL_AVDTP, 0xffff, NULL);
213747ec646SMilanka Ringwald                     return;
2148ef7100fSMilanka Ringwald                 case AVDTP_SI_START:
215e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
216e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_START: stream endpoint is null");
217e8c2501fSMilanka Ringwald                         break;
218e8c2501fSMilanka Ringwald                     }
219747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) {
220747ec646SMilanka Ringwald                         log_error("AVDTP_SI_START in wrong stream endpoint state");
221747ec646SMilanka Ringwald                         return;
222747ec646SMilanka Ringwald                     }
2238ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
2248ef7100fSMilanka Ringwald                     break;
2258ef7100fSMilanka Ringwald                 case AVDTP_SI_SUSPEND:
226e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
227e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND: stream endpoint is null");
228e8c2501fSMilanka Ringwald                         break;
229e8c2501fSMilanka Ringwald                     }
230747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) {
231747ec646SMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state");
232747ec646SMilanka Ringwald                         return;
233747ec646SMilanka Ringwald                     }
2348ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
2358ef7100fSMilanka Ringwald                     break;
2368ef7100fSMilanka Ringwald                 case AVDTP_SI_CLOSE:
237e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
238e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_CLOSE: stream endpoint is null");
239e8c2501fSMilanka Ringwald                         break;
240e8c2501fSMilanka Ringwald                     }
2418ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING;
2428ef7100fSMilanka Ringwald                     break;
2438ef7100fSMilanka Ringwald                 case AVDTP_SI_ABORT:
244e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
245e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_ABORT: stream endpoint is null");
246e8c2501fSMilanka Ringwald                         break;
247e8c2501fSMilanka Ringwald                     }
2488ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
2498ef7100fSMilanka Ringwald                     break;
25019af95b4SMilanka Ringwald 
2518ef7100fSMilanka Ringwald                 default:
2528587e32cSMilanka Ringwald                     log_info("    AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->signaling_packet.signal_identifier);
2538ef7100fSMilanka Ringwald                     break;
2548ef7100fSMilanka Ringwald             }
2554ccacc40SMilanka Ringwald             avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->signaling_packet.signal_identifier);
25660ec20d0SMilanka Ringwald             connection->initiator_transaction_label++;
2578ef7100fSMilanka Ringwald             break;
2588ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_REJECT_MSG:
259d8b859a2SMilanka Ringwald             switch (connection->signaling_packet.signal_identifier){
260d8b859a2SMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:
261d8b859a2SMilanka Ringwald                     connection->is_initiator = 0;
262bdbc3ef6SMilanka Ringwald                     log_info("Received reject for set configuration, role changed from initiator to acceptor. Start timer.");
263d8b859a2SMilanka Ringwald                     avdtp_configuration_timer_start(connection);
264d8b859a2SMilanka Ringwald                     break;
265d8b859a2SMilanka Ringwald                 default:
266d8b859a2SMilanka Ringwald                     break;
267d8b859a2SMilanka Ringwald             }
2688587e32cSMilanka Ringwald             log_info("    AVDTP_RESPONSE_REJECT_MSG signal %d", connection->signaling_packet.signal_identifier);
2694ccacc40SMilanka Ringwald             avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->signaling_packet.signal_identifier);
2708ef7100fSMilanka Ringwald             return;
2718ef7100fSMilanka Ringwald         case AVDTP_GENERAL_REJECT_MSG:
2728587e32cSMilanka Ringwald             log_info("    AVDTP_GENERAL_REJECT_MSG signal %d", connection->signaling_packet.signal_identifier);
2734ccacc40SMilanka Ringwald             avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->signaling_packet.signal_identifier);
2748ef7100fSMilanka Ringwald             return;
2758ef7100fSMilanka Ringwald         default:
2768ef7100fSMilanka Ringwald             break;
2778ef7100fSMilanka Ringwald     }
2788ef7100fSMilanka Ringwald }
2798ef7100fSMilanka Ringwald 
280747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){
2818ef7100fSMilanka Ringwald     int sent = 1;
2828ef7100fSMilanka Ringwald     switch (connection->initiator_connection_state){
2838ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS:
2848587e32cSMilanka Ringwald             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS");
2858ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2869413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label);
2878ef7100fSMilanka Ringwald             break;
2888ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES:
2898587e32cSMilanka Ringwald             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES");
2908ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2919413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->remote_seid);
2928ef7100fSMilanka Ringwald             break;
2938ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES:
2948587e32cSMilanka Ringwald             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES");
2958ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2969413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->remote_seid);
2978ef7100fSMilanka Ringwald             break;
2988ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION:
2998587e32cSMilanka Ringwald             log_info("INT: AVDTP_INITIATOR_W4_GET_CONFIGURATION");
3008ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
3019413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->remote_seid);
3028ef7100fSMilanka Ringwald             break;
30319af95b4SMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT:
30419af95b4SMilanka Ringwald             log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_DELAY_REPORT");
30519af95b4SMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30619af95b4SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label,
30719af95b4SMilanka Ringwald                 connection->remote_seid, connection->delay_ms);
30819af95b4SMilanka Ringwald             break;
3098ef7100fSMilanka Ringwald         default:
3108ef7100fSMilanka Ringwald             sent = 0;
3118ef7100fSMilanka Ringwald             break;
3128ef7100fSMilanka Ringwald     }
3138ef7100fSMilanka Ringwald 
3148ef7100fSMilanka Ringwald     if (sent) return;
3158ef7100fSMilanka Ringwald     sent = 1;
3168ef7100fSMilanka Ringwald 
3175cfe7f4cSMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = NULL;
3188ef7100fSMilanka Ringwald 
3199413b167SMilanka Ringwald     stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->remote_seid, context);
3208ef7100fSMilanka Ringwald     if (!stream_endpoint){
3214ccacc40SMilanka Ringwald         stream_endpoint = avdtp_stream_endpoint_with_seid(connection->local_seid, context);
3228ef7100fSMilanka Ringwald     }
3238ef7100fSMilanka Ringwald     if (!stream_endpoint) return;
3248ef7100fSMilanka Ringwald 
3258ef7100fSMilanka Ringwald     avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state;
3268ef7100fSMilanka Ringwald     stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER;
3278ef7100fSMilanka Ringwald 
32860ec20d0SMilanka Ringwald     if (stream_endpoint->start_stream){
32960ec20d0SMilanka Ringwald         stream_endpoint->start_stream = 0;
330da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){
3314ccacc40SMilanka Ringwald             connection->local_seid = stream_endpoint->sep.seid;
332485c0a4cSMilanka Ringwald             connection->remote_seid = stream_endpoint->remote_sep.seid;
3339413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->remote_seid);
33460ec20d0SMilanka Ringwald             return;
33560ec20d0SMilanka Ringwald         }
33660ec20d0SMilanka Ringwald         return;
33760ec20d0SMilanka Ringwald     }
33860ec20d0SMilanka Ringwald 
33960ec20d0SMilanka Ringwald     if (stream_endpoint->stop_stream){
34060ec20d0SMilanka Ringwald         stream_endpoint->stop_stream = 0;
341da4d6891SMilanka Ringwald         if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){
3424ccacc40SMilanka Ringwald             connection->local_seid = stream_endpoint->sep.seid;
343485c0a4cSMilanka Ringwald             connection->remote_seid = stream_endpoint->remote_sep.seid;
3449413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->remote_seid);
34560ec20d0SMilanka Ringwald             return;
34660ec20d0SMilanka Ringwald         }
34760ec20d0SMilanka Ringwald     }
34860ec20d0SMilanka Ringwald 
34960ec20d0SMilanka Ringwald     if (stream_endpoint->abort_stream){
350da4d6891SMilanka Ringwald         stream_endpoint->abort_stream = 0;
35160ec20d0SMilanka Ringwald         switch (stream_endpoint->state){
35260ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CONFIGURED:
35360ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CLOSING:
35460ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_OPENED:
35560ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_STREAMING:
3564ccacc40SMilanka Ringwald                 connection->local_seid = stream_endpoint->sep.seid;
357485c0a4cSMilanka Ringwald                 connection->remote_seid = stream_endpoint->remote_sep.seid;
35860ec20d0SMilanka Ringwald                 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
3599413b167SMilanka Ringwald                 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->remote_seid);
36060ec20d0SMilanka Ringwald                 return;
36160ec20d0SMilanka Ringwald             default:
36260ec20d0SMilanka Ringwald                 break;
36360ec20d0SMilanka Ringwald         }
36460ec20d0SMilanka Ringwald     }
36560ec20d0SMilanka Ringwald 
36660ec20d0SMilanka Ringwald     if (stream_endpoint->suspend_stream){
36760ec20d0SMilanka Ringwald         stream_endpoint->suspend_stream = 0;
368da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
36919af95b4SMilanka Ringwald             connection->local_seid = stream_endpoint->sep.seid;
37019af95b4SMilanka Ringwald             connection->remote_seid = stream_endpoint->remote_sep.seid;
37160ec20d0SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
3729413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->remote_seid);
37360ec20d0SMilanka Ringwald             return;
37460ec20d0SMilanka Ringwald         }
37560ec20d0SMilanka Ringwald     }
37660ec20d0SMilanka Ringwald 
37760ec20d0SMilanka Ringwald     if (stream_endpoint->send_stream){
37860ec20d0SMilanka Ringwald         stream_endpoint->send_stream = 0;
379da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
38060ec20d0SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
38160ec20d0SMilanka Ringwald             avdtp_streaming_emit_can_send_media_packet_now(context->avdtp_callback, stream_endpoint->l2cap_media_cid, stream_endpoint->sep.seid, stream_endpoint->sequence_number);
38260ec20d0SMilanka Ringwald             return;
38360ec20d0SMilanka Ringwald         }
38460ec20d0SMilanka Ringwald     }
38560ec20d0SMilanka Ringwald 
3868ef7100fSMilanka Ringwald     switch (stream_endpoint_state){
3878ef7100fSMilanka Ringwald         case AVDTP_INITIATOR_W2_SET_CONFIGURATION:
3888ef7100fSMilanka Ringwald         case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{
3899974aee0SMilanka Ringwald             if (stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION && !connection->is_initiator){
390ec3d71e3SMilanka Ringwald                 log_info("initiator SM stop sending SET_CONFIGURATION cmd: current role is acceptor");
391d8b859a2SMilanka Ringwald                 connection->is_configuration_initiated_locally = 0;
39263331bf4SMilanka Ringwald                 break;
39363331bf4SMilanka Ringwald             }
3949974aee0SMilanka Ringwald             log_info("initiator SM prepare SET_CONFIGURATION cmd");
395d8b859a2SMilanka Ringwald             connection->is_configuration_initiated_locally = 1;
3969413b167SMilanka Ringwald             log_info("INT: AVDTP_INITIATOR_W2_(RE)CONFIGURATION bitmap, int seid %d, acp seid %d", connection->local_seid, connection->remote_seid);
3978587e32cSMilanka Ringwald             // log_info_hexdump(  connection->remote_capabilities.media_codec.media_codec_information,  connection->remote_capabilities.media_codec.media_codec_information_len);
3989413b167SMilanka Ringwald             connection->signaling_packet.acp_seid = connection->remote_seid;
3994ccacc40SMilanka Ringwald             connection->signaling_packet.int_seid = connection->local_seid;
4008ef7100fSMilanka Ringwald 
4018ef7100fSMilanka Ringwald             connection->signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION;
402bdbc3ef6SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE;
4038ef7100fSMilanka Ringwald             if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){
4048ef7100fSMilanka Ringwald                 connection->signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE;
4058ef7100fSMilanka Ringwald             }
4068ef7100fSMilanka Ringwald 
407f53d6fa7SMilanka Ringwald             avdtp_prepare_capabilities(&connection->signaling_packet, connection->initiator_transaction_label, stream_endpoint->remote_configuration_bitmap, stream_endpoint->remote_configuration, connection->signaling_packet.signal_identifier);
4088ef7100fSMilanka Ringwald             l2cap_reserve_packet_buffer();
4098ef7100fSMilanka Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
4109413b167SMilanka Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->signaling_packet, out_buffer);
4118ef7100fSMilanka Ringwald             if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){
4128ef7100fSMilanka Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
4138587e32cSMilanka Ringwald                 log_info("INT: fragmented");
4148ef7100fSMilanka Ringwald             }
4159413b167SMilanka Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
4168ef7100fSMilanka Ringwald             break;
4178ef7100fSMilanka Ringwald         }
4188ef7100fSMilanka Ringwald         case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{
4198ef7100fSMilanka Ringwald             l2cap_reserve_packet_buffer();
4208ef7100fSMilanka Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
4219413b167SMilanka Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->signaling_packet, out_buffer);
4228ef7100fSMilanka Ringwald             if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){
4238ef7100fSMilanka Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
4248587e32cSMilanka Ringwald                 log_info("INT: fragmented");
4258ef7100fSMilanka Ringwald             }
4269413b167SMilanka Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
4278ef7100fSMilanka Ringwald             break;
4288ef7100fSMilanka Ringwald         }
429747ec646SMilanka Ringwald         case AVDTP_INITIATOR_W2_OPEN_STREAM:
430747ec646SMilanka Ringwald             switch (stream_endpoint->state){
431747ec646SMilanka Ringwald                 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM:
4328587e32cSMilanka Ringwald                     log_info("INT: AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM");
4339413b167SMilanka Ringwald                     avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->remote_seid);
4348ef7100fSMilanka Ringwald                     break;
435747ec646SMilanka Ringwald                 default:
43660ec20d0SMilanka Ringwald                     sent = 0;
437747ec646SMilanka Ringwald                     break;
438747ec646SMilanka Ringwald             }
439747ec646SMilanka Ringwald             break;
4408ef7100fSMilanka Ringwald         default:
44160ec20d0SMilanka Ringwald             sent = 0;
4428ef7100fSMilanka Ringwald             break;
4438ef7100fSMilanka Ringwald     }
4448ef7100fSMilanka Ringwald 
4458ef7100fSMilanka Ringwald     // check fragmentation
4468ef7100fSMilanka Ringwald     if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){
4479413b167SMilanka Ringwald         avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid);
4488ef7100fSMilanka Ringwald     }
4498ef7100fSMilanka Ringwald }
450