18ef7100fSMilanka Ringwald /* 28ef7100fSMilanka Ringwald * Copyright (C) 2016 BlueKitchen GmbH 38ef7100fSMilanka Ringwald * 48ef7100fSMilanka Ringwald * Redistribution and use in source and binary forms, with or without 58ef7100fSMilanka Ringwald * modification, are permitted provided that the following conditions 68ef7100fSMilanka Ringwald * are met: 78ef7100fSMilanka Ringwald * 88ef7100fSMilanka Ringwald * 1. Redistributions of source code must retain the above copyright 98ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer. 108ef7100fSMilanka Ringwald * 2. Redistributions in binary form must reproduce the above copyright 118ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer in the 128ef7100fSMilanka Ringwald * documentation and/or other materials provided with the distribution. 138ef7100fSMilanka Ringwald * 3. Neither the name of the copyright holders nor the names of 148ef7100fSMilanka Ringwald * contributors may be used to endorse or promote products derived 158ef7100fSMilanka Ringwald * from this software without specific prior written permission. 168ef7100fSMilanka Ringwald * 4. Any redistribution, use, or modification is done solely for 178ef7100fSMilanka Ringwald * personal benefit and not for any commercial purpose or for 188ef7100fSMilanka Ringwald * monetary gain. 198ef7100fSMilanka Ringwald * 208ef7100fSMilanka Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 218ef7100fSMilanka Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 228ef7100fSMilanka Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 238ef7100fSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 248ef7100fSMilanka Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 258ef7100fSMilanka Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 268ef7100fSMilanka Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 278ef7100fSMilanka Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 288ef7100fSMilanka Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 298ef7100fSMilanka Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 308ef7100fSMilanka Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 318ef7100fSMilanka Ringwald * SUCH DAMAGE. 328ef7100fSMilanka Ringwald * 338ef7100fSMilanka Ringwald * Please inquire about commercial licensing options at 348ef7100fSMilanka Ringwald * [email protected] 358ef7100fSMilanka Ringwald * 368ef7100fSMilanka Ringwald */ 378ef7100fSMilanka Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avdtp_initiator.c" 39ab2c6ae4SMatthias Ringwald 408ef7100fSMilanka Ringwald #include <stdint.h> 418ef7100fSMilanka Ringwald #include <string.h> 428ef7100fSMilanka Ringwald 4384e3541eSMilanka Ringwald #include "bluetooth_psm.h" 4484e3541eSMilanka Ringwald #include "bluetooth_sdp.h" 4584e3541eSMilanka Ringwald #include "btstack_debug.h" 4684e3541eSMilanka Ringwald #include "btstack_event.h" 4784e3541eSMilanka Ringwald #include "l2cap.h" 484cb889a5SMilanka Ringwald #include "classic/avdtp.h" 494cb889a5SMilanka Ringwald #include "classic/avdtp_util.h" 504cb889a5SMilanka Ringwald #include "classic/avdtp_initiator.h" 518ef7100fSMilanka Ringwald 528ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){ 538ef7100fSMilanka Ringwald uint8_t command[2]; 548ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 558ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 568ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 578ef7100fSMilanka Ringwald } 588ef7100fSMilanka Ringwald 598ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd_with_seid(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label, uint8_t sep_id){ 608ef7100fSMilanka Ringwald uint8_t command[3]; 618ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 628ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 638ef7100fSMilanka Ringwald command[2] = sep_id << 2; 648ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 658ef7100fSMilanka Ringwald } 668ef7100fSMilanka Ringwald 6719af95b4SMilanka Ringwald static int avdtp_initiator_send_signaling_cmd_delay_report(uint16_t cid, uint8_t transaction_label, uint8_t sep_id, uint16_t delay_ms){ 6819af95b4SMilanka Ringwald uint8_t command[5]; 6919af95b4SMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 7019af95b4SMilanka Ringwald command[1] = AVDTP_SI_DELAYREPORT; 7119af95b4SMilanka Ringwald command[2] = sep_id << 2; 7219af95b4SMilanka Ringwald big_endian_store_16(command, 3, delay_ms); 7319af95b4SMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 7419af95b4SMilanka Ringwald } 7519af95b4SMilanka Ringwald 76747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){ 77319b19ccSMilanka Ringwald // int status = 0; 788ef7100fSMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = NULL; 79747ec646SMilanka Ringwald 808ef7100fSMilanka Ringwald avdtp_sep_t sep; 818ef7100fSMilanka Ringwald if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) { 828ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE; 838ef7100fSMilanka Ringwald } else { 84054be048SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 858ef7100fSMilanka Ringwald if (!stream_endpoint){ 866f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 878ef7100fSMilanka Ringwald } 88b95f2da3SMilanka Ringwald if (!stream_endpoint) { 89b95f2da3SMilanka Ringwald log_error("stream_endpoint for seid 0x%02x not found", connection->initiator_local_seid); 90b95f2da3SMilanka Ringwald return; 91b95f2da3SMilanka Ringwald } 9296dcd0f4SMatthias Ringwald sep.seid = connection->initiator_remote_seid; 938ef7100fSMilanka Ringwald 94b95f2da3SMilanka Ringwald if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) { 95b95f2da3SMilanka Ringwald log_error("initiator_config_state is in wrong state %d, expected %d", stream_endpoint->initiator_config_state, AVDTP_INITIATOR_W4_ANSWER); 96b95f2da3SMilanka Ringwald return; 97b95f2da3SMilanka Ringwald } 988ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 998ef7100fSMilanka Ringwald } 1008ef7100fSMilanka Ringwald 10150453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.message_type){ 1028ef7100fSMilanka Ringwald case AVDTP_RESPONSE_ACCEPT_MSG: 10350453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 1048ef7100fSMilanka Ringwald case AVDTP_SI_DISCOVER:{ 10550453b92SMatthias Ringwald if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){ 10650453b92SMatthias Ringwald log_info(" unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label); 107319b19ccSMilanka Ringwald // status = BAD_HEADER_FORMAT; 1088ef7100fSMilanka Ringwald break; 1098ef7100fSMilanka Ringwald } 1108ef7100fSMilanka Ringwald 1118ef7100fSMilanka Ringwald if (size == 3){ 1128587e32cSMilanka Ringwald log_info(" ERROR code %02x", packet[offset]); 1138ef7100fSMilanka Ringwald break; 1148ef7100fSMilanka Ringwald } 1158ef7100fSMilanka Ringwald 1168ef7100fSMilanka Ringwald int i; 1178ef7100fSMilanka Ringwald for (i = offset; i < size; i += 2){ 1188ef7100fSMilanka Ringwald sep.seid = packet[i] >> 2; 1198ef7100fSMilanka Ringwald offset++; 1200e588213SMatthias Ringwald if ((sep.seid < 0x01) || (sep.seid > 0x3E)){ 1218587e32cSMilanka Ringwald log_info(" invalid sep id"); 122319b19ccSMilanka Ringwald // status = BAD_ACP_SEID; 1238ef7100fSMilanka Ringwald break; 1248ef7100fSMilanka Ringwald } 1258ef7100fSMilanka Ringwald sep.in_use = (packet[i] >> 1) & 0x01; 1268ef7100fSMilanka Ringwald sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4); 1278ef7100fSMilanka Ringwald sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01); 1284ccacc40SMilanka Ringwald avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep); 1298ef7100fSMilanka Ringwald } 130485c0a4cSMilanka Ringwald avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid); 1318ef7100fSMilanka Ringwald break; 1328ef7100fSMilanka Ringwald } 1338ef7100fSMilanka Ringwald 1348ef7100fSMilanka Ringwald case AVDTP_SI_GET_CAPABILITIES: 1358ef7100fSMilanka Ringwald case AVDTP_SI_GET_ALL_CAPABILITIES: 13650453b92SMatthias Ringwald sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset); 1375bd73fa2SMatthias Ringwald avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, &sep.capabilities, sep.registered_service_categories); 1388ef7100fSMilanka Ringwald break; 13919af95b4SMilanka Ringwald case AVDTP_SI_DELAYREPORT: 1402d9d000fSMatthias Ringwald avdtp_signaling_emit_delay(connection->avdtp_cid, connection->initiator_local_seid, 1412d9d000fSMatthias Ringwald little_endian_read_16(packet, offset)); 14219af95b4SMilanka Ringwald break; 1438ef7100fSMilanka Ringwald case AVDTP_SI_GET_CONFIGURATION: 144ffa6c160SMilanka Ringwald // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset); 145ffa6c160SMilanka Ringwald // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){ 146ffa6c160SMilanka Ringwald // switch (sep.configuration.media_codec.media_codec_type){ 147ffa6c160SMilanka Ringwald // case AVDTP_CODEC_SBC: 1485bd73fa2SMatthias Ringwald // avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, 149ffa6c160SMilanka Ringwald // sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information); 150ffa6c160SMilanka Ringwald // break; 151ffa6c160SMilanka Ringwald // default: 1525bd73fa2SMatthias Ringwald // avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, sep.configuration.media_codec); 153ffa6c160SMilanka Ringwald // break; 154ffa6c160SMilanka Ringwald // } 155ffa6c160SMilanka Ringwald // } 1568ef7100fSMilanka Ringwald break; 1578ef7100fSMilanka Ringwald 1588ef7100fSMilanka Ringwald case AVDTP_SI_RECONFIGURE: 159e8c2501fSMilanka Ringwald if (!stream_endpoint){ 160e8c2501fSMilanka Ringwald log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null"); 161e8c2501fSMilanka Ringwald break; 162e8c2501fSMilanka Ringwald } 1638d254f09SMilanka Ringwald // copy sbc media codec info 164c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap; 165c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration; 1666535961aSMatthias Ringwald (void)memcpy(stream_endpoint->media_codec_sbc_info, 1676535961aSMatthias Ringwald stream_endpoint->remote_configuration.media_codec.media_codec_information, 1686535961aSMatthias Ringwald 4); 169c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info; 1702bb3471fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 1718ef7100fSMilanka Ringwald break; 1728ef7100fSMilanka Ringwald 1738ef7100fSMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION:{ 174e8c2501fSMilanka Ringwald if (!stream_endpoint){ 175e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null"); 176e8c2501fSMilanka Ringwald break; 177e8c2501fSMilanka Ringwald } 178ffa6c160SMilanka Ringwald sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap; 179ffa6c160SMilanka Ringwald sep.configuration = stream_endpoint->remote_configuration; 1808ef7100fSMilanka Ringwald sep.in_use = 1; 1818ef7100fSMilanka Ringwald 1828ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED; 183485c0a4cSMilanka Ringwald stream_endpoint->remote_sep = sep; 184485c0a4cSMilanka Ringwald stream_endpoint->connection = connection; 185a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED; 186485c0a4cSMilanka Ringwald 187485c0a4cSMilanka Ringwald log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint); 188ffa6c160SMilanka Ringwald 189ffa6c160SMilanka Ringwald switch (stream_endpoint->media_codec_type){ 190ffa6c160SMilanka Ringwald case AVDTP_CODEC_SBC: 191*0fbfe070SMatthias Ringwald avdtp_signaling_emit_media_codec_sbc_configuration( 192*0fbfe070SMatthias Ringwald stream_endpoint, 193*0fbfe070SMatthias Ringwald connection->avdtp_cid, 194*0fbfe070SMatthias Ringwald stream_endpoint->media_type, 195*0fbfe070SMatthias Ringwald stream_endpoint->media_codec_sbc_info); 196ffa6c160SMilanka Ringwald break; 197ffa6c160SMilanka Ringwald default: 198ffa6c160SMilanka Ringwald // TODO: we don\t have codec info to emit config 1995bd73fa2SMatthias Ringwald avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, sep.configuration.media_codec); 200ffa6c160SMilanka Ringwald break; 201ffa6c160SMilanka Ringwald } 2028ef7100fSMilanka Ringwald break; 2038ef7100fSMilanka Ringwald } 2048ef7100fSMilanka Ringwald 2058ef7100fSMilanka Ringwald case AVDTP_SI_OPEN: 206e8c2501fSMilanka Ringwald if (!stream_endpoint){ 207e8c2501fSMilanka Ringwald log_error("AVDTP_SI_OPEN: stream endpoint is null"); 208e8c2501fSMilanka Ringwald break; 209e8c2501fSMilanka Ringwald } 210747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) { 211747ec646SMilanka Ringwald log_error("AVDTP_SI_OPEN in wrong stream endpoint state"); 212747ec646SMilanka Ringwald return; 213747ec646SMilanka Ringwald } 214747ec646SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED; 2155bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 216ed161adbSMilanka Ringwald l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL); 217747ec646SMilanka Ringwald return; 2188ef7100fSMilanka Ringwald case AVDTP_SI_START: 219e8c2501fSMilanka Ringwald if (!stream_endpoint){ 220e8c2501fSMilanka Ringwald log_error("AVDTP_SI_START: stream endpoint is null"); 221e8c2501fSMilanka Ringwald break; 222e8c2501fSMilanka Ringwald } 223747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) { 224747ec646SMilanka Ringwald log_error("AVDTP_SI_START in wrong stream endpoint state"); 225747ec646SMilanka Ringwald return; 226747ec646SMilanka Ringwald } 2278ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 2288ef7100fSMilanka Ringwald break; 2298ef7100fSMilanka Ringwald case AVDTP_SI_SUSPEND: 230e8c2501fSMilanka Ringwald if (!stream_endpoint){ 231e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SUSPEND: stream endpoint is null"); 232e8c2501fSMilanka Ringwald break; 233e8c2501fSMilanka Ringwald } 234747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) { 235747ec646SMilanka Ringwald log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state"); 236747ec646SMilanka Ringwald return; 237747ec646SMilanka Ringwald } 2388ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 2398ef7100fSMilanka Ringwald break; 2408ef7100fSMilanka Ringwald case AVDTP_SI_CLOSE: 241e8c2501fSMilanka Ringwald if (!stream_endpoint){ 242e8c2501fSMilanka Ringwald log_error("AVDTP_SI_CLOSE: stream endpoint is null"); 243e8c2501fSMilanka Ringwald break; 244e8c2501fSMilanka Ringwald } 2458ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING; 2468ef7100fSMilanka Ringwald break; 2478ef7100fSMilanka Ringwald case AVDTP_SI_ABORT: 248e8c2501fSMilanka Ringwald if (!stream_endpoint){ 249e8c2501fSMilanka Ringwald log_error("AVDTP_SI_ABORT: stream endpoint is null"); 250e8c2501fSMilanka Ringwald break; 251e8c2501fSMilanka Ringwald } 2528ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 2538ef7100fSMilanka Ringwald break; 2548ef7100fSMilanka Ringwald default: 25550453b92SMatthias Ringwald log_info(" AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier); 2568ef7100fSMilanka Ringwald break; 2578ef7100fSMilanka Ringwald } 25863274943SMilanka Ringwald avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true); 25960ec20d0SMilanka Ringwald connection->initiator_transaction_label++; 2608ef7100fSMilanka Ringwald break; 2618ef7100fSMilanka Ringwald case AVDTP_RESPONSE_REJECT_MSG: 26250453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 263d8b859a2SMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION: 264a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE; 265270f0cffSMatthias Ringwald log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry."); 266d8b859a2SMilanka Ringwald break; 267d8b859a2SMilanka Ringwald default: 268d8b859a2SMilanka Ringwald break; 269d8b859a2SMilanka Ringwald } 27063274943SMilanka Ringwald log_info(" AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 27163274943SMilanka Ringwald avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 2728ef7100fSMilanka Ringwald return; 2738ef7100fSMilanka Ringwald case AVDTP_GENERAL_REJECT_MSG: 27463274943SMilanka Ringwald log_info(" AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 27563274943SMilanka Ringwald avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 2768ef7100fSMilanka Ringwald return; 2778ef7100fSMilanka Ringwald default: 2788ef7100fSMilanka Ringwald break; 2798ef7100fSMilanka Ringwald } 2808ef7100fSMilanka Ringwald } 2818ef7100fSMilanka Ringwald 282087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){ 2838ef7100fSMilanka Ringwald switch (connection->initiator_connection_state){ 2848ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS: 285149deddbSMilanka Ringwald log_info("INT: W2_DISCOVER_SEPS"); 2868ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 2879413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label); 288087c4e09SMatthias Ringwald return true; 2898ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES: 290149deddbSMilanka Ringwald log_info("INT: W2_GET_CAPABILITIES"); 2918ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 29296dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 293087c4e09SMatthias Ringwald return true; 2948ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES: 295149deddbSMilanka Ringwald log_info("INT: W2_GET_ALL_CAPABILITIES"); 2968ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 29796dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 298087c4e09SMatthias Ringwald return true; 2998ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION: 300149deddbSMilanka Ringwald log_info("INT: W4_GET_CONFIGURATION"); 3018ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 30296dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid); 303087c4e09SMatthias Ringwald return true; 30419af95b4SMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT: 305149deddbSMilanka Ringwald log_info("INT: W4_DELAY_REPORT"); 30619af95b4SMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 30719af95b4SMilanka Ringwald avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label, 30896dcd0f4SMatthias Ringwald connection->initiator_remote_seid, connection->delay_ms); 309087c4e09SMatthias Ringwald return true; 3108ef7100fSMilanka Ringwald default: 3118ef7100fSMilanka Ringwald break; 3128ef7100fSMilanka Ringwald } 313087c4e09SMatthias Ringwald return false; 314087c4e09SMatthias Ringwald } 3158ef7100fSMilanka Ringwald 316087c4e09SMatthias Ringwald static void avdtp_initiator_stream_config_subsm_run_endpoint(avdtp_connection_t * connection, avdtp_stream_endpoint_t * stream_endpoint, avdtp_initiator_stream_endpoint_state_t stream_endpoint_state){ 317087c4e09SMatthias Ringwald switch (stream_endpoint_state){ 318087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_SET_CONFIGURATION: 319087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{ 320087c4e09SMatthias Ringwald if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){ 321087c4e09SMatthias Ringwald log_info("initiator SM stop sending SET_CONFIGURATION cmd:"); 322087c4e09SMatthias Ringwald break; 323087c4e09SMatthias Ringwald } 324149deddbSMilanka Ringwald log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid); 325087c4e09SMatthias Ringwald // log_info_hexdump( connection->remote_capabilities.media_codec.media_codec_information, connection->remote_capabilities.media_codec.media_codec_information_len); 326087c4e09SMatthias Ringwald connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid; 327087c4e09SMatthias Ringwald connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid; 328087c4e09SMatthias Ringwald 329087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION; 330087c4e09SMatthias Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE; 331087c4e09SMatthias Ringwald if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){ 332087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE; 333087c4e09SMatthias Ringwald } 334087c4e09SMatthias Ringwald 335087c4e09SMatthias Ringwald avdtp_prepare_capabilities(&connection->initiator_signaling_packet, connection->initiator_transaction_label, stream_endpoint->remote_configuration_bitmap, stream_endpoint->remote_configuration, connection->initiator_signaling_packet.signal_identifier); 336087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 337087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 338087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 339087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 340087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 341087c4e09SMatthias Ringwald log_info("INT: fragmented"); 342087c4e09SMatthias Ringwald } 343087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 344087c4e09SMatthias Ringwald break; 345087c4e09SMatthias Ringwald } 346087c4e09SMatthias Ringwald case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{ 347087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 348087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 349087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 350087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 351087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 352087c4e09SMatthias Ringwald log_info("INT: fragmented"); 353087c4e09SMatthias Ringwald } 354087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 355087c4e09SMatthias Ringwald break; 356087c4e09SMatthias Ringwald } 357087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_OPEN_STREAM: 358087c4e09SMatthias Ringwald switch (stream_endpoint->state){ 359087c4e09SMatthias Ringwald case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM: 360087c4e09SMatthias Ringwald log_info("INT: send AVDTP_SI_OPEN signaling to remote, transaction_label %d, remote seid 0x%02x", connection->initiator_transaction_label, connection->initiator_remote_seid); 361087c4e09SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid); 362087c4e09SMatthias Ringwald break; 363087c4e09SMatthias Ringwald default: 364087c4e09SMatthias Ringwald break; 365087c4e09SMatthias Ringwald } 366087c4e09SMatthias Ringwald break; 367087c4e09SMatthias Ringwald default: 368087c4e09SMatthias Ringwald break; 369087c4e09SMatthias Ringwald } 370087c4e09SMatthias Ringwald } 371087c4e09SMatthias Ringwald 372087c4e09SMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){ 373087c4e09SMatthias Ringwald 374087c4e09SMatthias Ringwald bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection); 3758ef7100fSMilanka Ringwald if (sent) return; 3768ef7100fSMilanka Ringwald 377054be048SMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 3788ef7100fSMilanka Ringwald if (!stream_endpoint){ 3796f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 3808ef7100fSMilanka Ringwald } 3818ef7100fSMilanka Ringwald if (!stream_endpoint) return; 3828ef7100fSMilanka Ringwald 3838ef7100fSMilanka Ringwald avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state; 3848ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 3858ef7100fSMilanka Ringwald 38660ec20d0SMilanka Ringwald if (stream_endpoint->start_stream){ 38760ec20d0SMilanka Ringwald stream_endpoint->start_stream = 0; 388da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){ 3895bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 39096dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 39196dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid); 39260ec20d0SMilanka Ringwald return; 39360ec20d0SMilanka Ringwald } 39460ec20d0SMilanka Ringwald } 39560ec20d0SMilanka Ringwald 39660ec20d0SMilanka Ringwald if (stream_endpoint->stop_stream){ 39760ec20d0SMilanka Ringwald stream_endpoint->stop_stream = 0; 398da4d6891SMilanka Ringwald if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){ 3995bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 40096dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 40196dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid); 40260ec20d0SMilanka Ringwald return; 40360ec20d0SMilanka Ringwald } 40460ec20d0SMilanka Ringwald } 40560ec20d0SMilanka Ringwald 40660ec20d0SMilanka Ringwald if (stream_endpoint->abort_stream){ 407da4d6891SMilanka Ringwald stream_endpoint->abort_stream = 0; 40860ec20d0SMilanka Ringwald switch (stream_endpoint->state){ 40960ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CONFIGURED: 41060ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CLOSING: 41160ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 41260ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 4135bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 41496dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 41560ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 41696dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid); 41760ec20d0SMilanka Ringwald return; 41860ec20d0SMilanka Ringwald default: 41960ec20d0SMilanka Ringwald break; 42060ec20d0SMilanka Ringwald } 42160ec20d0SMilanka Ringwald } 42260ec20d0SMilanka Ringwald 42360ec20d0SMilanka Ringwald if (stream_endpoint->suspend_stream){ 42460ec20d0SMilanka Ringwald stream_endpoint->suspend_stream = 0; 425da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 4265bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 42796dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 42860ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 42996dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid); 43060ec20d0SMilanka Ringwald return; 43160ec20d0SMilanka Ringwald } 43260ec20d0SMilanka Ringwald } 43360ec20d0SMilanka Ringwald 43460ec20d0SMilanka Ringwald if (stream_endpoint->send_stream){ 43560ec20d0SMilanka Ringwald stream_endpoint->send_stream = 0; 436da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 43760ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 438f751daa3SMatthias Ringwald avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint, 439f751daa3SMatthias Ringwald stream_endpoint->sequence_number); 44060ec20d0SMilanka Ringwald return; 44160ec20d0SMilanka Ringwald } 44260ec20d0SMilanka Ringwald } 44360ec20d0SMilanka Ringwald 444087c4e09SMatthias Ringwald avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state); 4458ef7100fSMilanka Ringwald 4468ef7100fSMilanka Ringwald // check fragmentation 44750453b92SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 4489413b167SMilanka Ringwald avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 4498ef7100fSMilanka Ringwald } 4508ef7100fSMilanka Ringwald } 451