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 7677092f3eSMatthias Ringwald void avdtp_initiator_stream_config_subsm(avdtp_connection_t *connection, uint8_t *packet, uint16_t size, int offset) { 77319b19ccSMilanka Ringwald // int status = 0; 788ef7100fSMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = NULL; 798f3d0a2fSMatthias Ringwald avdtp_stream_endpoint_t * stream_endpoint_for_event = NULL; 80747ec646SMilanka Ringwald 818ef7100fSMilanka Ringwald avdtp_sep_t sep; 828ef7100fSMilanka Ringwald if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) { 838ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE; 848ef7100fSMilanka Ringwald } else { 85054be048SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 863a69f723SMatthias Ringwald if (stream_endpoint == NULL){ 876f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 883a69f723SMatthias Ringwald if (stream_endpoint == NULL){ 893a69f723SMatthias Ringwald log_debug("no stream endpoint for local %u, remote %u", connection->initiator_local_seid, connection->initiator_remote_seid); 90b95f2da3SMilanka Ringwald return; 913a69f723SMatthias Ringwald } else { 923a69f723SMatthias Ringwald log_debug("Using stream endpoint %p for local seid %u", stream_endpoint, connection->initiator_local_seid); 93b95f2da3SMilanka Ringwald } 943a69f723SMatthias Ringwald } else { 953a69f723SMatthias Ringwald log_debug("Using stream endpoint %p for remote seid %u", stream_endpoint, connection->initiator_remote_seid); 963a69f723SMatthias Ringwald } 973a69f723SMatthias Ringwald 9844e638f3SMatthias Ringwald log_debug("SE %p, initiator_connection_state: 0x%02x, initiator_config_state: 0x%02x", stream_endpoint, connection->initiator_connection_state, stream_endpoint->initiator_config_state); 9996dcd0f4SMatthias Ringwald sep.seid = connection->initiator_remote_seid; 1008ef7100fSMilanka Ringwald 101b95f2da3SMilanka Ringwald if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) { 102b95f2da3SMilanka Ringwald log_error("initiator_config_state is in wrong state %d, expected %d", stream_endpoint->initiator_config_state, AVDTP_INITIATOR_W4_ANSWER); 103b95f2da3SMilanka Ringwald return; 104b95f2da3SMilanka Ringwald } 1058ef7100fSMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 1068ef7100fSMilanka Ringwald } 1078ef7100fSMilanka Ringwald 10850453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.message_type){ 1098ef7100fSMilanka Ringwald case AVDTP_RESPONSE_ACCEPT_MSG: 11050453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 1118ef7100fSMilanka Ringwald case AVDTP_SI_DISCOVER:{ 11250453b92SMatthias Ringwald if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){ 11350453b92SMatthias Ringwald log_info("unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label); 114319b19ccSMilanka Ringwald // status = BAD_HEADER_FORMAT; 1158ef7100fSMilanka Ringwald break; 1168ef7100fSMilanka Ringwald } 1178ef7100fSMilanka Ringwald 1188ef7100fSMilanka Ringwald if (size == 3){ 1198587e32cSMilanka Ringwald log_info("ERROR code %02x", packet[offset]); 1208ef7100fSMilanka Ringwald break; 1218ef7100fSMilanka Ringwald } 1228ef7100fSMilanka Ringwald 1238ef7100fSMilanka Ringwald int i; 1248ef7100fSMilanka Ringwald for (i = offset; i < size; i += 2){ 1258ef7100fSMilanka Ringwald sep.seid = packet[i] >> 2; 1268ef7100fSMilanka Ringwald offset++; 1270e588213SMatthias Ringwald if ((sep.seid < 0x01) || (sep.seid > 0x3E)){ 1288587e32cSMilanka Ringwald log_info("invalid sep id"); 129319b19ccSMilanka Ringwald // status = BAD_ACP_SEID; 1308ef7100fSMilanka Ringwald break; 1318ef7100fSMilanka Ringwald } 1328ef7100fSMilanka Ringwald sep.in_use = (packet[i] >> 1) & 0x01; 1338ef7100fSMilanka Ringwald sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4); 1348ef7100fSMilanka Ringwald sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01); 135c69f4ba5SMatthias Ringwald avdtp_signaling_emit_sep(connection->avdtp_cid, sep); 1368ef7100fSMilanka Ringwald } 137c69f4ba5SMatthias Ringwald avdtp_signaling_emit_sep_done(connection->avdtp_cid); 1388ef7100fSMilanka Ringwald break; 1398ef7100fSMilanka Ringwald } 1408ef7100fSMilanka Ringwald 1418ef7100fSMilanka Ringwald case AVDTP_SI_GET_CAPABILITIES: 1428ef7100fSMilanka Ringwald case AVDTP_SI_GET_ALL_CAPABILITIES: 14350453b92SMatthias Ringwald sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset); 1441159d239SMatthias Ringwald avdtp_signaling_emit_capabilities(connection->avdtp_cid, 145c69f4ba5SMatthias Ringwald connection->initiator_remote_seid, &sep.capabilities, 146c69f4ba5SMatthias Ringwald sep.registered_service_categories); 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 } 1548f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 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; 1572bb3471fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 158*82767773SMatthias Ringwald 159*82767773SMatthias Ringwald // copy media codec configuration if reconfigured 160*82767773SMatthias Ringwald if ((stream_endpoint->remote_configuration_bitmap & (1 << AVDTP_MEDIA_CODEC)) != 0){ 161*82767773SMatthias Ringwald btstack_assert(stream_endpoint->remote_configuration.media_codec.media_codec_information_len == stream_endpoint->media_codec_configuration_len); 162*82767773SMatthias Ringwald (void)memcpy(stream_endpoint->media_codec_configuration_info, stream_endpoint->remote_configuration.media_codec.media_codec_information, stream_endpoint->media_codec_configuration_len); 163*82767773SMatthias Ringwald } 1648ef7100fSMilanka Ringwald break; 1658ef7100fSMilanka Ringwald 166*82767773SMatthias Ringwald case AVDTP_SI_SET_CONFIGURATION: 167e8c2501fSMilanka Ringwald if (!stream_endpoint){ 168e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null"); 169e8c2501fSMilanka Ringwald break; 170e8c2501fSMilanka Ringwald } 1718f3d0a2fSMatthias Ringwald 1728f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 1738f3d0a2fSMatthias Ringwald 174ffa6c160SMilanka Ringwald sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap; 175ffa6c160SMilanka Ringwald sep.configuration = stream_endpoint->remote_configuration; 1768ef7100fSMilanka Ringwald sep.in_use = 1; 1778ef7100fSMilanka Ringwald 1788ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED; 179485c0a4cSMilanka Ringwald stream_endpoint->remote_sep = sep; 180485c0a4cSMilanka Ringwald stream_endpoint->connection = connection; 181a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED; 182485c0a4cSMilanka Ringwald 1837344f9afSMilanka Ringwald log_info("configured remote seid %d", stream_endpoint->remote_sep.seid); 184ffa6c160SMilanka Ringwald 185*82767773SMatthias Ringwald // copy media codec configuration if configured 186*82767773SMatthias Ringwald if ((stream_endpoint->remote_configuration_bitmap & (1 << AVDTP_MEDIA_CODEC)) != 0) { 187*82767773SMatthias Ringwald btstack_assert(stream_endpoint->remote_configuration.media_codec.media_codec_information_len == 188*82767773SMatthias Ringwald stream_endpoint->media_codec_configuration_len); 189*82767773SMatthias Ringwald (void) memcpy(stream_endpoint->media_codec_configuration_info, 190*82767773SMatthias Ringwald stream_endpoint->remote_configuration.media_codec.media_codec_information, 191*82767773SMatthias Ringwald stream_endpoint->media_codec_configuration_len); 192*82767773SMatthias Ringwald 193ffa6c160SMilanka Ringwald switch (stream_endpoint->media_codec_type) { 194ffa6c160SMilanka Ringwald case AVDTP_CODEC_SBC: 1950fbfe070SMatthias Ringwald avdtp_signaling_emit_media_codec_sbc_configuration( 1960fbfe070SMatthias Ringwald stream_endpoint, 1970fbfe070SMatthias Ringwald connection->avdtp_cid, 1980fbfe070SMatthias Ringwald stream_endpoint->media_type, 199*82767773SMatthias Ringwald stream_endpoint->media_codec_configuration_info); 200ffa6c160SMilanka Ringwald break; 201ffa6c160SMilanka Ringwald default: 202*82767773SMatthias Ringwald // TODO: we don't have codec info to emit config 203f08f4934SMatthias Ringwald avdtp_signaling_emit_media_codec_other_configuration(stream_endpoint, 204f08f4934SMatthias Ringwald connection->avdtp_cid, 205e8a431c1SMatthias Ringwald &sep.configuration.media_codec); 206ffa6c160SMilanka Ringwald break; 207ffa6c160SMilanka Ringwald } 2088ef7100fSMilanka Ringwald } 209*82767773SMatthias Ringwald break; 2108ef7100fSMilanka Ringwald 2118ef7100fSMilanka Ringwald case AVDTP_SI_OPEN: 212e8c2501fSMilanka Ringwald if (!stream_endpoint){ 213e8c2501fSMilanka Ringwald log_error("AVDTP_SI_OPEN: stream endpoint is null"); 214e8c2501fSMilanka Ringwald break; 215e8c2501fSMilanka Ringwald } 21641c62a08SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W4_ACCEPT_OPEN_STREAM) { 21741c62a08SMilanka Ringwald log_error("AVDTP_SI_OPEN in wrong stream endpoint state %d", stream_endpoint->state); 218747ec646SMilanka Ringwald return; 219747ec646SMilanka Ringwald } 2208f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 221747ec646SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED; 2225bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 223ed161adbSMilanka Ringwald l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL); 224747ec646SMilanka Ringwald return; 2258ef7100fSMilanka Ringwald case AVDTP_SI_START: 226e8c2501fSMilanka Ringwald if (!stream_endpoint){ 227e8c2501fSMilanka Ringwald log_error("AVDTP_SI_START: stream endpoint is null"); 228e8c2501fSMilanka Ringwald break; 229e8c2501fSMilanka Ringwald } 230747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) { 23141c62a08SMilanka Ringwald log_error("AVDTP_SI_START in wrong stream endpoint state %d", stream_endpoint->state); 232747ec646SMilanka Ringwald return; 233747ec646SMilanka Ringwald } 2348f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 2358ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 2368ef7100fSMilanka Ringwald break; 2378ef7100fSMilanka Ringwald case AVDTP_SI_SUSPEND: 238e8c2501fSMilanka Ringwald if (!stream_endpoint){ 239e8c2501fSMilanka Ringwald log_error("AVDTP_SI_SUSPEND: stream endpoint is null"); 240e8c2501fSMilanka Ringwald break; 241e8c2501fSMilanka Ringwald } 242747ec646SMilanka Ringwald if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) { 24341c62a08SMilanka Ringwald log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state %d", stream_endpoint->state); 244747ec646SMilanka Ringwald return; 245747ec646SMilanka Ringwald } 2468f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 2478ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 2488ef7100fSMilanka Ringwald break; 2498ef7100fSMilanka Ringwald case AVDTP_SI_CLOSE: 250e8c2501fSMilanka Ringwald if (!stream_endpoint){ 251e8c2501fSMilanka Ringwald log_error("AVDTP_SI_CLOSE: stream endpoint is null"); 252e8c2501fSMilanka Ringwald break; 253e8c2501fSMilanka Ringwald } 25400e061dbSMilanka Ringwald switch (stream_endpoint->state){ 25500e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 25600e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 2578f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 2588ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING; 25900e061dbSMilanka Ringwald l2cap_disconnect(stream_endpoint->l2cap_media_cid, 0); 26000e061dbSMilanka Ringwald break; 26100e061dbSMilanka Ringwald default: 26200e061dbSMilanka Ringwald break; 26300e061dbSMilanka Ringwald } 2648ef7100fSMilanka Ringwald break; 2658ef7100fSMilanka Ringwald case AVDTP_SI_ABORT: 266e8c2501fSMilanka Ringwald if (!stream_endpoint){ 267e8c2501fSMilanka Ringwald log_error("AVDTP_SI_ABORT: stream endpoint is null"); 268e8c2501fSMilanka Ringwald break; 269e8c2501fSMilanka Ringwald } 27000e061dbSMilanka Ringwald switch (stream_endpoint->state){ 27100e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CONFIGURED: 27200e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CLOSING: 27300e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 27400e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 2758f3d0a2fSMatthias Ringwald stream_endpoint_for_event = stream_endpoint; 2768ef7100fSMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 27700e061dbSMilanka Ringwald l2cap_disconnect(stream_endpoint->l2cap_media_cid, 0); 27800e061dbSMilanka Ringwald break; 27900e061dbSMilanka Ringwald default: 28000e061dbSMilanka Ringwald break; 28100e061dbSMilanka Ringwald } 2828ef7100fSMilanka Ringwald break; 283e2dcb544SMilanka Ringwald 284e2dcb544SMilanka Ringwald case AVDTP_SI_DELAYREPORT: 285e2dcb544SMilanka Ringwald break; 286e2dcb544SMilanka Ringwald case AVDTP_SI_GET_CONFIGURATION: 287e2dcb544SMilanka Ringwald break; 2888ef7100fSMilanka Ringwald default: 28950453b92SMatthias Ringwald log_info("AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier); 2908ef7100fSMilanka Ringwald break; 2918ef7100fSMilanka Ringwald } 2928f3d0a2fSMatthias Ringwald if (stream_endpoint_for_event != NULL){ 2938f3d0a2fSMatthias Ringwald avdtp_signaling_emit_accept_for_stream_endpoint(stream_endpoint_for_event, connection->initiator_local_seid, 294c69f4ba5SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier, true); 2958f3d0a2fSMatthias Ringwald } else { 2968f3d0a2fSMatthias Ringwald avdtp_signaling_emit_accept(connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true); 2978f3d0a2fSMatthias Ringwald } 298b1935866SMilanka Ringwald connection->initiator_transaction_label = avdtp_get_next_transaction_label(); 2998ef7100fSMilanka Ringwald break; 3008ef7100fSMilanka Ringwald case AVDTP_RESPONSE_REJECT_MSG: 30150453b92SMatthias Ringwald switch (connection->initiator_signaling_packet.signal_identifier){ 302d8b859a2SMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION: 303a3ce0109SMatthias Ringwald connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE; 304270f0cffSMatthias Ringwald log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry."); 305d8b859a2SMilanka Ringwald break; 306d8b859a2SMilanka Ringwald default: 307d8b859a2SMilanka Ringwald break; 308d8b859a2SMilanka Ringwald } 30963274943SMilanka Ringwald log_info("AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 310c69f4ba5SMatthias Ringwald avdtp_signaling_emit_reject(connection->avdtp_cid, connection->initiator_local_seid, 311c69f4ba5SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier, true); 3128ef7100fSMilanka Ringwald return; 3138ef7100fSMilanka Ringwald case AVDTP_GENERAL_REJECT_MSG: 31463274943SMilanka Ringwald log_info("AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 315c69f4ba5SMatthias Ringwald avdtp_signaling_emit_general_reject(connection->avdtp_cid, connection->initiator_local_seid, 316c69f4ba5SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier, true); 3178ef7100fSMilanka Ringwald return; 3188ef7100fSMilanka Ringwald default: 3198ef7100fSMilanka Ringwald break; 3208ef7100fSMilanka Ringwald } 3218ef7100fSMilanka Ringwald } 3228ef7100fSMilanka Ringwald 323087c4e09SMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){ 3248ef7100fSMilanka Ringwald switch (connection->initiator_connection_state){ 3258ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS: 3267344f9afSMilanka Ringwald log_info("W2_DISCOVER_SEPS"); 3278ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 3289413b167SMilanka Ringwald avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label); 329087c4e09SMatthias Ringwald return true; 3308ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES: 3317344f9afSMilanka Ringwald log_info("W2_GET_CAPABILITIES"); 3328ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 33396dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 334087c4e09SMatthias Ringwald return true; 3358ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES: 3367344f9afSMilanka Ringwald log_info("W2_GET_ALL_CAPABILITIES"); 3378ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 33896dcd0f4SMatthias 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); 339087c4e09SMatthias Ringwald return true; 3408ef7100fSMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION: 3417344f9afSMilanka Ringwald log_info("W4_GET_CONFIGURATION"); 3428ef7100fSMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 34396dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid); 344087c4e09SMatthias Ringwald return true; 34519af95b4SMilanka Ringwald case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT: 3467344f9afSMilanka Ringwald log_info("W4_DELAY_REPORT"); 34719af95b4SMilanka Ringwald connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 34819af95b4SMilanka Ringwald avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label, 34996dcd0f4SMatthias Ringwald connection->initiator_remote_seid, connection->delay_ms); 350087c4e09SMatthias Ringwald return true; 3518ef7100fSMilanka Ringwald default: 3528ef7100fSMilanka Ringwald break; 3538ef7100fSMilanka Ringwald } 354087c4e09SMatthias Ringwald return false; 355087c4e09SMatthias Ringwald } 3568ef7100fSMilanka Ringwald 357bdf09c5fSMatthias Ringwald static bool avdtp_initiator_stream_config_subsm_run_endpoint(avdtp_connection_t * connection, avdtp_stream_endpoint_t * stream_endpoint){ 3581c8795f6SMatthias Ringwald log_debug("SE %p, initiator_config_state: 0x%02x", stream_endpoint, stream_endpoint->initiator_config_state); 359bdf09c5fSMatthias Ringwald switch (stream_endpoint->initiator_config_state){ 360087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_SET_CONFIGURATION: 361087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{ 362bdf09c5fSMatthias Ringwald if ((stream_endpoint->initiator_config_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){ 363087c4e09SMatthias Ringwald log_info("initiator SM stop sending SET_CONFIGURATION cmd:"); 364087c4e09SMatthias Ringwald break; 365087c4e09SMatthias Ringwald } 36647612f7fSMilanka Ringwald log_info("W2_(RE)CONFIGURATION bitmap, local seid 0x%02x, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid); 367087c4e09SMatthias Ringwald // log_info_hexdump( connection->remote_capabilities.media_codec.media_codec_information, connection->remote_capabilities.media_codec.media_codec_information_len); 368087c4e09SMatthias Ringwald connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid; 369087c4e09SMatthias Ringwald connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid; 370087c4e09SMatthias Ringwald 371087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION; 372087c4e09SMatthias Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE; 373bdf09c5fSMatthias Ringwald if (stream_endpoint->initiator_config_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){ 374087c4e09SMatthias Ringwald connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE; 375087c4e09SMatthias Ringwald } 376087c4e09SMatthias Ringwald 377087c4e09SMatthias 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); 378087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 379087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 380087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 381087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 382087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 3837344f9afSMilanka Ringwald log_info("fragmented"); 384bdf09c5fSMatthias Ringwald } else { 385bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 386087c4e09SMatthias Ringwald } 387087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 388bdf09c5fSMatthias Ringwald if (stream_endpoint->initiator_config_state == AVDTP_INITIATOR_FRAGMENTATED_COMMAND){ 389bdf09c5fSMatthias Ringwald avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 390bdf09c5fSMatthias Ringwald } 391bdf09c5fSMatthias Ringwald return true; 392087c4e09SMatthias Ringwald } 393087c4e09SMatthias Ringwald case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{ 394087c4e09SMatthias Ringwald l2cap_reserve_packet_buffer(); 395087c4e09SMatthias Ringwald uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 396087c4e09SMatthias Ringwald uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 397087c4e09SMatthias Ringwald if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 398087c4e09SMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 3997344f9afSMilanka Ringwald log_info("fragmented"); 400bdf09c5fSMatthias Ringwald } else { 401bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 402087c4e09SMatthias Ringwald } 403087c4e09SMatthias Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 404bdf09c5fSMatthias Ringwald if (stream_endpoint->initiator_config_state == AVDTP_INITIATOR_FRAGMENTATED_COMMAND){ 405bdf09c5fSMatthias Ringwald avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 406bdf09c5fSMatthias Ringwald } 407bdf09c5fSMatthias Ringwald return true; 408087c4e09SMatthias Ringwald } 409087c4e09SMatthias Ringwald case AVDTP_INITIATOR_W2_OPEN_STREAM: 410087c4e09SMatthias Ringwald switch (stream_endpoint->state){ 411087c4e09SMatthias Ringwald case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM: 41241c62a08SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_ACCEPT_OPEN_STREAM; 4137344f9afSMilanka Ringwald log_info("send AVDTP_SI_OPEN signaling to remote, transaction_label %d, remote seid 0x%02x", connection->initiator_transaction_label, connection->initiator_remote_seid); 414087c4e09SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid); 415bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 416bdf09c5fSMatthias Ringwald return true; 417087c4e09SMatthias Ringwald default: 418087c4e09SMatthias Ringwald break; 419087c4e09SMatthias Ringwald } 420087c4e09SMatthias Ringwald break; 421087c4e09SMatthias Ringwald default: 422087c4e09SMatthias Ringwald break; 423087c4e09SMatthias Ringwald } 424bdf09c5fSMatthias Ringwald return false; 425087c4e09SMatthias Ringwald } 426087c4e09SMatthias Ringwald 42777092f3eSMatthias Ringwald void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t *connection) { 428bdf09c5fSMatthias Ringwald bool sent; 429087c4e09SMatthias Ringwald 430bdf09c5fSMatthias Ringwald sent = avdtp_initiator_stream_config_subsm_run_signaling(connection); 4318ef7100fSMilanka Ringwald if (sent) return; 4328ef7100fSMilanka Ringwald 433054be048SMilanka Ringwald avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 4343a69f723SMatthias Ringwald if (stream_endpoint == NULL){ 4356f98b084SMilanka Ringwald stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 4363a69f723SMatthias Ringwald if (stream_endpoint == NULL){ 4373a69f723SMatthias Ringwald log_debug("no stream endpoint for local %u, remote %u", connection->initiator_local_seid, connection->initiator_remote_seid); 438bdf09c5fSMatthias Ringwald return; 4393a69f723SMatthias Ringwald } else { 4403a69f723SMatthias Ringwald log_debug("Using stream endpoint %p for local seid %u", stream_endpoint, connection->initiator_local_seid); 4413a69f723SMatthias Ringwald } 4423a69f723SMatthias Ringwald } else { 4433a69f723SMatthias Ringwald log_debug("Using stream endpoint %p for remote seid %u", stream_endpoint, connection->initiator_remote_seid); 444bdf09c5fSMatthias Ringwald } 4458ef7100fSMilanka Ringwald 446bdf09c5fSMatthias Ringwald sent = avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint); 447bdf09c5fSMatthias Ringwald if (sent) return; 448bdf09c5fSMatthias Ringwald 449bdf09c5fSMatthias Ringwald log_debug("stream: start %u, close %u, abort %u, suspend %u, request %u", stream_endpoint->start_stream, stream_endpoint->close_stream, 450bdf09c5fSMatthias Ringwald stream_endpoint->abort_stream, stream_endpoint->suspend_stream, stream_endpoint->request_can_send_now); 4518ef7100fSMilanka Ringwald 45260ec20d0SMilanka Ringwald if (stream_endpoint->start_stream){ 45360ec20d0SMilanka Ringwald stream_endpoint->start_stream = 0; 454da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){ 455bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 4565bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 45796dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 458b1935866SMilanka Ringwald connection->initiator_transaction_label = avdtp_get_next_transaction_label(); 459b1935866SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label, connection->initiator_remote_seid); 46060ec20d0SMilanka Ringwald return; 46160ec20d0SMilanka Ringwald } 46260ec20d0SMilanka Ringwald } 46360ec20d0SMilanka Ringwald 46400e061dbSMilanka Ringwald if (stream_endpoint->close_stream){ 46500e061dbSMilanka Ringwald stream_endpoint->close_stream = 0; 46600e061dbSMilanka Ringwald switch (stream_endpoint->state){ 46700e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 46800e061dbSMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 469bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 4705bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 47196dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 472b1935866SMilanka Ringwald connection->initiator_transaction_label = avdtp_get_next_transaction_label(); 473b1935866SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label, connection->initiator_remote_seid); 47460ec20d0SMilanka Ringwald return; 47500e061dbSMilanka Ringwald default: 47600e061dbSMilanka Ringwald break; 47760ec20d0SMilanka Ringwald } 47860ec20d0SMilanka Ringwald } 47960ec20d0SMilanka Ringwald 48060ec20d0SMilanka Ringwald if (stream_endpoint->abort_stream){ 481da4d6891SMilanka Ringwald stream_endpoint->abort_stream = 0; 48260ec20d0SMilanka Ringwald switch (stream_endpoint->state){ 48360ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CONFIGURED: 48460ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_CLOSING: 48560ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_OPENED: 48660ec20d0SMilanka Ringwald case AVDTP_STREAM_ENDPOINT_STREAMING: 487bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 4885bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 48996dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 490b1935866SMilanka Ringwald connection->initiator_transaction_label = avdtp_get_next_transaction_label(); 491b1935866SMilanka Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label, connection->initiator_remote_seid); 49260ec20d0SMilanka Ringwald return; 49360ec20d0SMilanka Ringwald default: 49460ec20d0SMilanka Ringwald break; 49560ec20d0SMilanka Ringwald } 49660ec20d0SMilanka Ringwald } 49760ec20d0SMilanka Ringwald 49860ec20d0SMilanka Ringwald if (stream_endpoint->suspend_stream){ 49960ec20d0SMilanka Ringwald stream_endpoint->suspend_stream = 0; 500da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 501bdf09c5fSMatthias Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 5025bd73fa2SMatthias Ringwald connection->initiator_local_seid = stream_endpoint->sep.seid; 50396dcd0f4SMatthias Ringwald connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 5042dbb0487SMilanka Ringwald connection->initiator_transaction_label = avdtp_get_next_transaction_label(); 50596dcd0f4SMatthias Ringwald avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid); 50660ec20d0SMilanka Ringwald return; 50760ec20d0SMilanka Ringwald } 50860ec20d0SMilanka Ringwald } 50960ec20d0SMilanka Ringwald 510c38fa3efSMilanka Ringwald if (stream_endpoint->request_can_send_now){ 511c38fa3efSMilanka Ringwald stream_endpoint->request_can_send_now = 0; 512da4d6891SMilanka Ringwald if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 51360ec20d0SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 514bdf09c5fSMatthias Ringwald avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint, stream_endpoint->sequence_number); 51560ec20d0SMilanka Ringwald return; 51660ec20d0SMilanka Ringwald } 51760ec20d0SMilanka Ringwald } 5188ef7100fSMilanka Ringwald } 519