xref: /btstack/src/classic/avdtp_initiator.c (revision 0fbfe0705ce515f74b808566b16b94c29ea198ee)
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 <string.h>
428ef7100fSMilanka Ringwald 
4384e3541eSMilanka Ringwald #include "bluetooth_psm.h"
4484e3541eSMilanka Ringwald #include "bluetooth_sdp.h"
4584e3541eSMilanka Ringwald #include "btstack_debug.h"
4684e3541eSMilanka Ringwald #include "btstack_event.h"
4784e3541eSMilanka Ringwald #include "l2cap.h"
484cb889a5SMilanka Ringwald #include "classic/avdtp.h"
494cb889a5SMilanka Ringwald #include "classic/avdtp_util.h"
504cb889a5SMilanka Ringwald #include "classic/avdtp_initiator.h"
518ef7100fSMilanka Ringwald 
528ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){
538ef7100fSMilanka Ringwald     uint8_t command[2];
548ef7100fSMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
558ef7100fSMilanka Ringwald     command[1] = (uint8_t)identifier;
568ef7100fSMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
578ef7100fSMilanka Ringwald }
588ef7100fSMilanka Ringwald 
598ef7100fSMilanka 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){
608ef7100fSMilanka Ringwald     uint8_t command[3];
618ef7100fSMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
628ef7100fSMilanka Ringwald     command[1] = (uint8_t)identifier;
638ef7100fSMilanka Ringwald     command[2] = sep_id << 2;
648ef7100fSMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
658ef7100fSMilanka Ringwald }
668ef7100fSMilanka Ringwald 
6719af95b4SMilanka 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){
6819af95b4SMilanka Ringwald     uint8_t command[5];
6919af95b4SMilanka Ringwald     command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG);
7019af95b4SMilanka Ringwald     command[1] = AVDTP_SI_DELAYREPORT;
7119af95b4SMilanka Ringwald     command[2] = sep_id << 2;
7219af95b4SMilanka Ringwald     big_endian_store_16(command, 3, delay_ms);
7319af95b4SMilanka Ringwald     return l2cap_send(cid, command, sizeof(command));
7419af95b4SMilanka Ringwald }
7519af95b4SMilanka Ringwald 
76747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){
77319b19ccSMilanka Ringwald     // int status = 0;
788ef7100fSMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = NULL;
79747ec646SMilanka Ringwald 
808ef7100fSMilanka Ringwald     avdtp_sep_t sep;
818ef7100fSMilanka Ringwald     if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) {
828ef7100fSMilanka Ringwald         connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE;
838ef7100fSMilanka Ringwald     } else {
84054be048SMilanka Ringwald         stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid);
858ef7100fSMilanka Ringwald         if (!stream_endpoint){
866f98b084SMilanka Ringwald             stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid);
878ef7100fSMilanka Ringwald         }
88b95f2da3SMilanka Ringwald         if (!stream_endpoint) {
89b95f2da3SMilanka Ringwald             log_error("stream_endpoint for seid 0x%02x not found", connection->initiator_local_seid);
90b95f2da3SMilanka Ringwald             return;
91b95f2da3SMilanka Ringwald         }
9296dcd0f4SMatthias Ringwald         sep.seid = connection->initiator_remote_seid;
938ef7100fSMilanka Ringwald 
94b95f2da3SMilanka Ringwald         if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) {
95b95f2da3SMilanka Ringwald             log_error("initiator_config_state is in wrong state %d, expected %d", stream_endpoint->initiator_config_state, AVDTP_INITIATOR_W4_ANSWER);
96b95f2da3SMilanka Ringwald             return;
97b95f2da3SMilanka Ringwald         }
988ef7100fSMilanka Ringwald         stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE;
998ef7100fSMilanka Ringwald     }
1008ef7100fSMilanka Ringwald 
10150453b92SMatthias Ringwald     switch (connection->initiator_signaling_packet.message_type){
1028ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_ACCEPT_MSG:
10350453b92SMatthias Ringwald             switch (connection->initiator_signaling_packet.signal_identifier){
1048ef7100fSMilanka Ringwald                 case AVDTP_SI_DISCOVER:{
10550453b92SMatthias Ringwald                     if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){
10650453b92SMatthias Ringwald                         log_info("    unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label);
107319b19ccSMilanka Ringwald                         // status = BAD_HEADER_FORMAT;
1088ef7100fSMilanka Ringwald                         break;
1098ef7100fSMilanka Ringwald                     }
1108ef7100fSMilanka Ringwald 
1118ef7100fSMilanka Ringwald                     if (size == 3){
1128587e32cSMilanka Ringwald                         log_info("    ERROR code %02x", packet[offset]);
1138ef7100fSMilanka Ringwald                         break;
1148ef7100fSMilanka Ringwald                     }
1158ef7100fSMilanka Ringwald 
1168ef7100fSMilanka Ringwald                     int i;
1178ef7100fSMilanka Ringwald                     for (i = offset; i < size; i += 2){
1188ef7100fSMilanka Ringwald                         sep.seid = packet[i] >> 2;
1198ef7100fSMilanka Ringwald                         offset++;
1200e588213SMatthias Ringwald                         if ((sep.seid < 0x01) || (sep.seid > 0x3E)){
1218587e32cSMilanka Ringwald                             log_info("    invalid sep id");
122319b19ccSMilanka Ringwald                             // status = BAD_ACP_SEID;
1238ef7100fSMilanka Ringwald                             break;
1248ef7100fSMilanka Ringwald                         }
1258ef7100fSMilanka Ringwald                         sep.in_use = (packet[i] >> 1) & 0x01;
1268ef7100fSMilanka Ringwald                         sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4);
1278ef7100fSMilanka Ringwald                         sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01);
1284ccacc40SMilanka Ringwald                         avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep);
1298ef7100fSMilanka Ringwald                     }
130485c0a4cSMilanka Ringwald                     avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid);
1318ef7100fSMilanka Ringwald                     break;
1328ef7100fSMilanka Ringwald                 }
1338ef7100fSMilanka Ringwald 
1348ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_CAPABILITIES:
1358ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_ALL_CAPABILITIES:
13650453b92SMatthias Ringwald                     sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset);
1375bd73fa2SMatthias Ringwald                     avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, &sep.capabilities, sep.registered_service_categories);
1388ef7100fSMilanka Ringwald                     break;
13919af95b4SMilanka Ringwald                 case AVDTP_SI_DELAYREPORT:
1402d9d000fSMatthias Ringwald                     avdtp_signaling_emit_delay(connection->avdtp_cid, connection->initiator_local_seid,
1412d9d000fSMatthias Ringwald                                                little_endian_read_16(packet, offset));
14219af95b4SMilanka Ringwald                     break;
1438ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_CONFIGURATION:
144ffa6c160SMilanka Ringwald                     // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset);
145ffa6c160SMilanka Ringwald                     // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){
146ffa6c160SMilanka Ringwald                     //     switch (sep.configuration.media_codec.media_codec_type){
147ffa6c160SMilanka Ringwald                     //         case AVDTP_CODEC_SBC:
1485bd73fa2SMatthias Ringwald                     //             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid,
149ffa6c160SMilanka Ringwald                     //                 sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information);
150ffa6c160SMilanka Ringwald                     //             break;
151ffa6c160SMilanka Ringwald                     //         default:
1525bd73fa2SMatthias Ringwald                     //             avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid,  connection->remote_seid, sep.configuration.media_codec);
153ffa6c160SMilanka Ringwald                     //             break;
154ffa6c160SMilanka Ringwald                     //     }
155ffa6c160SMilanka Ringwald                     // }
1568ef7100fSMilanka Ringwald                     break;
1578ef7100fSMilanka Ringwald 
1588ef7100fSMilanka Ringwald                 case AVDTP_SI_RECONFIGURE:
159e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
160e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null");
161e8c2501fSMilanka Ringwald                         break;
162e8c2501fSMilanka Ringwald                     }
1638d254f09SMilanka Ringwald                     // copy sbc media codec info
164c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap;
165c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration;
1666535961aSMatthias Ringwald                     (void)memcpy(stream_endpoint->media_codec_sbc_info,
1676535961aSMatthias Ringwald                                  stream_endpoint->remote_configuration.media_codec.media_codec_information,
1686535961aSMatthias Ringwald                                  4);
169c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info;
1702bb3471fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
1718ef7100fSMilanka Ringwald                     break;
1728ef7100fSMilanka Ringwald 
1738ef7100fSMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:{
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;
185a3ce0109SMatthias Ringwald                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED;
186485c0a4cSMilanka Ringwald 
187485c0a4cSMilanka Ringwald                     log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint);
188ffa6c160SMilanka Ringwald 
189ffa6c160SMilanka Ringwald                     switch (stream_endpoint->media_codec_type){
190ffa6c160SMilanka Ringwald                         case AVDTP_CODEC_SBC:
191*0fbfe070SMatthias Ringwald                             avdtp_signaling_emit_media_codec_sbc_configuration(
192*0fbfe070SMatthias Ringwald                                     stream_endpoint,
193*0fbfe070SMatthias Ringwald                                     connection->avdtp_cid,
194*0fbfe070SMatthias Ringwald                                     stream_endpoint->media_type,
195*0fbfe070SMatthias Ringwald                                     stream_endpoint->media_codec_sbc_info);
196ffa6c160SMilanka Ringwald                             break;
197ffa6c160SMilanka Ringwald                         default:
198ffa6c160SMilanka Ringwald                             // TODO: we don\t have codec info to emit config
1995bd73fa2SMatthias Ringwald                             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);
200ffa6c160SMilanka Ringwald                             break;
201ffa6c160SMilanka Ringwald                     }
2028ef7100fSMilanka Ringwald                     break;
2038ef7100fSMilanka Ringwald                 }
2048ef7100fSMilanka Ringwald 
2058ef7100fSMilanka Ringwald                 case AVDTP_SI_OPEN:
206e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
207e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_OPEN: stream endpoint is null");
208e8c2501fSMilanka Ringwald                         break;
209e8c2501fSMilanka Ringwald                     }
210747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) {
211747ec646SMilanka Ringwald                         log_error("AVDTP_SI_OPEN in wrong stream endpoint state");
212747ec646SMilanka Ringwald                         return;
213747ec646SMilanka Ringwald                     }
214747ec646SMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED;
2155bd73fa2SMatthias Ringwald                     connection->initiator_local_seid = stream_endpoint->sep.seid;
216ed161adbSMilanka Ringwald                     l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL);
217747ec646SMilanka Ringwald                     return;
2188ef7100fSMilanka Ringwald                 case AVDTP_SI_START:
219e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
220e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_START: stream endpoint is null");
221e8c2501fSMilanka Ringwald                         break;
222e8c2501fSMilanka Ringwald                     }
223747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) {
224747ec646SMilanka Ringwald                         log_error("AVDTP_SI_START in wrong stream endpoint state");
225747ec646SMilanka Ringwald                         return;
226747ec646SMilanka Ringwald                     }
2278ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
2288ef7100fSMilanka Ringwald                     break;
2298ef7100fSMilanka Ringwald                 case AVDTP_SI_SUSPEND:
230e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
231e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND: stream endpoint is null");
232e8c2501fSMilanka Ringwald                         break;
233e8c2501fSMilanka Ringwald                     }
234747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) {
235747ec646SMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state");
236747ec646SMilanka Ringwald                         return;
237747ec646SMilanka Ringwald                     }
2388ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
2398ef7100fSMilanka Ringwald                     break;
2408ef7100fSMilanka Ringwald                 case AVDTP_SI_CLOSE:
241e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
242e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_CLOSE: stream endpoint is null");
243e8c2501fSMilanka Ringwald                         break;
244e8c2501fSMilanka Ringwald                     }
2458ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING;
2468ef7100fSMilanka Ringwald                     break;
2478ef7100fSMilanka Ringwald                 case AVDTP_SI_ABORT:
248e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
249e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_ABORT: stream endpoint is null");
250e8c2501fSMilanka Ringwald                         break;
251e8c2501fSMilanka Ringwald                     }
2528ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
2538ef7100fSMilanka Ringwald                     break;
2548ef7100fSMilanka Ringwald                 default:
25550453b92SMatthias Ringwald                     log_info("    AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier);
2568ef7100fSMilanka Ringwald                     break;
2578ef7100fSMilanka Ringwald             }
25863274943SMilanka Ringwald             avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true);
25960ec20d0SMilanka Ringwald             connection->initiator_transaction_label++;
2608ef7100fSMilanka Ringwald             break;
2618ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_REJECT_MSG:
26250453b92SMatthias Ringwald             switch (connection->initiator_signaling_packet.signal_identifier){
263d8b859a2SMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:
264a3ce0109SMatthias Ringwald                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE;
265270f0cffSMatthias Ringwald                     log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry.");
266d8b859a2SMilanka Ringwald                     break;
267d8b859a2SMilanka Ringwald                 default:
268d8b859a2SMilanka Ringwald                     break;
269d8b859a2SMilanka Ringwald             }
27063274943SMilanka Ringwald             log_info("    AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
27163274943SMilanka Ringwald             avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2728ef7100fSMilanka Ringwald             return;
2738ef7100fSMilanka Ringwald         case AVDTP_GENERAL_REJECT_MSG:
27463274943SMilanka Ringwald             log_info("    AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
27563274943SMilanka Ringwald             avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2768ef7100fSMilanka Ringwald             return;
2778ef7100fSMilanka Ringwald         default:
2788ef7100fSMilanka Ringwald             break;
2798ef7100fSMilanka Ringwald     }
2808ef7100fSMilanka Ringwald }
2818ef7100fSMilanka Ringwald 
282087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){
2838ef7100fSMilanka Ringwald     switch (connection->initiator_connection_state){
2848ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS:
285149deddbSMilanka Ringwald             log_info("INT: W2_DISCOVER_SEPS");
2868ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2879413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label);
288087c4e09SMatthias Ringwald             return true;
2898ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES:
290149deddbSMilanka Ringwald             log_info("INT: W2_GET_CAPABILITIES");
2918ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
29296dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
293087c4e09SMatthias Ringwald             return true;
2948ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES:
295149deddbSMilanka Ringwald             log_info("INT: W2_GET_ALL_CAPABILITIES");
2968ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
29796dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
298087c4e09SMatthias Ringwald             return true;
2998ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION:
300149deddbSMilanka Ringwald             log_info("INT: W4_GET_CONFIGURATION");
3018ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30296dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid);
303087c4e09SMatthias Ringwald             return true;
30419af95b4SMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT:
305149deddbSMilanka Ringwald             log_info("INT: W4_DELAY_REPORT");
30619af95b4SMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30719af95b4SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label,
30896dcd0f4SMatthias Ringwald                                                             connection->initiator_remote_seid, connection->delay_ms);
309087c4e09SMatthias Ringwald             return true;
3108ef7100fSMilanka Ringwald         default:
3118ef7100fSMilanka Ringwald             break;
3128ef7100fSMilanka Ringwald     }
313087c4e09SMatthias Ringwald     return false;
314087c4e09SMatthias Ringwald }
3158ef7100fSMilanka Ringwald 
316087c4e09SMatthias Ringwald static void avdtp_initiator_stream_config_subsm_run_endpoint(avdtp_connection_t * connection, avdtp_stream_endpoint_t * stream_endpoint,  avdtp_initiator_stream_endpoint_state_t stream_endpoint_state){
317087c4e09SMatthias Ringwald     switch (stream_endpoint_state){
318087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_SET_CONFIGURATION:
319087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{
320087c4e09SMatthias Ringwald             if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){
321087c4e09SMatthias Ringwald                 log_info("initiator SM stop sending SET_CONFIGURATION cmd:");
322087c4e09SMatthias Ringwald                 break;
323087c4e09SMatthias Ringwald             }
324149deddbSMilanka Ringwald             log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid);
325087c4e09SMatthias Ringwald             // log_info_hexdump(  connection->remote_capabilities.media_codec.media_codec_information,  connection->remote_capabilities.media_codec.media_codec_information_len);
326087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid;
327087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid;
328087c4e09SMatthias Ringwald 
329087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION;
330087c4e09SMatthias Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE;
331087c4e09SMatthias Ringwald             if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){
332087c4e09SMatthias Ringwald                 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE;
333087c4e09SMatthias Ringwald             }
334087c4e09SMatthias Ringwald 
335087c4e09SMatthias Ringwald             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);
336087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
337087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
338087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
339087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
340087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
341087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
342087c4e09SMatthias Ringwald             }
343087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
344087c4e09SMatthias Ringwald             break;
345087c4e09SMatthias Ringwald         }
346087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{
347087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
348087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
349087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
350087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
351087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
352087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
353087c4e09SMatthias Ringwald             }
354087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
355087c4e09SMatthias Ringwald             break;
356087c4e09SMatthias Ringwald         }
357087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_OPEN_STREAM:
358087c4e09SMatthias Ringwald             switch (stream_endpoint->state){
359087c4e09SMatthias Ringwald                 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM:
360087c4e09SMatthias Ringwald                     log_info("INT: send AVDTP_SI_OPEN signaling to remote, transaction_label %d, remote seid 0x%02x", connection->initiator_transaction_label, connection->initiator_remote_seid);
361087c4e09SMatthias Ringwald                     avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid);
362087c4e09SMatthias Ringwald                     break;
363087c4e09SMatthias Ringwald                 default:
364087c4e09SMatthias Ringwald                     break;
365087c4e09SMatthias Ringwald             }
366087c4e09SMatthias Ringwald             break;
367087c4e09SMatthias Ringwald         default:
368087c4e09SMatthias Ringwald             break;
369087c4e09SMatthias Ringwald     }
370087c4e09SMatthias Ringwald }
371087c4e09SMatthias Ringwald 
372087c4e09SMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){
373087c4e09SMatthias Ringwald 
374087c4e09SMatthias Ringwald     bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection);
3758ef7100fSMilanka Ringwald     if (sent) return;
3768ef7100fSMilanka Ringwald 
377054be048SMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid);
3788ef7100fSMilanka Ringwald     if (!stream_endpoint){
3796f98b084SMilanka Ringwald         stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid);
3808ef7100fSMilanka Ringwald     }
3818ef7100fSMilanka Ringwald     if (!stream_endpoint) return;
3828ef7100fSMilanka Ringwald 
3838ef7100fSMilanka Ringwald     avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state;
3848ef7100fSMilanka Ringwald     stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER;
3858ef7100fSMilanka Ringwald 
38660ec20d0SMilanka Ringwald     if (stream_endpoint->start_stream){
38760ec20d0SMilanka Ringwald         stream_endpoint->start_stream = 0;
388da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){
3895bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
39096dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
39196dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid);
39260ec20d0SMilanka Ringwald             return;
39360ec20d0SMilanka Ringwald         }
39460ec20d0SMilanka Ringwald     }
39560ec20d0SMilanka Ringwald 
39660ec20d0SMilanka Ringwald     if (stream_endpoint->stop_stream){
39760ec20d0SMilanka Ringwald         stream_endpoint->stop_stream = 0;
398da4d6891SMilanka Ringwald         if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){
3995bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
40096dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
40196dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid);
40260ec20d0SMilanka Ringwald             return;
40360ec20d0SMilanka Ringwald         }
40460ec20d0SMilanka Ringwald     }
40560ec20d0SMilanka Ringwald 
40660ec20d0SMilanka Ringwald     if (stream_endpoint->abort_stream){
407da4d6891SMilanka Ringwald         stream_endpoint->abort_stream = 0;
40860ec20d0SMilanka Ringwald         switch (stream_endpoint->state){
40960ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CONFIGURED:
41060ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CLOSING:
41160ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_OPENED:
41260ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_STREAMING:
4135bd73fa2SMatthias Ringwald                 connection->initiator_local_seid = stream_endpoint->sep.seid;
41496dcd0f4SMatthias Ringwald                 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
41560ec20d0SMilanka Ringwald                 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
41696dcd0f4SMatthias Ringwald                 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid);
41760ec20d0SMilanka Ringwald                 return;
41860ec20d0SMilanka Ringwald             default:
41960ec20d0SMilanka Ringwald                 break;
42060ec20d0SMilanka Ringwald         }
42160ec20d0SMilanka Ringwald     }
42260ec20d0SMilanka Ringwald 
42360ec20d0SMilanka Ringwald     if (stream_endpoint->suspend_stream){
42460ec20d0SMilanka Ringwald         stream_endpoint->suspend_stream = 0;
425da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
4265bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
42796dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
42860ec20d0SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
42996dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid);
43060ec20d0SMilanka Ringwald             return;
43160ec20d0SMilanka Ringwald         }
43260ec20d0SMilanka Ringwald     }
43360ec20d0SMilanka Ringwald 
43460ec20d0SMilanka Ringwald     if (stream_endpoint->send_stream){
43560ec20d0SMilanka Ringwald         stream_endpoint->send_stream = 0;
436da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
43760ec20d0SMilanka Ringwald             stream_endpoint->state =  AVDTP_STREAM_ENDPOINT_STREAMING;
438f751daa3SMatthias Ringwald             avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint,
439f751daa3SMatthias Ringwald                                                            stream_endpoint->sequence_number);
44060ec20d0SMilanka Ringwald             return;
44160ec20d0SMilanka Ringwald         }
44260ec20d0SMilanka Ringwald     }
44360ec20d0SMilanka Ringwald 
444087c4e09SMatthias Ringwald     avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state);
4458ef7100fSMilanka Ringwald 
4468ef7100fSMilanka Ringwald     // check fragmentation
44750453b92SMatthias Ringwald     if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
4489413b167SMilanka Ringwald         avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid);
4498ef7100fSMilanka Ringwald     }
4508ef7100fSMilanka Ringwald }
451