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__ "avrcp.c" 39 40 #include <stdint.h> 41 #include <stdio.h> 42 #include <stdlib.h> 43 #include <string.h> 44 45 #include "btstack.h" 46 #include "classic/avrcp.h" 47 #include "classic/avrcp_controller.h" 48 49 #define PSM_AVCTP BLUETOOTH_PROTOCOL_AVCTP 50 #define PSM_AVCTP_BROWSING 0x001b 51 52 static const char * default_avrcp_controller_service_name = "BTstack AVRCP Controller Service"; 53 static const char * default_avrcp_controller_service_provider_name = "BTstack AVRCP Controller Service Provider"; 54 static const char * default_avrcp_target_service_name = "BTstack AVRCP Target Service"; 55 static const char * default_avrcp_target_service_provider_name = "BTstack AVRCP Target Service Provider"; 56 57 static uint16_t avrcp_cid_counter = 0; 58 59 static avrcp_context_t * sdp_query_context; 60 static uint8_t attribute_value[1000]; 61 static const unsigned int attribute_value_buffer_size = sizeof(attribute_value); 62 63 static btstack_linked_list_t connections; 64 static btstack_packet_handler_t avrcp_controller_packet_handler; 65 static btstack_packet_handler_t avrcp_target_packet_handler; 66 // static int l2cap_service_registered = 0; 67 68 static const char * avrcp_subunit_type_name[] = { 69 "MONITOR", "AUDIO", "PRINTER", "DISC", "TAPE_RECORDER_PLAYER", "TUNER", 70 "CA", "CAMERA", "RESERVED", "PANEL", "BULLETIN_BOARD", "CAMERA_STORAGE", 71 "VENDOR_UNIQUE", "RESERVED_FOR_ALL_SUBUNIT_TYPES", 72 "EXTENDED_TO_NEXT_BYTE", "UNIT", "ERROR" 73 }; 74 75 const char * avrcp_subunit2str(uint16_t index){ 76 if (index <= 11) return avrcp_subunit_type_name[index]; 77 if (index >= 0x1C && index <= 0x1F) return avrcp_subunit_type_name[index - 0x10]; 78 return avrcp_subunit_type_name[16]; 79 } 80 81 static const char * avrcp_event_name[] = { 82 "ERROR", "PLAYBACK_STATUS_CHANGED", 83 "TRACK_CHANGED", "TRACK_REACHED_END", "TRACK_REACHED_START", 84 "PLAYBACK_POS_CHANGED", "BATT_STATUS_CHANGED", "SYSTEM_STATUS_CHANGED", 85 "PLAYER_APPLICATION_SETTING_CHANGED", "NOW_PLAYING_CONTENT_CHANGED", 86 "AVAILABLE_PLAYERS_CHANGED", "ADDRESSED_PLAYER_CHANGED", "UIDS_CHANGED", "VOLUME_CHANGED" 87 }; 88 const char * avrcp_event2str(uint16_t index){ 89 if (index <= 0x0d) return avrcp_event_name[index]; 90 return avrcp_event_name[0]; 91 } 92 93 static const char * avrcp_operation_name[] = { 94 "NOT SUPPORTED", // 0x3B 95 "SKIP", "NOT SUPPORTED", "NOT SUPPORTED", "NOT SUPPORTED", "NOT SUPPORTED", 96 "VOLUME_UP", "VOLUME_DOWN", "MUTE", "PLAY", "STOP", "PAUSE", "NOT SUPPORTED", 97 "REWIND", "FAST_FORWARD", "NOT SUPPORTED", "FORWARD", "BACKWARD" // 0x4C 98 }; 99 const char * avrcp_operation2str(uint8_t index){ 100 if (index >= 0x3B && index <= 0x4C) return avrcp_operation_name[index - 0x3B]; 101 return avrcp_operation_name[0]; 102 } 103 104 static const char * avrcp_media_attribute_id_name[] = { 105 "NONE", "TITLE", "ARTIST", "ALBUM", "TRACK", "TOTAL TRACKS", "GENRE", "SONG LENGTH" 106 }; 107 const char * avrcp_attribute2str(uint8_t index){ 108 if (index >= 1 && index <= 7) return avrcp_media_attribute_id_name[index]; 109 return avrcp_media_attribute_id_name[0]; 110 } 111 112 static const char * avrcp_play_status_name[] = { 113 "STOPPED", "PLAYING", "PAUSED", "FORWARD SEEK", "REVERSE SEEK", 114 "ERROR" // 0xFF 115 }; 116 const char * avrcp_play_status2str(uint8_t index){ 117 if (index >= 1 && index <= 4) return avrcp_play_status_name[index]; 118 return avrcp_play_status_name[5]; 119 } 120 121 static const char * avrcp_ctype_name[] = { 122 "CONTROL", 123 "STATUS", 124 "SPECIFIC_INQUIRY", 125 "NOTIFY", 126 "GENERAL_INQUIRY", 127 "RESERVED5", 128 "RESERVED6", 129 "RESERVED7", 130 "NOT IMPLEMENTED IN REMOTE", 131 "ACCEPTED BY REMOTE", 132 "REJECTED BY REMOTE", 133 "IN_TRANSITION", 134 "IMPLEMENTED_STABLE", 135 "CHANGED_STABLE", 136 "RESERVED", 137 "INTERIM" 138 }; 139 const char * avrcp_ctype2str(uint8_t index){ 140 if (index < sizeof(avrcp_ctype_name)){ 141 return avrcp_ctype_name[index]; 142 } 143 return "NONE"; 144 } 145 146 static const char * avrcp_shuffle_mode_name[] = { 147 "SHUFFLE OFF", 148 "SHUFFLE ALL TRACKS", 149 "SHUFFLE GROUP" 150 }; 151 152 const char * avrcp_shuffle2str(uint8_t index){ 153 if (index >= 1 && index <= 3) return avrcp_shuffle_mode_name[index-1]; 154 return "NONE"; 155 } 156 157 static const char * avrcp_repeat_mode_name[] = { 158 "REPEAT OFF", 159 "REPEAT SINGLE TRACK", 160 "REPEAT ALL TRACKS", 161 "REPEAT GROUP" 162 }; 163 164 const char * avrcp_repeat2str(uint8_t index){ 165 if (index >= 1 && index <= 4) return avrcp_repeat_mode_name[index-1]; 166 return "NONE"; 167 } 168 169 uint8_t avrcp_cmd_opcode(uint8_t *packet, uint16_t size){ 170 uint8_t cmd_opcode_index = 5; 171 if (cmd_opcode_index > size) return AVRCP_CMD_OPCODE_UNDEFINED; 172 return packet[cmd_opcode_index]; 173 } 174 175 void avrcp_create_sdp_record(uint8_t controller, uint8_t * service, uint32_t service_record_handle, uint8_t browsing, uint16_t supported_features, 176 const char * service_name, const char * service_provider_name){ 177 uint8_t* attribute; 178 de_create_sequence(service); 179 180 // 0x0000 "Service Record Handle" 181 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_SERVICE_RECORD_HANDLE); 182 de_add_number(service, DE_UINT, DE_SIZE_32, service_record_handle); 183 184 // 0x0001 "Service Class ID List" 185 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_SERVICE_CLASS_ID_LIST); 186 attribute = de_push_sequence(service); 187 { 188 if (controller){ 189 de_add_number(attribute, DE_UUID, DE_SIZE_16, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL); 190 de_add_number(attribute, DE_UUID, DE_SIZE_16, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL_CONTROLLER); 191 } else { 192 de_add_number(attribute, DE_UUID, DE_SIZE_16, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL_TARGET); 193 } 194 } 195 de_pop_sequence(service, attribute); 196 197 // 0x0004 "Protocol Descriptor List" 198 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST); 199 attribute = de_push_sequence(service); 200 { 201 uint8_t* l2cpProtocol = de_push_sequence(attribute); 202 { 203 de_add_number(l2cpProtocol, DE_UUID, DE_SIZE_16, BLUETOOTH_PROTOCOL_L2CAP); 204 de_add_number(l2cpProtocol, DE_UINT, DE_SIZE_16, BLUETOOTH_PROTOCOL_AVCTP); 205 } 206 de_pop_sequence(attribute, l2cpProtocol); 207 208 uint8_t* avctpProtocol = de_push_sequence(attribute); 209 { 210 de_add_number(avctpProtocol, DE_UUID, DE_SIZE_16, BLUETOOTH_PROTOCOL_AVCTP); // avctpProtocol_service 211 de_add_number(avctpProtocol, DE_UINT, DE_SIZE_16, 0x0103); // version 212 } 213 de_pop_sequence(attribute, avctpProtocol); 214 } 215 de_pop_sequence(service, attribute); 216 217 // 0x0005 "Public Browse Group" 218 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_BROWSE_GROUP_LIST); // public browse group 219 attribute = de_push_sequence(service); 220 { 221 de_add_number(attribute, DE_UUID, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_PUBLIC_BROWSE_ROOT); 222 } 223 de_pop_sequence(service, attribute); 224 225 // 0x0009 "Bluetooth Profile Descriptor List" 226 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_BLUETOOTH_PROFILE_DESCRIPTOR_LIST); 227 attribute = de_push_sequence(service); 228 { 229 uint8_t *avrcProfile = de_push_sequence(attribute); 230 { 231 de_add_number(avrcProfile, DE_UUID, DE_SIZE_16, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL); 232 de_add_number(avrcProfile, DE_UINT, DE_SIZE_16, 0x0105); 233 } 234 de_pop_sequence(attribute, avrcProfile); 235 } 236 de_pop_sequence(service, attribute); 237 238 // 0x000d "Additional Bluetooth Profile Descriptor List" 239 if (browsing){ 240 de_add_number(service, DE_UINT, DE_SIZE_16, BLUETOOTH_ATTRIBUTE_ADDITIONAL_PROTOCOL_DESCRIPTOR_LISTS); 241 attribute = de_push_sequence(service); 242 { 243 uint8_t * des = de_push_sequence(attribute); 244 { 245 uint8_t* browsing_l2cpProtocol = de_push_sequence(des); 246 { 247 de_add_number(browsing_l2cpProtocol, DE_UUID, DE_SIZE_16, BLUETOOTH_PROTOCOL_L2CAP); 248 de_add_number(browsing_l2cpProtocol, DE_UINT, DE_SIZE_16, PSM_AVCTP_BROWSING); 249 } 250 de_pop_sequence(des, browsing_l2cpProtocol); 251 252 uint8_t* browsing_avctpProtocol = de_push_sequence(des); 253 { 254 de_add_number(browsing_avctpProtocol, DE_UUID, DE_SIZE_16, BLUETOOTH_PROTOCOL_AVCTP); // browsing_avctpProtocol_service 255 de_add_number(browsing_avctpProtocol, DE_UINT, DE_SIZE_16, 0x0103); // version 256 } 257 de_pop_sequence(des, browsing_avctpProtocol); 258 } 259 de_pop_sequence(attribute, des); 260 } 261 de_pop_sequence(service, attribute); 262 } 263 264 265 // 0x0100 "Service Name" 266 de_add_number(service, DE_UINT, DE_SIZE_16, 0x0100); 267 if (service_name){ 268 de_add_data(service, DE_STRING, strlen(service_name), (uint8_t *) service_name); 269 } else { 270 if (controller){ 271 de_add_data(service, DE_STRING, strlen(default_avrcp_controller_service_name), (uint8_t *) default_avrcp_controller_service_name); 272 } else { 273 de_add_data(service, DE_STRING, strlen(default_avrcp_target_service_name), (uint8_t *) default_avrcp_target_service_name); 274 } 275 } 276 277 // 0x0100 "Provider Name" 278 de_add_number(service, DE_UINT, DE_SIZE_16, 0x0102); 279 if (service_provider_name){ 280 de_add_data(service, DE_STRING, strlen(service_provider_name), (uint8_t *) service_provider_name); 281 } else { 282 if (controller){ 283 de_add_data(service, DE_STRING, strlen(default_avrcp_controller_service_provider_name), (uint8_t *) default_avrcp_controller_service_provider_name); 284 } else { 285 de_add_data(service, DE_STRING, strlen(default_avrcp_target_service_provider_name), (uint8_t *) default_avrcp_target_service_provider_name); 286 } 287 } 288 289 // 0x0311 "Supported Features" 290 de_add_number(service, DE_UINT, DE_SIZE_16, 0x0311); 291 de_add_number(service, DE_UINT, DE_SIZE_16, supported_features); 292 } 293 294 avrcp_connection_t * get_avrcp_connection_for_bd_addr(avrcp_role_t role, bd_addr_t addr){ 295 btstack_linked_list_iterator_t it; 296 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 297 while (btstack_linked_list_iterator_has_next(&it)){ 298 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 299 if (connection->role != role) continue; 300 if (memcmp(addr, connection->remote_addr, 6) != 0) continue; 301 return connection; 302 } 303 return NULL; 304 } 305 306 avrcp_connection_t * get_avrcp_connection_for_l2cap_signaling_cid(avrcp_role_t role, uint16_t l2cap_cid){ 307 btstack_linked_list_iterator_t it; 308 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 309 while (btstack_linked_list_iterator_has_next(&it)){ 310 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 311 if (connection->role != role) continue; 312 if (connection->l2cap_signaling_cid != l2cap_cid) continue; 313 return connection; 314 } 315 return NULL; 316 } 317 318 avrcp_connection_t * get_avrcp_connection_for_avrcp_cid(avrcp_role_t role, uint16_t avrcp_cid){ 319 btstack_linked_list_iterator_t it; 320 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 321 while (btstack_linked_list_iterator_has_next(&it)){ 322 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 323 if (connection->role != role) continue; 324 if (connection->avrcp_cid != avrcp_cid) continue; 325 return connection; 326 } 327 return NULL; 328 } 329 330 avrcp_connection_t * get_avrcp_connection_for_browsing_cid(avrcp_role_t role, uint16_t browsing_cid){ 331 btstack_linked_list_iterator_t it; 332 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 333 while (btstack_linked_list_iterator_has_next(&it)){ 334 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 335 if (connection->role != role) continue; 336 if (connection->avrcp_browsing_cid != browsing_cid) continue; 337 return connection; 338 } 339 return NULL; 340 } 341 342 avrcp_connection_t * get_avrcp_connection_for_browsing_l2cap_cid(avrcp_role_t role, uint16_t browsing_l2cap_cid){ 343 btstack_linked_list_iterator_t it; 344 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 345 while (btstack_linked_list_iterator_has_next(&it)){ 346 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 347 if (connection->role != role) continue; 348 if (connection->browsing_connection && connection->browsing_connection->l2cap_browsing_cid != browsing_l2cap_cid) continue; 349 return connection; 350 } 351 return NULL; 352 } 353 354 avrcp_browsing_connection_t * get_avrcp_browsing_connection_for_l2cap_cid(avrcp_role_t role, uint16_t l2cap_cid){ 355 btstack_linked_list_iterator_t it; 356 btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &connections); 357 while (btstack_linked_list_iterator_has_next(&it)){ 358 avrcp_connection_t * connection = (avrcp_connection_t *)btstack_linked_list_iterator_next(&it); 359 if (connection->role != role) continue; 360 if (connection->browsing_connection && connection->browsing_connection->l2cap_browsing_cid != l2cap_cid) continue; 361 return connection->browsing_connection; 362 } 363 return NULL; 364 } 365 366 void avrcp_request_can_send_now(avrcp_connection_t * connection, uint16_t l2cap_cid){ 367 connection->wait_to_send = 1; 368 l2cap_request_can_send_now_event(l2cap_cid); 369 } 370 371 372 uint16_t avrcp_get_next_cid(void){ 373 avrcp_cid_counter++; 374 if (avrcp_cid_counter == 0){ 375 avrcp_cid_counter = 1; 376 } 377 return avrcp_cid_counter; 378 } 379 380 static avrcp_connection_t * avrcp_create_connection(avrcp_role_t role, bd_addr_t remote_addr){ 381 avrcp_connection_t * connection = btstack_memory_avrcp_connection_get(); 382 if (!connection){ 383 log_error("avrcp: not enough memory to create connection"); 384 return NULL; 385 } 386 connection->role = role; 387 connection->state = AVCTP_CONNECTION_IDLE; 388 connection->transaction_label = 0xFF; 389 connection->max_num_fragments = 0xFF; 390 connection->avrcp_cid = avrcp_get_next_cid(); 391 memcpy(connection->remote_addr, remote_addr, 6); 392 btstack_linked_list_add(&connections, (btstack_linked_item_t *) connection); 393 return connection; 394 } 395 396 static void avrcp_finalize_connection(avrcp_connection_t * connection){ 397 btstack_linked_list_remove(&connections, (btstack_linked_item_t*) connection); 398 btstack_memory_avrcp_connection_free(connection); 399 } 400 401 void avrcp_emit_connection_established(btstack_packet_handler_t callback, uint16_t avrcp_cid, bd_addr_t addr, uint8_t status){ 402 if (!callback) return; 403 uint8_t event[12]; 404 int pos = 0; 405 event[pos++] = HCI_EVENT_AVRCP_META; 406 event[pos++] = sizeof(event) - 2; 407 event[pos++] = AVRCP_SUBEVENT_CONNECTION_ESTABLISHED; 408 event[pos++] = status; 409 reverse_bd_addr(addr,&event[pos]); 410 pos += 6; 411 little_endian_store_16(event, pos, avrcp_cid); 412 pos += 2; 413 (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 414 } 415 416 void avrcp_emit_connection_closed(btstack_packet_handler_t callback, uint16_t avrcp_cid){ 417 if (!callback) return; 418 uint8_t event[5]; 419 int pos = 0; 420 event[pos++] = HCI_EVENT_AVRCP_META; 421 event[pos++] = sizeof(event) - 2; 422 event[pos++] = AVRCP_SUBEVENT_CONNECTION_RELEASED; 423 little_endian_store_16(event, pos, avrcp_cid); 424 pos += 2; 425 (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 426 } 427 428 void avrcp_handle_sdp_client_query_result(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 429 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(sdp_query_context->role, sdp_query_context->avrcp_cid); 430 if (!connection) return; 431 if (connection->state != AVCTP_CONNECTION_W4_SDP_QUERY_COMPLETE) return; 432 433 UNUSED(packet_type); 434 UNUSED(channel); 435 UNUSED(size); 436 uint8_t status; 437 des_iterator_t des_list_it; 438 des_iterator_t prot_it; 439 // uint32_t avdtp_remote_uuid = 0; 440 441 switch (hci_event_packet_get_type(packet)){ 442 case SDP_EVENT_QUERY_ATTRIBUTE_VALUE: 443 // Handle new SDP record 444 if (sdp_event_query_attribute_byte_get_record_id(packet) != sdp_query_context->record_id) { 445 sdp_query_context->record_id = sdp_event_query_attribute_byte_get_record_id(packet); 446 sdp_query_context->parse_sdp_record = 0; 447 // log_info("SDP Record: Nr: %d", record_id); 448 } 449 450 if (sdp_event_query_attribute_byte_get_attribute_length(packet) <= attribute_value_buffer_size) { 451 attribute_value[sdp_event_query_attribute_byte_get_data_offset(packet)] = sdp_event_query_attribute_byte_get_data(packet); 452 453 if ((uint16_t)(sdp_event_query_attribute_byte_get_data_offset(packet)+1) == sdp_event_query_attribute_byte_get_attribute_length(packet)) { 454 switch(sdp_event_query_attribute_byte_get_attribute_id(packet)) { 455 case BLUETOOTH_ATTRIBUTE_SERVICE_CLASS_ID_LIST: 456 if (de_get_element_type(attribute_value) != DE_DES) break; 457 for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) { 458 uint8_t * element = des_iterator_get_element(&des_list_it); 459 if (de_get_element_type(element) != DE_UUID) continue; 460 uint32_t uuid = de_get_uuid32(element); 461 switch (uuid){ 462 case BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL_TARGET: 463 if (sdp_query_context->role == AVRCP_CONTROLLER) { 464 sdp_query_context->parse_sdp_record = 1; 465 break; 466 } 467 break; 468 case BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL: 469 case BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL_CONTROLLER: 470 if (sdp_query_context->role == AVRCP_TARGET) { 471 sdp_query_context->parse_sdp_record = 1; 472 break; 473 } 474 break; 475 default: 476 break; 477 } 478 } 479 break; 480 481 case BLUETOOTH_ATTRIBUTE_PROTOCOL_DESCRIPTOR_LIST: { 482 if (!sdp_query_context->parse_sdp_record) break; 483 // log_info("SDP Attribute: 0x%04x", sdp_event_query_attribute_byte_get_attribute_id(packet)); 484 for (des_iterator_init(&des_list_it, attribute_value); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) { 485 uint8_t *des_element; 486 uint8_t *element; 487 uint32_t uuid; 488 489 if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 490 491 des_element = des_iterator_get_element(&des_list_it); 492 des_iterator_init(&prot_it, des_element); 493 element = des_iterator_get_element(&prot_it); 494 495 if (de_get_element_type(element) != DE_UUID) continue; 496 497 uuid = de_get_uuid32(element); 498 des_iterator_next(&prot_it); 499 switch (uuid){ 500 case BLUETOOTH_PROTOCOL_L2CAP: 501 if (!des_iterator_has_more(&prot_it)) continue; 502 de_element_get_uint16(des_iterator_get_element(&prot_it), &sdp_query_context->avrcp_l2cap_psm); 503 break; 504 case BLUETOOTH_PROTOCOL_AVCTP: 505 if (!des_iterator_has_more(&prot_it)) continue; 506 de_element_get_uint16(des_iterator_get_element(&prot_it), &sdp_query_context->avrcp_version); 507 break; 508 default: 509 break; 510 } 511 } 512 } 513 break; 514 case BLUETOOTH_ATTRIBUTE_ADDITIONAL_PROTOCOL_DESCRIPTOR_LISTS: { 515 // log_info("SDP Attribute: 0x%04x", sdp_event_query_attribute_byte_get_attribute_id(packet)); 516 if (!sdp_query_context->parse_sdp_record) break; 517 if (de_get_element_type(attribute_value) != DE_DES) break; 518 519 des_iterator_t des_list_0_it; 520 uint8_t *element_0; 521 522 des_iterator_init(&des_list_0_it, attribute_value); 523 element_0 = des_iterator_get_element(&des_list_0_it); 524 525 for (des_iterator_init(&des_list_it, element_0); des_iterator_has_more(&des_list_it); des_iterator_next(&des_list_it)) { 526 uint8_t *des_element; 527 uint8_t *element; 528 uint32_t uuid; 529 530 if (des_iterator_get_type(&des_list_it) != DE_DES) continue; 531 532 des_element = des_iterator_get_element(&des_list_it); 533 des_iterator_init(&prot_it, des_element); 534 element = des_iterator_get_element(&prot_it); 535 536 if (de_get_element_type(element) != DE_UUID) continue; 537 538 uuid = de_get_uuid32(element); 539 des_iterator_next(&prot_it); 540 switch (uuid){ 541 case BLUETOOTH_PROTOCOL_L2CAP: 542 if (!des_iterator_has_more(&prot_it)) continue; 543 de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->browsing_l2cap_psm); 544 break; 545 case BLUETOOTH_PROTOCOL_AVCTP: 546 if (!des_iterator_has_more(&prot_it)) continue; 547 de_element_get_uint16(des_iterator_get_element(&prot_it), &connection->browsing_version); 548 break; 549 default: 550 break; 551 } 552 } 553 } 554 break; 555 default: 556 break; 557 } 558 } 559 } else { 560 log_error("SDP attribute value buffer size exceeded: available %d, required %d", attribute_value_buffer_size, sdp_event_query_attribute_byte_get_attribute_length(packet)); 561 } 562 break; 563 564 case SDP_EVENT_QUERY_COMPLETE:{ 565 status = sdp_event_query_complete_get_status(packet); 566 567 if (status != ERROR_CODE_SUCCESS){ 568 log_info("AVRCP: SDP query failed with status 0x%02x.", status); 569 avrcp_emit_connection_established(sdp_query_context->avrcp_callback, connection->avrcp_cid, connection->remote_addr, status); 570 avrcp_finalize_connection(connection); 571 break; 572 } 573 574 if (!sdp_query_context->avrcp_l2cap_psm){ 575 connection->state = AVCTP_CONNECTION_IDLE; 576 log_info("AVRCP: no suitable service found"); 577 avrcp_emit_connection_established(sdp_query_context->avrcp_callback, connection->avrcp_cid, connection->remote_addr, SDP_SERVICE_NOT_FOUND); 578 avrcp_finalize_connection(connection); 579 break; 580 } 581 connection->state = AVCTP_CONNECTION_W4_L2CAP_CONNECTED; 582 l2cap_create_channel(sdp_query_context->packet_handler, connection->remote_addr, sdp_query_context->avrcp_l2cap_psm, l2cap_max_mtu(), NULL); 583 break; 584 } 585 } 586 } 587 588 void avrcp_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size, avrcp_context_t * context){ 589 UNUSED(channel); 590 UNUSED(size); 591 bd_addr_t event_addr; 592 uint16_t local_cid; 593 uint8_t status; 594 avrcp_connection_t * connection = NULL; 595 uint16_t psm; 596 597 switch (packet_type) { 598 599 #if 0 600 case L2CAP_DATA_PACKET: 601 // figure out role! 602 connection = get_avrcp_connection_for_l2cap_signaling_cid(AVRCP_CONTROLLER, channel); 603 // or? 604 connection = get_avrcp_connection_for_l2cap_signaling_cid(AVRCP_TARGET, channel); 605 if (!connection) break; 606 // call correct controller/target packet hander 607 break; 608 #endif 609 610 case HCI_EVENT_PACKET: 611 switch (hci_event_packet_get_type(packet)) { 612 case HCI_EVENT_DISCONNECTION_COMPLETE: 613 avrcp_emit_connection_closed(context->avrcp_callback, 0); 614 break; 615 case L2CAP_EVENT_INCOMING_CONNECTION: 616 l2cap_event_incoming_connection_get_address(packet, event_addr); 617 local_cid = l2cap_event_incoming_connection_get_local_cid(packet); 618 619 // create two connection objects (both) 620 connection = avrcp_create_connection(context->role, event_addr); 621 if (!connection) { 622 log_error("Failed to alloc connection structure"); 623 l2cap_decline_connection(local_cid); 624 break; 625 } 626 627 psm = l2cap_event_incoming_connection_get_psm(packet); 628 if (psm == PSM_AVCTP){ 629 if (!connection->l2cap_signaling_cid){ 630 connection->state = AVCTP_CONNECTION_W4_L2CAP_CONNECTED; 631 connection->l2cap_signaling_cid = local_cid; 632 log_info("L2CAP_EVENT_INCOMING_CONNECTION avrcp_cid 0x%02x, l2cap_signaling_cid 0x%02x", connection->avrcp_cid, connection->l2cap_signaling_cid); 633 l2cap_accept_connection(local_cid); 634 break; 635 } 636 } 637 log_info("L2CAP_EVENT_INCOMING_CONNECTION local_cid 0x%02x, psm 0x%2x, decline connection", local_cid, psm); 638 l2cap_decline_connection(local_cid); 639 break; 640 641 case L2CAP_EVENT_CHANNEL_OPENED: 642 l2cap_event_channel_opened_get_address(packet, event_addr); 643 status = l2cap_event_channel_opened_get_status(packet); 644 local_cid = l2cap_event_channel_opened_get_local_cid(packet); 645 646 connection = get_avrcp_connection_for_bd_addr(context->role, event_addr); 647 if (!connection){ 648 // TODO: validate if this cannot happen. If not, drop disconnect call 649 log_error("AVRCP connection lookup failed"); 650 l2cap_disconnect(local_cid, 0); // reason isn't used 651 break; 652 } 653 if (status != ERROR_CODE_SUCCESS){ 654 log_info("L2CAP connection to connection %s failed. status code 0x%02x", bd_addr_to_str(event_addr), status); 655 // emit twice for each role 656 avrcp_emit_connection_established(context->avrcp_callback, connection->avrcp_cid, event_addr, status); 657 avrcp_finalize_connection(connection); 658 break; 659 } 660 661 psm = l2cap_event_channel_opened_get_psm(packet); 662 if (psm == PSM_AVCTP){ 663 connection->l2cap_signaling_cid = local_cid; 664 connection->l2cap_mtu = l2cap_event_channel_opened_get_remote_mtu(packet); 665 connection->song_length_ms = 0xFFFFFFFF; 666 connection->song_position_ms = 0xFFFFFFFF; 667 connection->playback_status = AVRCP_PLAYBACK_STATUS_ERROR; 668 669 log_info("L2CAP_EVENT_CHANNEL_OPENED avrcp_cid 0x%02x, l2cap_signaling_cid 0x%02x", connection->avrcp_cid, connection->l2cap_signaling_cid); 670 connection->state = AVCTP_CONNECTION_OPENED; 671 // emit twice for each role 672 avrcp_emit_connection_established(context->avrcp_callback, connection->avrcp_cid, event_addr, ERROR_CODE_SUCCESS); 673 } 674 break; 675 676 case L2CAP_EVENT_CHANNEL_CLOSED: 677 // data: event (8), len(8), channel (16) 678 local_cid = l2cap_event_channel_closed_get_local_cid(packet); 679 connection = get_avrcp_connection_for_l2cap_signaling_cid(context->role, local_cid); 680 // emit twice for each role 681 if (connection){ 682 avrcp_emit_connection_closed(context->avrcp_callback, connection->avrcp_cid); 683 avrcp_finalize_connection(connection); 684 break; 685 } 686 break; 687 default: 688 break; 689 } 690 break; 691 default: 692 break; 693 } 694 } 695 696 uint8_t avrcp_connect(avrcp_role_t role, bd_addr_t bd_addr, avrcp_context_t * context, uint16_t * avrcp_cid){ 697 avrcp_connection_t * connection = get_avrcp_connection_for_bd_addr(context->role, bd_addr); 698 if (connection) return ERROR_CODE_COMMAND_DISALLOWED; 699 700 if (!sdp_client_ready()) return ERROR_CODE_COMMAND_DISALLOWED; 701 702 connection = avrcp_create_connection(role, bd_addr); 703 if (!connection){ 704 log_error("avrcp: could not allocate connection struct."); 705 return BTSTACK_MEMORY_ALLOC_FAILED; 706 } 707 708 if (avrcp_cid){ 709 *avrcp_cid = connection->avrcp_cid; 710 } 711 712 context->avrcp_l2cap_psm = 0; 713 context->avrcp_version = 0; 714 context->avrcp_cid = connection->avrcp_cid; 715 connection->browsing_l2cap_psm = 0; 716 connection->state = AVCTP_CONNECTION_W4_SDP_QUERY_COMPLETE; 717 718 sdp_query_context = context; 719 sdp_client_query_uuid16(&avrcp_handle_sdp_client_query_result, connection->remote_addr, BLUETOOTH_PROTOCOL_AVCTP); 720 return ERROR_CODE_SUCCESS; 721 } 722 723 void avrcp_init(void){ 724 connections = NULL; 725 726 #if 0 727 if (l2cap_service_registered) return; 728 int status = l2cap_register_service(&avrcp_packet_handler, BLUETOOTH_PROTOCOL_AVCTP, 0xffff, LEVEL_2); 729 if (status != ERROR_CODE_SUCCESS) return; 730 l2cap_service_registered = 1; 731 #endif 732 } 733 734 void avrcp_register_controller_packet_handler(btstack_packet_handler_t callback){ 735 avrcp_controller_packet_handler = callback; 736 } 737 738 739 void avrcp_register_target_packet_handler(btstack_packet_handler_t callback){ 740 avrcp_target_packet_handler = callback; 741 } 742 743