1 /* 2 * Copyright (C) 2016 BlueKitchen GmbH 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the copyright holders nor the names of 14 * contributors may be used to endorse or promote products derived 15 * from this software without specific prior written permission. 16 * 4. Any redistribution, use, or modification is done solely for 17 * personal benefit and not for any commercial purpose or for 18 * monetary gain. 19 * 20 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24 * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * Please inquire about commercial licensing options at 34 * [email protected] 35 * 36 */ 37 38 #define BTSTACK_FILE__ "avdtp_initiator.c" 39 40 #include <stdint.h> 41 #include <string.h> 42 43 #include "bluetooth_psm.h" 44 #include "bluetooth_sdp.h" 45 #include "btstack_debug.h" 46 #include "btstack_event.h" 47 #include "l2cap.h" 48 #include "classic/avdtp.h" 49 #include "classic/avdtp_util.h" 50 #include "classic/avdtp_initiator.h" 51 52 static int avdtp_initiator_send_signaling_cmd(uint16_t cid, avdtp_signal_identifier_t identifier, uint8_t transaction_label){ 53 uint8_t command[2]; 54 command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 55 command[1] = (uint8_t)identifier; 56 return l2cap_send(cid, command, sizeof(command)); 57 } 58 59 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){ 60 uint8_t command[3]; 61 command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 62 command[1] = (uint8_t)identifier; 63 command[2] = sep_id << 2; 64 return l2cap_send(cid, command, sizeof(command)); 65 } 66 67 static int avdtp_initiator_send_signaling_cmd_delay_report(uint16_t cid, uint8_t transaction_label, uint8_t sep_id, uint16_t delay_ms){ 68 uint8_t command[5]; 69 command[0] = avdtp_header(transaction_label, AVDTP_SINGLE_PACKET, AVDTP_CMD_MSG); 70 command[1] = AVDTP_SI_DELAYREPORT; 71 command[2] = sep_id << 2; 72 big_endian_store_16(command, 3, delay_ms); 73 return l2cap_send(cid, command, sizeof(command)); 74 } 75 76 void avdtp_initiator_stream_config_subsm(avdtp_connection_t * connection, uint8_t *packet, uint16_t size, int offset, avdtp_context_t * context){ 77 // int status = 0; 78 avdtp_stream_endpoint_t * stream_endpoint = NULL; 79 80 avdtp_sep_t sep; 81 if (connection->initiator_connection_state == AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER) { 82 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_IDLE; 83 } else { 84 stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 85 if (!stream_endpoint){ 86 stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 87 } 88 if (!stream_endpoint) { 89 log_error("stream_endpoint for seid 0x%02x not found", connection->initiator_local_seid); 90 return; 91 } 92 sep.seid = connection->initiator_remote_seid; 93 94 if (stream_endpoint->initiator_config_state != AVDTP_INITIATOR_W4_ANSWER) { 95 log_error("initiator_config_state is in wrong state %d, expected %d", stream_endpoint->initiator_config_state, AVDTP_INITIATOR_W4_ANSWER); 96 return; 97 } 98 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 99 } 100 101 switch (connection->initiator_signaling_packet.message_type){ 102 case AVDTP_RESPONSE_ACCEPT_MSG: 103 switch (connection->initiator_signaling_packet.signal_identifier){ 104 case AVDTP_SI_DISCOVER:{ 105 if (connection->initiator_signaling_packet.transaction_label != connection->initiator_transaction_label){ 106 log_info(" unexpected transaction label, got %d, expected %d", connection->initiator_signaling_packet.transaction_label, connection->initiator_transaction_label); 107 // status = BAD_HEADER_FORMAT; 108 break; 109 } 110 111 if (size == 3){ 112 log_info(" ERROR code %02x", packet[offset]); 113 break; 114 } 115 116 int i; 117 for (i = offset; i < size; i += 2){ 118 sep.seid = packet[i] >> 2; 119 offset++; 120 if ((sep.seid < 0x01) || (sep.seid > 0x3E)){ 121 log_info(" invalid sep id"); 122 // status = BAD_ACP_SEID; 123 break; 124 } 125 sep.in_use = (packet[i] >> 1) & 0x01; 126 sep.media_type = (avdtp_media_type_t)(packet[i+1] >> 4); 127 sep.type = (avdtp_sep_type_t)((packet[i+1] >> 3) & 0x01); 128 avdtp_signaling_emit_sep(context->avdtp_callback, connection->avdtp_cid, sep); 129 } 130 avdtp_signaling_emit_sep_done(context->avdtp_callback, connection->avdtp_cid); 131 break; 132 } 133 134 case AVDTP_SI_GET_CAPABILITIES: 135 case AVDTP_SI_GET_ALL_CAPABILITIES: 136 sep.registered_service_categories = avdtp_unpack_service_capabilities(connection, connection->initiator_signaling_packet.signal_identifier, &sep.capabilities, packet+offset, size-offset); 137 avdtp_emit_capabilities(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_remote_seid, &sep.capabilities, sep.registered_service_categories); 138 break; 139 case AVDTP_SI_DELAYREPORT: 140 avdtp_signaling_emit_delay(connection->avdtp_cid, connection->initiator_local_seid, 141 little_endian_read_16(packet, offset)); 142 break; 143 case AVDTP_SI_GET_CONFIGURATION: 144 // sep.configured_service_categories = avdtp_unpack_service_capabilities(connection, &sep.configuration, packet+offset, size-offset); 145 // if (get_bit16(sep.configured_service_categories, AVDTP_MEDIA_CODEC)){ 146 // switch (sep.configuration.media_codec.media_codec_type){ 147 // case AVDTP_CODEC_SBC: 148 // avdtp_signaling_emit_media_codec_sbc_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, 149 // sep.configuration.media_codec.media_type, sep.configuration.media_codec.media_codec_information); 150 // break; 151 // default: 152 // avdtp_signaling_emit_media_codec_other_configuration(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->remote_seid, sep.configuration.media_codec); 153 // break; 154 // } 155 // } 156 break; 157 158 case AVDTP_SI_RECONFIGURE: 159 if (!stream_endpoint){ 160 log_error("AVDTP_SI_RECONFIGURE: stream endpoint is null"); 161 break; 162 } 163 // copy sbc media codec info 164 stream_endpoint->remote_sep.configured_service_categories |= stream_endpoint->remote_configuration_bitmap; 165 stream_endpoint->remote_sep.configuration = stream_endpoint->remote_configuration; 166 (void)memcpy(stream_endpoint->media_codec_sbc_info, 167 stream_endpoint->remote_configuration.media_codec.media_codec_information, 168 4); 169 stream_endpoint->remote_sep.configuration.media_codec.media_codec_information = stream_endpoint->media_codec_sbc_info; 170 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 171 break; 172 173 case AVDTP_SI_SET_CONFIGURATION:{ 174 if (!stream_endpoint){ 175 log_error("AVDTP_SI_SET_CONFIGURATION: stream endpoint is null"); 176 break; 177 } 178 sep.configured_service_categories = stream_endpoint->remote_configuration_bitmap; 179 sep.configuration = stream_endpoint->remote_configuration; 180 sep.in_use = 1; 181 182 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURED; 183 stream_endpoint->remote_sep = sep; 184 stream_endpoint->connection = connection; 185 connection->configuration_state = AVDTP_CONFIGURATION_STATE_LOCAL_CONFIGURED; 186 187 log_info("INT: configured remote seid %d, to %p", stream_endpoint->remote_sep.seid, stream_endpoint); 188 189 switch (stream_endpoint->media_codec_type){ 190 case AVDTP_CODEC_SBC: 191 avdtp_signaling_emit_media_codec_sbc_configuration( 192 stream_endpoint, 193 connection->avdtp_cid, 194 stream_endpoint->media_type, 195 stream_endpoint->media_codec_sbc_info); 196 break; 197 default: 198 // TODO: we don\t have codec info to emit config 199 avdtp_signaling_emit_media_codec_other_configuration(stream_endpoint, 200 connection->avdtp_cid, 201 connection->initiator_local_seid, 202 connection->initiator_remote_seid, 203 sep.configuration.media_codec); 204 break; 205 } 206 break; 207 } 208 209 case AVDTP_SI_OPEN: 210 if (!stream_endpoint){ 211 log_error("AVDTP_SI_OPEN: stream endpoint is null"); 212 break; 213 } 214 if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM) { 215 log_error("AVDTP_SI_OPEN in wrong stream endpoint state"); 216 return; 217 } 218 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_W4_L2CAP_FOR_MEDIA_CONNECTED; 219 connection->initiator_local_seid = stream_endpoint->sep.seid; 220 l2cap_create_channel(avdtp_packet_handler, connection->remote_addr, BLUETOOTH_PSM_AVDTP, 0xffff, NULL); 221 return; 222 case AVDTP_SI_START: 223 if (!stream_endpoint){ 224 log_error("AVDTP_SI_START: stream endpoint is null"); 225 break; 226 } 227 if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_OPENED) { 228 log_error("AVDTP_SI_START in wrong stream endpoint state"); 229 return; 230 } 231 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 232 break; 233 case AVDTP_SI_SUSPEND: 234 if (!stream_endpoint){ 235 log_error("AVDTP_SI_SUSPEND: stream endpoint is null"); 236 break; 237 } 238 if (stream_endpoint->state != AVDTP_STREAM_ENDPOINT_STREAMING) { 239 log_error("AVDTP_SI_SUSPEND in wrong stream endpoint state"); 240 return; 241 } 242 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_OPENED; 243 break; 244 case AVDTP_SI_CLOSE: 245 if (!stream_endpoint){ 246 log_error("AVDTP_SI_CLOSE: stream endpoint is null"); 247 break; 248 } 249 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CLOSING; 250 break; 251 case AVDTP_SI_ABORT: 252 if (!stream_endpoint){ 253 log_error("AVDTP_SI_ABORT: stream endpoint is null"); 254 break; 255 } 256 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 257 break; 258 default: 259 log_info(" AVDTP_RESPONSE_ACCEPT_MSG, signal %d not implemented", connection->initiator_signaling_packet.signal_identifier); 260 break; 261 } 262 avdtp_signaling_emit_accept(context->avdtp_callback, connection->avdtp_cid, 0, connection->initiator_signaling_packet.signal_identifier, true); 263 connection->initiator_transaction_label++; 264 break; 265 case AVDTP_RESPONSE_REJECT_MSG: 266 switch (connection->initiator_signaling_packet.signal_identifier){ 267 case AVDTP_SI_SET_CONFIGURATION: 268 connection->configuration_state = AVDTP_CONFIGURATION_STATE_IDLE; 269 log_info("Received reject for set configuration, role changed from initiator to acceptor. TODO: implement retry."); 270 break; 271 default: 272 break; 273 } 274 log_info(" AVDTP_RESPONSE_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 275 avdtp_signaling_emit_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 276 return; 277 case AVDTP_GENERAL_REJECT_MSG: 278 log_info(" AVDTP_GENERAL_REJECT_MSG signal %s", avdtp_si2str(connection->initiator_signaling_packet.signal_identifier)); 279 avdtp_signaling_emit_general_reject(context->avdtp_callback, connection->avdtp_cid, connection->initiator_local_seid, connection->initiator_signaling_packet.signal_identifier, true); 280 return; 281 default: 282 break; 283 } 284 } 285 286 static bool avdtp_initiator_stream_config_subsm_run_signaling(avdtp_connection_t * connection){ 287 switch (connection->initiator_connection_state){ 288 case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_DISCOVER_SEPS: 289 log_info("INT: W2_DISCOVER_SEPS"); 290 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 291 avdtp_initiator_send_signaling_cmd(connection->l2cap_signaling_cid, AVDTP_SI_DISCOVER, connection->initiator_transaction_label); 292 return true; 293 case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CAPABILITIES: 294 log_info("INT: W2_GET_CAPABILITIES"); 295 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 296 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 297 return true; 298 case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_ALL_CAPABILITIES: 299 log_info("INT: W2_GET_ALL_CAPABILITIES"); 300 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 301 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_ALL_CAPABILITIES, connection->initiator_transaction_label, connection->initiator_remote_seid); 302 return true; 303 case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_GET_CONFIGURATION: 304 log_info("INT: W4_GET_CONFIGURATION"); 305 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 306 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_GET_CONFIGURATION, connection->initiator_transaction_label, connection->initiator_remote_seid); 307 return true; 308 case AVDTP_SIGNALING_CONNECTION_INITIATOR_W2_SEND_DELAY_REPORT: 309 log_info("INT: W4_DELAY_REPORT"); 310 connection->initiator_connection_state = AVDTP_SIGNALING_CONNECTION_INITIATOR_W4_ANSWER; 311 avdtp_initiator_send_signaling_cmd_delay_report(connection->l2cap_signaling_cid, connection->initiator_transaction_label, 312 connection->initiator_remote_seid, connection->delay_ms); 313 return true; 314 default: 315 break; 316 } 317 return false; 318 } 319 320 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){ 321 switch (stream_endpoint_state){ 322 case AVDTP_INITIATOR_W2_SET_CONFIGURATION: 323 case AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID:{ 324 if ((stream_endpoint_state == AVDTP_INITIATOR_W2_SET_CONFIGURATION) && (connection->configuration_state != AVDTP_CONFIGURATION_STATE_LOCAL_INITIATED)){ 325 log_info("initiator SM stop sending SET_CONFIGURATION cmd:"); 326 break; 327 } 328 log_info("INT: W2_(RE)CONFIGURATION bitmap, local seid %d, remote seid 0x%02x", connection->initiator_local_seid, connection->initiator_remote_seid); 329 // log_info_hexdump( connection->remote_capabilities.media_codec.media_codec_information, connection->remote_capabilities.media_codec.media_codec_information_len); 330 connection->initiator_signaling_packet.acp_seid = connection->initiator_remote_seid; 331 connection->initiator_signaling_packet.int_seid = connection->initiator_local_seid; 332 333 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_SET_CONFIGURATION; 334 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_CONFIGURATION_SUBSTATEMACHINE; 335 if (stream_endpoint_state == AVDTP_INITIATOR_W2_RECONFIGURE_STREAM_WITH_SEID){ 336 connection->initiator_signaling_packet.signal_identifier = AVDTP_SI_RECONFIGURE; 337 } 338 339 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); 340 l2cap_reserve_packet_buffer(); 341 uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 342 uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 343 if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 344 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 345 log_info("INT: fragmented"); 346 } 347 l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 348 break; 349 } 350 case AVDTP_INITIATOR_FRAGMENTATED_COMMAND:{ 351 l2cap_reserve_packet_buffer(); 352 uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 353 uint16_t pos = avdtp_signaling_create_fragment(connection->l2cap_signaling_cid, &connection->initiator_signaling_packet, out_buffer); 354 if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 355 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_FRAGMENTATED_COMMAND; 356 log_info("INT: fragmented"); 357 } 358 l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 359 break; 360 } 361 case AVDTP_INITIATOR_W2_OPEN_STREAM: 362 switch (stream_endpoint->state){ 363 case AVDTP_STREAM_ENDPOINT_W2_REQUEST_OPEN_STREAM: 364 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); 365 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_OPEN, connection->initiator_transaction_label, connection->initiator_remote_seid); 366 break; 367 default: 368 break; 369 } 370 break; 371 default: 372 break; 373 } 374 } 375 376 void avdtp_initiator_stream_config_subsm_run(avdtp_connection_t * connection, avdtp_context_t * context){ 377 378 bool sent = avdtp_initiator_stream_config_subsm_run_signaling(connection); 379 if (sent) return; 380 381 avdtp_stream_endpoint_t * stream_endpoint = avdtp_get_stream_endpoint_associated_with_acp_seid(connection->initiator_remote_seid); 382 if (!stream_endpoint){ 383 stream_endpoint = avdtp_get_stream_endpoint_with_seid(connection->initiator_local_seid); 384 } 385 if (!stream_endpoint) return; 386 387 avdtp_initiator_stream_endpoint_state_t stream_endpoint_state = stream_endpoint->initiator_config_state; 388 stream_endpoint->initiator_config_state = AVDTP_INITIATOR_W4_ANSWER; 389 390 if (stream_endpoint->start_stream){ 391 stream_endpoint->start_stream = 0; 392 if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_OPENED){ 393 connection->initiator_local_seid = stream_endpoint->sep.seid; 394 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 395 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_START, connection->initiator_transaction_label++, connection->initiator_remote_seid); 396 return; 397 } 398 } 399 400 if (stream_endpoint->stop_stream){ 401 stream_endpoint->stop_stream = 0; 402 if (stream_endpoint->state >= AVDTP_STREAM_ENDPOINT_OPENED){ 403 connection->initiator_local_seid = stream_endpoint->sep.seid; 404 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 405 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_CLOSE, connection->initiator_transaction_label++, connection->initiator_remote_seid); 406 return; 407 } 408 } 409 410 if (stream_endpoint->abort_stream){ 411 stream_endpoint->abort_stream = 0; 412 switch (stream_endpoint->state){ 413 case AVDTP_STREAM_ENDPOINT_CONFIGURED: 414 case AVDTP_STREAM_ENDPOINT_CLOSING: 415 case AVDTP_STREAM_ENDPOINT_OPENED: 416 case AVDTP_STREAM_ENDPOINT_STREAMING: 417 connection->initiator_local_seid = stream_endpoint->sep.seid; 418 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 419 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_ABORTING; 420 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_ABORT, connection->initiator_transaction_label++, connection->initiator_remote_seid); 421 return; 422 default: 423 break; 424 } 425 } 426 427 if (stream_endpoint->suspend_stream){ 428 stream_endpoint->suspend_stream = 0; 429 if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 430 connection->initiator_local_seid = stream_endpoint->sep.seid; 431 connection->initiator_remote_seid = stream_endpoint->remote_sep.seid; 432 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 433 avdtp_initiator_send_signaling_cmd_with_seid(connection->l2cap_signaling_cid, AVDTP_SI_SUSPEND, connection->initiator_transaction_label, connection->initiator_remote_seid); 434 return; 435 } 436 } 437 438 if (stream_endpoint->send_stream){ 439 stream_endpoint->send_stream = 0; 440 if (stream_endpoint->state == AVDTP_STREAM_ENDPOINT_STREAMING){ 441 stream_endpoint->state = AVDTP_STREAM_ENDPOINT_STREAMING; 442 avdtp_streaming_emit_can_send_media_packet_now(stream_endpoint, 443 stream_endpoint->sequence_number); 444 return; 445 } 446 } 447 448 avdtp_initiator_stream_config_subsm_run_endpoint(connection, stream_endpoint, stream_endpoint_state); 449 450 // check fragmentation 451 if ((connection->initiator_signaling_packet.packet_type != AVDTP_SINGLE_PACKET) && (connection->initiator_signaling_packet.packet_type != AVDTP_END_PACKET)){ 452 avdtp_request_can_send_now_initiator(connection, connection->l2cap_signaling_cid); 453 } 454 } 455