xref: /btstack/src/classic/avdtp_initiator.c (revision f08f4934f31cf992e4c7df753556e2e10ca62d73)
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:
1910fbfe070SMatthias Ringwald                             avdtp_signaling_emit_media_codec_sbc_configuration(
1920fbfe070SMatthias Ringwald                                     stream_endpoint,
1930fbfe070SMatthias Ringwald                                     connection->avdtp_cid,
1940fbfe070SMatthias Ringwald                                     stream_endpoint->media_type,
1950fbfe070SMatthias 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
199*f08f4934SMatthias Ringwald                             avdtp_signaling_emit_media_codec_other_configuration(stream_endpoint,
200*f08f4934SMatthias Ringwald                                                                                  connection->avdtp_cid,
201*f08f4934SMatthias Ringwald                                                                                  connection->initiator_local_seid,
202*f08f4934SMatthias Ringwald                                                                                  connection->initiator_remote_seid,
203*f08f4934SMatthias Ringwald                                                                                  sep.configuration.media_codec);
204ffa6c160SMilanka Ringwald                             break;
205ffa6c160SMilanka Ringwald                     }
2068ef7100fSMilanka Ringwald                     break;
2078ef7100fSMilanka Ringwald                 }
2088ef7100fSMilanka Ringwald 
2098ef7100fSMilanka Ringwald                 case AVDTP_SI_OPEN:
210e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
211e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_OPEN: stream endpoint is null");
212e8c2501fSMilanka Ringwald                         break;
213e8c2501fSMilanka Ringwald                     }
214747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) {
215747ec646SMilanka Ringwald                         log_error("AVDTP_SI_OPEN in wrong stream endpoint state");
216747ec646SMilanka Ringwald                         return;
217747ec646SMilanka Ringwald                     }
218747ec646SMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED;
2195bd73fa2SMatthias Ringwald                     connection->initiator_local_seid = stream_endpoint->sep.seid;
220ed161adbSMilanka Ringwald                     l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL);
221747ec646SMilanka Ringwald                     return;
2228ef7100fSMilanka Ringwald                 case AVDTP_SI_START:
223e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
224e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_START: stream endpoint is null");
225e8c2501fSMilanka Ringwald                         break;
226e8c2501fSMilanka Ringwald                     }
227747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) {
228747ec646SMilanka Ringwald                         log_error("AVDTP_SI_START in wrong stream endpoint state");
229747ec646SMilanka Ringwald                         return;
230747ec646SMilanka Ringwald                     }
2318ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
2328ef7100fSMilanka Ringwald                     break;
2338ef7100fSMilanka Ringwald                 case AVDTP_SI_SUSPEND:
234e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
235e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND: stream endpoint is null");
236e8c2501fSMilanka Ringwald                         break;
237e8c2501fSMilanka Ringwald                     }
238747ec646SMilanka Ringwald                     if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) {
239747ec646SMilanka Ringwald                         log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state");
240747ec646SMilanka Ringwald                         return;
241747ec646SMilanka Ringwald                     }
2428ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED;
2438ef7100fSMilanka Ringwald                     break;
2448ef7100fSMilanka Ringwald                 case AVDTP_SI_CLOSE:
245e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
246e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_CLOSE: stream endpoint is null");
247e8c2501fSMilanka Ringwald                         break;
248e8c2501fSMilanka Ringwald                     }
2498ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING;
2508ef7100fSMilanka Ringwald                     break;
2518ef7100fSMilanka Ringwald                 case AVDTP_SI_ABORT:
252e8c2501fSMilanka Ringwald                     if (!stream_endpoint){
253e8c2501fSMilanka Ringwald                         log_error("AVDTP_SI_ABORT: stream endpoint is null");
254e8c2501fSMilanka Ringwald                         break;
255e8c2501fSMilanka Ringwald                     }
2568ef7100fSMilanka Ringwald                     stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
2578ef7100fSMilanka Ringwald                     break;
2588ef7100fSMilanka Ringwald                 default:
25950453b92SMatthias Ringwald                     log_info("    AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier);
2608ef7100fSMilanka Ringwald                     break;
2618ef7100fSMilanka Ringwald             }
26263274943SMilanka Ringwald             avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true);
26360ec20d0SMilanka Ringwald             connection->initiator_transaction_label++;
2648ef7100fSMilanka Ringwald             break;
2658ef7100fSMilanka Ringwald         case AVDTP_RESPONSE_REJECT_MSG:
26650453b92SMatthias Ringwald             switch (connection->initiator_signaling_packet.signal_identifier){
267d8b859a2SMilanka Ringwald                 case AVDTP_SI_SET_CONFIGURATION:
268a3ce0109SMatthias Ringwald                     connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE;
269270f0cffSMatthias Ringwald                     log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry.");
270d8b859a2SMilanka Ringwald                     break;
271d8b859a2SMilanka Ringwald                 default:
272d8b859a2SMilanka Ringwald                     break;
273d8b859a2SMilanka Ringwald             }
27463274943SMilanka Ringwald             log_info("    AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
27563274943SMilanka Ringwald             avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2768ef7100fSMilanka Ringwald             return;
2778ef7100fSMilanka Ringwald         case AVDTP_GENERAL_REJECT_MSG:
27863274943SMilanka Ringwald             log_info("    AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier));
27963274943SMilanka Ringwald             avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true);
2808ef7100fSMilanka Ringwald             return;
2818ef7100fSMilanka Ringwald         default:
2828ef7100fSMilanka Ringwald             break;
2838ef7100fSMilanka Ringwald     }
2848ef7100fSMilanka Ringwald }
2858ef7100fSMilanka Ringwald 
286087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){
2878ef7100fSMilanka Ringwald     switch (connection->initiator_connection_state){
2888ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS:
289149deddbSMilanka Ringwald             log_info("INT: W2_DISCOVER_SEPS");
2908ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
2919413b167SMilanka Ringwald             avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label);
292087c4e09SMatthias Ringwald             return true;
2938ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES:
294149deddbSMilanka Ringwald             log_info("INT: W2_GET_CAPABILITIES");
2958ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
29696dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid);
297087c4e09SMatthias Ringwald             return true;
2988ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES:
299149deddbSMilanka Ringwald             log_info("INT: W2_GET_ALL_CAPABILITIES");
3008ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30196dcd0f4SMatthias 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);
302087c4e09SMatthias Ringwald             return true;
3038ef7100fSMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION:
304149deddbSMilanka Ringwald             log_info("INT: W4_GET_CONFIGURATION");
3058ef7100fSMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
30696dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid);
307087c4e09SMatthias Ringwald             return true;
30819af95b4SMilanka Ringwald         case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT:
309149deddbSMilanka Ringwald             log_info("INT: W4_DELAY_REPORT");
31019af95b4SMilanka Ringwald             connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER;
31119af95b4SMilanka Ringwald             avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label,
31296dcd0f4SMatthias Ringwald                                                             connection->initiator_remote_seid, connection->delay_ms);
313087c4e09SMatthias Ringwald             return true;
3148ef7100fSMilanka Ringwald         default:
3158ef7100fSMilanka Ringwald             break;
3168ef7100fSMilanka Ringwald     }
317087c4e09SMatthias Ringwald     return false;
318087c4e09SMatthias Ringwald }
3198ef7100fSMilanka Ringwald 
320087c4e09SMatthias 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){
321087c4e09SMatthias Ringwald     switch (stream_endpoint_state){
322087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_SET_CONFIGURATION:
323087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{
324087c4e09SMatthias Ringwald             if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){
325087c4e09SMatthias Ringwald                 log_info("initiator SM stop sending SET_CONFIGURATION cmd:");
326087c4e09SMatthias Ringwald                 break;
327087c4e09SMatthias Ringwald             }
328149deddbSMilanka Ringwald             log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid);
329087c4e09SMatthias Ringwald             // log_info_hexdump(  connection->remote_capabilities.media_codec.media_codec_information,  connection->remote_capabilities.media_codec.media_codec_information_len);
330087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid;
331087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid;
332087c4e09SMatthias Ringwald 
333087c4e09SMatthias Ringwald             connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION;
334087c4e09SMatthias Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE;
335087c4e09SMatthias Ringwald             if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){
336087c4e09SMatthias Ringwald                 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE;
337087c4e09SMatthias Ringwald             }
338087c4e09SMatthias Ringwald 
339087c4e09SMatthias 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);
340087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
341087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
342087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
343087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
344087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
345087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
346087c4e09SMatthias Ringwald             }
347087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
348087c4e09SMatthias Ringwald             break;
349087c4e09SMatthias Ringwald         }
350087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{
351087c4e09SMatthias Ringwald             l2cap_reserve_packet_buffer();
352087c4e09SMatthias Ringwald             uint8_t * out_buffer = l2cap_get_outgoing_buffer();
353087c4e09SMatthias Ringwald             uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer);
354087c4e09SMatthias Ringwald             if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
355087c4e09SMatthias Ringwald                 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND;
356087c4e09SMatthias Ringwald                 log_info("INT: fragmented");
357087c4e09SMatthias Ringwald             }
358087c4e09SMatthias Ringwald             l2cap_send_prepared(connection->l2cap_signaling_cid, pos);
359087c4e09SMatthias Ringwald             break;
360087c4e09SMatthias Ringwald         }
361087c4e09SMatthias Ringwald         case AVDTP_INITIATOR_W2_OPEN_STREAM:
362087c4e09SMatthias Ringwald             switch (stream_endpoint->state){
363087c4e09SMatthias Ringwald                 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM:
364087c4e09SMatthias 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);
365087c4e09SMatthias Ringwald                     avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid);
366087c4e09SMatthias Ringwald                     break;
367087c4e09SMatthias Ringwald                 default:
368087c4e09SMatthias Ringwald                     break;
369087c4e09SMatthias Ringwald             }
370087c4e09SMatthias Ringwald             break;
371087c4e09SMatthias Ringwald         default:
372087c4e09SMatthias Ringwald             break;
373087c4e09SMatthias Ringwald     }
374087c4e09SMatthias Ringwald }
375087c4e09SMatthias Ringwald 
376087c4e09SMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){
377087c4e09SMatthias Ringwald 
378087c4e09SMatthias Ringwald     bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection);
3798ef7100fSMilanka Ringwald     if (sent) return;
3808ef7100fSMilanka Ringwald 
381054be048SMilanka Ringwald     avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid);
3828ef7100fSMilanka Ringwald     if (!stream_endpoint){
3836f98b084SMilanka Ringwald         stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid);
3848ef7100fSMilanka Ringwald     }
3858ef7100fSMilanka Ringwald     if (!stream_endpoint) return;
3868ef7100fSMilanka Ringwald 
3878ef7100fSMilanka Ringwald     avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state;
3888ef7100fSMilanka Ringwald     stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER;
3898ef7100fSMilanka Ringwald 
39060ec20d0SMilanka Ringwald     if (stream_endpoint->start_stream){
39160ec20d0SMilanka Ringwald         stream_endpoint->start_stream = 0;
392da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){
3935bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
39496dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
39596dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid);
39660ec20d0SMilanka Ringwald             return;
39760ec20d0SMilanka Ringwald         }
39860ec20d0SMilanka Ringwald     }
39960ec20d0SMilanka Ringwald 
40060ec20d0SMilanka Ringwald     if (stream_endpoint->stop_stream){
40160ec20d0SMilanka Ringwald         stream_endpoint->stop_stream = 0;
402da4d6891SMilanka Ringwald         if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){
4035bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
40496dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
40596dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid);
40660ec20d0SMilanka Ringwald             return;
40760ec20d0SMilanka Ringwald         }
40860ec20d0SMilanka Ringwald     }
40960ec20d0SMilanka Ringwald 
41060ec20d0SMilanka Ringwald     if (stream_endpoint->abort_stream){
411da4d6891SMilanka Ringwald         stream_endpoint->abort_stream = 0;
41260ec20d0SMilanka Ringwald         switch (stream_endpoint->state){
41360ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CONFIGURED:
41460ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_CLOSING:
41560ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_OPENED:
41660ec20d0SMilanka Ringwald             case AVDTP_STREAM_ENDPOINT_STREAMING:
4175bd73fa2SMatthias Ringwald                 connection->initiator_local_seid = stream_endpoint->sep.seid;
41896dcd0f4SMatthias Ringwald                 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
41960ec20d0SMilanka Ringwald                 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING;
42096dcd0f4SMatthias Ringwald                 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid);
42160ec20d0SMilanka Ringwald                 return;
42260ec20d0SMilanka Ringwald             default:
42360ec20d0SMilanka Ringwald                 break;
42460ec20d0SMilanka Ringwald         }
42560ec20d0SMilanka Ringwald     }
42660ec20d0SMilanka Ringwald 
42760ec20d0SMilanka Ringwald     if (stream_endpoint->suspend_stream){
42860ec20d0SMilanka Ringwald         stream_endpoint->suspend_stream = 0;
429da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
4305bd73fa2SMatthias Ringwald             connection->initiator_local_seid = stream_endpoint->sep.seid;
43196dcd0f4SMatthias Ringwald             connection->initiator_remote_seid = stream_endpoint->remote_sep.seid;
43260ec20d0SMilanka Ringwald             stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING;
43396dcd0f4SMatthias Ringwald             avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid);
43460ec20d0SMilanka Ringwald             return;
43560ec20d0SMilanka Ringwald         }
43660ec20d0SMilanka Ringwald     }
43760ec20d0SMilanka Ringwald 
43860ec20d0SMilanka Ringwald     if (stream_endpoint->send_stream){
43960ec20d0SMilanka Ringwald         stream_endpoint->send_stream = 0;
440da4d6891SMilanka Ringwald         if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){
44160ec20d0SMilanka Ringwald             stream_endpoint->state =  AVDTP_STREAM_ENDPOINT_STREAMING;
442f751daa3SMatthias Ringwald             avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint,
443f751daa3SMatthias Ringwald                                                            stream_endpoint->sequence_number);
44460ec20d0SMilanka Ringwald             return;
44560ec20d0SMilanka Ringwald         }
44660ec20d0SMilanka Ringwald     }
44760ec20d0SMilanka Ringwald 
448087c4e09SMatthias Ringwald     avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state);
4498ef7100fSMilanka Ringwald 
4508ef7100fSMilanka Ringwald     // check fragmentation
45150453b92SMatthias Ringwald     if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){
4529413b167SMilanka Ringwald         avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid);
4538ef7100fSMilanka Ringwald     }
4548ef7100fSMilanka Ringwald }
455