xref: /btstack/src/classic/avdtp_initiator.c (revision f751daa3e83b8c78f824b3d6cfa8412a4f191539)
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:
1405bd73fa2SMatthias Ringwald                     avdtp_signaling_emit_delay(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, little_endian_read_16(packet, offset));
14119af95b4SMilanka Ringwald                     break;
1428ef7100fSMilanka Ringwald                 case AVDTP_SI_GET_CONFIGURATION:
143ffa6c160SMilanka Ringwald                     // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset);
144ffa6c160SMilanka Ringwald                     // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){
145ffa6c160SMilanka Ringwald                     //     switch (sep.configuration.media_codec.media_codec_type){
146ffa6c160SMilanka Ringwald                     //         case AVDTP_CODEC_SBC:
1475bd73fa2SMatthias Ringwald                     //             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid,
148ffa6c160SMilanka Ringwald                     //                 sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information);
149ffa6c160SMilanka Ringwald                     //             break;
150ffa6c160SMilanka Ringwald                     //         default:
1515bd73fa2SMatthias 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);
152ffa6c160SMilanka Ringwald                     //             break;
153ffa6c160SMilanka Ringwald                     //     }
154ffa6c160SMilanka Ringwald                     // }
1558ef7100fSMilanka Ringwald                     break;
1568ef7100fSMilanka Ringwald 
1578ef7100fSMilanka Ringwald                 case AVDTP_SI_RECONFIGURE:
158e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
159e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null");
160e8c2501fSMilanka Ringwald                         break;
161e8c2501fSMilanka Ringwald                     }
1628d254f09SMilanka Ringwald                     // copy sbc media codec info
163c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap;
164c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration;
1656535961aSMatthias Ringwald                     (void)memcpy(stream_endpoint->media_codec_sbc_info,
1666535961aSMatthias Ringwald                                  stream_endpoint->remote_configuration.media_codec.media_codec_information,
1676535961aSMatthias Ringwald                                  4);
168c4bbf774SMilanka Ringwald                     stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info;
1692bb3471fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
1708ef7100fSMilanka Ringwald                     break;
1718ef7100fSMilanka Ringwald 
1728ef7100fSMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:{
173e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
174e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null");
175e8c2501fSMilanka Ringwald                         break;
176e8c2501fSMilanka Ringwald                     }
177ffa6c160SMilanka Ringwald                     sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap;
178ffa6c160SMilanka Ringwald                     sep.configuration = stream_endpoint->remote_configuration;
1798ef7100fSMilanka Ringwald                     sep.in_use = 1;
1808ef7100fSMilanka Ringwald 
1818ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED;
182485c0a4cSMilanka Ringwald                     stream_endpoint->remote_sep = sep;
183485c0a4cSMilanka Ringwald                     stream_endpoint->connection = connection;
184a3ce0109SMatthias Ringwald                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED;
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:
1905bd73fa2SMatthias Ringwald                             avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_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
1955bd73fa2SMatthias 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);
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;
2115bd73fa2SMatthias Ringwald                     connection->initiator_local_seid = stream_endpoint->sep.seid;
212ed161adbSMilanka Ringwald                     l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_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;
2508ef7100fSMilanka Ringwald                 default:
25150453b92SMatthias Ringwald                     log_info("    AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier);
2528ef7100fSMilanka Ringwald                     break;
2538ef7100fSMilanka Ringwald             }
25463274943SMilanka Ringwald             avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true);
25560ec20d0SMilanka Ringwald             connection->initiator_transaction_label++;
2568ef7100fSMilanka Ringwald             break;
2578ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_REJECT_MSG:
25850453b92SMatthias Ringwald             switch (connection->initiator_signaling_packet.signal_identifier){
259d8b859a2SMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:
260a3ce0109SMatthias Ringwald                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE;
261270f0cffSMatthias Ringwald                     log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry.");
262d8b859a2SMilanka Ringwald                     break;
263d8b859a2SMilanka Ringwald                 default:
264d8b859a2SMilanka Ringwald                     break;
265d8b859a2SMilanka Ringwald             }
26663274943SMilanka Ringwald             log_info("    AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
26763274943SMilanka Ringwald             avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2688ef7100fSMilanka Ringwald             return;
2698ef7100fSMilanka Ringwald         case AVDTP_GENERAL_REJECT_MSG:
27063274943SMilanka Ringwald             log_info("    AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
27163274943SMilanka Ringwald             avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2728ef7100fSMilanka Ringwald             return;
2738ef7100fSMilanka Ringwald         default:
2748ef7100fSMilanka Ringwald             break;
2758ef7100fSMilanka Ringwald     }
2768ef7100fSMilanka Ringwald }
2778ef7100fSMilanka Ringwald 
278087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){
2798ef7100fSMilanka Ringwald     switch (connection->initiator_connection_state){
2808ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS:
281149deddbSMilanka Ringwald             log_info("INT: W2_DISCOVER_SEPS");
2828ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2839413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label);
284087c4e09SMatthias Ringwald             return true;
2858ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES:
286149deddbSMilanka Ringwald             log_info("INT: W2_GET_CAPABILITIES");
2878ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
28896dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
289087c4e09SMatthias Ringwald             return true;
2908ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES:
291149deddbSMilanka Ringwald             log_info("INT: W2_GET_ALL_CAPABILITIES");
2928ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
29396dcd0f4SMatthias 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);
294087c4e09SMatthias Ringwald             return true;
2958ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION:
296149deddbSMilanka Ringwald             log_info("INT: W4_GET_CONFIGURATION");
2978ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
29896dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid);
299087c4e09SMatthias Ringwald             return true;
30019af95b4SMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT:
301149deddbSMilanka Ringwald             log_info("INT: W4_DELAY_REPORT");
30219af95b4SMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30319af95b4SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label,
30496dcd0f4SMatthias Ringwald                                                             connection->initiator_remote_seid, connection->delay_ms);
305087c4e09SMatthias Ringwald             return true;
3068ef7100fSMilanka Ringwald         default:
3078ef7100fSMilanka Ringwald             break;
3088ef7100fSMilanka Ringwald     }
309087c4e09SMatthias Ringwald     return false;
310087c4e09SMatthias Ringwald }
3118ef7100fSMilanka Ringwald 
312087c4e09SMatthias 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){
313087c4e09SMatthias Ringwald     switch (stream_endpoint_state){
314087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_SET_CONFIGURATION:
315087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{
316087c4e09SMatthias Ringwald             if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){
317087c4e09SMatthias Ringwald                 log_info("initiator SM stop sending SET_CONFIGURATION cmd:");
318087c4e09SMatthias Ringwald                 break;
319087c4e09SMatthias Ringwald             }
320149deddbSMilanka Ringwald             log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid);
321087c4e09SMatthias Ringwald             // log_info_hexdump(  connection->remote_capabilities.media_codec.media_codec_information,  connection->remote_capabilities.media_codec.media_codec_information_len);
322087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid;
323087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid;
324087c4e09SMatthias Ringwald 
325087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION;
326087c4e09SMatthias Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE;
327087c4e09SMatthias Ringwald             if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){
328087c4e09SMatthias Ringwald                 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE;
329087c4e09SMatthias Ringwald             }
330087c4e09SMatthias Ringwald 
331087c4e09SMatthias 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);
332087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
333087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
334087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
335087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
336087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
337087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
338087c4e09SMatthias Ringwald             }
339087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
340087c4e09SMatthias Ringwald             break;
341087c4e09SMatthias Ringwald         }
342087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{
343087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
344087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
345087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
346087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
347087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
348087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
349087c4e09SMatthias Ringwald             }
350087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
351087c4e09SMatthias Ringwald             break;
352087c4e09SMatthias Ringwald         }
353087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_OPEN_STREAM:
354087c4e09SMatthias Ringwald             switch (stream_endpoint->state){
355087c4e09SMatthias Ringwald                 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM:
356087c4e09SMatthias 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);
357087c4e09SMatthias Ringwald                     avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid);
358087c4e09SMatthias Ringwald                     break;
359087c4e09SMatthias Ringwald                 default:
360087c4e09SMatthias Ringwald                     break;
361087c4e09SMatthias Ringwald             }
362087c4e09SMatthias Ringwald             break;
363087c4e09SMatthias Ringwald         default:
364087c4e09SMatthias Ringwald             break;
365087c4e09SMatthias Ringwald     }
366087c4e09SMatthias Ringwald }
367087c4e09SMatthias Ringwald 
368087c4e09SMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){
369087c4e09SMatthias Ringwald 
370087c4e09SMatthias Ringwald     bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection);
3718ef7100fSMilanka Ringwald     if (sent) return;
3728ef7100fSMilanka Ringwald 
373054be048SMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid);
3748ef7100fSMilanka Ringwald     if (!stream_endpoint){
3756f98b084SMilanka Ringwald         stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid);
3768ef7100fSMilanka Ringwald     }
3778ef7100fSMilanka Ringwald     if (!stream_endpoint) return;
3788ef7100fSMilanka Ringwald 
3798ef7100fSMilanka Ringwald     avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state;
3808ef7100fSMilanka Ringwald     stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER;
3818ef7100fSMilanka Ringwald 
38260ec20d0SMilanka Ringwald     if (stream_endpoint->start_stream){
38360ec20d0SMilanka Ringwald         stream_endpoint->start_stream = 0;
384da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){
3855bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
38696dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
38796dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid);
38860ec20d0SMilanka Ringwald             return;
38960ec20d0SMilanka Ringwald         }
39060ec20d0SMilanka Ringwald     }
39160ec20d0SMilanka Ringwald 
39260ec20d0SMilanka Ringwald     if (stream_endpoint->stop_stream){
39360ec20d0SMilanka Ringwald         stream_endpoint->stop_stream = 0;
394da4d6891SMilanka Ringwald         if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){
3955bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
39696dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
39796dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid);
39860ec20d0SMilanka Ringwald             return;
39960ec20d0SMilanka Ringwald         }
40060ec20d0SMilanka Ringwald     }
40160ec20d0SMilanka Ringwald 
40260ec20d0SMilanka Ringwald     if (stream_endpoint->abort_stream){
403da4d6891SMilanka Ringwald         stream_endpoint->abort_stream = 0;
40460ec20d0SMilanka Ringwald         switch (stream_endpoint->state){
40560ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CONFIGURED:
40660ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CLOSING:
40760ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_OPENED:
40860ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_STREAMING:
4095bd73fa2SMatthias Ringwald                 connection->initiator_local_seid = stream_endpoint->sep.seid;
41096dcd0f4SMatthias Ringwald                 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
41160ec20d0SMilanka Ringwald                 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
41296dcd0f4SMatthias Ringwald                 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid);
41360ec20d0SMilanka Ringwald                 return;
41460ec20d0SMilanka Ringwald             default:
41560ec20d0SMilanka Ringwald                 break;
41660ec20d0SMilanka Ringwald         }
41760ec20d0SMilanka Ringwald     }
41860ec20d0SMilanka Ringwald 
41960ec20d0SMilanka Ringwald     if (stream_endpoint->suspend_stream){
42060ec20d0SMilanka Ringwald         stream_endpoint->suspend_stream = 0;
421da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
4225bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
42396dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
42460ec20d0SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
42596dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid);
42660ec20d0SMilanka Ringwald             return;
42760ec20d0SMilanka Ringwald         }
42860ec20d0SMilanka Ringwald     }
42960ec20d0SMilanka Ringwald 
43060ec20d0SMilanka Ringwald     if (stream_endpoint->send_stream){
43160ec20d0SMilanka Ringwald         stream_endpoint->send_stream = 0;
432da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
43360ec20d0SMilanka Ringwald             stream_endpoint->state =  AVDTP_STREAM_ENDPOINT_STREAMING;
434*f751daa3SMatthias Ringwald             avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint,
435*f751daa3SMatthias Ringwald                                                            stream_endpoint->sequence_number);
43660ec20d0SMilanka Ringwald             return;
43760ec20d0SMilanka Ringwald         }
43860ec20d0SMilanka Ringwald     }
43960ec20d0SMilanka Ringwald 
440087c4e09SMatthias Ringwald     avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state);
4418ef7100fSMilanka Ringwald 
4428ef7100fSMilanka Ringwald     // check fragmentation
44350453b92SMatthias Ringwald     if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
4449413b167SMilanka Ringwald         avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid);
4458ef7100fSMilanka Ringwald     }
4468ef7100fSMilanka Ringwald }
447