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