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_target.c" 39 40 #include <stdint.h> 41 #include <stdio.h> 42 #include <stdlib.h> 43 #include <string.h> 44 #include <inttypes.h> 45 46 #include "btstack.h" 47 #include "classic/avrcp.h" 48 49 #define AVRCP_ATTR_HEADER_LEN 8 50 51 static const uint8_t AVRCP_NOTIFICATION_TRACK_SELECTED[] = {0,0,0,0,0,0,0,0}; 52 static const uint8_t AVRCP_NOTIFICATION_TRACK_NOT_SELECTED[] = {0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF}; 53 54 avrcp_context_t avrcp_target_context; 55 56 void avrcp_target_create_sdp_record(uint8_t * service, uint32_t service_record_handle, uint8_t browsing, uint16_t supported_features, const char * service_name, const char * service_provider_name){ 57 avrcp_create_sdp_record(0, service, service_record_handle, browsing, supported_features, service_name, service_provider_name); 58 } 59 60 static void avrcp_target_emit_operation(btstack_packet_handler_t callback, uint16_t avrcp_cid, avrcp_operation_id_t operation_id, uint8_t operands_length, uint8_t operand){ 61 if (!callback) return; 62 uint8_t event[8]; 63 int pos = 0; 64 event[pos++] = HCI_EVENT_AVRCP_META; 65 event[pos++] = sizeof(event) - 2; 66 event[pos++] = AVRCP_SUBEVENT_OPERATION; 67 little_endian_store_16(event, pos, avrcp_cid); 68 pos += 2; 69 event[pos++] = operation_id; 70 event[pos++] = operands_length; 71 event[pos++] = operand; 72 (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 73 } 74 75 static void avrcp_target_emit_respond_vendor_dependent_query(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t subevent_id){ 76 if (!callback) return; 77 uint8_t event[5]; 78 int pos = 0; 79 event[pos++] = HCI_EVENT_AVRCP_META; 80 event[pos++] = sizeof(event) - 2; 81 event[pos++] = subevent_id; 82 little_endian_store_16(event, pos, avrcp_cid); 83 (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 84 } 85 86 static uint16_t avrcp_target_pack_single_element_attribute_number(uint8_t * packet, uint16_t pos, avrcp_media_attribute_id_t attr_id, uint32_t value){ 87 if ((attr_id < 1) || (attr_id > AVRCP_MEDIA_ATTR_COUNT)) return 0; 88 uint16_t attr_value_length = sprintf((char *)(packet+pos+8), "%0" PRIu32, value); 89 big_endian_store_32(packet, pos, attr_id); 90 pos += 4; 91 big_endian_store_16(packet, pos, RFC2978_CHARSET_MIB_UTF8); 92 pos += 2; 93 big_endian_store_16(packet, pos, attr_value_length); 94 pos += 2; 95 return 8 + attr_value_length; 96 } 97 98 static uint16_t avrcp_target_pack_single_element_attribute_string(uint8_t * packet, uint16_t pos, rfc2978_charset_mib_enumid_t mib_enumid, avrcp_media_attribute_id_t attr_id, uint8_t * attr_value, uint16_t attr_value_to_copy, uint16_t attr_value_size, uint8_t header){ 99 if (attr_value_size == 0) return 0; 100 if ((attr_id < 1) || (attr_id > AVRCP_MEDIA_ATTR_COUNT)) return 0; 101 if (header){ 102 big_endian_store_32(packet, pos, attr_id); 103 pos += 4; 104 big_endian_store_16(packet, pos, mib_enumid); 105 pos += 2; 106 big_endian_store_16(packet, pos, attr_value_size); 107 pos += 2; 108 } 109 memcpy(packet+pos, attr_value, attr_value_to_copy); 110 pos += attr_value_size; 111 return header * 8 + attr_value_size; 112 } 113 114 static int avrcp_target_abort_continue_response(uint16_t cid, avrcp_connection_t * connection){ 115 uint16_t pos = 0; 116 l2cap_reserve_packet_buffer(); 117 uint8_t * packet = l2cap_get_outgoing_buffer(); 118 119 connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 120 connection->command_type = AVRCP_CTYPE_RESPONSE_ACCEPTED; 121 connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 122 connection->subunit_id = AVRCP_SUBUNIT_ID; 123 124 packet[pos++] = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0; 125 // Profile IDentifier (PID) 126 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 127 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 128 129 // command_type 130 packet[pos++] = connection->command_type; 131 // subunit_type | subunit ID 132 packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 133 // opcode 134 packet[pos++] = (uint8_t)connection->command_opcode; 135 136 // company id is 3 bytes long 137 big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID); 138 pos += 3; 139 140 packet[pos++] = AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE; 141 142 // reserve byte for packet type 143 packet[pos++] = AVRCP_SINGLE_PACKET; 144 big_endian_store_16(packet, pos, 0); 145 pos += 2; 146 return l2cap_send_prepared(cid, pos); 147 } 148 149 static int avrcp_target_send_now_playing_info(uint16_t cid, avrcp_connection_t * connection){ 150 uint16_t pos = 0; 151 l2cap_reserve_packet_buffer(); 152 uint8_t * packet = l2cap_get_outgoing_buffer(); 153 uint16_t size = l2cap_get_remote_mtu_for_local_cid(connection->l2cap_signaling_cid); 154 155 packet[pos++] = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0; 156 // Profile IDentifier (PID) 157 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 158 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 159 160 // command_type 161 packet[pos++] = connection->command_type; 162 // subunit_type | subunit ID 163 packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 164 // opcode 165 packet[pos++] = (uint8_t)connection->command_opcode; 166 167 // company id is 3 bytes long 168 big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID); 169 pos += 3; 170 171 packet[pos++] = AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES; 172 173 // reserve byte for packet type 174 uint8_t pos_packet_type = pos; 175 pos++; 176 177 uint16_t playing_info_buffer_len_position = pos; 178 pos += 2; 179 // printf("connection->next_attr_id %d \n", connection->next_attr_id); 180 if (connection->next_attr_id == AVRCP_MEDIA_ATTR_NONE){ 181 packet[pos_packet_type] = AVRCP_SINGLE_PACKET; 182 connection->packet_type = AVRCP_SINGLE_PACKET; 183 packet[pos++] = count_set_bits_uint32(connection->now_playing_info_attr_bitmap); 184 connection->next_attr_id++; 185 } 186 // printf("updated connection->next_attr_id %d, connection->attribute_value_offset %d \n", connection->next_attr_id, connection->attribute_value_offset); 187 188 uint8_t fragmented = 0; 189 int num_free_bytes = size - pos - 2; 190 uint8_t MAX_NUMBER_ATTR_LEN = 10; 191 192 while (!fragmented && num_free_bytes > 0 && connection->next_attr_id <= AVRCP_MEDIA_ATTR_SONG_LENGTH_MS){ 193 avrcp_media_attribute_id_t attr_id = connection->next_attr_id; 194 int attr_index = attr_id - 1; 195 196 if (connection->now_playing_info_attr_bitmap & (1 << attr_id)){ 197 int num_written_bytes = 0; 198 int num_bytes_to_write = 0; 199 switch (attr_id){ 200 case AVRCP_MEDIA_ATTR_ALL: 201 case AVRCP_MEDIA_ATTR_NONE: 202 break; 203 case AVRCP_MEDIA_ATTR_TRACK: 204 num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN; 205 if (num_free_bytes >= num_bytes_to_write){ 206 num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->track_nr); 207 break; 208 } 209 fragmented = 1; 210 connection->attribute_value_offset = 0; 211 break; 212 case AVRCP_MEDIA_ATTR_TOTAL_NUM_ITEMS: 213 num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN; 214 if (num_free_bytes >= num_bytes_to_write){ 215 num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->total_tracks); 216 break; 217 } 218 fragmented = 1; 219 connection->attribute_value_offset = 0; 220 break; 221 case AVRCP_MEDIA_ATTR_SONG_LENGTH_MS: 222 num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN; 223 if (num_free_bytes >= num_bytes_to_write){ 224 num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->song_length_ms); 225 break; 226 } 227 fragmented = 1; 228 connection->attribute_value_offset = 0; 229 break; 230 default:{ 231 uint8_t header = (connection->attribute_value_offset == 0); 232 uint8_t * attr_value = (uint8_t *) (connection->now_playing_info[attr_index].value + connection->attribute_value_offset); 233 uint16_t attr_value_len = connection->now_playing_info[attr_index].len - connection->attribute_value_offset; 234 235 num_bytes_to_write = attr_value_len + header * AVRCP_ATTR_HEADER_LEN; 236 if (num_bytes_to_write <= num_free_bytes){ 237 connection->attribute_value_offset = 0; 238 num_written_bytes = num_bytes_to_write; 239 avrcp_target_pack_single_element_attribute_string(packet, pos, RFC2978_CHARSET_MIB_UTF8, attr_id, attr_value, attr_value_len, connection->now_playing_info[attr_index].len, header); 240 break; 241 } 242 fragmented = 1; 243 num_written_bytes = num_free_bytes; 244 attr_value_len = num_free_bytes - header * AVRCP_ATTR_HEADER_LEN; 245 avrcp_target_pack_single_element_attribute_string(packet, pos, RFC2978_CHARSET_MIB_UTF8, attr_id, attr_value, attr_value_len, connection->now_playing_info[attr_index].len, header); 246 connection->attribute_value_offset += attr_value_len; 247 break; 248 } 249 } 250 pos += num_written_bytes; 251 num_free_bytes -= num_written_bytes; 252 } 253 if (!fragmented){ 254 connection->next_attr_id++; 255 } 256 } 257 258 if (fragmented){ 259 switch (connection->packet_type){ 260 case AVRCP_SINGLE_PACKET: 261 connection->packet_type = AVRCP_START_PACKET; 262 break; 263 default: 264 connection->packet_type = AVRCP_CONTINUE_PACKET; 265 break; 266 } 267 } else { 268 if (connection->next_attr_id >= AVRCP_MEDIA_ATTR_SONG_LENGTH_MS){ // DONE 269 if (connection->packet_type != AVRCP_SINGLE_PACKET){ 270 connection->packet_type = AVRCP_END_PACKET; 271 } 272 } 273 } 274 packet[pos_packet_type] = connection->packet_type; 275 // store attr value length 276 big_endian_store_16(packet, playing_info_buffer_len_position, pos - playing_info_buffer_len_position - 2); 277 return l2cap_send_prepared(cid, size); 278 } 279 280 281 282 static int avrcp_target_send_response(uint16_t cid, avrcp_connection_t * connection){ 283 int pos = 0; 284 l2cap_reserve_packet_buffer(); 285 uint8_t * packet = l2cap_get_outgoing_buffer(); 286 287 // transport header 288 // Transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier) 289 290 // TODO: check for fragmentation 291 connection->packet_type = AVRCP_SINGLE_PACKET; 292 293 packet[pos++] = (connection->transaction_label << 4) | (connection->packet_type << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0; 294 // Profile IDentifier (PID) 295 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 296 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 297 // command_type 298 packet[pos++] = connection->command_type; 299 // subunit_type | subunit ID 300 packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 301 // opcode 302 packet[pos++] = (uint8_t)connection->command_opcode; 303 // operands 304 memcpy(packet+pos, connection->cmd_operands, connection->cmd_operands_length); 305 // printf_hexdump(packet+pos, connection->cmd_operands_length); 306 307 pos += connection->cmd_operands_length; 308 connection->wait_to_send = 0; 309 return l2cap_send_prepared(cid, pos); 310 } 311 312 static uint8_t avrcp_target_response_accept(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, avrcp_status_code_t status){ 313 // AVRCP_CTYPE_RESPONSE_REJECTED 314 connection->command_type = AVRCP_CTYPE_RESPONSE_ACCEPTED; 315 connection->subunit_type = subunit_type; 316 connection->subunit_id = subunit_id; 317 connection->command_opcode = opcode; 318 // company id is 3 bytes long 319 int pos = connection->cmd_operands_length; 320 connection->cmd_operands[pos++] = pdu_id; 321 connection->cmd_operands[pos++] = 0; 322 // param length 323 big_endian_store_16(connection->cmd_operands, pos, 1); 324 pos += 2; 325 connection->cmd_operands[pos++] = status; 326 connection->cmd_operands_length = pos; 327 connection->state = AVCTP_W2_SEND_RESPONSE; 328 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 329 return ERROR_CODE_SUCCESS; 330 } 331 332 static uint8_t avrcp_target_response_reject(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, avrcp_status_code_t status){ 333 // AVRCP_CTYPE_RESPONSE_REJECTED 334 connection->command_type = AVRCP_CTYPE_RESPONSE_REJECTED; 335 connection->subunit_type = subunit_type; 336 connection->subunit_id = subunit_id; 337 connection->command_opcode = opcode; 338 // company id is 3 bytes long 339 int pos = connection->cmd_operands_length; 340 connection->cmd_operands[pos++] = pdu_id; 341 connection->cmd_operands[pos++] = 0; 342 // param length 343 big_endian_store_16(connection->cmd_operands, pos, 1); 344 pos += 2; 345 connection->cmd_operands[pos++] = status; 346 connection->cmd_operands_length = pos; 347 connection->state = AVCTP_W2_SEND_RESPONSE; 348 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 349 return ERROR_CODE_SUCCESS; 350 } 351 352 static uint8_t avrcp_target_response_not_implemented(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, uint8_t event_id){ 353 connection->command_type = AVRCP_CTYPE_RESPONSE_NOT_IMPLEMENTED; 354 connection->subunit_type = subunit_type; 355 connection->subunit_id = subunit_id; 356 connection->command_opcode = opcode; 357 358 // company id is 3 bytes long 359 int pos = connection->cmd_operands_length; 360 connection->cmd_operands[pos++] = pdu_id; 361 connection->cmd_operands[pos++] = 0; 362 // param length 363 big_endian_store_16(connection->cmd_operands, pos, 1); 364 pos += 2; 365 connection->cmd_operands[pos++] = event_id; 366 connection->cmd_operands_length = pos; 367 368 connection->state = AVCTP_W2_SEND_RESPONSE; 369 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 370 return ERROR_CODE_SUCCESS; 371 } 372 373 static uint8_t avrcp_target_response_vendor_dependent_interim(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, 374 avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, uint8_t event_id, const uint8_t * value, uint16_t value_len){ 375 connection->command_type = AVRCP_CTYPE_RESPONSE_INTERIM; 376 connection->subunit_type = subunit_type; 377 connection->subunit_id = subunit_id; 378 connection->command_opcode = opcode; 379 380 // company id is 3 bytes long 381 int pos = connection->cmd_operands_length; 382 connection->cmd_operands[pos++] = pdu_id; 383 connection->cmd_operands[pos++] = 0; 384 // param length 385 big_endian_store_16(connection->cmd_operands, pos, 1 + value_len); 386 pos += 2; 387 connection->cmd_operands[pos++] = event_id; 388 if (value && value_len > 0){ 389 memcpy(connection->cmd_operands + pos, value, value_len); 390 pos += value_len; 391 } 392 connection->cmd_operands_length = pos; 393 394 connection->state = AVCTP_W2_SEND_RESPONSE; 395 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 396 return ERROR_CODE_SUCCESS; 397 } 398 399 static uint8_t avrcp_target_response_addressed_player_changed_interim(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id){ 400 connection->command_type = AVRCP_CTYPE_RESPONSE_INTERIM; 401 connection->subunit_type = subunit_type; 402 connection->subunit_id = subunit_id; 403 connection->command_opcode = opcode; 404 405 // company id is 3 bytes long 406 int pos = connection->cmd_operands_length; 407 connection->cmd_operands[pos++] = pdu_id; 408 connection->cmd_operands[pos++] = 0; 409 // param length 410 big_endian_store_16(connection->cmd_operands, pos, 5); 411 pos += 2; 412 connection->cmd_operands[pos++] = AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED; 413 big_endian_read_16( &connection->cmd_operands[pos], connection->addressed_player_id); 414 pos += 2; 415 big_endian_read_16( &connection->cmd_operands[pos], connection->uid_counter); 416 pos += 2; 417 418 connection->cmd_operands_length = pos; 419 connection->state = AVCTP_W2_SEND_RESPONSE; 420 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 421 return ERROR_CODE_SUCCESS; 422 } 423 424 425 // static uint8_t avrcp_target_response_vendor_dependent_changed(avrcp_connection_t * connection, avrcp_pdu_id_t pdu_id, uint8_t event_id){ 426 // connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 427 // connection->command_type = AVRCP_CTYPE_RESPONSE_CHANGED_STABLE; 428 // connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 429 // connection->subunit_id = AVRCP_SUBUNIT_ID; 430 431 // // company id is 3 bytes long 432 // int pos = connection->cmd_operands_length; 433 // connection->cmd_operands[pos++] = pdu_id; 434 // connection->cmd_operands[pos++] = 0; 435 // // param length 436 // big_endian_store_16(connection->cmd_operands, pos, 1); 437 // pos += 2; 438 // connection->cmd_operands[pos++] = event_id; 439 // connection->cmd_operands_length = pos; 440 441 // connection->state = AVCTP_W2_SEND_RESPONSE; 442 // avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 443 // return ERROR_CODE_SUCCESS; 444 // } 445 446 static uint8_t avrcp_target_pass_through_response(uint16_t avrcp_cid, avrcp_command_type_t cmd_type, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){ 447 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 448 if (!connection){ 449 log_error("Could not find a connection."); 450 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 451 } 452 connection->command_type = cmd_type; 453 connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 454 connection->subunit_id = AVRCP_SUBUNIT_ID; 455 connection->command_opcode = AVRCP_CMD_OPCODE_PASS_THROUGH; 456 457 int pos = 0; 458 connection->cmd_operands[pos++] = opid; 459 connection->cmd_operands[pos++] = operands_length; 460 if (operands_length == 1){ 461 connection->cmd_operands[pos++] = operand; 462 } 463 connection->cmd_operands_length = pos; 464 465 connection->state = AVCTP_W2_SEND_RESPONSE; 466 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 467 return ERROR_CODE_SUCCESS; 468 } 469 470 uint8_t avrcp_target_operation_rejected(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){ 471 return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_REJECTED, opid, operands_length, operand); 472 } 473 474 uint8_t avrcp_target_operation_accepted(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){ 475 return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_ACCEPTED, opid, operands_length, operand); 476 } 477 478 uint8_t avrcp_target_operation_not_implemented(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){ 479 return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_ACCEPTED, opid, operands_length, operand); 480 } 481 482 void avrcp_target_set_unit_info(uint16_t avrcp_cid, avrcp_subunit_type_t unit_type, uint32_t company_id){ 483 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 484 if (!connection){ 485 log_error("avrcp_target_operation_reject: could not find a connection."); 486 return; 487 } 488 connection->unit_type = unit_type; 489 connection->company_id = company_id; 490 } 491 492 void avrcp_target_set_subunit_info(uint16_t avrcp_cid, avrcp_subunit_type_t subunit_type, const uint8_t * subunit_info_data, uint16_t subunit_info_data_size){ 493 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 494 if (!connection){ 495 log_error("avrcp_target_operation_reject: could not find a connection."); 496 return; 497 } 498 connection->subunit_info_type = subunit_type; 499 connection->subunit_info_data = subunit_info_data; 500 connection->subunit_info_data_size = subunit_info_data_size; 501 } 502 503 static uint8_t avrcp_target_unit_info(avrcp_connection_t * connection){ 504 if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 505 506 uint8_t unit = 0; 507 connection->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE; 508 connection->subunit_type = AVRCP_SUBUNIT_TYPE_UNIT; //vendor unique 509 connection->subunit_id = AVRCP_SUBUNIT_ID_IGNORE; 510 connection->command_opcode = AVRCP_CMD_OPCODE_UNIT_INFO; 511 512 connection->cmd_operands_length = 5; 513 connection->cmd_operands[0] = 0x07; 514 connection->cmd_operands[1] = (connection->unit_type << 4) | unit; 515 // company id is 3 bytes long 516 big_endian_store_32(connection->cmd_operands, 2, connection->company_id); 517 518 connection->state = AVCTP_W2_SEND_RESPONSE; 519 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 520 return ERROR_CODE_SUCCESS; 521 } 522 523 524 static uint8_t avrcp_target_subunit_info(avrcp_connection_t * connection, uint8_t offset){ 525 if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 526 if (offset - 4 > connection->subunit_info_data_size) return AVRCP_STATUS_INVALID_PARAMETER; 527 528 connection->command_opcode = AVRCP_CMD_OPCODE_SUBUNIT_INFO; 529 connection->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE; 530 connection->subunit_type = AVRCP_SUBUNIT_TYPE_UNIT; //vendor unique 531 connection->subunit_id = AVRCP_SUBUNIT_ID_IGNORE; 532 // printf("avrcp_target_subunit_info subunit_type %d\n", connection->subunit_type); 533 534 uint8_t page = offset / 4; 535 uint8_t extension_code = 7; 536 connection->cmd_operands_length = 5; 537 connection->cmd_operands[0] = (page << 4) | extension_code; 538 539 memcpy(connection->cmd_operands+1, connection->subunit_info_data + offset, 4); 540 541 connection->state = AVCTP_W2_SEND_RESPONSE; 542 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 543 return ERROR_CODE_SUCCESS; 544 } 545 546 static inline uint8_t avrcp_prepare_vendor_dependent_response(uint16_t avrcp_cid, avrcp_connection_t ** out_connection, avrcp_pdu_id_t pdu_id, uint16_t param_length){ 547 *out_connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 548 if (!*out_connection){ 549 log_error("avrcp tartget: could not find a connection."); 550 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 551 } 552 553 if ((*out_connection)->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 554 (*out_connection)->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 555 (*out_connection)->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE; 556 (*out_connection)->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 557 (*out_connection)->subunit_id = AVRCP_SUBUNIT_ID; 558 559 (*out_connection)->cmd_operands[(*out_connection)->cmd_operands_length++] = pdu_id; 560 // reserved 561 (*out_connection)->cmd_operands[(*out_connection)->cmd_operands_length++] = 0; 562 // param length 563 big_endian_store_16((*out_connection)->cmd_operands, (*out_connection)->cmd_operands_length, param_length); 564 (*out_connection)->cmd_operands_length += 2; 565 return ERROR_CODE_SUCCESS; 566 } 567 568 static uint8_t avrcp_target_capability(uint16_t avrcp_cid, avrcp_capability_id_t capability_id, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size){ 569 avrcp_connection_t * connection = NULL; 570 uint8_t status = avrcp_prepare_vendor_dependent_response(avrcp_cid, &connection, AVRCP_PDU_ID_GET_CAPABILITIES, 2+size); 571 if (status != ERROR_CODE_SUCCESS) return status; 572 573 connection->cmd_operands[connection->cmd_operands_length++] = capability_id; 574 connection->cmd_operands[connection->cmd_operands_length++] = capabilities_num; 575 memcpy(connection->cmd_operands+connection->cmd_operands_length, capabilities, size); 576 connection->cmd_operands_length += size; 577 578 connection->state = AVCTP_W2_SEND_RESPONSE; 579 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 580 return ERROR_CODE_SUCCESS; 581 } 582 583 uint8_t avrcp_target_supported_events(uint16_t avrcp_cid, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size){ 584 return avrcp_target_capability(avrcp_cid, AVRCP_CAPABILITY_ID_EVENT, capabilities_num, capabilities, size); 585 } 586 587 uint8_t avrcp_target_supported_companies(uint16_t avrcp_cid, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size ){ 588 return avrcp_target_capability(avrcp_cid, AVRCP_CAPABILITY_ID_COMPANY, capabilities_num, capabilities, size); 589 } 590 591 uint8_t avrcp_target_play_status(uint16_t avrcp_cid, uint32_t song_length_ms, uint32_t song_position_ms, avrcp_playback_status_t play_status){ 592 avrcp_connection_t * connection = NULL; 593 uint8_t status = avrcp_prepare_vendor_dependent_response(avrcp_cid, &connection, AVRCP_PDU_ID_GET_PLAY_STATUS, 11); 594 if (status != ERROR_CODE_SUCCESS) return status; 595 596 big_endian_store_32(connection->cmd_operands, connection->cmd_operands_length, song_length_ms); 597 connection->cmd_operands_length += 4; 598 big_endian_store_32(connection->cmd_operands, connection->cmd_operands_length, song_position_ms); 599 connection->cmd_operands_length += 4; 600 connection->cmd_operands[connection->cmd_operands_length++] = play_status; 601 602 connection->state = AVCTP_W2_SEND_RESPONSE; 603 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 604 return ERROR_CODE_SUCCESS; 605 } 606 607 static uint8_t avrcp_target_now_playing_info(avrcp_connection_t * connection){ 608 if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 609 connection->now_playing_info_response = 1; 610 connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 611 connection->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE; 612 connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 613 connection->subunit_id = AVRCP_SUBUNIT_ID; 614 615 connection->state = AVCTP_W2_SEND_RESPONSE; 616 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 617 return ERROR_CODE_SUCCESS; 618 } 619 620 static uint8_t avrcp_target_store_media_attr(avrcp_connection_t * connection, avrcp_media_attribute_id_t attr_id, const char * value){ 621 int index = attr_id - 1; 622 if (!value) return AVRCP_STATUS_INVALID_PARAMETER; 623 connection->now_playing_info[index].value = (uint8_t*)value; 624 connection->now_playing_info[index].len = strlen(value); 625 // printf("store %lu bytes, %s\n", strlen(value), value); 626 return ERROR_CODE_SUCCESS; 627 } 628 629 uint8_t avrcp_target_set_playback_status(uint16_t avrcp_cid, avrcp_playback_status_t playback_status){ 630 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 631 if (!connection){ 632 log_error("avrcp_unit_info: could not find a connection."); 633 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 634 } 635 if (connection->playback_status == playback_status) return ERROR_CODE_SUCCESS; 636 637 connection->playback_status = playback_status; 638 connection->playback_status_changed = 1; 639 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 640 return ERROR_CODE_SUCCESS; 641 } 642 643 void avrcp_target_set_now_playing_info(uint16_t avrcp_cid, const avrcp_track_t * current_track, uint16_t total_tracks){ 644 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 645 if (!connection){ 646 log_error("avrcp_unit_info: could not find a connection. cid 0x%02x\n", avrcp_cid); 647 return; 648 } 649 if (!current_track){ 650 connection->track_selected = 0; 651 connection->playback_status = AVRCP_PLAYBACK_STATUS_ERROR; 652 return; 653 } 654 memcpy(connection->track_id, current_track->track_id, 8); 655 connection->song_length_ms = current_track->song_length_ms; 656 connection->track_nr = current_track->track_nr; 657 connection->total_tracks = total_tracks; 658 avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_TITLE, current_track->title); 659 avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_ARTIST, current_track->artist); 660 avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_ALBUM, current_track->album); 661 avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_GENRE, current_track->genre); 662 connection->track_selected = 1; 663 664 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED)) { 665 connection->track_changed = 1; 666 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 667 } 668 return; 669 } 670 671 uint8_t avrcp_target_track_changed(uint16_t avrcp_cid, uint8_t * track_id){ 672 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 673 if (!connection){ 674 log_error("avrcp_target_track_changed: could not find connection."); 675 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 676 } 677 if (!track_id) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 678 679 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED)) { 680 connection->track_changed = 1; 681 memcpy(connection->track_id, track_id, 8); 682 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 683 } 684 return ERROR_CODE_SUCCESS; 685 } 686 687 uint8_t avrcp_target_playing_content_changed(uint16_t avrcp_cid){ 688 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 689 if (!connection){ 690 log_error("avrcp_target_playing_content_changed: could not find a connection."); 691 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 692 } 693 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED)) { 694 connection->playing_content_changed = 1; 695 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 696 } 697 return ERROR_CODE_SUCCESS; 698 } 699 700 uint8_t avrcp_target_addressed_player_changed(uint16_t avrcp_cid, uint16_t player_id, uint16_t uid_counter){ 701 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 702 if (!connection){ 703 log_error("avrcp_unit_info: could not find a connection."); 704 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 705 } 706 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED)) { 707 // printf("send AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED\n"); 708 // connection->addressed_player_changed = 1; 709 connection->uid_counter = uid_counter; 710 connection->addressed_player_id = player_id; 711 // avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 712 } 713 return ERROR_CODE_SUCCESS; 714 } 715 716 uint8_t avrcp_target_battery_status_changed(uint16_t avrcp_cid, avrcp_battery_status_t battery_status){ 717 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 718 if (!connection){ 719 log_error("avrcp_unit_info: could not find a connection."); 720 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 721 } 722 if (connection->battery_status == battery_status) return ERROR_CODE_SUCCESS; 723 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED)) { 724 connection->battery_status = battery_status; 725 connection->battery_status_changed = 1; 726 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 727 } 728 return ERROR_CODE_SUCCESS; 729 } 730 731 uint8_t avrcp_target_volume_changed(uint16_t avrcp_cid, uint8_t volume_percentage){ 732 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 733 if (!connection){ 734 log_error("avrcp_unit_info: could not find a connection."); 735 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 736 } 737 if (connection->volume_percentage == volume_percentage) return ERROR_CODE_SUCCESS; 738 if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED )) { 739 connection->volume_percentage = volume_percentage; 740 connection->volume_percentage_changed = 1; 741 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 742 } 743 return ERROR_CODE_SUCCESS; 744 } 745 746 747 static uint8_t * avrcp_get_company_id(uint8_t *packet, uint16_t size){ 748 UNUSED(size); 749 return packet + 6; 750 } 751 752 static uint8_t * avrcp_get_pdu(uint8_t *packet, uint16_t size){ 753 UNUSED(size); 754 return packet + 9; 755 } 756 757 static uint8_t avrcp_is_receive_pass_through_cmd(uint8_t operation_id){ 758 return operation_id & 0x80; 759 } 760 761 static void avrcp_handle_l2cap_data_packet_for_signaling_connection(avrcp_connection_t * connection, uint8_t *packet, uint16_t size){ 762 UNUSED(connection); 763 UNUSED(packet); 764 UNUSED(size); 765 766 // uint8_t opcode; 767 uint16_t pid = 0; 768 uint8_t transport_header = packet[0]; 769 connection->transaction_label = transport_header >> 4; 770 // uint8_t frame_type = (transport_header & 0x03) >> 1; 771 avrcp_packet_type_t packet_type = (transport_header & 0x0F) >> 2; 772 switch (packet_type){ 773 case AVRCP_SINGLE_PACKET: 774 pid = big_endian_read_16(packet, 1); 775 break; 776 case AVRCP_START_PACKET: 777 pid = big_endian_read_16(packet, 2); 778 break; 779 default: 780 break; 781 } 782 783 switch (packet_type){ 784 case AVRCP_SINGLE_PACKET: 785 case AVRCP_START_PACKET: 786 if (pid != BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL){ 787 log_info("Invalid pid 0x%02x, expected 0x%02x", connection->invalid_pid, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL); 788 connection->reject_transport_header = 1; 789 connection->invalid_pid = pid; 790 connection->transport_header = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2 ) | (AVRCP_RESPONSE_FRAME << 1) | 1; 791 connection->state = AVCTP_W2_SEND_RESPONSE; 792 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 793 return; 794 } 795 break; 796 default: 797 break; 798 } 799 800 // avrcp_command_type_t ctype = (avrcp_command_type_t) packet[3]; 801 // uint8_t byte_value = packet[4]; 802 avrcp_subunit_type_t subunit_type = (avrcp_subunit_type_t) (packet[4] >> 3); 803 avrcp_subunit_id_t subunit_id = (avrcp_subunit_id_t) (packet[4] & 0x07); 804 // opcode = packet[pos++]; 805 // printf(" Transport header 0x%02x (transaction_label %d, packet_type %d, frame_type %d, ipid %d), pid 0x%4x\n", 806 // transport_header, transaction_label, packet_type, frame_type, ipid, pid); 807 // printf_hexdump(packet+pos, size-pos); 808 809 avrcp_command_opcode_t opcode = avrcp_cmd_opcode(packet,size); 810 uint8_t * company_id = avrcp_get_company_id(packet, size); 811 uint8_t * pdu = avrcp_get_pdu(packet, size); 812 // uint16_t param_length = big_endian_read_16(pdu, 2); 813 814 int pos = 4; 815 uint8_t pdu_id; 816 connection->cmd_operands_length = 0; 817 818 switch (opcode){ 819 case AVRCP_CMD_OPCODE_UNIT_INFO: 820 avrcp_target_unit_info(connection); 821 break; 822 case AVRCP_CMD_OPCODE_SUBUNIT_INFO:{ 823 uint8_t offset = 4 * (packet[pos+2]>>4); 824 avrcp_target_subunit_info(connection, offset); 825 break; 826 } 827 case AVRCP_CMD_OPCODE_PASS_THROUGH:{ 828 log_info("AVRCP_OPERATION_ID 0x%02x, operands length %d, operand %d", packet[6], packet[7], packet[8]); 829 avrcp_operation_id_t operation_id = packet[6]; 830 831 if (avrcp_is_receive_pass_through_cmd(operation_id)){ 832 operation_id = packet[6] & 0x7F; 833 avrcp_target_operation_accepted(connection->avrcp_cid, packet[6], packet[7], packet[8]); 834 break; 835 } 836 837 switch (operation_id){ 838 case AVRCP_OPERATION_ID_PLAY: 839 case AVRCP_OPERATION_ID_PAUSE: 840 case AVRCP_OPERATION_ID_STOP: 841 case AVRCP_OPERATION_ID_VOLUME_UP: 842 case AVRCP_OPERATION_ID_VOLUME_DOWN: 843 case AVRCP_OPERATION_ID_REWIND: 844 case AVRCP_OPERATION_ID_FAST_FORWARD: 845 case AVRCP_OPERATION_ID_FORWARD: 846 case AVRCP_OPERATION_ID_BACKWARD: 847 case AVRCP_OPERATION_ID_SKIP: 848 case AVRCP_OPERATION_ID_MUTE: 849 case AVRCP_OPERATION_ID_CHANNEL_UP: 850 case AVRCP_OPERATION_ID_CHANNEL_DOWN: 851 case AVRCP_OPERATION_ID_SELECT: 852 case AVRCP_OPERATION_ID_UP: 853 case AVRCP_OPERATION_ID_DOWN: 854 case AVRCP_OPERATION_ID_LEFT: 855 case AVRCP_OPERATION_ID_RIGHT: 856 case AVRCP_OPERATION_ID_ROOT_MENU: 857 avrcp_target_operation_accepted(connection->avrcp_cid, packet[6], packet[7], packet[8]); 858 avrcp_target_emit_operation(avrcp_target_context.avrcp_callback, connection->avrcp_cid, operation_id, packet[7], packet[8]); 859 break; 860 case AVRCP_OPERATION_ID_UNDEFINED: 861 avrcp_target_operation_not_implemented(connection->avrcp_cid, packet[6], packet[7], packet[8]); 862 return; 863 default: 864 avrcp_target_operation_not_implemented(connection->avrcp_cid, packet[6], packet[7], packet[8]); 865 return; 866 } 867 break; 868 } 869 870 case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT: 871 pdu_id = pdu[0]; 872 // 1 - reserved 873 // 2-3 param length, 874 uint16_t length = big_endian_read_16(pdu, 2); 875 memcpy(connection->cmd_operands, company_id, 3); 876 connection->cmd_operands_length = 3; 877 switch (pdu_id){ 878 case AVRCP_PDU_ID_SET_ADDRESSED_PLAYER:{ 879 if (length == 0){ 880 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PLAYER_ID); 881 break; 882 } 883 avrcp_target_response_accept(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_SUCCESS); 884 break; 885 } 886 case AVRCP_PDU_ID_GET_CAPABILITIES:{ 887 avrcp_capability_id_t capability_id = (avrcp_capability_id_t) pdu[pos]; 888 switch (capability_id){ 889 case AVRCP_CAPABILITY_ID_EVENT: 890 avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_EVENT_IDS_QUERY); 891 break; 892 case AVRCP_CAPABILITY_ID_COMPANY: 893 avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_COMPANY_IDS_QUERY); 894 break; 895 default: 896 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER); 897 break; 898 } 899 break; 900 } 901 case AVRCP_PDU_ID_GET_PLAY_STATUS: 902 avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_PLAY_STATUS_QUERY); 903 break; 904 case AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE: 905 connection->cmd_operands[0] = pdu[4]; 906 connection->abort_continue_response = 1; 907 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 908 break; 909 case AVRCP_PDU_ID_REQUEST_CONTINUING_RESPONSE: 910 if (pdu[4] != AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES){ 911 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND); 912 return; 913 } 914 connection->now_playing_info_response = 1; 915 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 916 break; 917 case AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES:{ 918 uint8_t play_identifier[8]; 919 memset(play_identifier, 0, 8); 920 if (memcmp(pdu+pos, play_identifier, 8) != 0) { 921 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER); 922 return; 923 } 924 pos += 8; 925 uint8_t attribute_count = pdu[pos++]; 926 // printf("AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES attribute count %d\n", attribute_count); 927 connection->next_attr_id = AVRCP_MEDIA_ATTR_NONE; 928 if (!attribute_count){ 929 connection->now_playing_info_attr_bitmap = 0xFE; 930 } else { 931 int i; 932 connection->now_playing_info_attr_bitmap = 0; 933 for (i=0; i < attribute_count; i++){ 934 uint16_t attr_id = big_endian_read_16(pdu, pos); 935 pos += 2; 936 connection->now_playing_info_attr_bitmap |= (1 << attr_id); 937 } 938 } 939 log_info("now_playing_info_attr_bitmap 0x%02x", connection->now_playing_info_attr_bitmap); 940 avrcp_target_now_playing_info(connection); 941 break; 942 } 943 case AVRCP_PDU_ID_REGISTER_NOTIFICATION:{ 944 // 0 - pdu id 945 // 1 - reserved 946 // 2-3 param length 947 avrcp_notification_event_id_t event_id = (avrcp_notification_event_id_t) pdu[4]; 948 uint16_t event_mask = (1 << event_id); 949 950 switch (event_id){ 951 case AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED: 952 connection->notifications_enabled |= event_mask; 953 if (connection->track_selected){ 954 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, AVRCP_NOTIFICATION_TRACK_SELECTED, 8); 955 } else { 956 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, AVRCP_NOTIFICATION_TRACK_NOT_SELECTED, 8); 957 } 958 break; 959 case AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED: 960 connection->notifications_enabled |= event_mask; 961 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, (const uint8_t *)&connection->playback_status, 1); 962 break; 963 case AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED: 964 connection->notifications_enabled |= event_mask; 965 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, NULL, 0); 966 break; 967 case AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED: 968 connection->notifications_enabled |= event_mask; 969 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, (const uint8_t *)&connection->volume_percentage, 1); 970 break; 971 case AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED: 972 connection->notifications_enabled |= event_mask; 973 avrcp_target_response_vendor_dependent_interim(connection, subunit_type, subunit_id, opcode, pdu_id, event_id, (const uint8_t *)&connection->battery_status, 1); 974 break; 975 case AVRCP_NOTIFICATION_EVENT_AVAILABLE_PLAYERS_CHANGED: 976 case AVRCP_NOTIFICATION_EVENT_PLAYER_APPLICATION_SETTING_CHANGED: 977 case AVRCP_NOTIFICATION_EVENT_UIDS_CHANGED: 978 avrcp_target_response_not_implemented(connection, subunit_type, subunit_id, opcode, pdu_id, event_id); 979 return; 980 case AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED: 981 connection->notifications_enabled |= event_mask; 982 avrcp_target_response_addressed_player_changed_interim(connection, subunit_type, subunit_id, opcode, pdu_id); 983 return; 984 default: 985 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER); 986 return; 987 } 988 break; 989 } 990 case AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME: { 991 if (length != 1){ 992 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND); 993 break; 994 } 995 996 uint8_t absolute_volume = pdu[4]; 997 if (absolute_volume < 0x80){ 998 connection->volume_percentage = absolute_volume; 999 } 1000 avrcp_target_response_accept(connection, subunit_type, subunit_id, opcode, pdu_id, connection->volume_percentage); 1001 break; 1002 } 1003 default: 1004 log_info("AVRCP target: unhandled pdu id 0x%02x", pdu_id); 1005 avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND); 1006 break; 1007 } 1008 break; 1009 default: 1010 log_info("AVRCP target: opcode 0x%02x not implemented", avrcp_cmd_opcode(packet,size)); 1011 break; 1012 } 1013 } 1014 1015 #if 0 1016 static int avrcp_target_send_addressed_player_changed_notification(uint16_t cid, avrcp_connection_t * connection, uint16_t uid, uint16_t uid_counter){ 1017 if (!connection){ 1018 log_error("avrcp tartget: could not find a connection."); 1019 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1020 } 1021 connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 1022 connection->command_type = AVRCP_CTYPE_RESPONSE_CHANGED_STABLE; 1023 connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 1024 connection->subunit_id = AVRCP_SUBUNIT_ID; 1025 1026 uint16_t pos = 0; 1027 l2cap_reserve_packet_buffer(); 1028 uint8_t * packet = l2cap_get_outgoing_buffer(); 1029 1030 connection->packet_type = AVRCP_SINGLE_PACKET; 1031 packet[pos++] = (connection->transaction_label << 4) | (connection->packet_type << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0; 1032 // Profile IDentifier (PID) 1033 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 1034 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 1035 1036 // command_type 1037 packet[pos++] = connection->command_type; 1038 // subunit_type | subunit ID 1039 packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 1040 // opcode 1041 packet[pos++] = (uint8_t)connection->command_opcode; 1042 1043 // company id is 3 bytes long 1044 big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID); 1045 pos += 3; 1046 1047 packet[pos++] = AVRCP_PDU_ID_REGISTER_NOTIFICATION; 1048 packet[pos++] = 0; 1049 big_endian_store_16(packet, pos, 5); 1050 pos += 2; 1051 packet[pos++] = AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED; 1052 big_endian_store_16(packet, pos, uid); 1053 pos += 2; 1054 big_endian_store_16(packet, pos, uid_counter); 1055 pos += 2; 1056 1057 connection->wait_to_send = 0; 1058 return l2cap_send_prepared(cid, pos); 1059 } 1060 #endif 1061 1062 static int avrcp_target_send_notification(uint16_t cid, avrcp_connection_t * connection, uint8_t notification_id, uint8_t * value, uint16_t value_len){ 1063 if (!connection){ 1064 log_error("avrcp tartget: could not find a connection."); 1065 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1066 } 1067 1068 connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 1069 connection->command_type = AVRCP_CTYPE_RESPONSE_CHANGED_STABLE; 1070 connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 1071 connection->subunit_id = AVRCP_SUBUNIT_ID; 1072 1073 uint16_t pos = 0; 1074 l2cap_reserve_packet_buffer(); 1075 uint8_t * packet = l2cap_get_outgoing_buffer(); 1076 uint16_t size = l2cap_get_remote_mtu_for_local_cid(connection->l2cap_signaling_cid); 1077 1078 connection->packet_type = AVRCP_SINGLE_PACKET; 1079 packet[pos++] = (connection->transaction_label << 4) | (connection->packet_type << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0; 1080 // Profile IDentifier (PID) 1081 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 1082 packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 1083 1084 // command_type 1085 packet[pos++] = connection->command_type; 1086 // subunit_type | subunit ID 1087 packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 1088 // opcode 1089 packet[pos++] = (uint8_t)connection->command_opcode; 1090 1091 // company id is 3 bytes long 1092 big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID); 1093 pos += 3; 1094 1095 packet[pos++] = AVRCP_PDU_ID_REGISTER_NOTIFICATION; 1096 packet[pos++] = 0; 1097 uint16_t remainig_outgoing_buffer_size = size > (value_len + 2 + 1) ? size - (value_len + 2 + 1): 0; 1098 uint16_t caped_value_len = value_len > remainig_outgoing_buffer_size ? remainig_outgoing_buffer_size : value_len; 1099 big_endian_store_16(packet, pos, caped_value_len); 1100 pos += 2; 1101 packet[pos++] = notification_id; 1102 1103 memcpy(packet+pos, value, caped_value_len); 1104 pos += caped_value_len; 1105 connection->wait_to_send = 0; 1106 return l2cap_send_prepared(cid, pos); 1107 } 1108 1109 static void avrcp_target_reset_notification(avrcp_connection_t * connection, uint8_t notification_id){ 1110 if (!connection){ 1111 log_error("avrcp tartget: could not find a connection."); 1112 return; 1113 } 1114 connection->notifications_enabled &= ~(1 << notification_id); 1115 connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 1116 1117 } 1118 1119 static void avrcp_target_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 1120 avrcp_connection_t * connection; 1121 switch (packet_type) { 1122 case L2CAP_DATA_PACKET: 1123 connection = get_avrcp_connection_for_l2cap_signaling_cid(channel, &avrcp_target_context); 1124 if (!connection) break; 1125 avrcp_handle_l2cap_data_packet_for_signaling_connection(connection, packet, size); 1126 break; 1127 case HCI_EVENT_PACKET: 1128 switch (hci_event_packet_get_type(packet)){ 1129 case L2CAP_EVENT_CAN_SEND_NOW:{ 1130 connection = get_avrcp_connection_for_l2cap_signaling_cid(channel, &avrcp_target_context); 1131 if (!connection) { 1132 log_error("Connection not found\n"); 1133 break; 1134 } 1135 1136 if (connection->abort_continue_response){ 1137 connection->abort_continue_response = 0; 1138 connection->now_playing_info_response = 0; 1139 avrcp_target_abort_continue_response(connection->l2cap_signaling_cid, connection); 1140 break; 1141 } 1142 1143 if (connection->now_playing_info_response){ 1144 connection->now_playing_info_response = 0; 1145 avrcp_target_send_now_playing_info(connection->l2cap_signaling_cid, connection); 1146 break; 1147 } 1148 1149 if (connection->track_changed){ 1150 connection->track_changed = 0; 1151 avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED, connection->track_id, 8); 1152 avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED); 1153 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1154 break; 1155 } 1156 1157 if (connection->playback_status_changed){ 1158 connection->playback_status_changed = 0; 1159 avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED, &connection->playback_status_changed, 1); 1160 avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED); 1161 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1162 break; 1163 } 1164 1165 // if (connection->addressed_player_changed){ 1166 // connection->playback_status_changed = 0; 1167 // avrcp_target_send_addressed_player_changed_notification(connection->l2cap_signaling_cid, connection, connection->addressed_player_id, connection->uid_counter); 1168 // avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED); 1169 // avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1170 // break; 1171 // } 1172 1173 if (connection->playing_content_changed){ 1174 connection->playing_content_changed = 0; 1175 avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED, NULL, 0); 1176 avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED); 1177 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1178 break; 1179 } 1180 1181 if (connection->battery_status_changed){ 1182 connection->battery_status_changed = 0; 1183 avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED, (uint8_t *)&connection->battery_status, 1); 1184 avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED); 1185 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1186 break; 1187 } 1188 1189 if (connection->volume_percentage_changed){ 1190 connection->volume_percentage_changed = 0; 1191 avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED, &connection->volume_percentage, 1); 1192 avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED); 1193 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1194 break; 1195 } 1196 1197 if (connection->reject_transport_header){ 1198 printf(" reject_transport_header\n"); 1199 connection->state = AVCTP_CONNECTION_OPENED; 1200 connection->reject_transport_header = 0; 1201 l2cap_reserve_packet_buffer(); 1202 uint8_t * out_buffer = l2cap_get_outgoing_buffer(); 1203 out_buffer[0] = connection->transport_header; 1204 big_endian_store_16(out_buffer, 1, connection->invalid_pid); 1205 l2cap_send_prepared(connection->l2cap_signaling_cid, 3); 1206 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1207 break; 1208 } 1209 1210 1211 switch (connection->state){ 1212 case AVCTP_W2_SEND_RESPONSE: 1213 connection->state = AVCTP_CONNECTION_OPENED; 1214 // if (connection->now_playing_info_response){ 1215 // connection->now_playing_info_response = 0; 1216 // avrcp_target_send_now_playing_info(connection->l2cap_signaling_cid, connection); 1217 // break; 1218 // } 1219 avrcp_target_send_response(connection->l2cap_signaling_cid, connection); 1220 break; 1221 default: 1222 return; 1223 } 1224 break; 1225 } 1226 default: 1227 avrcp_packet_handler(packet_type, channel, packet, size, &avrcp_target_context); 1228 break; 1229 } 1230 default: 1231 break; 1232 } 1233 } 1234 1235 void avrcp_target_init(void){ 1236 avrcp_target_context.role = AVRCP_TARGET; 1237 avrcp_target_context.connections = NULL; 1238 avrcp_target_context.packet_handler = avrcp_target_packet_handler; 1239 l2cap_register_service(&avrcp_target_packet_handler, BLUETOOTH_PROTOCOL_AVCTP, 0xffff, LEVEL_2); 1240 } 1241 1242 void avrcp_target_register_packet_handler(btstack_packet_handler_t callback){ 1243 if (callback == NULL){ 1244 log_error("avrcp_register_packet_handler called with NULL callback"); 1245 return; 1246 } 1247 avrcp_target_context.avrcp_callback = callback; 1248 } 1249 1250 uint8_t avrcp_target_connect(bd_addr_t bd_addr, uint16_t * avrcp_cid){ 1251 return avrcp_connect(bd_addr, &avrcp_target_context, avrcp_cid); 1252 } 1253 1254 uint8_t avrcp_target_disconnect(uint16_t avrcp_cid){ 1255 avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid(avrcp_cid, &avrcp_target_context); 1256 if (!connection){ 1257 log_error("avrcp_get_capabilities: could not find a connection."); 1258 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1259 } 1260 if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1261 l2cap_disconnect(connection->l2cap_signaling_cid, 0); 1262 return ERROR_CODE_SUCCESS; 1263 } 1264 1265