16983e65eSMilanka Ringwald /* 26983e65eSMilanka Ringwald * Copyright (C) 2016 BlueKitchen GmbH 36983e65eSMilanka Ringwald * 46983e65eSMilanka Ringwald * Redistribution and use in source and binary forms, with or without 56983e65eSMilanka Ringwald * modification, are permitted provided that the following conditions 66983e65eSMilanka Ringwald * are met: 76983e65eSMilanka Ringwald * 86983e65eSMilanka Ringwald * 1. Redistributions of source code must retain the above copyright 96983e65eSMilanka Ringwald * notice, this list of conditions and the following disclaimer. 106983e65eSMilanka Ringwald * 2. Redistributions in binary form must reproduce the above copyright 116983e65eSMilanka Ringwald * notice, this list of conditions and the following disclaimer in the 126983e65eSMilanka Ringwald * documentation and/or other materials provided with the distribution. 136983e65eSMilanka Ringwald * 3. Neither the name of the copyright holders nor the names of 146983e65eSMilanka Ringwald * contributors may be used to endorse or promote products derived 156983e65eSMilanka Ringwald * from this software without specific prior written permission. 166983e65eSMilanka Ringwald * 4. Any redistribution, use, or modification is done solely for 176983e65eSMilanka Ringwald * personal benefit and not for any commercial purpose or for 186983e65eSMilanka Ringwald * monetary gain. 196983e65eSMilanka Ringwald * 206983e65eSMilanka Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 216983e65eSMilanka Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 226983e65eSMilanka Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 232fca4dadSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 242fca4dadSMilanka Ringwald * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 256983e65eSMilanka Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 266983e65eSMilanka Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 276983e65eSMilanka Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 286983e65eSMilanka Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 296983e65eSMilanka Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 306983e65eSMilanka Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 316983e65eSMilanka Ringwald * SUCH DAMAGE. 326983e65eSMilanka Ringwald * 336983e65eSMilanka Ringwald * Please inquire about commercial licensing options at 346983e65eSMilanka Ringwald * [email protected] 356983e65eSMilanka Ringwald * 366983e65eSMilanka Ringwald */ 376983e65eSMilanka Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avrcp_controller.c" 396983e65eSMilanka Ringwald 406983e65eSMilanka Ringwald #include <stdint.h> 416983e65eSMilanka Ringwald #include <string.h> 42adaba9f3SMatthias Ringwald #include <inttypes.h> 436983e65eSMilanka Ringwald 446983e65eSMilanka Ringwald #include "classic/avrcp.h" 456983e65eSMilanka Ringwald #include "classic/avrcp_controller.h" 466983e65eSMilanka Ringwald 477c76cd61SMatthias Ringwald #include "bluetooth_sdp.h" 487c76cd61SMatthias Ringwald #include "btstack_debug.h" 497c76cd61SMatthias Ringwald #include "btstack_event.h" 507c76cd61SMatthias Ringwald #include "btstack_util.h" 517c76cd61SMatthias Ringwald #include "l2cap.h" 527c76cd61SMatthias Ringwald 534adb0765SMatthias Ringwald // made public in avrcp_controller.h 54e3d57ee2SMilanka Ringwald avrcp_context_t avrcp_controller_context; 559aa720b2SMilanka Ringwald 566e7485d0SMilanka Ringwald static uint8_t avrcp_controller_calc_next_transaction_label(uint8_t current_transaction_label){ 576e7485d0SMilanka Ringwald current_transaction_label++; 586e7485d0SMilanka Ringwald if (current_transaction_label == 16){ 596e7485d0SMilanka Ringwald current_transaction_label = 1; 609aa720b2SMilanka Ringwald } 616e7485d0SMilanka Ringwald return current_transaction_label; 626e7485d0SMilanka Ringwald } 636e7485d0SMilanka Ringwald 646e7485d0SMilanka Ringwald static uint8_t avrcp_controller_get_next_transaction_label(avrcp_connection_t * connection){ 656e7485d0SMilanka Ringwald connection->transaction_id_counter = avrcp_controller_calc_next_transaction_label(connection->transaction_id_counter); 6623773c45SMilanka Ringwald return connection->transaction_id_counter; 679aa720b2SMilanka Ringwald } 684adb0765SMatthias Ringwald 696e7485d0SMilanka Ringwald static bool avrcp_controller_is_transaction_id_valid(avrcp_connection_t * connection, uint8_t transaction_id){ 70393f5724SMilanka Ringwald uint8_t delta = ((int8_t) transaction_id - connection->controller_last_confirmed_transaction_id) & 0x0f; 716e7485d0SMilanka Ringwald return delta < 15; 726e7485d0SMilanka Ringwald } 736e7485d0SMilanka Ringwald 747bccc69fSMilanka Ringwald static void avrcp_controller_custom_command_data_init(avrcp_connection_t * connection, 758d316b1bSMilanka Ringwald avrcp_command_opcode_t opcode, avrcp_command_type_t command_type, 768d316b1bSMilanka Ringwald avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, 778d316b1bSMilanka Ringwald avrcp_pdu_id_t pdu_id, uint32_t company_id){ 788d316b1bSMilanka Ringwald 798d316b1bSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 808d316b1bSMilanka Ringwald connection->command_opcode = opcode; 818d316b1bSMilanka Ringwald connection->command_type = command_type; 828d316b1bSMilanka Ringwald connection->subunit_type = subunit_type; 838d316b1bSMilanka Ringwald connection->subunit_id = subunit_id; 843a19cf32SMilanka Ringwald connection->company_id = company_id; 858d316b1bSMilanka Ringwald connection->pdu_id = pdu_id; 865d3671d9SMilanka Ringwald connection->data = NULL; 875d3671d9SMilanka Ringwald connection->data_offset = 0; 885d3671d9SMilanka Ringwald connection->data_len = 0; 898d316b1bSMilanka Ringwald } 908d316b1bSMilanka Ringwald 9166b242bbSMilanka Ringwald static void avrcp_controller_vendor_dependent_command_data_init(avrcp_connection_t * connection, avrcp_command_type_t command_type, avrcp_pdu_id_t pdu_id){ 928d316b1bSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 938d316b1bSMilanka Ringwald connection->command_opcode = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 948d316b1bSMilanka Ringwald connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 958d316b1bSMilanka Ringwald connection->subunit_id = AVRCP_SUBUNIT_ID; 968d316b1bSMilanka Ringwald connection->company_id = BT_SIG_COMPANY_ID; 978d316b1bSMilanka Ringwald 988d316b1bSMilanka Ringwald connection->command_type = command_type; 998d316b1bSMilanka Ringwald connection->pdu_id = pdu_id; 100393f5724SMilanka Ringwald connection->data = connection->message_body; 1015d3671d9SMilanka Ringwald connection->data_offset = 0; 1025d3671d9SMilanka Ringwald connection->data_len = 0; 1038d316b1bSMilanka Ringwald } 1048d316b1bSMilanka Ringwald 10566b242bbSMilanka Ringwald static void avrcp_controller_pass_through_command_data_init(avrcp_connection_t * connection, avrcp_operation_id_t opid){ 1068d316b1bSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 1078d316b1bSMilanka Ringwald connection->command_opcode = AVRCP_CMD_OPCODE_PASS_THROUGH; 1088d316b1bSMilanka Ringwald connection->command_type = AVRCP_CTYPE_CONTROL; 1098d316b1bSMilanka Ringwald connection->subunit_type = AVRCP_SUBUNIT_TYPE_PANEL; 1108d316b1bSMilanka Ringwald connection->subunit_id = AVRCP_SUBUNIT_ID; 1118d316b1bSMilanka Ringwald 1128d316b1bSMilanka Ringwald connection->company_id = 0; 11392ae15eaSMilanka Ringwald connection->pdu_id = AVRCP_PDU_ID_UNDEFINED; 1148d316b1bSMilanka Ringwald connection->operation_id = opid; 1158d316b1bSMilanka Ringwald 116393f5724SMilanka Ringwald connection->data = connection->message_body; 1175d3671d9SMilanka Ringwald connection->data_offset = 0; 1185d3671d9SMilanka Ringwald connection->data_len = 0; 1198d316b1bSMilanka Ringwald } 1203d9ab93fSMilanka Ringwald static int avrcp_controller_supports_browsing(uint16_t controller_supported_features){ 1213d9ab93fSMilanka Ringwald return controller_supported_features & AVRCP_FEATURE_MASK_BROWSING; 1223d9ab93fSMilanka Ringwald } 1233d9ab93fSMilanka Ringwald 124176d21adSMilanka Ringwald static void avrcp_controller_prepare_custom_command_response(avrcp_connection_t * connection, uint8_t response_len, uint8_t * in_place_buffer){ 125176d21adSMilanka Ringwald uint8_t pos = 0; 126176d21adSMilanka Ringwald in_place_buffer[pos++] = HCI_EVENT_AVRCP_META; 127176d21adSMilanka Ringwald // skip len 128176d21adSMilanka Ringwald pos++; 129176d21adSMilanka Ringwald in_place_buffer[pos++] = AVRCP_SUBEVENT_CUSTOM_COMMAND_RESPONSE; 130176d21adSMilanka Ringwald little_endian_store_16(in_place_buffer, pos, connection->avrcp_cid); 131176d21adSMilanka Ringwald pos += 2; 132176d21adSMilanka Ringwald in_place_buffer[pos++] = connection->pdu_id; 133176d21adSMilanka Ringwald little_endian_store_16(in_place_buffer, pos, response_len); 134176d21adSMilanka Ringwald pos += 2; 135176d21adSMilanka Ringwald in_place_buffer[1] = pos + response_len - 2; 136176d21adSMilanka Ringwald } 137176d21adSMilanka Ringwald 138b2e02b8dSMilanka Ringwald static void avrcp_controller_emit_notification_complete(avrcp_connection_t * connection, uint8_t status, uint8_t event_id, bool enabled){ 139b2e02b8dSMilanka Ringwald uint8_t event[8]; 140bce3db21SMilanka Ringwald uint8_t pos = 0; 141bce3db21SMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 142bce3db21SMilanka Ringwald event[pos++] = sizeof(event) - 2; 143b2e02b8dSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_NOTIFICATION_STATE; 144bce3db21SMilanka Ringwald little_endian_store_16(event, pos, connection->avrcp_cid); 145bce3db21SMilanka Ringwald pos += 2; 146bce3db21SMilanka Ringwald event[pos++] = status; 147b2e02b8dSMilanka Ringwald event[pos++] = enabled ? 1 : 0; 148bce3db21SMilanka Ringwald event[pos++] = event_id; 149bce3db21SMilanka Ringwald UNUSED(pos); 150bce3db21SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 151bce3db21SMilanka Ringwald } 152bce3db21SMilanka Ringwald 153ff243a1bSMilanka Ringwald static void avrcp_controller_emit_supported_events(avrcp_connection_t * connection){ 154ff243a1bSMilanka Ringwald uint8_t ctype = (uint8_t) AVRCP_CTYPE_RESPONSE_CHANGED_STABLE; 1552ac1dc76SMilanka Ringwald uint8_t event_id; 156ff243a1bSMilanka Ringwald 15799845bb7SMilanka Ringwald for (event_id = (uint8_t) AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; event_id < (uint8_t) AVRCP_NOTIFICATION_EVENT_LAST_INDEX; event_id++){ 158393f5724SMilanka Ringwald if ((connection->notifications_supported_by_target & (1 << event_id)) == 0){ 159ff243a1bSMilanka Ringwald continue; 160ff243a1bSMilanka Ringwald } 1612ac1dc76SMilanka Ringwald uint8_t event[8]; 1622ac1dc76SMilanka Ringwald uint8_t pos = 0; 1632ac1dc76SMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 1642ac1dc76SMilanka Ringwald event[pos++] = sizeof(event) - 2; 1652ac1dc76SMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_GET_CAPABILITY_EVENT_ID; 1662ac1dc76SMilanka Ringwald little_endian_store_16(event, pos, connection->avrcp_cid); 1672ac1dc76SMilanka Ringwald pos += 2; 1682ac1dc76SMilanka Ringwald event[pos++] = ctype; 1692ac1dc76SMilanka Ringwald event[pos++] = 0; 1702ac1dc76SMilanka Ringwald event[pos++] = event_id; 1712ac1dc76SMilanka Ringwald UNUSED(pos); 1722ac1dc76SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 173ff243a1bSMilanka Ringwald } 174ff243a1bSMilanka Ringwald 1752ac1dc76SMilanka Ringwald uint8_t event[7]; 1762ac1dc76SMilanka Ringwald uint8_t pos = 0; 1772ac1dc76SMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 1782ac1dc76SMilanka Ringwald event[pos++] = sizeof(event) - 2; 1792ac1dc76SMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_GET_CAPABILITY_EVENT_ID_DONE; 1802ac1dc76SMilanka Ringwald little_endian_store_16(event, pos, connection->avrcp_cid); 1812ac1dc76SMilanka Ringwald pos += 2; 1822ac1dc76SMilanka Ringwald event[pos++] = ctype; 1832ac1dc76SMilanka Ringwald event[pos++] = 0; 1842ac1dc76SMilanka Ringwald UNUSED(pos); 185ff243a1bSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 186ff243a1bSMilanka Ringwald } 187ff243a1bSMilanka Ringwald 18899702381SMatthias Ringwald static void avrcp_controller_emit_notification_for_event_id(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id, 18999702381SMatthias Ringwald avrcp_command_type_t ctype, const uint8_t *payload, 19099702381SMatthias Ringwald uint16_t size) { 19116dc7cb4SMilanka Ringwald switch (event_id){ 19216dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYBACK_POS_CHANGED:{ 19399702381SMatthias Ringwald if (size < 4) break; 19416dc7cb4SMilanka Ringwald uint32_t song_position = big_endian_read_32(payload, 0); 19516dc7cb4SMilanka Ringwald uint16_t offset = 0; 19616dc7cb4SMilanka Ringwald uint8_t event[10]; 19716dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 19816dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 19916dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_PLAYBACK_POS_CHANGED; 20016dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 20116dc7cb4SMilanka Ringwald offset += 2; 20216dc7cb4SMilanka Ringwald event[offset++] = ctype; 20316dc7cb4SMilanka Ringwald little_endian_store_32(event, offset, song_position); 20416dc7cb4SMilanka Ringwald offset += 4; 20516dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 20616dc7cb4SMilanka Ringwald break; 20716dc7cb4SMilanka Ringwald } 20816dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED:{ 20999702381SMatthias Ringwald if (size < 1) break; 21016dc7cb4SMilanka Ringwald uint16_t offset = 0; 21116dc7cb4SMilanka Ringwald uint8_t event[7]; 21216dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 21316dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 21416dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_PLAYBACK_STATUS_CHANGED; 21516dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 21616dc7cb4SMilanka Ringwald offset += 2; 21716dc7cb4SMilanka Ringwald event[offset++] = ctype; 21816dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 21916dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 22016dc7cb4SMilanka Ringwald break; 22116dc7cb4SMilanka Ringwald } 22216dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED:{ 22316dc7cb4SMilanka Ringwald uint16_t offset = 0; 22416dc7cb4SMilanka Ringwald uint8_t event[6]; 22516dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 22616dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 22716dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_TRACK_CHANGED; 22816dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 22916dc7cb4SMilanka Ringwald offset += 2; 23016dc7cb4SMilanka Ringwald event[offset++] = ctype; 23116dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 23216dc7cb4SMilanka Ringwald break; 23316dc7cb4SMilanka Ringwald } 23416dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED:{ 23516dc7cb4SMilanka Ringwald uint16_t offset = 0; 23616dc7cb4SMilanka Ringwald uint8_t event[6]; 23716dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 23816dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 23916dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_NOW_PLAYING_CONTENT_CHANGED; 24016dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 24116dc7cb4SMilanka Ringwald offset += 2; 24216dc7cb4SMilanka Ringwald event[offset++] = ctype; 24316dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 24416dc7cb4SMilanka Ringwald break; 24516dc7cb4SMilanka Ringwald } 24616dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_AVAILABLE_PLAYERS_CHANGED:{ 24716dc7cb4SMilanka Ringwald uint16_t offset = 0; 24816dc7cb4SMilanka Ringwald uint8_t event[6]; 24916dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 25016dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 25116dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_AVAILABLE_PLAYERS_CHANGED; 25216dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 25316dc7cb4SMilanka Ringwald offset += 2; 25416dc7cb4SMilanka Ringwald event[offset++] = ctype; 25516dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 25616dc7cb4SMilanka Ringwald break; 25716dc7cb4SMilanka Ringwald } 25816dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED:{ 25999702381SMatthias Ringwald if (size < 1) break; 26016dc7cb4SMilanka Ringwald uint16_t offset = 0; 26116dc7cb4SMilanka Ringwald uint8_t event[7]; 26216dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 26316dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 26416dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_VOLUME_CHANGED; 26516dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 26616dc7cb4SMilanka Ringwald offset += 2; 26716dc7cb4SMilanka Ringwald event[offset++] = ctype; 26816dc7cb4SMilanka Ringwald event[offset++] = payload[0] & 0x7F; 26916dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 27016dc7cb4SMilanka Ringwald break; 27116dc7cb4SMilanka Ringwald } 27216dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_UIDS_CHANGED:{ 27399702381SMatthias Ringwald if (size < 2) break; 27416dc7cb4SMilanka Ringwald uint8_t event[8]; 27516dc7cb4SMilanka Ringwald uint16_t offset = 0; 27616dc7cb4SMilanka Ringwald uint16_t uuid = big_endian_read_16(payload, 0); 27716dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 27816dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 27916dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_UIDS_CHANGED; 28016dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 28116dc7cb4SMilanka Ringwald offset += 2; 28216dc7cb4SMilanka Ringwald event[offset++] = ctype; 28316dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, uuid); 28416dc7cb4SMilanka Ringwald offset += 2; 28516dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 28616dc7cb4SMilanka Ringwald break; 28716dc7cb4SMilanka Ringwald } 28816dc7cb4SMilanka Ringwald 28916dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_TRACK_REACHED_END:{ 29016dc7cb4SMilanka Ringwald uint16_t offset = 0; 29116dc7cb4SMilanka Ringwald uint8_t event[6]; 29216dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 29316dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 29416dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_TRACK_REACHED_END; 29516dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 29616dc7cb4SMilanka Ringwald offset += 2; 29716dc7cb4SMilanka Ringwald event[offset++] = ctype; 29816dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 29916dc7cb4SMilanka Ringwald break; 30016dc7cb4SMilanka Ringwald } 30116dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_TRACK_REACHED_START:{ 30216dc7cb4SMilanka Ringwald uint16_t offset = 0; 30316dc7cb4SMilanka Ringwald uint8_t event[6]; 30416dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 30516dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 30616dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_TRACK_REACHED_START; 30716dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 30816dc7cb4SMilanka Ringwald offset += 2; 30916dc7cb4SMilanka Ringwald event[offset++] = ctype; 31016dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 31116dc7cb4SMilanka Ringwald break; 31216dc7cb4SMilanka Ringwald } 31316dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED:{ 31499702381SMatthias Ringwald if (size < 1) break; 31516dc7cb4SMilanka Ringwald uint16_t offset = 0; 31616dc7cb4SMilanka Ringwald uint8_t event[7]; 31716dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 31816dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 31916dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_BATT_STATUS_CHANGED; 32016dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 32116dc7cb4SMilanka Ringwald offset += 2; 32216dc7cb4SMilanka Ringwald event[offset++] = ctype; 32316dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 32416dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 32516dc7cb4SMilanka Ringwald break; 32616dc7cb4SMilanka Ringwald } 32716dc7cb4SMilanka Ringwald 32816dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_SYSTEM_STATUS_CHANGED:{ 32999702381SMatthias Ringwald if (size < 1) break; 33016dc7cb4SMilanka Ringwald uint16_t offset = 0; 33116dc7cb4SMilanka Ringwald uint8_t event[7]; 33216dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 33316dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 33416dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_SYSTEM_STATUS_CHANGED; 33516dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 33616dc7cb4SMilanka Ringwald offset += 2; 33716dc7cb4SMilanka Ringwald event[offset++] = ctype; 33816dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 33916dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 34016dc7cb4SMilanka Ringwald break; 34116dc7cb4SMilanka Ringwald } 34216dc7cb4SMilanka Ringwald 34316dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYER_APPLICATION_SETTING_CHANGED: 34416dc7cb4SMilanka Ringwald default: 34516dc7cb4SMilanka Ringwald log_info("avrcp: not implemented"); 34616dc7cb4SMilanka Ringwald break; 34716dc7cb4SMilanka Ringwald } 34816dc7cb4SMilanka Ringwald } 34916dc7cb4SMilanka Ringwald 3503d9ab93fSMilanka Ringwald static void avrcp_controller_emit_repeat_and_shuffle_mode(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t ctype, avrcp_repeat_mode_t repeat_mode, avrcp_shuffle_mode_t shuffle_mode){ 3513d9ab93fSMilanka Ringwald btstack_assert(callback != NULL); 3523d9ab93fSMilanka Ringwald 3533d9ab93fSMilanka Ringwald uint8_t event[8]; 3546983e65eSMilanka Ringwald int pos = 0; 3553d9ab93fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3563d9ab93fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 3573d9ab93fSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_SHUFFLE_AND_REPEAT_MODE; 3583d9ab93fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3596983e65eSMilanka Ringwald pos += 2; 3603d9ab93fSMilanka Ringwald event[pos++] = ctype; 3613d9ab93fSMilanka Ringwald event[pos++] = repeat_mode; 3623d9ab93fSMilanka Ringwald event[pos++] = shuffle_mode; 3633d9ab93fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 3641bf7a74fSMilanka Ringwald } 3651bf7a74fSMilanka Ringwald 3661bf7a74fSMilanka Ringwald static void avrcp_controller_emit_now_playing_info_event_done(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t ctype, uint8_t status){ 3671bf7a74fSMilanka Ringwald uint8_t event[7]; 3681bf7a74fSMilanka Ringwald int pos = 0; 3691bf7a74fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3701bf7a74fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 3711bf7a74fSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_NOW_PLAYING_INFO_DONE; 3721bf7a74fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3731bf7a74fSMilanka Ringwald pos += 2; 3741bf7a74fSMilanka Ringwald event[pos++] = ctype; 3751bf7a74fSMilanka Ringwald event[pos++] = status; 3761bf7a74fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, pos); 3771bf7a74fSMilanka Ringwald } 3781bf7a74fSMilanka Ringwald 3791bf7a74fSMilanka Ringwald static void avrcp_controller_emit_now_playing_info_event(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t ctype, avrcp_media_attribute_id_t attr_id, uint8_t * value, uint16_t value_len){ 3801bf7a74fSMilanka Ringwald uint8_t event[HCI_EVENT_BUFFER_SIZE]; 3811bf7a74fSMilanka Ringwald int pos = 0; 3821bf7a74fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3831bf7a74fSMilanka Ringwald // reserve one byte for subevent type and data len 3841bf7a74fSMilanka Ringwald int data_len_pos = pos; 3851bf7a74fSMilanka Ringwald pos++; 3861bf7a74fSMilanka Ringwald int subevent_type_pos = pos; 3871bf7a74fSMilanka Ringwald pos++; 3881bf7a74fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3891bf7a74fSMilanka Ringwald pos += 2; 3901bf7a74fSMilanka Ringwald event[pos++] = ctype; 3911bf7a74fSMilanka Ringwald 3921bf7a74fSMilanka Ringwald switch (attr_id){ 3931bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_TITLE: 3941bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TITLE_INFO; 3951bf7a74fSMilanka Ringwald event[pos++] = value_len; 3966535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 3971bf7a74fSMilanka Ringwald break; 3981bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_ARTIST: 3991bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_ARTIST_INFO; 4001bf7a74fSMilanka Ringwald event[pos++] = value_len; 4016535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 4021bf7a74fSMilanka Ringwald break; 4031bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_ALBUM: 4041bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_ALBUM_INFO; 4051bf7a74fSMilanka Ringwald event[pos++] = value_len; 4066535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 4071bf7a74fSMilanka Ringwald break; 4081bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_GENRE: 4091bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_GENRE_INFO; 4101bf7a74fSMilanka Ringwald event[pos++] = value_len; 4116535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 4121bf7a74fSMilanka Ringwald break; 4132f511ffbSMilanka Ringwald case AVRCP_MEDIA_ATTR_SONG_LENGTH_MS: 4141bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_SONG_LENGTH_MS_INFO; 4151bf7a74fSMilanka Ringwald if (value){ 4161bf7a74fSMilanka Ringwald little_endian_store_32(event, pos, btstack_atoi((char *)value)); 4171bf7a74fSMilanka Ringwald } else { 4181bf7a74fSMilanka Ringwald little_endian_store_32(event, pos, 0); 4191bf7a74fSMilanka Ringwald } 4201bf7a74fSMilanka Ringwald pos += 4; 4211bf7a74fSMilanka Ringwald break; 4221bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_TRACK: 4231bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TRACK_INFO; 4241bf7a74fSMilanka Ringwald if (value){ 4251bf7a74fSMilanka Ringwald event[pos++] = btstack_atoi((char *)value); 4261bf7a74fSMilanka Ringwald } else { 4271bf7a74fSMilanka Ringwald event[pos++] = 0; 4281bf7a74fSMilanka Ringwald } 4291bf7a74fSMilanka Ringwald break; 430864d08b0SMilanka Ringwald case AVRCP_MEDIA_ATTR_TOTAL_NUM_ITEMS: 4311bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TOTAL_TRACKS_INFO; 4321bf7a74fSMilanka Ringwald if (value){ 4331bf7a74fSMilanka Ringwald event[pos++] = btstack_atoi((char *)value); 4341bf7a74fSMilanka Ringwald } else { 4351bf7a74fSMilanka Ringwald event[pos++] = 0; 4361bf7a74fSMilanka Ringwald } 4371bf7a74fSMilanka Ringwald break; 4381bf7a74fSMilanka Ringwald default: 4391bf7a74fSMilanka Ringwald break; 4401bf7a74fSMilanka Ringwald } 4411bf7a74fSMilanka Ringwald event[data_len_pos] = pos - 2; 4421bf7a74fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, pos); 4431bf7a74fSMilanka Ringwald } 4441bf7a74fSMilanka Ringwald 4453d9ab93fSMilanka Ringwald static void avrcp_controller_emit_operation_status(btstack_packet_handler_t callback, uint8_t subevent, uint16_t avrcp_cid, uint8_t ctype, uint8_t operation_id){ 4463d9ab93fSMilanka Ringwald btstack_assert(callback != NULL); 4473d9ab93fSMilanka Ringwald 4483d9ab93fSMilanka Ringwald uint8_t event[7]; 4493d9ab93fSMilanka Ringwald int pos = 0; 4503d9ab93fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 4513d9ab93fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 4523d9ab93fSMilanka Ringwald event[pos++] = subevent; 4533d9ab93fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 4543d9ab93fSMilanka Ringwald pos += 2; 4553d9ab93fSMilanka Ringwald event[pos++] = ctype; 4563d9ab93fSMilanka Ringwald event[pos++] = operation_id; 4573d9ab93fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 4583d9ab93fSMilanka Ringwald } 4593d9ab93fSMilanka Ringwald 4603d9ab93fSMilanka Ringwald static void avrcp_parser_reset(avrcp_connection_t * connection){ 4613d9ab93fSMilanka Ringwald connection->list_offset = 0; 4623d9ab93fSMilanka Ringwald connection->parser_attribute_header_pos = 0; 4633d73cc81SMilanka Ringwald connection->controller_num_received_fragments = 0; 4643d9ab93fSMilanka Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_HEADER; 4653d9ab93fSMilanka Ringwald } 4663d9ab93fSMilanka Ringwald 4671bf7a74fSMilanka Ringwald static void avrcp_parser_process_byte(uint8_t byte, avrcp_connection_t * connection, avrcp_command_type_t ctype){ 468836408dfSMatthias Ringwald uint16_t attribute_total_value_len; 469836408dfSMatthias Ringwald uint32_t attribute_id; 4701bf7a74fSMilanka Ringwald switch(connection->parser_state){ 471836408dfSMatthias Ringwald case AVRCP_PARSER_GET_ATTRIBUTE_HEADER: 4721bf7a74fSMilanka Ringwald connection->parser_attribute_header[connection->parser_attribute_header_pos++] = byte; 4731bf7a74fSMilanka Ringwald connection->list_offset++; 4749771e28cSMatthias Ringwald 4759771e28cSMatthias Ringwald if (connection->parser_attribute_header_pos < AVRCP_ATTRIBUTE_HEADER_LEN) return; 4769771e28cSMatthias Ringwald 477836408dfSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 478aeb99916SMilanka Ringwald connection->attribute_value_len = btstack_min(attribute_total_value_len, AVRCP_MAX_ATTRIBUTE_SIZE); 4799771e28cSMatthias Ringwald if (connection->attribute_value_len > 0){ 4809771e28cSMatthias Ringwald // get ready for attribute value 481836408dfSMatthias Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_VALUE; 482836408dfSMatthias Ringwald return; 4839771e28cSMatthias Ringwald } 4849771e28cSMatthias Ringwald 4859771e28cSMatthias Ringwald // emit empty attribute 4869771e28cSMatthias Ringwald attribute_id = big_endian_read_32(connection->parser_attribute_header, 0); 487dfbbc26bSMatthias Ringwald avrcp_controller_emit_now_playing_info_event(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, (avrcp_media_attribute_id_t) attribute_id, connection->attribute_value, connection->attribute_value_len); 4889771e28cSMatthias Ringwald 4899771e28cSMatthias Ringwald // done, see below 4909771e28cSMatthias Ringwald break; 491836408dfSMatthias Ringwald 492836408dfSMatthias Ringwald case AVRCP_PARSER_GET_ATTRIBUTE_VALUE: 4931bf7a74fSMilanka Ringwald connection->attribute_value[connection->attribute_value_offset++] = byte; 4941bf7a74fSMilanka Ringwald connection->list_offset++; 4959771e28cSMatthias Ringwald 4969771e28cSMatthias Ringwald if (connection->attribute_value_offset < connection->attribute_value_len) return; 4978b2b4034SMilanka Ringwald 498836408dfSMatthias Ringwald // emit (potentially partial) attribute 499836408dfSMatthias Ringwald attribute_id = big_endian_read_32(connection->parser_attribute_header, 0); 500dfbbc26bSMatthias Ringwald avrcp_controller_emit_now_playing_info_event(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, (avrcp_media_attribute_id_t) attribute_id, connection->attribute_value, connection->attribute_value_len); 5011bf7a74fSMilanka Ringwald 502836408dfSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 503836408dfSMatthias Ringwald if (connection->attribute_value_offset < attribute_total_value_len){ 5049771e28cSMatthias Ringwald // ignore rest of attribute 50514e95846SMilanka Ringwald connection->parser_state = AVRCP_PARSER_IGNORE_REST_OF_ATTRIBUTE_VALUE; 506836408dfSMatthias Ringwald return; 5071bf7a74fSMilanka Ringwald } 5089771e28cSMatthias Ringwald 5099771e28cSMatthias Ringwald // done, see below 510836408dfSMatthias Ringwald break; 5111bf7a74fSMilanka Ringwald 51214e95846SMilanka Ringwald case AVRCP_PARSER_IGNORE_REST_OF_ATTRIBUTE_VALUE: 5131bf7a74fSMilanka Ringwald connection->attribute_value_offset++; 5149771e28cSMatthias Ringwald connection->list_offset++; 5159771e28cSMatthias Ringwald 5169771e28cSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 5179771e28cSMatthias Ringwald if (connection->attribute_value_offset < attribute_total_value_len) return; 5189771e28cSMatthias Ringwald 5199771e28cSMatthias Ringwald // done, see below 520836408dfSMatthias Ringwald break; 5211bf7a74fSMilanka Ringwald 522836408dfSMatthias Ringwald default: 523836408dfSMatthias Ringwald return; 5241bf7a74fSMilanka Ringwald } 525836408dfSMatthias Ringwald 526836408dfSMatthias Ringwald // attribute fully read, check if more to come 527836408dfSMatthias Ringwald if (connection->list_offset < connection->list_size){ 5289771e28cSMatthias Ringwald // more to come, reset parser 5291bf7a74fSMilanka Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_HEADER; 5301bf7a74fSMilanka Ringwald connection->parser_attribute_header_pos = 0; 5311c7ac872SMatthias Ringwald connection->attribute_value_offset = 0; 532836408dfSMatthias Ringwald } else { 533836408dfSMatthias Ringwald // fully done 534836408dfSMatthias Ringwald avrcp_parser_reset(connection); 535836408dfSMatthias Ringwald avrcp_controller_emit_now_playing_info_event_done(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, 0); 5361bf7a74fSMilanka Ringwald } 5371bf7a74fSMilanka Ringwald } 5381bf7a74fSMilanka Ringwald 5393d9ab93fSMilanka Ringwald static void avrcp_controller_parse_and_emit_element_attrs(uint8_t * packet, uint16_t num_bytes_to_read, avrcp_connection_t * connection, avrcp_command_type_t ctype){ 5401bf7a74fSMilanka Ringwald int i; 5411bf7a74fSMilanka Ringwald for (i=0;i<num_bytes_to_read;i++){ 5421bf7a74fSMilanka Ringwald avrcp_parser_process_byte(packet[i], connection, ctype); 5431bf7a74fSMilanka Ringwald } 5441bf7a74fSMilanka Ringwald } 5451bf7a74fSMilanka Ringwald 5464a23d858SMilanka Ringwald static void avrcp_send_cmd_with_avctp_fragmentation(avrcp_connection_t * connection){ 54762434ba8SMilanka Ringwald l2cap_reserve_packet_buffer(); 54862434ba8SMilanka Ringwald uint8_t * command = l2cap_get_outgoing_buffer(); 5494a23d858SMilanka Ringwald 5504d7cf390SMilanka Ringwald uint16_t max_payload_size; 5514d7cf390SMilanka Ringwald avctp_packet_type_t avctp_packet_type = avctp_get_packet_type(connection, &max_payload_size); 5524a23d858SMilanka Ringwald 5533d9ab93fSMilanka Ringwald // non-fragmented: transport header (1) + PID (2) 5543d9ab93fSMilanka Ringwald // fragmented: transport header (1) + num packets (1) + PID (2) 5553d9ab93fSMilanka Ringwald 5564a23d858SMilanka Ringwald // AVCTP header 5573d9ab93fSMilanka Ringwald // transport header : transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier) 5584a23d858SMilanka Ringwald uint16_t pos = 0; 559ecb2ff93SMilanka Ringwald command[pos++] = (connection->transaction_id << 4) | (avctp_packet_type << 2) | (AVRCP_COMMAND_FRAME << 1) | 0; 5603d9ab93fSMilanka Ringwald 5614a23d858SMilanka Ringwald switch (avctp_packet_type){ 5624a23d858SMilanka Ringwald case AVCTP_SINGLE_PACKET: 5634a23d858SMilanka Ringwald case AVCTP_START_PACKET: 564ecb2ff93SMilanka Ringwald if (avctp_packet_type == AVCTP_START_PACKET){ 5654d7cf390SMilanka Ringwald // num packets 5664d7cf390SMilanka Ringwald command[pos++] = ((connection->data_len + max_payload_size - 1) / max_payload_size); 5673d9ab93fSMilanka Ringwald } 5683a19cf32SMilanka Ringwald 5693d9ab93fSMilanka Ringwald // Profile IDentifier (PID) 5703d9ab93fSMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 5713d9ab93fSMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 5723d9ab93fSMilanka Ringwald 5733d9ab93fSMilanka Ringwald // command_type 5743d9ab93fSMilanka Ringwald command[pos++] = connection->command_type; 5753d9ab93fSMilanka Ringwald // subunit_type | subunit ID 5763d9ab93fSMilanka Ringwald command[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 5773d9ab93fSMilanka Ringwald // opcode 5783d9ab93fSMilanka Ringwald command[pos++] = (uint8_t)connection->command_opcode; 5794a23d858SMilanka Ringwald 5804a23d858SMilanka Ringwald switch (connection->command_opcode){ 5814a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT: 5824a23d858SMilanka Ringwald big_endian_store_24(command, pos, connection->company_id); 5834a23d858SMilanka Ringwald pos += 3; 5844a23d858SMilanka Ringwald command[pos++] = connection->pdu_id; 5854a23d858SMilanka Ringwald command[pos++] = 0; // reserved(upper 6) | packet_type -> 0 5864a23d858SMilanka Ringwald big_endian_store_16(command, pos, connection->data_len); // parameter length 5874a23d858SMilanka Ringwald pos += 2; 5884a23d858SMilanka Ringwald break; 5894a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_PASS_THROUGH: 5904a23d858SMilanka Ringwald command[pos++] = connection->operation_id; 5914a23d858SMilanka Ringwald command[pos++] = (uint8_t)connection->data_len; // parameter length 5924a23d858SMilanka Ringwald pos += 2; 5934a23d858SMilanka Ringwald break; 5944a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_UNIT_INFO: 5954a23d858SMilanka Ringwald break; 5964a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_SUBUNIT_INFO: 5974a23d858SMilanka Ringwald break; 5984a23d858SMilanka Ringwald default: 5994a23d858SMilanka Ringwald btstack_assert(false); 6004a23d858SMilanka Ringwald return; 6014a23d858SMilanka Ringwald } 6024a23d858SMilanka Ringwald break; 6034a23d858SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 6044a23d858SMilanka Ringwald case AVCTP_END_PACKET: 6054a23d858SMilanka Ringwald break; 6064a23d858SMilanka Ringwald default: 6074a23d858SMilanka Ringwald btstack_assert(false); 6084a23d858SMilanka Ringwald return; 6093d9ab93fSMilanka Ringwald } 61066b242bbSMilanka Ringwald // compare number of bytes to store with the remaining buffer size 6114d7cf390SMilanka Ringwald uint16_t bytes_to_copy = btstack_min(connection->data_len - connection->data_offset, max_payload_size - pos); 6124a23d858SMilanka Ringwald 6134a23d858SMilanka Ringwald (void)memcpy(command + pos, &connection->data[connection->data_offset], bytes_to_copy); 6143d9ab93fSMilanka Ringwald pos += bytes_to_copy; 6154a23d858SMilanka Ringwald connection->data_offset += bytes_to_copy; 6163d9ab93fSMilanka Ringwald 6174a23d858SMilanka Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 6183d9ab93fSMilanka Ringwald } 6193d9ab93fSMilanka Ringwald 6204701e250SMilanka Ringwald static int avrcp_send_register_notification(avrcp_connection_t * connection, uint8_t event_id){ 6214701e250SMilanka Ringwald uint8_t command[18]; 6224701e250SMilanka Ringwald uint16_t pos = 0; 6234701e250SMilanka Ringwald // transport header : transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier) 624022b77fcSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 625022b77fcSMilanka Ringwald command[pos++] = (connection->transaction_id << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_COMMAND_FRAME << 1) | 0; 6264701e250SMilanka Ringwald 6274701e250SMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 6284701e250SMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 6294701e250SMilanka Ringwald command[pos++] = AVRCP_CTYPE_NOTIFY; 6304701e250SMilanka Ringwald command[pos++] = (AVRCP_SUBUNIT_TYPE_PANEL << 3) | AVRCP_SUBUNIT_ID; 6314701e250SMilanka Ringwald command[pos++] = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 6324701e250SMilanka Ringwald 6334701e250SMilanka Ringwald big_endian_store_24(command, pos, BT_SIG_COMPANY_ID); 6344701e250SMilanka Ringwald pos += 3; 6354701e250SMilanka Ringwald command[pos++] = AVRCP_PDU_ID_REGISTER_NOTIFICATION; 6364701e250SMilanka Ringwald command[pos++] = 0; // reserved(upper 6) | packet_type -> 0 6374701e250SMilanka Ringwald big_endian_store_16(command, pos, 5); // parameter length 6384701e250SMilanka Ringwald pos += 2; 6394701e250SMilanka Ringwald command[pos++] = event_id; 6404701e250SMilanka Ringwald big_endian_store_32(command, pos, 1); // send notification on playback position every second, for other notifications it is ignored 6414701e250SMilanka Ringwald pos += 4; 6424701e250SMilanka Ringwald return l2cap_send(connection->l2cap_signaling_cid, command, pos); 6434701e250SMilanka Ringwald } 6444701e250SMilanka Ringwald 6453d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timeout_handler(btstack_timer_source_t * timer){ 6463d9ab93fSMilanka Ringwald UNUSED(timer); 6473d9ab93fSMilanka Ringwald avrcp_connection_t * connection = (avrcp_connection_t*) btstack_run_loop_get_timer_context(timer); 648393f5724SMilanka Ringwald btstack_run_loop_set_timer(&connection->controller_press_and_hold_cmd_timer, 2000); // 2 seconds timeout 649393f5724SMilanka Ringwald btstack_run_loop_add_timer(&connection->controller_press_and_hold_cmd_timer); 6503d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_PRESS_COMMAND; 6513d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 6523d9ab93fSMilanka Ringwald } 6533d9ab93fSMilanka Ringwald 6543d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timer_start(avrcp_connection_t * connection){ 655393f5724SMilanka Ringwald btstack_run_loop_remove_timer(&connection->controller_press_and_hold_cmd_timer); 656393f5724SMilanka Ringwald btstack_run_loop_set_timer_handler(&connection->controller_press_and_hold_cmd_timer, avrcp_press_and_hold_timeout_handler); 657393f5724SMilanka Ringwald btstack_run_loop_set_timer_context(&connection->controller_press_and_hold_cmd_timer, connection); 658393f5724SMilanka Ringwald btstack_run_loop_set_timer(&connection->controller_press_and_hold_cmd_timer, 2000); // 2 seconds timeout 659393f5724SMilanka Ringwald btstack_run_loop_add_timer(&connection->controller_press_and_hold_cmd_timer); 6603d9ab93fSMilanka Ringwald } 6613d9ab93fSMilanka Ringwald 6623d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timer_stop(avrcp_connection_t * connection){ 663393f5724SMilanka Ringwald connection->controller_press_and_hold_cmd_active = false; 664393f5724SMilanka Ringwald btstack_run_loop_remove_timer(&connection->controller_press_and_hold_cmd_timer); 6653d9ab93fSMilanka Ringwald } 6663d9ab93fSMilanka Ringwald 6673d9ab93fSMilanka Ringwald 6683d9ab93fSMilanka Ringwald static uint8_t avrcp_controller_request_pass_through_release_control_cmd(avrcp_connection_t * connection){ 6693d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 670393f5724SMilanka Ringwald if (connection->controller_press_and_hold_cmd_active){ 6713d9ab93fSMilanka Ringwald avrcp_press_and_hold_timer_stop(connection); 6723d9ab93fSMilanka Ringwald } 673ccfcd81eSMilanka Ringwald connection->operation_id = (avrcp_operation_id_t)(0x80 | connection->operation_id); 674022b77fcSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 6753d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 6763d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 6773d9ab93fSMilanka Ringwald } 6783d9ab93fSMilanka Ringwald 679b623cfebSMilanka Ringwald static uint8_t avrcp_controller_request_pass_through_press_control_cmd(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint16_t playback_speed, bool continuous_cmd){ 6803d9ab93fSMilanka Ringwald log_info("Send command %d", opid); 6813d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 6823d9ab93fSMilanka Ringwald if (!connection){ 6833d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 6843d9ab93fSMilanka Ringwald } 6853d9ab93fSMilanka Ringwald 6863d9ab93fSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 6873d9ab93fSMilanka Ringwald log_error("Connection in wrong state %d, expected %d. avrcp cid 0x%02x", connection->state, AVCTP_CONNECTION_OPENED, avrcp_cid); 6883d9ab93fSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 6893d9ab93fSMilanka Ringwald } 6903d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_PRESS_COMMAND; 69166b242bbSMilanka Ringwald avrcp_controller_pass_through_command_data_init(connection, opid); 6923d9ab93fSMilanka Ringwald 6933d9ab93fSMilanka Ringwald if (playback_speed > 0){ 6945d3671d9SMilanka Ringwald connection->data[0] = playback_speed; 6955d3671d9SMilanka Ringwald connection->data_len = 1; 6963d9ab93fSMilanka Ringwald } 6973d9ab93fSMilanka Ringwald 698393f5724SMilanka Ringwald connection->controller_press_and_hold_cmd_active = continuous_cmd; 699393f5724SMilanka Ringwald if (connection->controller_press_and_hold_cmd_active){ 7003d9ab93fSMilanka Ringwald avrcp_press_and_hold_timer_start(connection); 7013d9ab93fSMilanka Ringwald } 7023d9ab93fSMilanka Ringwald 7033d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 7043d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 7053d9ab93fSMilanka Ringwald } 7063d9ab93fSMilanka Ringwald 7073d9ab93fSMilanka Ringwald static uint8_t request_single_pass_through_press_control_cmd(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint16_t playback_speed){ 7080c436f0bSMatthias Ringwald return avrcp_controller_request_pass_through_press_control_cmd(avrcp_cid, opid, playback_speed, false); 7093d9ab93fSMilanka Ringwald } 7103d9ab93fSMilanka Ringwald 7113d9ab93fSMilanka Ringwald static uint8_t request_continuous_pass_through_press_control_cmd(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint16_t playback_speed){ 7120c436f0bSMatthias Ringwald return avrcp_controller_request_pass_through_press_control_cmd(avrcp_cid, opid, playback_speed, true); 7133d9ab93fSMilanka Ringwald } 7143d9ab93fSMilanka Ringwald 715826b3cedSMilanka Ringwald static void avrcp_controller_get_capabilities_for_connection(avrcp_connection_t * connection, uint8_t capability_id){ 716826b3cedSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 71766b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_CAPABILITIES); 7188d316b1bSMilanka Ringwald 7195d3671d9SMilanka Ringwald // Parameter Length 7205d3671d9SMilanka Ringwald connection->data_len = 1; 7215d3671d9SMilanka Ringwald connection->data[0] = capability_id; // capability ID 7225d3671d9SMilanka Ringwald 723826b3cedSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 724826b3cedSMilanka Ringwald } 7252b8461f9SMilanka Ringwald 7262b8461f9SMilanka Ringwald static uint8_t avrcp_controller_register_notification(avrcp_connection_t * connection, avrcp_notification_event_id_t event_id){ 727393f5724SMilanka Ringwald if (connection->controller_notifications_supported_by_target_queried && (connection->notifications_supported_by_target & (1 << event_id)) == 0){ 7282b8461f9SMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 7292b8461f9SMilanka Ringwald } 730393f5724SMilanka Ringwald if ((connection->controller_notifications_to_deregister & (1 << event_id)) != 0){ 7312b8461f9SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 7322b8461f9SMilanka Ringwald } 7332b8461f9SMilanka Ringwald if ( (connection->notifications_enabled & (1 << event_id)) != 0){ 7342b8461f9SMilanka Ringwald return ERROR_CODE_SUCCESS; 7352b8461f9SMilanka Ringwald } 736393f5724SMilanka Ringwald connection->controller_notifications_to_register |= (1 << event_id); 7372ac1dc76SMilanka Ringwald 738393f5724SMilanka Ringwald if (!connection->controller_notifications_supported_by_target_queried){ 739393f5724SMilanka Ringwald connection->controller_notifications_supported_by_target_suppress_emit_result = true; 7402ac1dc76SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_EVENT); 7412ac1dc76SMilanka Ringwald return ERROR_CODE_SUCCESS; 7422ac1dc76SMilanka Ringwald } 7433d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 7442b8461f9SMilanka Ringwald return ERROR_CODE_SUCCESS; 7453d9ab93fSMilanka Ringwald } 7463d9ab93fSMilanka Ringwald 7475d3671d9SMilanka Ringwald static uint8_t avrcp_controller_request_continuation(avrcp_connection_t * connection, avrcp_pdu_id_t pdu_id){ 7481bf7a74fSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 74966b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, pdu_id); 7508d316b1bSMilanka Ringwald 7511bf7a74fSMilanka Ringwald // Parameter Length 7525d3671d9SMilanka Ringwald connection->data_len = 3; 7535d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 0, 1); 7545d3671d9SMilanka Ringwald connection->data[2] = AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES; 7555d3671d9SMilanka Ringwald 7561bf7a74fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 7571bf7a74fSMilanka Ringwald return ERROR_CODE_SUCCESS; 7581bf7a74fSMilanka Ringwald } 7591bf7a74fSMilanka Ringwald 7605d3671d9SMilanka Ringwald static uint8_t avrcp_controller_request_abort_continuation(avrcp_connection_t * connection){ 7615d3671d9SMilanka Ringwald return avrcp_controller_request_continuation(connection, AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE); 7625d3671d9SMilanka Ringwald } 7631bf7a74fSMilanka Ringwald 7641bf7a74fSMilanka Ringwald static uint8_t avrcp_controller_request_continue_response(avrcp_connection_t * connection){ 7655d3671d9SMilanka Ringwald return avrcp_controller_request_continuation(connection, AVRCP_PDU_ID_REQUEST_CONTINUING_RESPONSE); 7661bf7a74fSMilanka Ringwald } 7671bf7a74fSMilanka Ringwald 768737e7617SMilanka Ringwald static void avrcp_controller_handle_notification(avrcp_connection_t *connection, avrcp_command_type_t ctype, uint8_t *payload, uint16_t size) { 76999702381SMatthias Ringwald if (size < 1) return; 7704701e250SMilanka Ringwald uint16_t pos = 0; 7714701e250SMilanka Ringwald avrcp_notification_event_id_t event_id = (avrcp_notification_event_id_t) payload[pos++]; 772eebb600bSMilanka Ringwald if ( (event_id < AVRCP_NOTIFICATION_EVENT_FIRST_INDEX) || (event_id > AVRCP_NOTIFICATION_EVENT_LAST_INDEX)){ 773eebb600bSMilanka Ringwald return; 774eebb600bSMilanka Ringwald } 775eebb600bSMilanka Ringwald 7764701e250SMilanka Ringwald uint16_t event_mask = (1 << event_id); 7774701e250SMilanka Ringwald uint16_t reset_event_mask = ~event_mask; 778dac572e6SMilanka Ringwald 7794701e250SMilanka Ringwald switch (ctype){ 7807229b758SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_REJECTED: 781393f5724SMilanka Ringwald connection->controller_notifications_to_deregister &= reset_event_mask; 782393f5724SMilanka Ringwald connection->controller_notifications_to_register &= reset_event_mask; 783393f5724SMilanka Ringwald connection->controller_initial_status_reported &= reset_event_mask; 7847229b758SMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE, event_id, false); 7857229b758SMilanka Ringwald return; 7867229b758SMilanka Ringwald 7874701e250SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_INTERIM: 7884701e250SMilanka Ringwald // register as enabled 7894701e250SMilanka Ringwald connection->notifications_enabled |= event_mask; 790bc3843bfSMilanka Ringwald 791bce3db21SMilanka Ringwald // check if initial value is already sent 792393f5724SMilanka Ringwald if ((connection->controller_initial_status_reported & event_mask) != 0 ){ 793dac572e6SMilanka Ringwald return; 794dac572e6SMilanka Ringwald } 795bc3843bfSMilanka Ringwald // emit event only once, initially 796b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_SUCCESS, event_id, true); 797393f5724SMilanka Ringwald connection->controller_initial_status_reported |= event_mask; 7987229b758SMilanka Ringwald // emit initial value after this switch 7994701e250SMilanka Ringwald break; 8007229b758SMilanka Ringwald 8014701e250SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_CHANGED_STABLE: 802bce3db21SMilanka Ringwald // received change, event is considered de-registered 8034701e250SMilanka Ringwald // we are re-enabling it automatically, if it is not 8044701e250SMilanka Ringwald // explicitly disabled 8054701e250SMilanka Ringwald connection->notifications_enabled &= reset_event_mask; 806393f5724SMilanka Ringwald if ((connection->controller_notifications_to_deregister & event_mask) == 0){ 8074701e250SMilanka Ringwald avrcp_controller_register_notification(connection, event_id); 8084701e250SMilanka Ringwald } else { 809393f5724SMilanka Ringwald connection->controller_notifications_to_deregister &= reset_event_mask; 810393f5724SMilanka Ringwald connection->controller_notifications_to_register &= reset_event_mask; 811393f5724SMilanka Ringwald connection->controller_initial_status_reported &= reset_event_mask; 812b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_SUCCESS, event_id, false); 8134701e250SMilanka Ringwald } 8144701e250SMilanka Ringwald break; 8157229b758SMilanka Ringwald 8164701e250SMilanka Ringwald default: 81766ec1603SMilanka Ringwald return; 8184701e250SMilanka Ringwald } 8194701e250SMilanka Ringwald 82099702381SMatthias Ringwald avrcp_controller_emit_notification_for_event_id(connection->avrcp_cid, event_id, ctype, payload + pos, size - pos); 8214701e250SMilanka Ringwald } 8224701e250SMilanka Ringwald 823c3b8c0a2SMilanka Ringwald #ifdef ENABLE_AVCTP_FRAGMENTATION 824c3b8c0a2SMilanka Ringwald static void avctp_reassemble_message(avrcp_connection_t * connection, avctp_packet_type_t packet_type, uint8_t *packet, uint16_t size){ 825c3b8c0a2SMilanka Ringwald // after header (transaction label and packet type) 826c3b8c0a2SMilanka Ringwald uint16_t pos; 827c3b8c0a2SMilanka Ringwald uint16_t bytes_to_store; 828c3b8c0a2SMilanka Ringwald 829c3b8c0a2SMilanka Ringwald switch (packet_type){ 830c3b8c0a2SMilanka Ringwald case AVCTP_START_PACKET: 831c3b8c0a2SMilanka Ringwald if (size < 2) return; 832c3b8c0a2SMilanka Ringwald 833c3b8c0a2SMilanka Ringwald // store header 834c3b8c0a2SMilanka Ringwald pos = 0; 835c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_buffer[pos] = packet[pos]; 836c3b8c0a2SMilanka Ringwald pos++; 837c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size = pos; 838c3b8c0a2SMilanka Ringwald 839c3b8c0a2SMilanka Ringwald // NOTE: num packets not needed for reassembly, ignoring it does not pose security risk -> no need to store it 840c3b8c0a2SMilanka Ringwald pos++; 841c3b8c0a2SMilanka Ringwald 842c3b8c0a2SMilanka Ringwald // PID in reassembled packet is at offset 1, it will be read later after the avctp_reassemble_message with AVCTP_END_PACKET is called 843c3b8c0a2SMilanka Ringwald 844c3b8c0a2SMilanka Ringwald bytes_to_store = btstack_min(size - pos, sizeof(connection->avctp_reassembly_buffer) - connection->avctp_reassembly_size); 845c3b8c0a2SMilanka Ringwald memcpy(&connection->avctp_reassembly_buffer[connection->avctp_reassembly_size], &packet[pos], bytes_to_store); 846c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size += bytes_to_store; 847c3b8c0a2SMilanka Ringwald break; 848c3b8c0a2SMilanka Ringwald 849c3b8c0a2SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 850c3b8c0a2SMilanka Ringwald case AVCTP_END_PACKET: 851c3b8c0a2SMilanka Ringwald if (size < 1) return; 852c3b8c0a2SMilanka Ringwald 853c3b8c0a2SMilanka Ringwald // store remaining data, ignore header 854c3b8c0a2SMilanka Ringwald pos = 1; 855c3b8c0a2SMilanka Ringwald bytes_to_store = btstack_min(size - pos, sizeof(connection->avctp_reassembly_buffer) - connection->avctp_reassembly_size); 856c3b8c0a2SMilanka Ringwald memcpy(&connection->avctp_reassembly_buffer[connection->avctp_reassembly_size], &packet[pos], bytes_to_store); 857c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size += bytes_to_store; 858c3b8c0a2SMilanka Ringwald break; 859c3b8c0a2SMilanka Ringwald 860c3b8c0a2SMilanka Ringwald default: 861c3b8c0a2SMilanka Ringwald return; 862c3b8c0a2SMilanka Ringwald } 863c3b8c0a2SMilanka Ringwald } 864c3b8c0a2SMilanka Ringwald #endif 865c3b8c0a2SMilanka Ringwald 8666983e65eSMilanka Ringwald static void avrcp_handle_l2cap_data_packet_for_signaling_connection(avrcp_connection_t * connection, uint8_t *packet, uint16_t size){ 867697b823eSMatthias Ringwald if (size < 6u) return; 8683acd1f1cSMilanka Ringwald uint8_t pdu_id; 869c3b8c0a2SMilanka Ringwald avrcp_packet_type_t vendor_dependent_packet_type; 8703acd1f1cSMilanka Ringwald 871c3b8c0a2SMilanka Ringwald uint16_t pos = 0; 872393f5724SMilanka Ringwald connection->controller_last_confirmed_transaction_id = packet[pos] >> 4; 873c3b8c0a2SMilanka Ringwald avrcp_frame_type_t frame_type = (avrcp_frame_type_t)((packet[pos] >> 1) & 0x01); 874c3b8c0a2SMilanka Ringwald avctp_packet_type_t packet_type = (avctp_packet_type_t)((packet[pos] >> 2) & 0x03); 875c3b8c0a2SMilanka Ringwald pos++; 8766e7485d0SMilanka Ringwald 8773acd1f1cSMilanka Ringwald if (frame_type != AVRCP_RESPONSE_FRAME) return; 8783acd1f1cSMilanka Ringwald 8793acd1f1cSMilanka Ringwald switch (packet_type){ 880c3b8c0a2SMilanka Ringwald case AVCTP_SINGLE_PACKET: 8813acd1f1cSMilanka Ringwald break; 882c3b8c0a2SMilanka Ringwald 883c3b8c0a2SMilanka Ringwald #ifdef ENABLE_AVCTP_FRAGMENTATION 884c3b8c0a2SMilanka Ringwald case AVCTP_START_PACKET: 885c3b8c0a2SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 886c3b8c0a2SMilanka Ringwald avctp_reassemble_message(connection, packet_type, packet, size); 887c3b8c0a2SMilanka Ringwald return; 888c3b8c0a2SMilanka Ringwald 889c3b8c0a2SMilanka Ringwald case AVCTP_END_PACKET: 890c3b8c0a2SMilanka Ringwald avctp_reassemble_message(connection, packet_type, packet, size); 891c3b8c0a2SMilanka Ringwald 892c3b8c0a2SMilanka Ringwald packet = connection->avctp_reassembly_buffer; 893c3b8c0a2SMilanka Ringwald size = connection->avctp_reassembly_size; 894c3b8c0a2SMilanka Ringwald break; 895c3b8c0a2SMilanka Ringwald #endif 896c3b8c0a2SMilanka Ringwald 8973acd1f1cSMilanka Ringwald default: 8983acd1f1cSMilanka Ringwald return; 8993acd1f1cSMilanka Ringwald } 9003acd1f1cSMilanka Ringwald 901c3b8c0a2SMilanka Ringwald pos += 2; // PID 902c3b8c0a2SMilanka Ringwald 9036983e65eSMilanka Ringwald avrcp_command_type_t ctype = (avrcp_command_type_t) packet[pos++]; 9043acd1f1cSMilanka Ringwald 905e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 906e0d13a19SMilanka Ringwald uint8_t byte_value = packet[pos]; 9076983e65eSMilanka Ringwald avrcp_subunit_type_t subunit_type = (avrcp_subunit_type_t) (byte_value >> 3); 9086983e65eSMilanka Ringwald avrcp_subunit_type_t subunit_id = (avrcp_subunit_type_t) (byte_value & 0x07); 909e0d13a19SMilanka Ringwald #endif 910e0d13a19SMilanka Ringwald pos++; 9116983e65eSMilanka Ringwald 912e0d13a19SMilanka Ringwald uint8_t opcode = packet[pos++]; 9136983e65eSMilanka Ringwald uint16_t param_length; 9143acd1f1cSMilanka Ringwald 9153acd1f1cSMilanka Ringwald switch (opcode){ 916ad75da14SMilanka Ringwald case AVRCP_CMD_OPCODE_SUBUNIT_INFO:{ 917ad75da14SMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE) return; 918ad75da14SMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 919e0d13a19SMilanka Ringwald 920e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 92199845bb7SMilanka Ringwald // page, extension code (1) 922e33c5309SMilanka Ringwald pos++; 923e33c5309SMilanka Ringwald uint8_t unit_type = packet[pos] >> 3; 924e33c5309SMilanka Ringwald uint8_t max_subunit_ID = packet[pos] & 0x07; 925393f5724SMilanka Ringwald log_info("SUBUNIT INFO response: ctype 0x%02x (0C), subunit_type 0x%02x (1F), subunit_id 0x%02x (07), opcode 0x%02x (30), target_unit_type 0x%02x, max_subunit_ID %d", ctype, subunit_type, subunit_id, opcode, unit_type, max_subunit_ID); 926e0d13a19SMilanka Ringwald #endif 927ad75da14SMilanka Ringwald break; 928ad75da14SMilanka Ringwald } 9296983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_UNIT_INFO:{ 9306983e65eSMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE) return; 9316983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 932e0d13a19SMilanka Ringwald 933e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 934e33c5309SMilanka Ringwald // byte value 7 (1) 935e33c5309SMilanka Ringwald pos++; 936e33c5309SMilanka Ringwald uint8_t unit_type = packet[pos] >> 3; 937e33c5309SMilanka Ringwald uint8_t unit = packet[pos] & 0x07; 938e33c5309SMilanka Ringwald pos++; 939e33c5309SMilanka Ringwald uint32_t company_id = big_endian_read_24(packet, pos); 940393f5724SMilanka Ringwald log_info("UNIT INFO response: ctype 0x%02x (0C), subunit_type 0x%02x (1F), subunit_id 0x%02x (07), opcode 0x%02x (30), target_unit_type 0x%02x, unit %d, company_id 0x%06" PRIx32, 9416983e65eSMilanka Ringwald ctype, subunit_type, subunit_id, opcode, unit_type, unit, company_id); 942e0d13a19SMilanka Ringwald #endif 9436983e65eSMilanka Ringwald break; 9446983e65eSMilanka Ringwald } 9456983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT: 94699702381SMatthias Ringwald 94799702381SMatthias Ringwald if ((size - pos) < 7) return; 94899702381SMatthias Ringwald 949e33c5309SMilanka Ringwald // Company ID (3) 950e33c5309SMilanka Ringwald pos += 3; 951e33c5309SMilanka Ringwald pdu_id = packet[pos++]; 95261920526SMilanka Ringwald vendor_dependent_packet_type = (avrcp_packet_type_t)(packet[pos++] & 0x03); 953e33c5309SMilanka Ringwald param_length = big_endian_read_16(packet, pos); 954e33c5309SMilanka Ringwald pos += 2; 955e33c5309SMilanka Ringwald 95699702381SMatthias Ringwald if ((size - pos) < param_length) return; 9576983e65eSMilanka Ringwald 9584701e250SMilanka Ringwald // handle asynchronous notifications, without changing state 9594701e250SMilanka Ringwald if (pdu_id == AVRCP_PDU_ID_REGISTER_NOTIFICATION){ 960737e7617SMilanka Ringwald avrcp_controller_handle_notification(connection, ctype, packet + pos, size - pos); 9614701e250SMilanka Ringwald break; 9624701e250SMilanka Ringwald } 9634701e250SMilanka Ringwald 9644701e250SMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE){ 9656983e65eSMilanka Ringwald log_info("AVRCP_CMD_OPCODE_VENDOR_DEPENDENT state %d", connection->state); 9666983e65eSMilanka Ringwald return; 9676983e65eSMilanka Ringwald } 9686983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 9696983e65eSMilanka Ringwald 9706983e65eSMilanka Ringwald log_info("VENDOR DEPENDENT response: pdu id 0x%02x, param_length %d, status %s", pdu_id, param_length, avrcp_ctype2str(ctype)); 9716983e65eSMilanka Ringwald switch (pdu_id){ 97208485fc4SMilanka Ringwald case AVRCP_PDU_ID_GET_CURRENT_PLAYER_APPLICATION_SETTING_VALUE:{ 9736983e65eSMilanka Ringwald uint8_t num_attributes = packet[pos++]; 9746983e65eSMilanka Ringwald int i; 9756983e65eSMilanka Ringwald avrcp_repeat_mode_t repeat_mode = AVRCP_REPEAT_MODE_INVALID; 9766983e65eSMilanka Ringwald avrcp_shuffle_mode_t shuffle_mode = AVRCP_SHUFFLE_MODE_INVALID; 9776983e65eSMilanka Ringwald for (i = 0; i < num_attributes; i++){ 9786983e65eSMilanka Ringwald uint8_t attribute_id = packet[pos++]; 9796983e65eSMilanka Ringwald uint8_t value = packet[pos++]; 9806983e65eSMilanka Ringwald switch (attribute_id){ 9816983e65eSMilanka Ringwald case 0x02: 9826983e65eSMilanka Ringwald repeat_mode = (avrcp_repeat_mode_t) value; 9836983e65eSMilanka Ringwald break; 9846983e65eSMilanka Ringwald case 0x03: 9856983e65eSMilanka Ringwald shuffle_mode = (avrcp_shuffle_mode_t) value; 9866983e65eSMilanka Ringwald break; 9876983e65eSMilanka Ringwald default: 9886983e65eSMilanka Ringwald break; 9896983e65eSMilanka Ringwald } 9906983e65eSMilanka Ringwald } 9913d9ab93fSMilanka Ringwald avrcp_controller_emit_repeat_and_shuffle_mode(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, repeat_mode, shuffle_mode); 9926983e65eSMilanka Ringwald break; 9936983e65eSMilanka Ringwald } 99416dc7cb4SMilanka Ringwald 99508485fc4SMilanka Ringwald case AVRCP_PDU_ID_SET_PLAYER_APPLICATION_SETTING_VALUE:{ 9965509e888SMatthias Ringwald uint16_t offset = 0; 9976983e65eSMilanka Ringwald uint8_t event[6]; 9986983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 9996983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 10006983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_PLAYER_APPLICATION_VALUE_RESPONSE; 10016983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10026983e65eSMilanka Ringwald offset += 2; 10036983e65eSMilanka Ringwald event[offset++] = ctype; 10046983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 10056983e65eSMilanka Ringwald break; 10066983e65eSMilanka Ringwald } 100716dc7cb4SMilanka Ringwald 10086983e65eSMilanka Ringwald case AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME:{ 10095509e888SMatthias Ringwald uint16_t offset = 0; 10106983e65eSMilanka Ringwald uint8_t event[7]; 10116983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10126983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 10136983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_SET_ABSOLUTE_VOLUME_RESPONSE; 10146983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10156983e65eSMilanka Ringwald offset += 2; 10166983e65eSMilanka Ringwald event[offset++] = ctype; 10176983e65eSMilanka Ringwald event[offset++] = packet[pos++]; 10186983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 10196983e65eSMilanka Ringwald break; 10206983e65eSMilanka Ringwald } 102116dc7cb4SMilanka Ringwald 10226983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_CAPABILITIES:{ 10236983e65eSMilanka Ringwald avrcp_capability_id_t capability_id = (avrcp_capability_id_t) packet[pos++]; 1024cb925874SMatthias Ringwald uint8_t capability_count = 0; 1025cb925874SMatthias Ringwald if (param_length > 1){ 1026cb925874SMatthias Ringwald capability_count = packet[pos++]; 1027cb925874SMatthias Ringwald } 10285509e888SMatthias Ringwald uint16_t i; 10295509e888SMatthias Ringwald uint16_t offset = 0; 10305509e888SMatthias Ringwald uint8_t event[10]; 10314f5eb797SMilanka Ringwald 10326983e65eSMilanka Ringwald switch (capability_id){ 10334f5eb797SMilanka Ringwald 10346983e65eSMilanka Ringwald case AVRCP_CAPABILITY_ID_COMPANY: 10353032b6e1SMilanka Ringwald for (i = 0; (i < capability_count) && ((size - pos) >= 3); i++){ 10366983e65eSMilanka Ringwald uint32_t company_id = big_endian_read_24(packet, pos); 10376983e65eSMilanka Ringwald pos += 3; 1038adaba9f3SMatthias Ringwald log_info(" 0x%06" PRIx32 ", ", company_id); 10394f5eb797SMilanka Ringwald 10404f5eb797SMilanka Ringwald offset = 0; 10414f5eb797SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10424f5eb797SMilanka Ringwald event[offset++] = sizeof(event) - 2; 10434f5eb797SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_GET_CAPABILITY_COMPANY_ID; 10444f5eb797SMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10454f5eb797SMilanka Ringwald offset += 2; 10464f5eb797SMilanka Ringwald event[offset++] = ctype; 10474f5eb797SMilanka Ringwald event[offset++] = 0; 10484f5eb797SMilanka Ringwald little_endian_store_24(event, offset, company_id); 10494f5eb797SMilanka Ringwald offset += 3; 10504f5eb797SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, offset); 10514f5eb797SMilanka Ringwald } 10524f5eb797SMilanka Ringwald 10534f5eb797SMilanka Ringwald offset = 0; 10544f5eb797SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10554f5eb797SMilanka Ringwald event[offset++] = sizeof(event) - 2; 10564f5eb797SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_GET_CAPABILITY_COMPANY_ID_DONE; 10574f5eb797SMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10584f5eb797SMilanka Ringwald offset += 2; 10594f5eb797SMilanka Ringwald event[offset++] = ctype; 10604f5eb797SMilanka Ringwald event[offset++] = 0; 10614f5eb797SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, offset); 10624f5eb797SMilanka Ringwald break; 10634f5eb797SMilanka Ringwald 10646983e65eSMilanka Ringwald case AVRCP_CAPABILITY_ID_EVENT: 10653032b6e1SMilanka Ringwald for (i = 0; (i < capability_count) && ((size - pos) >= 1); i++){ 10666983e65eSMilanka Ringwald uint8_t event_id = packet[pos++]; 1067393f5724SMilanka Ringwald connection->notifications_supported_by_target |= (1 << event_id); 10686983e65eSMilanka Ringwald } 1069274ca16fSMilanka Ringwald 1070274ca16fSMilanka Ringwald // if the get supported events query is triggered by avrcp_controller_enable_notification call, 1071274ca16fSMilanka Ringwald // avrcp_controller_emit_supported_events should be suppressed 1072393f5724SMilanka Ringwald if (connection->controller_notifications_supported_by_target_suppress_emit_result){ 1073393f5724SMilanka Ringwald connection->controller_notifications_supported_by_target_suppress_emit_result = false; 1074274ca16fSMilanka Ringwald // also, notification might not be supported 1075274ca16fSMilanka Ringwald // if so, emit AVRCP_SUBEVENT_ENABLE_NOTIFICATION_COMPLETE event to app, 1076393f5724SMilanka Ringwald // and update controller_notifications_to_register bitmap 1077274ca16fSMilanka Ringwald for (i = (uint8_t)AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; i < (uint8_t) AVRCP_NOTIFICATION_EVENT_LAST_INDEX; i++){ 1078393f5724SMilanka Ringwald if ((connection->controller_notifications_to_register & (1 << i)) != 0){ 1079393f5724SMilanka Ringwald if ((connection->notifications_supported_by_target & (1 << i)) == 0){ 1080b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE, i, false); 1081393f5724SMilanka Ringwald connection->controller_notifications_to_register &= ~(1 << i); 1082274ca16fSMilanka Ringwald } 1083274ca16fSMilanka Ringwald } 1084274ca16fSMilanka Ringwald } 10852ac1dc76SMilanka Ringwald break; 10862ac1dc76SMilanka Ringwald } 1087274ca16fSMilanka Ringwald // supported events are emitted only if the get supported events query 1088274ca16fSMilanka Ringwald // is triggered by avrcp_controller_get_supported_events call 1089ff243a1bSMilanka Ringwald avrcp_controller_emit_supported_events(connection); 10906983e65eSMilanka Ringwald break; 10917bbeb3adSMilanka Ringwald 10927bbeb3adSMilanka Ringwald default: 1093cb925874SMatthias Ringwald // ignore 10947bbeb3adSMilanka Ringwald break; 10956983e65eSMilanka Ringwald } 10966983e65eSMilanka Ringwald break; 10976983e65eSMilanka Ringwald } 109816dc7cb4SMilanka Ringwald 10996983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_PLAY_STATUS:{ 11006983e65eSMilanka Ringwald uint32_t song_length = big_endian_read_32(packet, pos); 11016983e65eSMilanka Ringwald pos += 4; 11026983e65eSMilanka Ringwald uint32_t song_position = big_endian_read_32(packet, pos); 11036983e65eSMilanka Ringwald pos += 4; 11046983e65eSMilanka Ringwald uint8_t play_status = packet[pos]; 11056983e65eSMilanka Ringwald 11066983e65eSMilanka Ringwald uint8_t event[15]; 11076983e65eSMilanka Ringwald int offset = 0; 11086983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 11096983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 11106983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_PLAY_STATUS; 11116983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 11126983e65eSMilanka Ringwald offset += 2; 11136983e65eSMilanka Ringwald event[offset++] = ctype; 11146983e65eSMilanka Ringwald little_endian_store_32(event, offset, song_length); 11156983e65eSMilanka Ringwald offset += 4; 11166983e65eSMilanka Ringwald little_endian_store_32(event, offset, song_position); 11176983e65eSMilanka Ringwald offset += 4; 11186983e65eSMilanka Ringwald event[offset++] = play_status; 11196983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 11206983e65eSMilanka Ringwald break; 11216983e65eSMilanka Ringwald } 11226983e65eSMilanka Ringwald 11236983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES:{ 11244d7cf390SMilanka Ringwald // TODO Review 112561920526SMilanka Ringwald switch (vendor_dependent_packet_type){ 11261bf7a74fSMilanka Ringwald case AVRCP_START_PACKET: 11271bf7a74fSMilanka Ringwald case AVRCP_SINGLE_PACKET: 11281bf7a74fSMilanka Ringwald avrcp_parser_reset(connection); 11291bf7a74fSMilanka Ringwald connection->list_size = param_length; 1130f3bb6622SMilanka Ringwald // num_attributes 1131f3bb6622SMilanka Ringwald pos++; 11328b2b4034SMilanka Ringwald 11333d9ab93fSMilanka Ringwald avrcp_controller_parse_and_emit_element_attrs(packet+pos, size-pos, connection, ctype); 113461920526SMilanka Ringwald if (vendor_dependent_packet_type == AVRCP_START_PACKET){ 11351bf7a74fSMilanka Ringwald avrcp_controller_request_continue_response(connection); 11366983e65eSMilanka Ringwald } 11376983e65eSMilanka Ringwald break; 11381bf7a74fSMilanka Ringwald case AVRCP_CONTINUE_PACKET: 11391bf7a74fSMilanka Ringwald case AVRCP_END_PACKET: 11403d73cc81SMilanka Ringwald connection->controller_num_received_fragments++; 114161920526SMilanka Ringwald 11423d73cc81SMilanka Ringwald if (connection->controller_num_received_fragments < connection->controller_max_num_fragments){ 11433d9ab93fSMilanka Ringwald avrcp_controller_parse_and_emit_element_attrs(packet+pos, size-pos, connection, ctype); 114461920526SMilanka Ringwald 114561920526SMilanka Ringwald if (vendor_dependent_packet_type == AVRCP_CONTINUE_PACKET){ 11468b2b4034SMilanka Ringwald avrcp_controller_request_continue_response(connection); 11478b2b4034SMilanka Ringwald } 11488b2b4034SMilanka Ringwald } else { 11498b2b4034SMilanka Ringwald avrcp_controller_emit_now_playing_info_event_done(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, 1); 11508b2b4034SMilanka Ringwald avrcp_parser_reset(connection); 115161920526SMilanka Ringwald avrcp_controller_request_abort_continuation(connection); 11528b2b4034SMilanka Ringwald } 11531bf7a74fSMilanka Ringwald break; 11547bbeb3adSMilanka Ringwald default: 11557bbeb3adSMilanka Ringwald // TODO check 11567bbeb3adSMilanka Ringwald btstack_assert(false); 11577bbeb3adSMilanka Ringwald break; 11581bf7a74fSMilanka Ringwald } 11596983e65eSMilanka Ringwald } 11606983e65eSMilanka Ringwald default: 1161176d21adSMilanka Ringwald // custom command response comes here 1162176d21adSMilanka Ringwald if (pdu_id == connection->pdu_id) { 1163176d21adSMilanka Ringwald uint8_t *in_place_buffer = packet + pos - 8; 1164176d21adSMilanka Ringwald avrcp_controller_prepare_custom_command_response(connection, param_length, 1165176d21adSMilanka Ringwald in_place_buffer); 1166176d21adSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, in_place_buffer, 1167176d21adSMilanka Ringwald param_length + 8); 1168176d21adSMilanka Ringwald } 11696983e65eSMilanka Ringwald break; 11706983e65eSMilanka Ringwald } 11716983e65eSMilanka Ringwald break; 11726983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_PASS_THROUGH:{ 117399702381SMatthias Ringwald if ((size - pos) < 1) return; 11746983e65eSMilanka Ringwald uint8_t operation_id = packet[pos++]; 11756983e65eSMilanka Ringwald switch (connection->state){ 11766983e65eSMilanka Ringwald case AVCTP_W2_RECEIVE_PRESS_RESPONSE: 1177a2e9e6d7SMilanka Ringwald // trigger release for simple command: 1178393f5724SMilanka Ringwald if (!connection->controller_press_and_hold_cmd_active){ 11796983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 1180a2e9e6d7SMilanka Ringwald break; 1181a2e9e6d7SMilanka Ringwald } 1182a2e9e6d7SMilanka Ringwald // for press and hold, send release if it just has been requested, otherwise, wait for next repeat 1183393f5724SMilanka Ringwald if (connection->controller_press_and_hold_cmd_release){ 1184393f5724SMilanka Ringwald connection->controller_press_and_hold_cmd_release = false; 1185a2e9e6d7SMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 1186a2e9e6d7SMilanka Ringwald } else { 1187a2e9e6d7SMilanka Ringwald connection->state = AVCTP_W4_STOP; 11886983e65eSMilanka Ringwald } 11896983e65eSMilanka Ringwald break; 11906983e65eSMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 11916983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 11926983e65eSMilanka Ringwald break; 11936983e65eSMilanka Ringwald default: 11946983e65eSMilanka Ringwald break; 11956983e65eSMilanka Ringwald } 11966983e65eSMilanka Ringwald if (connection->state == AVCTP_W4_STOP){ 11973d9ab93fSMilanka Ringwald avrcp_controller_emit_operation_status(avrcp_controller_context.avrcp_callback, AVRCP_SUBEVENT_OPERATION_START, connection->avrcp_cid, ctype, operation_id); 11986983e65eSMilanka Ringwald } 11996983e65eSMilanka Ringwald if (connection->state == AVCTP_CONNECTION_OPENED) { 12006983e65eSMilanka Ringwald // RELEASE response 12016983e65eSMilanka Ringwald operation_id = operation_id & 0x7F; 12023d9ab93fSMilanka Ringwald avrcp_controller_emit_operation_status(avrcp_controller_context.avrcp_callback, AVRCP_SUBEVENT_OPERATION_COMPLETE, connection->avrcp_cid, ctype, operation_id); 12036983e65eSMilanka Ringwald } 12046983e65eSMilanka Ringwald if (connection->state == AVCTP_W2_SEND_RELEASE_COMMAND){ 12056983e65eSMilanka Ringwald // PRESS response 12063d9ab93fSMilanka Ringwald avrcp_controller_request_pass_through_release_control_cmd(connection); 12076983e65eSMilanka Ringwald } 12086983e65eSMilanka Ringwald break; 12096983e65eSMilanka Ringwald } 12106983e65eSMilanka Ringwald default: 12116983e65eSMilanka Ringwald break; 12126983e65eSMilanka Ringwald } 12132a7bb97aSMatthias Ringwald 12142a7bb97aSMatthias Ringwald // trigger pending notification reqistrations 1215393f5724SMilanka Ringwald if ((connection->state == AVCTP_CONNECTION_OPENED) && connection->controller_notifications_to_register){ 12162a7bb97aSMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 12172a7bb97aSMatthias Ringwald } 12186983e65eSMilanka Ringwald } 12196983e65eSMilanka Ringwald 12206983e65eSMilanka Ringwald static void avrcp_controller_handle_can_send_now(avrcp_connection_t * connection){ 12216983e65eSMilanka Ringwald switch (connection->state){ 12226983e65eSMilanka Ringwald case AVCTP_W2_SEND_PRESS_COMMAND: 12236983e65eSMilanka Ringwald case AVCTP_W2_SEND_COMMAND: 12246983e65eSMilanka Ringwald case AVCTP_W2_SEND_RELEASE_COMMAND: 12254a23d858SMilanka Ringwald avrcp_send_cmd_with_avctp_fragmentation(connection); 12264a23d858SMilanka Ringwald 12274a23d858SMilanka Ringwald if (connection->data_offset < connection->data_len){ 1228c4b5c3d5SMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 12294a23d858SMilanka Ringwald return; 12304a23d858SMilanka Ringwald } 12314a23d858SMilanka Ringwald if (connection->state == AVCTP_W2_SEND_PRESS_COMMAND){ 12324a23d858SMilanka Ringwald connection->state = AVCTP_W2_RECEIVE_PRESS_RESPONSE; 1233c4b5c3d5SMatthias Ringwald } else { 1234c4b5c3d5SMatthias Ringwald connection->state = AVCTP_W2_RECEIVE_RESPONSE; 1235c4b5c3d5SMatthias Ringwald } 12361ab8f8ddSMilanka Ringwald return; 123716dc7cb4SMilanka Ringwald default: 123816dc7cb4SMilanka Ringwald break; 123916dc7cb4SMilanka Ringwald } 12404a23d858SMilanka Ringwald 124116dc7cb4SMilanka Ringwald // send register notification if queued 1242393f5724SMilanka Ringwald if (connection->controller_notifications_to_register != 0){ 12434701e250SMilanka Ringwald uint8_t event_id; 124499845bb7SMilanka Ringwald for (event_id = (uint8_t)AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; event_id < (uint8_t)AVRCP_NOTIFICATION_EVENT_LAST_INDEX; event_id++){ 1245393f5724SMilanka Ringwald if (connection->controller_notifications_to_register & (1 << event_id)){ 1246393f5724SMilanka Ringwald connection->controller_notifications_to_register &= ~ (1 << event_id); 12474701e250SMilanka Ringwald avrcp_send_register_notification(connection, event_id); 124816dc7cb4SMilanka Ringwald return; 124916dc7cb4SMilanka Ringwald } 125016dc7cb4SMilanka Ringwald } 12516983e65eSMilanka Ringwald } 12526983e65eSMilanka Ringwald } 12536983e65eSMilanka Ringwald 12546983e65eSMilanka Ringwald static void avrcp_controller_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 12556983e65eSMilanka Ringwald avrcp_connection_t * connection; 12566983e65eSMilanka Ringwald 12576983e65eSMilanka Ringwald switch (packet_type) { 12586983e65eSMilanka Ringwald case L2CAP_DATA_PACKET: 12591945fe3eSMilanka Ringwald connection = avrcp_get_connection_for_l2cap_signaling_cid_for_role(AVRCP_CONTROLLER, channel); 12606983e65eSMilanka Ringwald avrcp_handle_l2cap_data_packet_for_signaling_connection(connection, packet, size); 12616983e65eSMilanka Ringwald break; 12620036e267SMilanka Ringwald 12636983e65eSMilanka Ringwald case HCI_EVENT_PACKET: 12646983e65eSMilanka Ringwald switch (hci_event_packet_get_type(packet)){ 12656983e65eSMilanka Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 12661945fe3eSMilanka Ringwald connection = avrcp_get_connection_for_l2cap_signaling_cid_for_role(AVRCP_CONTROLLER, channel); 12676983e65eSMilanka Ringwald avrcp_controller_handle_can_send_now(connection); 12686983e65eSMilanka Ringwald break; 12696983e65eSMilanka Ringwald default: 12706983e65eSMilanka Ringwald break; 12716983e65eSMilanka Ringwald } 12726983e65eSMilanka Ringwald default: 12736983e65eSMilanka Ringwald break; 12746983e65eSMilanka Ringwald } 12756983e65eSMilanka Ringwald } 12766983e65eSMilanka Ringwald 12773d9ab93fSMilanka Ringwald void avrcp_controller_create_sdp_record(uint8_t * service, uint32_t service_record_handle, uint16_t supported_features, const char * service_name, const char * service_provider_name){ 12783d9ab93fSMilanka Ringwald avrcp_create_sdp_record(1, service, service_record_handle, avrcp_controller_supports_browsing(supported_features), supported_features, service_name, service_provider_name); 12793d9ab93fSMilanka Ringwald } 12803d9ab93fSMilanka Ringwald 12816983e65eSMilanka Ringwald void avrcp_controller_init(void){ 12826983e65eSMilanka Ringwald avrcp_controller_context.role = AVRCP_CONTROLLER; 12836983e65eSMilanka Ringwald avrcp_controller_context.packet_handler = avrcp_controller_packet_handler; 1284b106f728SMilanka Ringwald avrcp_register_controller_packet_handler(&avrcp_controller_packet_handler); 12856983e65eSMilanka Ringwald } 12866983e65eSMilanka Ringwald 1287680af5dcSMatthias Ringwald void avrcp_controller_deinit(void){ 1288680af5dcSMatthias Ringwald memset(&avrcp_controller_context, 0, sizeof(avrcp_context_t)); 1289680af5dcSMatthias Ringwald } 1290680af5dcSMatthias Ringwald 12916983e65eSMilanka Ringwald void avrcp_controller_register_packet_handler(btstack_packet_handler_t callback){ 1292be4cc80aSMilanka Ringwald btstack_assert(callback != NULL); 12936983e65eSMilanka Ringwald avrcp_controller_context.avrcp_callback = callback; 12946983e65eSMilanka Ringwald } 12956983e65eSMilanka Ringwald 12963d9ab93fSMilanka Ringwald 12973d9ab93fSMilanka Ringwald uint8_t avrcp_controller_play(uint16_t avrcp_cid){ 12983d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PLAY, 0); 12993d9ab93fSMilanka Ringwald } 13003d9ab93fSMilanka Ringwald 13013d9ab93fSMilanka Ringwald uint8_t avrcp_controller_stop(uint16_t avrcp_cid){ 13023d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_STOP, 0); 13033d9ab93fSMilanka Ringwald } 13043d9ab93fSMilanka Ringwald 13053d9ab93fSMilanka Ringwald uint8_t avrcp_controller_pause(uint16_t avrcp_cid){ 13063d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PAUSE, 0); 13073d9ab93fSMilanka Ringwald } 13083d9ab93fSMilanka Ringwald 13093d9ab93fSMilanka Ringwald uint8_t avrcp_controller_forward(uint16_t avrcp_cid){ 13103d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FORWARD, 0); 13113d9ab93fSMilanka Ringwald } 13123d9ab93fSMilanka Ringwald 13133d9ab93fSMilanka Ringwald uint8_t avrcp_controller_backward(uint16_t avrcp_cid){ 13143d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_BACKWARD, 0); 13153d9ab93fSMilanka Ringwald } 13163d9ab93fSMilanka Ringwald 13173d9ab93fSMilanka Ringwald uint8_t avrcp_controller_volume_up(uint16_t avrcp_cid){ 13183d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_UP, 0); 13193d9ab93fSMilanka Ringwald } 13203d9ab93fSMilanka Ringwald 13213d9ab93fSMilanka Ringwald uint8_t avrcp_controller_volume_down(uint16_t avrcp_cid){ 13223d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_DOWN, 0); 13233d9ab93fSMilanka Ringwald } 13243d9ab93fSMilanka Ringwald 13253d9ab93fSMilanka Ringwald uint8_t avrcp_controller_mute(uint16_t avrcp_cid){ 13263d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_MUTE, 0); 13273d9ab93fSMilanka Ringwald } 13283d9ab93fSMilanka Ringwald 13293d9ab93fSMilanka Ringwald uint8_t avrcp_controller_skip(uint16_t avrcp_cid){ 13303d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_SKIP, 0); 13313d9ab93fSMilanka Ringwald } 13323d9ab93fSMilanka Ringwald 13333d9ab93fSMilanka Ringwald uint8_t avrcp_controller_fast_forward(uint16_t avrcp_cid){ 13343d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FAST_FORWARD, 0); 13353d9ab93fSMilanka Ringwald } 13363d9ab93fSMilanka Ringwald 13373d9ab93fSMilanka Ringwald uint8_t avrcp_controller_rewind(uint16_t avrcp_cid){ 13383d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_REWIND, 0); 13393d9ab93fSMilanka Ringwald } 13403d9ab93fSMilanka Ringwald 13413d9ab93fSMilanka Ringwald /* start continuous cmds */ 13423d9ab93fSMilanka Ringwald 134337a7ced0SMatthias Ringwald uint8_t avrcp_controller_start_press_and_hold_cmd(uint16_t avrcp_cid, avrcp_operation_id_t operation_id){ 134437a7ced0SMatthias Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, operation_id, 0); 134537a7ced0SMatthias Ringwald } 134637a7ced0SMatthias Ringwald 13473d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_play(uint16_t avrcp_cid){ 13483d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PLAY, 0); 13493d9ab93fSMilanka Ringwald } 13503d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_stop(uint16_t avrcp_cid){ 13513d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_STOP, 0); 13523d9ab93fSMilanka Ringwald } 13533d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_pause(uint16_t avrcp_cid){ 13543d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PAUSE, 0); 13553d9ab93fSMilanka Ringwald } 13563d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_forward(uint16_t avrcp_cid){ 13573d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FORWARD, 0); 13583d9ab93fSMilanka Ringwald } 13593d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_backward(uint16_t avrcp_cid){ 13603d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_BACKWARD, 0); 13613d9ab93fSMilanka Ringwald } 13623d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_fast_forward(uint16_t avrcp_cid){ 13633d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FAST_FORWARD, 0); 13643d9ab93fSMilanka Ringwald } 13653d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_rewind(uint16_t avrcp_cid){ 13663d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_REWIND, 0); 13673d9ab93fSMilanka Ringwald } 13683d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_volume_up(uint16_t avrcp_cid){ 13693d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_UP, 0); 13703d9ab93fSMilanka Ringwald } 13713d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_volume_down(uint16_t avrcp_cid){ 13723d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_DOWN, 0); 13733d9ab93fSMilanka Ringwald } 13743d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_mute(uint16_t avrcp_cid){ 13753d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_MUTE, 0); 13763d9ab93fSMilanka Ringwald } 13773d9ab93fSMilanka Ringwald 13783d9ab93fSMilanka Ringwald /* stop continuous cmds */ 13793d9ab93fSMilanka Ringwald uint8_t avrcp_controller_release_press_and_hold_cmd(uint16_t avrcp_cid){ 13803d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 13813d9ab93fSMilanka Ringwald if (!connection){ 13823d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 13833d9ab93fSMilanka Ringwald } 1384a2e9e6d7SMilanka Ringwald 1385a2e9e6d7SMilanka Ringwald switch (connection->state){ 1386a2e9e6d7SMilanka Ringwald // respond when we receive response for (repeated) press command 1387a2e9e6d7SMilanka Ringwald case AVCTP_W2_RECEIVE_PRESS_RESPONSE: 1388393f5724SMilanka Ringwald connection->controller_press_and_hold_cmd_release = true; 1389a2e9e6d7SMilanka Ringwald break; 1390a2e9e6d7SMilanka Ringwald 1391a2e9e6d7SMilanka Ringwald // release already sent or on the way, nothing to do 1392a2e9e6d7SMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 1393a2e9e6d7SMilanka Ringwald case AVCTP_W2_SEND_RELEASE_COMMAND: 1394a2e9e6d7SMilanka Ringwald break; 1395a2e9e6d7SMilanka Ringwald 1396a2e9e6d7SMilanka Ringwald // about to send next repeated press command or wait for it -> release right away 1397a2e9e6d7SMilanka Ringwald case AVCTP_W2_SEND_PRESS_COMMAND: 1398a2e9e6d7SMilanka Ringwald case AVCTP_W4_STOP: 13993d9ab93fSMilanka Ringwald return avrcp_controller_request_pass_through_release_control_cmd(connection); 1400a2e9e6d7SMilanka Ringwald 1401a2e9e6d7SMilanka Ringwald // otherwise reject request 1402a2e9e6d7SMilanka Ringwald default: 1403a2e9e6d7SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 1404a2e9e6d7SMilanka Ringwald } 1405a2e9e6d7SMilanka Ringwald return ERROR_CODE_SUCCESS; 14063d9ab93fSMilanka Ringwald } 14073d9ab93fSMilanka Ringwald 14083d9ab93fSMilanka Ringwald uint8_t avrcp_controller_enable_notification(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id){ 14093d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14103d9ab93fSMilanka Ringwald if (!connection){ 14113d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14123d9ab93fSMilanka Ringwald } 14132b8461f9SMilanka Ringwald return avrcp_controller_register_notification(connection, event_id); 14143d9ab93fSMilanka Ringwald } 14153d9ab93fSMilanka Ringwald 14163d9ab93fSMilanka Ringwald uint8_t avrcp_controller_disable_notification(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id){ 14173d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14183d9ab93fSMilanka Ringwald if (!connection){ 14193d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14203d9ab93fSMilanka Ringwald } 1421393f5724SMilanka Ringwald if (!connection->controller_notifications_supported_by_target_queried){ 142279464f8dSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 142379464f8dSMilanka Ringwald } 142479464f8dSMilanka Ringwald 1425393f5724SMilanka Ringwald if ((connection->notifications_supported_by_target & (1 << event_id)) == 0){ 142679464f8dSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 142779464f8dSMilanka Ringwald } 142879464f8dSMilanka Ringwald 14291d3f7785SMilanka Ringwald if ((connection->notifications_enabled & (1 << event_id)) == 0){ 1430b2e02b8dSMilanka Ringwald return ERROR_CODE_SUCCESS; 1431b2e02b8dSMilanka Ringwald } 1432b2e02b8dSMilanka Ringwald 1433393f5724SMilanka Ringwald connection->controller_notifications_to_deregister |= (1 << event_id); 14343d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 14353d9ab93fSMilanka Ringwald } 14363d9ab93fSMilanka Ringwald 14376983e65eSMilanka Ringwald uint8_t avrcp_controller_unit_info(uint16_t avrcp_cid){ 14381945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14396983e65eSMilanka Ringwald if (!connection){ 14406983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14416983e65eSMilanka Ringwald } 14426983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 14436983e65eSMilanka Ringwald 14445d3671d9SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 14457bccc69fSMilanka Ringwald avrcp_controller_custom_command_data_init(connection, AVRCP_CMD_OPCODE_UNIT_INFO, AVRCP_CTYPE_STATUS, 14467bccc69fSMilanka Ringwald AVRCP_SUBUNIT_TYPE_UNIT, AVRCP_SUBUNIT_ID_IGNORE, AVRCP_PDU_ID_UNDEFINED, 14477bccc69fSMilanka Ringwald 0); 14485d3671d9SMilanka Ringwald 1449393f5724SMilanka Ringwald connection->data = connection->message_body; 14505d3671d9SMilanka Ringwald memset(connection->data, 0xFF, 5); 14515d3671d9SMilanka Ringwald connection->data_len = 5; 14526983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 14536983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 14546983e65eSMilanka Ringwald } 14556983e65eSMilanka Ringwald 1456ad75da14SMilanka Ringwald uint8_t avrcp_controller_subunit_info(uint16_t avrcp_cid){ 14571945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1458ad75da14SMilanka Ringwald if (!connection){ 1459ad75da14SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1460ad75da14SMilanka Ringwald } 1461ad75da14SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1462ad75da14SMilanka Ringwald 14635d3671d9SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 14647bccc69fSMilanka Ringwald avrcp_controller_custom_command_data_init(connection, AVRCP_CMD_OPCODE_SUBUNIT_INFO, AVRCP_CTYPE_STATUS, 14657bccc69fSMilanka Ringwald AVRCP_SUBUNIT_TYPE_UNIT, AVRCP_SUBUNIT_ID_IGNORE, AVRCP_PDU_ID_UNDEFINED, 14667bccc69fSMilanka Ringwald 0); 14675d3671d9SMilanka Ringwald 1468393f5724SMilanka Ringwald connection->data = connection->message_body; 14694670b44aSMilanka Ringwald memset(connection->data, 0xFF, 5); 14707bccc69fSMilanka Ringwald connection->data[0] = 7; // page: 0, extension_code: 7 14715d3671d9SMilanka Ringwald connection->data_len = 5; 1472ad75da14SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1473ad75da14SMilanka Ringwald return ERROR_CODE_SUCCESS; 1474ad75da14SMilanka Ringwald } 1475ad75da14SMilanka Ringwald 14761f94eaa5SMilanka Ringwald uint8_t avrcp_controller_get_supported_company_ids(uint16_t avrcp_cid){ 14771945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14786983e65eSMilanka Ringwald if (!connection){ 14796983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14806983e65eSMilanka Ringwald } 1481826b3cedSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 1482826b3cedSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 1483826b3cedSMilanka Ringwald } 14841f94eaa5SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_COMPANY); 14851f94eaa5SMilanka Ringwald return ERROR_CODE_SUCCESS; 14866983e65eSMilanka Ringwald } 14876983e65eSMilanka Ringwald 14886983e65eSMilanka Ringwald uint8_t avrcp_controller_get_supported_events(uint16_t avrcp_cid){ 14891f94eaa5SMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14901f94eaa5SMilanka Ringwald if (!connection){ 14911f94eaa5SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14921f94eaa5SMilanka Ringwald } 14931f94eaa5SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 14941f94eaa5SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 14951f94eaa5SMilanka Ringwald } 14961f94eaa5SMilanka Ringwald 1497393f5724SMilanka Ringwald if (!connection->controller_notifications_supported_by_target_queried){ 1498393f5724SMilanka Ringwald connection->controller_notifications_supported_by_target_queried = true; 14991f94eaa5SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_EVENT); 15001f94eaa5SMilanka Ringwald return ERROR_CODE_SUCCESS; 15016983e65eSMilanka Ringwald } 15026983e65eSMilanka Ringwald 15032ac1dc76SMilanka Ringwald avrcp_controller_emit_supported_events(connection); 15042ac1dc76SMilanka Ringwald return ERROR_CODE_SUCCESS; 15052ac1dc76SMilanka Ringwald } 15062ac1dc76SMilanka Ringwald 15076983e65eSMilanka Ringwald uint8_t avrcp_controller_get_play_status(uint16_t avrcp_cid){ 15081945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 15096983e65eSMilanka Ringwald if (!connection){ 15106983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 15116983e65eSMilanka Ringwald } 15126983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 15138d316b1bSMilanka Ringwald 15146983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 151566b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_PLAY_STATUS); 15168d316b1bSMilanka Ringwald 15175d3671d9SMilanka Ringwald connection->data_len = 0; 15186983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 15196983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 15206983e65eSMilanka Ringwald } 15216983e65eSMilanka Ringwald 1522864d08b0SMilanka Ringwald uint8_t avrcp_controller_set_addressed_player(uint16_t avrcp_cid, uint16_t addressed_player_id){ 15231945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1524864d08b0SMilanka Ringwald if (!connection){ 1525864d08b0SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1526864d08b0SMilanka Ringwald } 1527864d08b0SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1528864d08b0SMilanka Ringwald 15298d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 153066b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_ADDRESSED_PLAYER); 15318d316b1bSMilanka Ringwald 15325d3671d9SMilanka Ringwald connection->data_len = 2; 15335d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 0, addressed_player_id); 1534864d08b0SMilanka Ringwald 1535864d08b0SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1536864d08b0SMilanka Ringwald return ERROR_CODE_SUCCESS; 1537864d08b0SMilanka Ringwald } 15381bf7a74fSMilanka Ringwald 153961920526SMilanka Ringwald uint8_t avrcp_controller_get_element_attributes(uint16_t avrcp_cid, uint8_t num_attributes, avrcp_media_attribute_id_t * attributes){ 15401945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 15416983e65eSMilanka Ringwald if (!connection){ 15426983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 15436983e65eSMilanka Ringwald } 154461920526SMilanka Ringwald 15456983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 154661920526SMilanka Ringwald 154761920526SMilanka Ringwald if (num_attributes >= AVRCP_MEDIA_ATTR_RESERVED) { 154861920526SMilanka Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 154961920526SMilanka Ringwald } 15506983e65eSMilanka Ringwald 15518d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 155266b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES); 15538d316b1bSMilanka Ringwald 15545d3671d9SMilanka Ringwald uint8_t pos = 0; 15556983e65eSMilanka Ringwald // write 8 bytes value 15565d3671d9SMilanka Ringwald memset(connection->data, pos, 8); // identifier: PLAYING 15576983e65eSMilanka Ringwald pos += 8; 15586983e65eSMilanka Ringwald 15595d3671d9SMilanka Ringwald uint8_t num_attributes_index = pos; 15605d3671d9SMilanka Ringwald pos++; 156161920526SMilanka Ringwald 15625d3671d9SMilanka Ringwald // If num_attributes is set to zero, all attribute information shall be returned, 15635d3671d9SMilanka Ringwald // and the AttributeID field is omitted 15645d3671d9SMilanka Ringwald connection->data[num_attributes_index] = 0; 15655d3671d9SMilanka Ringwald uint8_t i; 156661920526SMilanka Ringwald for (i = 0; i < num_attributes; i++){ 15675d3671d9SMilanka Ringwald // ignore invalid attribute ID and "get all attributes" 15685d3671d9SMilanka Ringwald if (AVRCP_MEDIA_ATTR_ALL > attributes[i] && attributes[i] < AVRCP_MEDIA_ATTR_RESERVED){ 15696983e65eSMilanka Ringwald // every attribute is 4 bytes long 15705d3671d9SMilanka Ringwald big_endian_store_32(connection->data, pos, attributes[i]); 157161920526SMilanka Ringwald pos += 4; 15725d3671d9SMilanka Ringwald connection->data[num_attributes_index]++; 15735d3671d9SMilanka Ringwald } 157461920526SMilanka Ringwald } 15756983e65eSMilanka Ringwald 15765d3671d9SMilanka Ringwald // Parameter Length 15775d3671d9SMilanka Ringwald connection->data_len = pos; 15785d3671d9SMilanka Ringwald 15796983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 15806983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 15816983e65eSMilanka Ringwald } 15826983e65eSMilanka Ringwald 158361920526SMilanka Ringwald uint8_t avrcp_controller_get_now_playing_info(uint16_t avrcp_cid){ 158461920526SMilanka Ringwald return avrcp_controller_get_element_attributes(avrcp_cid, 0, NULL); 158561920526SMilanka Ringwald } 158661920526SMilanka Ringwald 158766e22952SMilanka Ringwald uint8_t avrcp_controller_get_now_playing_info_for_media_attribute_id(uint16_t avrcp_cid, avrcp_media_attribute_id_t media_attribute_id){ 158866e22952SMilanka Ringwald if (media_attribute_id == AVRCP_MEDIA_ATTR_ALL){ 158966e22952SMilanka Ringwald return avrcp_controller_get_now_playing_info(avrcp_cid); 159066e22952SMilanka Ringwald } 159166e22952SMilanka Ringwald return avrcp_controller_get_element_attributes(avrcp_cid, 1, &media_attribute_id); 159266e22952SMilanka Ringwald } 159366e22952SMilanka Ringwald 15946983e65eSMilanka Ringwald uint8_t avrcp_controller_set_absolute_volume(uint16_t avrcp_cid, uint8_t volume){ 15951945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 15966983e65eSMilanka Ringwald if (!connection){ 15976983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 15986983e65eSMilanka Ringwald } 15996e7485d0SMilanka Ringwald 16006e7485d0SMilanka Ringwald // 16016e7485d0SMilanka Ringwald // allow sending of multiple set abs volume commands without waiting for response 16026e7485d0SMilanka Ringwald // 16036e7485d0SMilanka Ringwald uint8_t status = ERROR_CODE_COMMAND_DISALLOWED; 16046e7485d0SMilanka Ringwald switch (connection->state){ 16056e7485d0SMilanka Ringwald case AVCTP_CONNECTION_OPENED: 16066e7485d0SMilanka Ringwald status = ERROR_CODE_SUCCESS; 16076e7485d0SMilanka Ringwald break; 16086e7485d0SMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 16096e7485d0SMilanka Ringwald // - is pending response also set abs volume 16106e7485d0SMilanka Ringwald if (connection->command_opcode != AVRCP_CMD_OPCODE_VENDOR_DEPENDENT) break; 16116e7485d0SMilanka Ringwald if (connection->command_type != AVRCP_CTYPE_CONTROL) break; 16126e7485d0SMilanka Ringwald if (connection->subunit_type != AVRCP_SUBUNIT_TYPE_PANEL) break; 16136e7485d0SMilanka Ringwald if (connection->subunit_id != AVRCP_SUBUNIT_ID) break; 16145d3671d9SMilanka Ringwald if (connection->pdu_id != AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME) break; 16156e7485d0SMilanka Ringwald // - is next transaction id valid in window 16166e7485d0SMilanka Ringwald if (avrcp_controller_is_transaction_id_valid(connection, avrcp_controller_calc_next_transaction_label(connection->transaction_id_counter)) == false) break; 16176e7485d0SMilanka Ringwald status = ERROR_CODE_SUCCESS; 16186e7485d0SMilanka Ringwald break; 16196e7485d0SMilanka Ringwald default: 16206e7485d0SMilanka Ringwald break; 16216e7485d0SMilanka Ringwald } 16226e7485d0SMilanka Ringwald if (status != ERROR_CODE_SUCCESS) return status; 16236e7485d0SMilanka Ringwald 16246983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 162566b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME); 16266983e65eSMilanka Ringwald 16276983e65eSMilanka Ringwald // Parameter Length 16285d3671d9SMilanka Ringwald connection->data_len = 1; 16295d3671d9SMilanka Ringwald connection->data[0] = volume; 16306983e65eSMilanka Ringwald 16316983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16326983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16336983e65eSMilanka Ringwald } 16346983e65eSMilanka Ringwald 16356983e65eSMilanka Ringwald uint8_t avrcp_controller_query_shuffle_and_repeat_modes(uint16_t avrcp_cid){ 16361945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 16376983e65eSMilanka Ringwald if (!connection){ 16386983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 16396983e65eSMilanka Ringwald } 16406983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 16416983e65eSMilanka Ringwald 16428d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 164366b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_CURRENT_PLAYER_APPLICATION_SETTING_VALUE); 16448d316b1bSMilanka Ringwald 16455d3671d9SMilanka Ringwald connection->data_len = 5; 16465d3671d9SMilanka Ringwald connection->data[0] = 4; // NumPlayerApplicationSettingAttributeID 16476983e65eSMilanka Ringwald // PlayerApplicationSettingAttributeID1 AVRCP Spec, Appendix F, 133 16485d3671d9SMilanka Ringwald connection->data[1] = 0x01; // equalizer (1-OFF, 2-ON) 16495d3671d9SMilanka Ringwald connection->data[2] = 0x02; // repeat (1-off, 2-single track, 3-all tracks, 4-group repeat) 16505d3671d9SMilanka Ringwald connection->data[3] = 0x03; // shuffle (1-off, 2-all tracks, 3-group shuffle) 16515d3671d9SMilanka Ringwald connection->data[4] = 0x04; // scan (1-off, 2-all tracks, 3-group scan) 16525d3671d9SMilanka Ringwald 16536983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16546983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16556983e65eSMilanka Ringwald } 16566983e65eSMilanka Ringwald 16576983e65eSMilanka Ringwald static uint8_t avrcp_controller_set_current_player_application_setting_value(uint16_t avrcp_cid, uint8_t attr_id, uint8_t attr_value){ 16581945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 16596983e65eSMilanka Ringwald if (!connection){ 16606983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 16616983e65eSMilanka Ringwald } 16626983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 16636983e65eSMilanka Ringwald 16648d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 166566b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_PLAYER_APPLICATION_SETTING_VALUE); 16668d316b1bSMilanka Ringwald 16676983e65eSMilanka Ringwald // Parameter Length 16685d3671d9SMilanka Ringwald connection->data_len = 3; 16695d3671d9SMilanka Ringwald connection->data[0] = 2; 16705d3671d9SMilanka Ringwald connection->data[1] = attr_id; 16715d3671d9SMilanka Ringwald connection->data[2] = attr_value; 16725d3671d9SMilanka Ringwald 16736983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16746983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16756983e65eSMilanka Ringwald } 16766983e65eSMilanka Ringwald 16776983e65eSMilanka Ringwald uint8_t avrcp_controller_set_shuffle_mode(uint16_t avrcp_cid, avrcp_shuffle_mode_t mode){ 16780e588213SMatthias Ringwald if ((mode < AVRCP_SHUFFLE_MODE_OFF) || (mode > AVRCP_SHUFFLE_MODE_GROUP)) return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 16796983e65eSMilanka Ringwald return avrcp_controller_set_current_player_application_setting_value(avrcp_cid, 0x03, mode); 16806983e65eSMilanka Ringwald } 16816983e65eSMilanka Ringwald 16826983e65eSMilanka Ringwald uint8_t avrcp_controller_set_repeat_mode(uint16_t avrcp_cid, avrcp_repeat_mode_t mode){ 16830e588213SMatthias Ringwald if ((mode < AVRCP_REPEAT_MODE_OFF) || (mode > AVRCP_REPEAT_MODE_GROUP)) return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 16846983e65eSMilanka Ringwald return avrcp_controller_set_current_player_application_setting_value(avrcp_cid, 0x02, mode); 16856983e65eSMilanka Ringwald } 16866983e65eSMilanka Ringwald 16874614c049SMilanka Ringwald uint8_t avrcp_controller_play_item_for_scope(uint16_t avrcp_cid, uint8_t * uid, uint16_t uid_counter, avrcp_browsing_scope_t scope){ 16881945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1689be65baf4SMilanka Ringwald if (!connection){ 1690be65baf4SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1691be65baf4SMilanka Ringwald } 16924931e24aSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 16934931e24aSMilanka Ringwald log_error("Connection in wrong state, expected %d, received %d", AVCTP_CONNECTION_OPENED, connection->state); 16944931e24aSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 16954931e24aSMilanka Ringwald } 1696be65baf4SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 169766b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_PLAY_ITEM); 1698be65baf4SMilanka Ringwald 1699be65baf4SMilanka Ringwald // Parameter Length 17005d3671d9SMilanka Ringwald connection->data_len = 11; 17015d3671d9SMilanka Ringwald connection->data[0] = scope; 17025d3671d9SMilanka Ringwald memset(&connection->data[1], 0, 8); 1703be65baf4SMilanka Ringwald if (uid){ 17045d3671d9SMilanka Ringwald (void)memcpy(&connection->data[1], uid, 8); 1705be65baf4SMilanka Ringwald } 17065d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 9, uid_counter); 1707be65baf4SMilanka Ringwald 1708be65baf4SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1709be65baf4SMilanka Ringwald return ERROR_CODE_SUCCESS; 1710be65baf4SMilanka Ringwald } 17118b2b4034SMilanka Ringwald 17124931e24aSMilanka Ringwald uint8_t avrcp_controller_add_item_from_scope_to_now_playing_list(uint16_t avrcp_cid, uint8_t * uid, uint16_t uid_counter, avrcp_browsing_scope_t scope){ 17131945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 17144931e24aSMilanka Ringwald if (!connection){ 17154931e24aSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 17164931e24aSMilanka Ringwald } 17174931e24aSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 17184931e24aSMilanka Ringwald log_error("Connection in wrong state, expected %d, received %d", AVCTP_CONNECTION_OPENED, connection->state); 17194931e24aSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 17204931e24aSMilanka Ringwald } 17214931e24aSMilanka Ringwald 17228d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 172366b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_ADD_TO_NOW_PLAYING); 17248d316b1bSMilanka Ringwald 17254931e24aSMilanka Ringwald // Parameter Length 17265d3671d9SMilanka Ringwald connection->data_len = 11; 17275d3671d9SMilanka Ringwald connection->data[0] = scope; 17285d3671d9SMilanka Ringwald memset(&connection->data[1], 0, 8); 17294931e24aSMilanka Ringwald if (uid){ 17305d3671d9SMilanka Ringwald (void)memcpy(&connection->data[1], uid, 8); 17314931e24aSMilanka Ringwald } 17325d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 9, uid_counter); 17334931e24aSMilanka Ringwald 17344931e24aSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 17354931e24aSMilanka Ringwald return ERROR_CODE_SUCCESS; 17364931e24aSMilanka Ringwald } 17374931e24aSMilanka Ringwald 17388b2b4034SMilanka Ringwald uint8_t avrcp_controller_set_max_num_fragments(uint16_t avrcp_cid, uint8_t max_num_fragments){ 17391945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 17408b2b4034SMilanka Ringwald if (!connection){ 17418b2b4034SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 17428b2b4034SMilanka Ringwald } 17433d73cc81SMilanka Ringwald connection->controller_max_num_fragments = max_num_fragments; 17448b2b4034SMilanka Ringwald return ERROR_CODE_SUCCESS; 17458b2b4034SMilanka Ringwald } 1746c4b5c3d5SMatthias Ringwald 17475d3671d9SMilanka Ringwald 17485d3671d9SMilanka Ringwald uint8_t avrcp_controller_send_custom_command(uint16_t avrcp_cid, 17495d3671d9SMilanka Ringwald avrcp_command_type_t command_type, 17505d3671d9SMilanka Ringwald avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, 17515d3671d9SMilanka Ringwald avrcp_pdu_id_t pdu_id, uint32_t company_id, 17525d3671d9SMilanka Ringwald const uint8_t * data, uint16_t data_len){ 17535d3671d9SMilanka Ringwald 17541945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1755c4b5c3d5SMatthias Ringwald if (!connection){ 1756c4b5c3d5SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1757c4b5c3d5SMatthias Ringwald } 1758c4b5c3d5SMatthias Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1759c4b5c3d5SMatthias Ringwald 1760*c762f70cSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 17617bccc69fSMilanka Ringwald avrcp_controller_custom_command_data_init(connection, AVRCP_CMD_OPCODE_VENDOR_DEPENDENT, command_type, subunit_type, 17627bccc69fSMilanka Ringwald subunit_id, pdu_id, company_id); 17635d3671d9SMilanka Ringwald 17645d3671d9SMilanka Ringwald connection->data = (uint8_t *)data; 17655d3671d9SMilanka Ringwald connection->data_len = data_len; 1766c4b5c3d5SMatthias Ringwald 1767c4b5c3d5SMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1768c4b5c3d5SMatthias Ringwald return ERROR_CODE_SUCCESS; 1769c4b5c3d5SMatthias Ringwald } 1770