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 <stdio.h> 428ef7100fSMilanka Ringwald #include <stdlib.h> 438ef7100fSMilanka Ringwald #include <string.h> 448ef7100fSMilanka Ringwald 458ef7100fSMilanka Ringwald #include "btstack.h" 464cb889a5SMilanka Ringwald #include "classic/avdtp.h" 474cb889a5SMilanka Ringwald #include "classic/avdtp_util.h" 484cb889a5SMilanka Ringwald #include "classic/avdtp_initiator.h" 498ef7100fSMilanka Ringwald 508ef7100fSMilanka Ringwald static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){ 518ef7100fSMilanka Ringwald uint8_t command[2]; 528ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 538ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 548ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 558ef7100fSMilanka Ringwald } 568ef7100fSMilanka Ringwald 578ef7100fSMilanka 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){ 588ef7100fSMilanka Ringwald uint8_t command[3]; 598ef7100fSMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 608ef7100fSMilanka Ringwald command[1] = (uint8_t)identifier; 618ef7100fSMilanka Ringwald command[2] = sep_id << 2; 628ef7100fSMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 638ef7100fSMilanka Ringwald } 648ef7100fSMilanka Ringwald 6519af95b4SMilanka 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){ 6619af95b4SMilanka Ringwald uint8_t command[5]; 6719af95b4SMilanka Ringwald command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 6819af95b4SMilanka Ringwald command[1] = AVDTP_SI_DELAYREPORT; 6919af95b4SMilanka Ringwald command[2] = sep_id << 2; 7019af95b4SMilanka Ringwald big_endian_store_16(command, 3, delay_ms); 7119af95b4SMilanka Ringwald return l2cap_send(cid, command, sizeof(command)); 7219af95b4SMilanka Ringwald } 7319af95b4SMilanka Ringwald 74747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){ 75319b19ccSMilanka Ringwald // int status = 0; 768ef7100fSMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = NULL; 77747ec646SMilanka Ringwald 788ef7100fSMilanka Ringwald avdtp_sep_t sep; 798ef7100fSMilanka Ringwald if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) { 808ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE; 818ef7100fSMilanka Ringwald } else { 829413b167SMilanka Ringwald stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->remote_seid, context); 838ef7100fSMilanka Ringwald if (!stream_endpoint){ 844ccacc40SMilanka Ringwald stream_endpoint = avdtp_stream_endpoint_with_seid(connection->local_seid, context); 858ef7100fSMilanka Ringwald } 868ef7100fSMilanka Ringwald if (!stream_endpoint) return; 879413b167SMilanka Ringwald sep.seid = connection->remote_seid; 888ef7100fSMilanka Ringwald 898ef7100fSMilanka Ringwald if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) return; 908ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 918ef7100fSMilanka Ringwald } 928ef7100fSMilanka Ringwald 938ef7100fSMilanka Ringwald switch (connection->signaling_packet.message_type){ 948ef7100fSMilanka Ringwald case AVDTP_RESPONSE_ACCEPT_MSG: 958ef7100fSMilanka Ringwald switch (connection->signaling_packet.signal_identifier){ 968ef7100fSMilanka Ringwald case AVDTP_SI_DISCOVER:{ 978ef7100fSMilanka Ringwald if (connection->signaling_packet.transaction_label != connection->initiator_transaction_label){ 988587e32cSMilanka Ringwald log_info(" unexpected transaction label, got %d, expected %d", connection->signaling_packet.transaction_label, connection->initiator_transaction_label); 99319b19ccSMilanka Ringwald // status = BAD_HEADER_FORMAT; 1008ef7100fSMilanka Ringwald break; 1018ef7100fSMilanka Ringwald } 1028ef7100fSMilanka Ringwald 1038ef7100fSMilanka Ringwald if (size == 3){ 1048587e32cSMilanka Ringwald log_info(" ERROR code %02x", packet[offset]); 1058ef7100fSMilanka Ringwald break; 1068ef7100fSMilanka Ringwald } 1078ef7100fSMilanka Ringwald 1088ef7100fSMilanka Ringwald int i; 1098ef7100fSMilanka Ringwald for (i = offset; i < size; i += 2){ 1108ef7100fSMilanka Ringwald sep.seid = packet[i] >> 2; 1118ef7100fSMilanka Ringwald offset++; 1128ef7100fSMilanka Ringwald if (sep.seid < 0x01 || sep.seid > 0x3E){ 1138587e32cSMilanka Ringwald log_info(" invalid sep id"); 114319b19ccSMilanka Ringwald // status = BAD_ACP_SEID; 1158ef7100fSMilanka Ringwald break; 1168ef7100fSMilanka Ringwald } 1178ef7100fSMilanka Ringwald sep.in_use = (packet[i] >> 1) & 0x01; 1188ef7100fSMilanka Ringwald sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4); 1198ef7100fSMilanka Ringwald sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01); 1204ccacc40SMilanka Ringwald avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep); 1218ef7100fSMilanka Ringwald } 122485c0a4cSMilanka Ringwald avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid); 1238ef7100fSMilanka Ringwald break; 1248ef7100fSMilanka Ringwald } 1258ef7100fSMilanka Ringwald 1268ef7100fSMilanka Ringwald case AVDTP_SI_GET_CAPABILITIES: 1278ef7100fSMilanka Ringwald case AVDTP_SI_GET_ALL_CAPABILITIES: 1288ef7100fSMilanka Ringwald sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, &sep.capabilities, packet+offset, size-offset); 12967ae582dSMilanka Ringwald avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid, &sep.capabilities, sep.registered_service_categories); 1308ef7100fSMilanka Ringwald break; 13119af95b4SMilanka Ringwald case AVDTP_SI_DELAYREPORT: 132*32c78405SMilanka Ringwald avdtp_signaling_emit_delay(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, little_endian_read_16(packet, offset)); 13319af95b4SMilanka Ringwald break; 1348ef7100fSMilanka Ringwald case AVDTP_SI_GET_CONFIGURATION: 135ffa6c160SMilanka Ringwald // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset); 136ffa6c160SMilanka Ringwald // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){ 137ffa6c160SMilanka Ringwald // switch (sep.configuration.media_codec.media_codec_type){ 138ffa6c160SMilanka Ringwald // case AVDTP_CODEC_SBC: 139ffa6c160SMilanka Ringwald // avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid, 140ffa6c160SMilanka Ringwald // sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information); 141ffa6c160SMilanka Ringwald // break; 142ffa6c160SMilanka Ringwald // default: 143ffa6c160SMilanka Ringwald // avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->remote_seid, sep.configuration.media_codec); 144ffa6c160SMilanka Ringwald // break; 145ffa6c160SMilanka Ringwald // } 146ffa6c160SMilanka Ringwald // } 1478ef7100fSMilanka Ringwald break; 1488ef7100fSMilanka Ringwald 1498ef7100fSMilanka Ringwald case AVDTP_SI_RECONFIGURE: 150e8c2501fSMilanka Ringwald if (!stream_endpoint){ 151e8c2501fSMilanka Ringwald log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null"); 152e8c2501fSMilanka Ringwald break; 153e8c2501fSMilanka Ringwald } 1548d254f09SMilanka Ringwald // copy sbc media codec info 155c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap; 156c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration; 1578d254f09SMilanka Ringwald memcpy(stream_endpoint->media_codec_sbc_info, stream_endpoint->remote_configuration.media_codec.media_codec_information, 4); 158c4bbf774SMilanka Ringwald stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info; 1598d254f09SMilanka Ringwald 160b308acf6SMatthias Ringwald #if 0 1618ef7100fSMilanka Ringwald sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, connection->signaling_packet.command+4, connection->signaling_packet.size-4); 1628ef7100fSMilanka Ringwald // TODO check if configuration is supported 1638ef7100fSMilanka Ringwald 164485c0a4cSMilanka Ringwald if (!is_avdtp_remote_seid_registered(stream_endpoint)){ 165485c0a4cSMilanka Ringwald stream_endpoint->remote_sep = sep; 166485c0a4cSMilanka Ringwald log_info("INT: update seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint); 1678ef7100fSMilanka Ringwald } 168b308acf6SMatthias Ringwald #endif 1692bb3471fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 1708ef7100fSMilanka Ringwald break; 1718ef7100fSMilanka Ringwald 1728ef7100fSMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION:{ 173d8b859a2SMilanka Ringwald avdtp_configuration_timer_stop(connection); 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; 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: 190ffa6c160SMilanka Ringwald avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->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 195485c0a4cSMilanka Ringwald avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->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; 2116b0ee1d0SMilanka Ringwald connection->local_seid = stream_endpoint->sep.seid; 212235946f1SMatthias Ringwald l2cap_create_channel(context->packet_handler, connection->remote_addr, BLUETOOTH_PROTOCOL_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; 25019af95b4SMilanka Ringwald 2518ef7100fSMilanka Ringwald default: 2528587e32cSMilanka Ringwald log_info(" AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->signaling_packet.signal_identifier); 2538ef7100fSMilanka Ringwald break; 2548ef7100fSMilanka Ringwald } 2554ccacc40SMilanka Ringwald avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->signaling_packet.signal_identifier); 25660ec20d0SMilanka Ringwald connection->initiator_transaction_label++; 2578ef7100fSMilanka Ringwald break; 2588ef7100fSMilanka Ringwald case AVDTP_RESPONSE_REJECT_MSG: 259d8b859a2SMilanka Ringwald switch (connection->signaling_packet.signal_identifier){ 260d8b859a2SMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION: 261d8b859a2SMilanka Ringwald connection->is_initiator = 0; 262bdbc3ef6SMilanka Ringwald log_info("Received reject for set configuration, role changed from initiator to acceptor. Start timer."); 263d8b859a2SMilanka Ringwald avdtp_configuration_timer_start(connection); 264d8b859a2SMilanka Ringwald break; 265d8b859a2SMilanka Ringwald default: 266d8b859a2SMilanka Ringwald break; 267d8b859a2SMilanka Ringwald } 2688587e32cSMilanka Ringwald log_info(" AVDTP_RESPONSE_REJECT_MSG signal %d", connection->signaling_packet.signal_identifier); 2694ccacc40SMilanka Ringwald avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->signaling_packet.signal_identifier); 2708ef7100fSMilanka Ringwald return; 2718ef7100fSMilanka Ringwald case AVDTP_GENERAL_REJECT_MSG: 2728587e32cSMilanka Ringwald log_info(" AVDTP_GENERAL_REJECT_MSG signal %d", connection->signaling_packet.signal_identifier); 2734ccacc40SMilanka Ringwald avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->local_seid, connection->signaling_packet.signal_identifier); 2748ef7100fSMilanka Ringwald return; 2758ef7100fSMilanka Ringwald default: 2768ef7100fSMilanka Ringwald break; 2778ef7100fSMilanka Ringwald } 2788ef7100fSMilanka Ringwald } 2798ef7100fSMilanka Ringwald 280747ec646SMilanka Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){ 2818ef7100fSMilanka Ringwald int sent = 1; 2828ef7100fSMilanka Ringwald switch (connection->initiator_connection_state){ 2838ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS: 2848587e32cSMilanka Ringwald log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS"); 2858ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 2869413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label); 2878ef7100fSMilanka Ringwald break; 2888ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES: 2898587e32cSMilanka Ringwald log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES"); 2908ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 2919413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->remote_seid); 2928ef7100fSMilanka Ringwald break; 2938ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES: 2948587e32cSMilanka Ringwald log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES"); 2958ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 2969413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->remote_seid); 2978ef7100fSMilanka Ringwald break; 2988ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION: 2998587e32cSMilanka Ringwald log_info("INT: AVDTP_INITIATOR_W4_GET_CONFIGURATION"); 3008ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 3019413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->remote_seid); 3028ef7100fSMilanka Ringwald break; 30319af95b4SMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT: 30419af95b4SMilanka Ringwald log_info("INT: AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_DELAY_REPORT"); 30519af95b4SMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 30619af95b4SMilanka Ringwald avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label, 30719af95b4SMilanka Ringwald connection->remote_seid, connection->delay_ms); 30819af95b4SMilanka Ringwald break; 3098ef7100fSMilanka Ringwald default: 3108ef7100fSMilanka Ringwald sent = 0; 3118ef7100fSMilanka Ringwald break; 3128ef7100fSMilanka Ringwald } 3138ef7100fSMilanka Ringwald 3148ef7100fSMilanka Ringwald if (sent) return; 3158ef7100fSMilanka Ringwald sent = 1; 3168ef7100fSMilanka Ringwald 3175cfe7f4cSMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = NULL; 3188ef7100fSMilanka Ringwald 3199413b167SMilanka Ringwald stream_endpoint = avdtp_stream_endpoint_associated_with_acp_seid(connection->remote_seid, context); 3208ef7100fSMilanka Ringwald if (!stream_endpoint){ 3214ccacc40SMilanka Ringwald stream_endpoint = avdtp_stream_endpoint_with_seid(connection->local_seid, context); 3228ef7100fSMilanka Ringwald } 3238ef7100fSMilanka Ringwald if (!stream_endpoint) return; 3248ef7100fSMilanka Ringwald 3258ef7100fSMilanka Ringwald avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state; 3268ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 3278ef7100fSMilanka Ringwald 32860ec20d0SMilanka Ringwald if (stream_endpoint->start_stream){ 32960ec20d0SMilanka Ringwald stream_endpoint->start_stream = 0; 330da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){ 3314ccacc40SMilanka Ringwald connection->local_seid = stream_endpoint->sep.seid; 332485c0a4cSMilanka Ringwald connection->remote_seid = stream_endpoint->remote_sep.seid; 3339413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->remote_seid); 33460ec20d0SMilanka Ringwald return; 33560ec20d0SMilanka Ringwald } 33660ec20d0SMilanka Ringwald return; 33760ec20d0SMilanka Ringwald } 33860ec20d0SMilanka Ringwald 33960ec20d0SMilanka Ringwald if (stream_endpoint->stop_stream){ 34060ec20d0SMilanka Ringwald stream_endpoint->stop_stream = 0; 341da4d6891SMilanka Ringwald if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){ 3424ccacc40SMilanka Ringwald connection->local_seid = stream_endpoint->sep.seid; 343485c0a4cSMilanka Ringwald connection->remote_seid = stream_endpoint->remote_sep.seid; 3449413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->remote_seid); 34560ec20d0SMilanka Ringwald return; 34660ec20d0SMilanka Ringwald } 34760ec20d0SMilanka Ringwald } 34860ec20d0SMilanka Ringwald 34960ec20d0SMilanka Ringwald if (stream_endpoint->abort_stream){ 350da4d6891SMilanka Ringwald stream_endpoint->abort_stream = 0; 35160ec20d0SMilanka Ringwald switch (stream_endpoint->state){ 35260ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CONFIGURED: 35360ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CLOSING: 35460ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 35560ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 3564ccacc40SMilanka Ringwald connection->local_seid = stream_endpoint->sep.seid; 357485c0a4cSMilanka Ringwald connection->remote_seid = stream_endpoint->remote_sep.seid; 35860ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 3599413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->remote_seid); 36060ec20d0SMilanka Ringwald return; 36160ec20d0SMilanka Ringwald default: 36260ec20d0SMilanka Ringwald break; 36360ec20d0SMilanka Ringwald } 36460ec20d0SMilanka Ringwald } 36560ec20d0SMilanka Ringwald 36660ec20d0SMilanka Ringwald if (stream_endpoint->suspend_stream){ 36760ec20d0SMilanka Ringwald stream_endpoint->suspend_stream = 0; 368da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 36919af95b4SMilanka Ringwald connection->local_seid = stream_endpoint->sep.seid; 37019af95b4SMilanka Ringwald connection->remote_seid = stream_endpoint->remote_sep.seid; 37160ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 3729413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->remote_seid); 37360ec20d0SMilanka Ringwald return; 37460ec20d0SMilanka Ringwald } 37560ec20d0SMilanka Ringwald } 37660ec20d0SMilanka Ringwald 37760ec20d0SMilanka Ringwald if (stream_endpoint->send_stream){ 37860ec20d0SMilanka Ringwald stream_endpoint->send_stream = 0; 379da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 38060ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 38160ec20d0SMilanka Ringwald avdtp_streaming_emit_can_send_media_packet_now(context->avdtp_callback, stream_endpoint->l2cap_media_cid, stream_endpoint->sep.seid, stream_endpoint->sequence_number); 38260ec20d0SMilanka Ringwald return; 38360ec20d0SMilanka Ringwald } 38460ec20d0SMilanka Ringwald } 38560ec20d0SMilanka Ringwald 3868ef7100fSMilanka Ringwald switch (stream_endpoint_state){ 3878ef7100fSMilanka Ringwald case AVDTP_INITIATOR_W2_SET_CONFIGURATION: 3888ef7100fSMilanka Ringwald case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{ 3899974aee0SMilanka Ringwald if (stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION && !connection->is_initiator){ 390ec3d71e3SMilanka Ringwald log_info("initiator SM stop sending SET_CONFIGURATION cmd: current role is acceptor"); 391d8b859a2SMilanka Ringwald connection->is_configuration_initiated_locally = 0; 39263331bf4SMilanka Ringwald break; 39363331bf4SMilanka Ringwald } 3949974aee0SMilanka Ringwald log_info("initiator SM prepare SET_CONFIGURATION cmd"); 395d8b859a2SMilanka Ringwald connection->is_configuration_initiated_locally = 1; 3969413b167SMilanka Ringwald log_info("INT: AVDTP_INITIATOR_W2_(RE)CONFIGURATION bitmap, int seid %d, acp seid %d", connection->local_seid, connection->remote_seid); 3978587e32cSMilanka Ringwald // log_info_hexdump( connection->remote_capabilities.media_codec.media_codec_information, connection->remote_capabilities.media_codec.media_codec_information_len); 3989413b167SMilanka Ringwald connection->signaling_packet.acp_seid = connection->remote_seid; 3994ccacc40SMilanka Ringwald connection->signaling_packet.int_seid = connection->local_seid; 4008ef7100fSMilanka Ringwald 4018ef7100fSMilanka Ringwald connection->signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION; 402bdbc3ef6SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE; 4038ef7100fSMilanka Ringwald if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){ 4048ef7100fSMilanka Ringwald connection->signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE; 4058ef7100fSMilanka Ringwald } 4068ef7100fSMilanka Ringwald 407f53d6fa7SMilanka Ringwald avdtp_prepare_capabilities(&connection->signaling_packet, connection->initiator_transaction_label, stream_endpoint->remote_configuration_bitmap, stream_endpoint->remote_configuration, connection->signaling_packet.signal_identifier); 4088ef7100fSMilanka Ringwald l2cap_reserve_packet_buffer(); 4098ef7100fSMilanka Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 4109413b167SMilanka Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->signaling_packet, out_buffer); 4118ef7100fSMilanka Ringwald if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){ 4128ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 4138587e32cSMilanka Ringwald log_info("INT: fragmented"); 4148ef7100fSMilanka Ringwald } 4159413b167SMilanka Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 4168ef7100fSMilanka Ringwald break; 4178ef7100fSMilanka Ringwald } 4188ef7100fSMilanka Ringwald case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{ 4198ef7100fSMilanka Ringwald l2cap_reserve_packet_buffer(); 4208ef7100fSMilanka Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 4219413b167SMilanka Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->signaling_packet, out_buffer); 4228ef7100fSMilanka Ringwald if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){ 4238ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 4248587e32cSMilanka Ringwald log_info("INT: fragmented"); 4258ef7100fSMilanka Ringwald } 4269413b167SMilanka Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 4278ef7100fSMilanka Ringwald break; 4288ef7100fSMilanka Ringwald } 429747ec646SMilanka Ringwald case AVDTP_INITIATOR_W2_OPEN_STREAM: 430747ec646SMilanka Ringwald switch (stream_endpoint->state){ 431747ec646SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM: 4328587e32cSMilanka Ringwald log_info("INT: AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM"); 4339413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->remote_seid); 4348ef7100fSMilanka Ringwald break; 435747ec646SMilanka Ringwald default: 43660ec20d0SMilanka Ringwald sent = 0; 437747ec646SMilanka Ringwald break; 438747ec646SMilanka Ringwald } 439747ec646SMilanka Ringwald break; 4408ef7100fSMilanka Ringwald default: 44160ec20d0SMilanka Ringwald sent = 0; 4428ef7100fSMilanka Ringwald break; 4438ef7100fSMilanka Ringwald } 4448ef7100fSMilanka Ringwald 4458ef7100fSMilanka Ringwald // check fragmentation 4468ef7100fSMilanka Ringwald if (connection->signaling_packet.packet_type != AVDTP_SINGLE_PACKET && connection->signaling_packet.packet_type != AVDTP_END_PACKET){ 4479413b167SMilanka Ringwald avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 4488ef7100fSMilanka Ringwald } 4498ef7100fSMilanka Ringwald } 450