18ef7100fSMilanka Ringwald /* 28ef7100fSMilanka Ringwald * Copyright (C) 2016 BlueKitchen GmbH 38ef7100fSMilanka Ringwald * 48ef7100fSMilanka Ringwald * Redistribution and use in source and binary forms, with or without 58ef7100fSMilanka Ringwald * modification, are permitted provided that the following conditions 68ef7100fSMilanka Ringwald * are met: 78ef7100fSMilanka Ringwald * 88ef7100fSMilanka Ringwald * 1. Redistributions of source code must retain the above copyright 98ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer. 108ef7100fSMilanka Ringwald * 2. Redistributions in binary form must reproduce the above copyright 118ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer in the 128ef7100fSMilanka Ringwald * documentation and/or other materials provided with the distribution. 138ef7100fSMilanka Ringwald * 3. Neither the name of the copyright holders nor the names of 148ef7100fSMilanka Ringwald * contributors may be used to endorse or promote products derived 158ef7100fSMilanka Ringwald * from this software without specific prior written permission. 168ef7100fSMilanka Ringwald * 4. Any redistribution, use, or modification is done solely for 178ef7100fSMilanka Ringwald * personal benefit and not for any commercial purpose or for 188ef7100fSMilanka Ringwald * monetary gain. 198ef7100fSMilanka Ringwald * 208ef7100fSMilanka Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 218ef7100fSMilanka Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 228ef7100fSMilanka Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 238ef7100fSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 248ef7100fSMilanka Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 258ef7100fSMilanka Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 268ef7100fSMilanka Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 278ef7100fSMilanka Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 288ef7100fSMilanka Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 298ef7100fSMilanka Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 308ef7100fSMilanka Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 318ef7100fSMilanka Ringwald * SUCH DAMAGE. 328ef7100fSMilanka Ringwald * 338ef7100fSMilanka Ringwald * Please inquire about commercial licensing options at 348ef7100fSMilanka Ringwald * [email protected] 358ef7100fSMilanka Ringwald * 368ef7100fSMilanka Ringwald */ 378ef7100fSMilanka Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avdtp_initiator.c" 39ab2c6ae4SMatthias Ringwald 408ef7100fSMilanka Ringwald #include <stdint.h> 418ef7100fSMilanka Ringwald #include <string.h> 428ef7100fSMilanka Ringwald 4384e3541eSMilanka Ringwald #include "bluetooth_psm.h" 4484e3541eSMilanka Ringwald #include "bluetooth_sdp.h" 4584e3541eSMilanka Ringwald #include "btstack_debug.h" 4684e3541eSMilanka Ringwald #include "btstack_event.h" 4784e3541eSMilanka Ringwald #include "l2cap.h" 484cb889a5SMilanka Ringwald #include "classic/avdtp.h" 494cb889a5SMilanka Ringwald #include "classic/avdtp_util.h" 504cb889a5SMilanka Ringwald #include "classic/avdtp_initiator.h" 518ef7100fSMilanka Ringwald 528ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){ 538ef7100fSMilanka Ringwald uint8_t command[2]; 548ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 558ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 568ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 578ef7100fSMilanka Ringwald } 588ef7100fSMilanka Ringwald 598ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd_with_seid(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label, uint8_t sep_id){ 608ef7100fSMilanka Ringwald uint8_t command[3]; 618ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 628ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 638ef7100fSMilanka Ringwald command[2] = sep_id << 2; 648ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 658ef7100fSMilanka Ringwald } 668ef7100fSMilanka Ringwald 6719af95b4SMilanka Ringwald static int avdtp_initiator_send_signaling_cmd_delay_report(uint16_t cid, uint8_t transaction_label, uint8_t sep_id, uint16_t delay_ms){ 6819af95b4SMilanka Ringwald uint8_t command[5]; 6919af95b4SMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 7019af95b4SMilanka Ringwald command[1] = AVDTP_SI_DELAYREPORT; 7119af95b4SMilanka Ringwald command[2] = sep_id << 2; 7219af95b4SMilanka Ringwald big_endian_store_16(command, 3, delay_ms); 7319af95b4SMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 7419af95b4SMilanka Ringwald } 7519af95b4SMilanka Ringwald 76747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){ 77319b19ccSMilanka Ringwald // int status = 0; 788ef7100fSMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = NULL; 79747ec646SMilanka Ringwald 808ef7100fSMilanka Ringwald avdtp_sep_t sep; 818ef7100fSMilanka Ringwald if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) { 828ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE; 838ef7100fSMilanka Ringwald } else { 84054be048SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 858ef7100fSMilanka Ringwald if (!stream_endpoint){ 866f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 878ef7100fSMilanka Ringwald } 88b95f2da3SMilanka Ringwald if (!stream_endpoint) { 89b95f2da3SMilanka Ringwald log_error("stream_endpoint for seid 0x%02x not found", connection->initiator_local_seid); 90b95f2da3SMilanka Ringwald return; 91b95f2da3SMilanka Ringwald } 9296dcd0f4SMatthias Ringwald sep.seid = connection->initiator_remote_seid; 938ef7100fSMilanka Ringwald 94b95f2da3SMilanka Ringwald if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) { 95b95f2da3SMilanka Ringwald log_error("initiator_config_state is in wrong state %d, expected %d", stream_endpoint->initiator_config_state, AVDTP_INITIATOR_W4_ANSWER); 96b95f2da3SMilanka Ringwald return; 97b95f2da3SMilanka Ringwald } 988ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 998ef7100fSMilanka Ringwald } 1008ef7100fSMilanka Ringwald 10150453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.message_type){ 1028ef7100fSMilanka Ringwald case AVDTP_RESPONSE_ACCEPT_MSG: 10350453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 1048ef7100fSMilanka Ringwald case AVDTP_SI_DISCOVER:{ 10550453b92SMatthias Ringwald if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){ 10650453b92SMatthias Ringwald log_info(" unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label); 107319b19ccSMilanka Ringwald // status = BAD_HEADER_FORMAT; 1088ef7100fSMilanka Ringwald break; 1098ef7100fSMilanka Ringwald } 1108ef7100fSMilanka Ringwald 1118ef7100fSMilanka Ringwald if (size == 3){ 1128587e32cSMilanka Ringwald log_info(" ERROR code %02x", packet[offset]); 1138ef7100fSMilanka Ringwald break; 1148ef7100fSMilanka Ringwald } 1158ef7100fSMilanka Ringwald 1168ef7100fSMilanka Ringwald int i; 1178ef7100fSMilanka Ringwald for (i = offset; i < size; i += 2){ 1188ef7100fSMilanka Ringwald sep.seid = packet[i] >> 2; 1198ef7100fSMilanka Ringwald offset++; 1200e588213SMatthias Ringwald if ((sep.seid < 0x01) || (sep.seid > 0x3E)){ 1218587e32cSMilanka Ringwald log_info(" invalid sep id"); 122319b19ccSMilanka Ringwald // status = BAD_ACP_SEID; 1238ef7100fSMilanka Ringwald break; 1248ef7100fSMilanka Ringwald } 1258ef7100fSMilanka Ringwald sep.in_use = (packet[i] >> 1) & 0x01; 1268ef7100fSMilanka Ringwald sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4); 1278ef7100fSMilanka Ringwald sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01); 1284ccacc40SMilanka Ringwald avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep); 1298ef7100fSMilanka Ringwald } 130485c0a4cSMilanka Ringwald avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid); 1318ef7100fSMilanka Ringwald break; 1328ef7100fSMilanka Ringwald } 1338ef7100fSMilanka Ringwald 1348ef7100fSMilanka Ringwald case AVDTP_SI_GET_CAPABILITIES: 1358ef7100fSMilanka Ringwald case AVDTP_SI_GET_ALL_CAPABILITIES: 13650453b92SMatthias Ringwald sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset); 1375bd73fa2SMatthias Ringwald avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, &sep.capabilities, sep.registered_service_categories); 1388ef7100fSMilanka Ringwald break; 13919af95b4SMilanka Ringwald case AVDTP_SI_DELAYREPORT: 1405bd73fa2SMatthias Ringwald avdtp_signaling_emit_delay(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, little_endian_read_16(packet, offset)); 14119af95b4SMilanka Ringwald break; 1428ef7100fSMilanka Ringwald case AVDTP_SI_GET_CONFIGURATION: 143ffa6c160SMilanka Ringwald // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset); 144ffa6c160SMilanka Ringwald // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){ 145ffa6c160SMilanka Ringwald // switch (sep.configuration.media_codec.media_codec_type){ 146ffa6c160SMilanka Ringwald // case AVDTP_CODEC_SBC: 1475bd73fa2SMatthias Ringwald // avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, 148ffa6c160SMilanka Ringwald // sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information); 149ffa6c160SMilanka Ringwald // break; 150ffa6c160SMilanka Ringwald // default: 1515bd73fa2SMatthias Ringwald // avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, sep.configuration.media_codec); 152ffa6c160SMilanka Ringwald // break; 153ffa6c160SMilanka Ringwald // } 154ffa6c160SMilanka Ringwald // } 1558ef7100fSMilanka Ringwald break; 1568ef7100fSMilanka Ringwald 1578ef7100fSMilanka Ringwald case AVDTP_SI_RECONFIGURE: 158e8c2501fSMilanka Ringwald if (!stream_endpoint){ 159e8c2501fSMilanka Ringwald log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null"); 160e8c2501fSMilanka Ringwald break; 161e8c2501fSMilanka Ringwald } 1628d254f09SMilanka Ringwald // copy sbc media codec info 163c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap; 164c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration; 1656535961aSMatthias Ringwald (void)memcpy(stream_endpoint->media_codec_sbc_info, 1666535961aSMatthias Ringwald stream_endpoint->remote_configuration.media_codec.media_codec_information, 1676535961aSMatthias Ringwald 4); 168c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info; 1692bb3471fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 1708ef7100fSMilanka Ringwald break; 1718ef7100fSMilanka Ringwald 1728ef7100fSMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION:{ 173e8c2501fSMilanka Ringwald if (!stream_endpoint){ 174e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null"); 175e8c2501fSMilanka Ringwald break; 176e8c2501fSMilanka Ringwald } 177ffa6c160SMilanka Ringwald sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap; 178ffa6c160SMilanka Ringwald sep.configuration = stream_endpoint->remote_configuration; 1798ef7100fSMilanka Ringwald sep.in_use = 1; 1808ef7100fSMilanka Ringwald 1818ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED; 182485c0a4cSMilanka Ringwald stream_endpoint->remote_sep = sep; 183485c0a4cSMilanka Ringwald stream_endpoint->connection = connection; 184a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED; 185485c0a4cSMilanka Ringwald 186485c0a4cSMilanka Ringwald log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint); 187ffa6c160SMilanka Ringwald 188ffa6c160SMilanka Ringwald switch (stream_endpoint->media_codec_type){ 189ffa6c160SMilanka Ringwald case AVDTP_CODEC_SBC: 1905bd73fa2SMatthias Ringwald avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, 191ffa6c160SMilanka Ringwald stream_endpoint->media_type, stream_endpoint->media_codec_sbc_info); 192ffa6c160SMilanka Ringwald break; 193ffa6c160SMilanka Ringwald default: 194ffa6c160SMilanka Ringwald // TODO: we don\t have codec info to emit config 1955bd73fa2SMatthias Ringwald avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, sep.configuration.media_codec); 196ffa6c160SMilanka Ringwald break; 197ffa6c160SMilanka Ringwald } 1988ef7100fSMilanka Ringwald break; 1998ef7100fSMilanka Ringwald } 2008ef7100fSMilanka Ringwald 2018ef7100fSMilanka Ringwald case AVDTP_SI_OPEN: 202e8c2501fSMilanka Ringwald if (!stream_endpoint){ 203e8c2501fSMilanka Ringwald log_error("AVDTP_SI_OPEN: stream endpoint is null"); 204e8c2501fSMilanka Ringwald break; 205e8c2501fSMilanka Ringwald } 206747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) { 207747ec646SMilanka Ringwald log_error("AVDTP_SI_OPEN in wrong stream endpoint state"); 208747ec646SMilanka Ringwald return; 209747ec646SMilanka Ringwald } 210747ec646SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED; 2115bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 212ed161adbSMilanka Ringwald l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL); 213747ec646SMilanka Ringwald return; 2148ef7100fSMilanka Ringwald case AVDTP_SI_START: 215e8c2501fSMilanka Ringwald if (!stream_endpoint){ 216e8c2501fSMilanka Ringwald log_error("AVDTP_SI_START: stream endpoint is null"); 217e8c2501fSMilanka Ringwald break; 218e8c2501fSMilanka Ringwald } 219747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) { 220747ec646SMilanka Ringwald log_error("AVDTP_SI_START in wrong stream endpoint state"); 221747ec646SMilanka Ringwald return; 222747ec646SMilanka Ringwald } 2238ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 2248ef7100fSMilanka Ringwald break; 2258ef7100fSMilanka Ringwald case AVDTP_SI_SUSPEND: 226e8c2501fSMilanka Ringwald if (!stream_endpoint){ 227e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SUSPEND: stream endpoint is null"); 228e8c2501fSMilanka Ringwald break; 229e8c2501fSMilanka Ringwald } 230747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) { 231747ec646SMilanka Ringwald log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state"); 232747ec646SMilanka Ringwald return; 233747ec646SMilanka Ringwald } 2348ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 2358ef7100fSMilanka Ringwald break; 2368ef7100fSMilanka Ringwald case AVDTP_SI_CLOSE: 237e8c2501fSMilanka Ringwald if (!stream_endpoint){ 238e8c2501fSMilanka Ringwald log_error("AVDTP_SI_CLOSE: stream endpoint is null"); 239e8c2501fSMilanka Ringwald break; 240e8c2501fSMilanka Ringwald } 2418ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING; 2428ef7100fSMilanka Ringwald break; 2438ef7100fSMilanka Ringwald case AVDTP_SI_ABORT: 244e8c2501fSMilanka Ringwald if (!stream_endpoint){ 245e8c2501fSMilanka Ringwald log_error("AVDTP_SI_ABORT: stream endpoint is null"); 246e8c2501fSMilanka Ringwald break; 247e8c2501fSMilanka Ringwald } 2488ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 2498ef7100fSMilanka Ringwald break; 2508ef7100fSMilanka Ringwald default: 25150453b92SMatthias Ringwald log_info(" AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier); 2528ef7100fSMilanka Ringwald break; 2538ef7100fSMilanka Ringwald } 25463274943SMilanka Ringwald avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true); 25560ec20d0SMilanka Ringwald connection->initiator_transaction_label++; 2568ef7100fSMilanka Ringwald break; 2578ef7100fSMilanka Ringwald case AVDTP_RESPONSE_REJECT_MSG: 25850453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 259d8b859a2SMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION: 260a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE; 261270f0cffSMatthias Ringwald log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry."); 262d8b859a2SMilanka Ringwald break; 263d8b859a2SMilanka Ringwald default: 264d8b859a2SMilanka Ringwald break; 265d8b859a2SMilanka Ringwald } 26663274943SMilanka Ringwald log_info(" AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 26763274943SMilanka Ringwald avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 2688ef7100fSMilanka Ringwald return; 2698ef7100fSMilanka Ringwald case AVDTP_GENERAL_REJECT_MSG: 27063274943SMilanka Ringwald log_info(" AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 27163274943SMilanka Ringwald avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 2728ef7100fSMilanka Ringwald return; 2738ef7100fSMilanka Ringwald default: 2748ef7100fSMilanka Ringwald break; 2758ef7100fSMilanka Ringwald } 2768ef7100fSMilanka Ringwald } 2778ef7100fSMilanka Ringwald 278087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){ 2798ef7100fSMilanka Ringwald switch (connection->initiator_connection_state){ 2808ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS: 281149deddbSMilanka Ringwald log_info("INT: W2_DISCOVER_SEPS"); 2828ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 2839413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label); 284087c4e09SMatthias Ringwald return true; 2858ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES: 286149deddbSMilanka Ringwald log_info("INT: W2_GET_CAPABILITIES"); 2878ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 28896dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 289087c4e09SMatthias Ringwald return true; 2908ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES: 291149deddbSMilanka Ringwald log_info("INT: W2_GET_ALL_CAPABILITIES"); 2928ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 29396dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 294087c4e09SMatthias Ringwald return true; 2958ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION: 296149deddbSMilanka Ringwald log_info("INT: W4_GET_CONFIGURATION"); 2978ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 29896dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid); 299087c4e09SMatthias Ringwald return true; 30019af95b4SMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT: 301149deddbSMilanka Ringwald log_info("INT: W4_DELAY_REPORT"); 30219af95b4SMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 30319af95b4SMilanka Ringwald avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label, 30496dcd0f4SMatthias Ringwald connection->initiator_remote_seid, connection->delay_ms); 305087c4e09SMatthias Ringwald return true; 3068ef7100fSMilanka Ringwald default: 3078ef7100fSMilanka Ringwald break; 3088ef7100fSMilanka Ringwald } 309087c4e09SMatthias Ringwald return false; 310087c4e09SMatthias Ringwald } 3118ef7100fSMilanka Ringwald 312087c4e09SMatthias Ringwald static void avdtp_initiator_stream_config_subsm_run_endpoint(avdtp_connection_t * connection, avdtp_stream_endpoint_t * stream_endpoint, avdtp_initiator_stream_endpoint_state_t stream_endpoint_state){ 313087c4e09SMatthias Ringwald switch (stream_endpoint_state){ 314087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_SET_CONFIGURATION: 315087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{ 316087c4e09SMatthias Ringwald if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){ 317087c4e09SMatthias Ringwald log_info("initiator SM stop sending SET_CONFIGURATION cmd:"); 318087c4e09SMatthias Ringwald break; 319087c4e09SMatthias Ringwald } 320149deddbSMilanka Ringwald log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid); 321087c4e09SMatthias Ringwald // log_info_hexdump( connection->remote_capabilities.media_codec.media_codec_information, connection->remote_capabilities.media_codec.media_codec_information_len); 322087c4e09SMatthias Ringwald connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid; 323087c4e09SMatthias Ringwald connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid; 324087c4e09SMatthias Ringwald 325087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION; 326087c4e09SMatthias Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE; 327087c4e09SMatthias Ringwald if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){ 328087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE; 329087c4e09SMatthias Ringwald } 330087c4e09SMatthias Ringwald 331087c4e09SMatthias Ringwald avdtp_prepare_capabilities(&connection->initiator_signaling_packet, connection->initiator_transaction_label, stream_endpoint->remote_configuration_bitmap, stream_endpoint->remote_configuration, connection->initiator_signaling_packet.signal_identifier); 332087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 333087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 334087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 335087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 336087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 337087c4e09SMatthias Ringwald log_info("INT: fragmented"); 338087c4e09SMatthias Ringwald } 339087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 340087c4e09SMatthias Ringwald break; 341087c4e09SMatthias Ringwald } 342087c4e09SMatthias Ringwald case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{ 343087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 344087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 345087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 346087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 347087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 348087c4e09SMatthias Ringwald log_info("INT: fragmented"); 349087c4e09SMatthias Ringwald } 350087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 351087c4e09SMatthias Ringwald break; 352087c4e09SMatthias Ringwald } 353087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_OPEN_STREAM: 354087c4e09SMatthias Ringwald switch (stream_endpoint->state){ 355087c4e09SMatthias Ringwald case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM: 356087c4e09SMatthias Ringwald log_info("INT: send AVDTP_SI_OPEN signaling to remote, transaction_label %d, remote seid 0x%02x", connection->initiator_transaction_label, connection->initiator_remote_seid); 357087c4e09SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid); 358087c4e09SMatthias Ringwald break; 359087c4e09SMatthias Ringwald default: 360087c4e09SMatthias Ringwald break; 361087c4e09SMatthias Ringwald } 362087c4e09SMatthias Ringwald break; 363087c4e09SMatthias Ringwald default: 364087c4e09SMatthias Ringwald break; 365087c4e09SMatthias Ringwald } 366087c4e09SMatthias Ringwald } 367087c4e09SMatthias Ringwald 368087c4e09SMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){ 369087c4e09SMatthias Ringwald 370087c4e09SMatthias Ringwald bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection); 3718ef7100fSMilanka Ringwald if (sent) return; 3728ef7100fSMilanka Ringwald 373054be048SMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 3748ef7100fSMilanka Ringwald if (!stream_endpoint){ 3756f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 3768ef7100fSMilanka Ringwald } 3778ef7100fSMilanka Ringwald if (!stream_endpoint) return; 3788ef7100fSMilanka Ringwald 3798ef7100fSMilanka Ringwald avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state; 3808ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 3818ef7100fSMilanka Ringwald 38260ec20d0SMilanka Ringwald if (stream_endpoint->start_stream){ 38360ec20d0SMilanka Ringwald stream_endpoint->start_stream = 0; 384da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){ 3855bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 38696dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 38796dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid); 38860ec20d0SMilanka Ringwald return; 38960ec20d0SMilanka Ringwald } 39060ec20d0SMilanka Ringwald } 39160ec20d0SMilanka Ringwald 39260ec20d0SMilanka Ringwald if (stream_endpoint->stop_stream){ 39360ec20d0SMilanka Ringwald stream_endpoint->stop_stream = 0; 394da4d6891SMilanka Ringwald if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){ 3955bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 39696dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 39796dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid); 39860ec20d0SMilanka Ringwald return; 39960ec20d0SMilanka Ringwald } 40060ec20d0SMilanka Ringwald } 40160ec20d0SMilanka Ringwald 40260ec20d0SMilanka Ringwald if (stream_endpoint->abort_stream){ 403da4d6891SMilanka Ringwald stream_endpoint->abort_stream = 0; 40460ec20d0SMilanka Ringwald switch (stream_endpoint->state){ 40560ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CONFIGURED: 40660ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CLOSING: 40760ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 40860ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 4095bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 41096dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 41160ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 41296dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid); 41360ec20d0SMilanka Ringwald return; 41460ec20d0SMilanka Ringwald default: 41560ec20d0SMilanka Ringwald break; 41660ec20d0SMilanka Ringwald } 41760ec20d0SMilanka Ringwald } 41860ec20d0SMilanka Ringwald 41960ec20d0SMilanka Ringwald if (stream_endpoint->suspend_stream){ 42060ec20d0SMilanka Ringwald stream_endpoint->suspend_stream = 0; 421da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 4225bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 42396dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 42460ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 42596dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid); 42660ec20d0SMilanka Ringwald return; 42760ec20d0SMilanka Ringwald } 42860ec20d0SMilanka Ringwald } 42960ec20d0SMilanka Ringwald 43060ec20d0SMilanka Ringwald if (stream_endpoint->send_stream){ 43160ec20d0SMilanka Ringwald stream_endpoint->send_stream = 0; 432da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 43360ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 434*f751daa3SMatthias Ringwald avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint, 435*f751daa3SMatthias Ringwald stream_endpoint->sequence_number); 43660ec20d0SMilanka Ringwald return; 43760ec20d0SMilanka Ringwald } 43860ec20d0SMilanka Ringwald } 43960ec20d0SMilanka Ringwald 440087c4e09SMatthias Ringwald avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state); 4418ef7100fSMilanka Ringwald 4428ef7100fSMilanka Ringwald // check fragmentation 44350453b92SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 4449413b167SMilanka Ringwald avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 4458ef7100fSMilanka Ringwald } 4468ef7100fSMilanka Ringwald } 447