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){ 706e7485d0SMilanka Ringwald uint8_t delta = ((int8_t) transaction_id - connection->last_confirmed_transaction_id) & 0x0f; 716e7485d0SMilanka Ringwald return delta < 15; 726e7485d0SMilanka Ringwald } 736e7485d0SMilanka Ringwald 7466b242bbSMilanka Ringwald static void avrcp_controller_custome_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; 84*3a19cf32SMilanka 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; 1005d3671d9SMilanka Ringwald connection->data = connection->cmd_operands; 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; 1138d316b1bSMilanka Ringwald connection->pdu_id = 0; 1148d316b1bSMilanka Ringwald connection->operation_id = opid; 1158d316b1bSMilanka Ringwald 1165d3671d9SMilanka Ringwald connection->data = connection->cmd_operands; 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 124b2e02b8dSMilanka Ringwald static void avrcp_controller_emit_notification_complete(avrcp_connection_t * connection, uint8_t status, uint8_t event_id, bool enabled){ 125b2e02b8dSMilanka Ringwald uint8_t event[8]; 126bce3db21SMilanka Ringwald uint8_t pos = 0; 127bce3db21SMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 128bce3db21SMilanka Ringwald event[pos++] = sizeof(event) - 2; 129b2e02b8dSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_NOTIFICATION_STATE; 130bce3db21SMilanka Ringwald little_endian_store_16(event, pos, connection->avrcp_cid); 131bce3db21SMilanka Ringwald pos += 2; 132bce3db21SMilanka Ringwald event[pos++] = status; 133b2e02b8dSMilanka Ringwald event[pos++] = enabled ? 1 : 0; 134bce3db21SMilanka Ringwald event[pos++] = event_id; 135bce3db21SMilanka Ringwald UNUSED(pos); 136bce3db21SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 137bce3db21SMilanka Ringwald } 138bce3db21SMilanka Ringwald 139ff243a1bSMilanka Ringwald static void avrcp_controller_emit_supported_events(avrcp_connection_t * connection){ 140ff243a1bSMilanka Ringwald uint8_t ctype = (uint8_t) AVRCP_CTYPE_RESPONSE_CHANGED_STABLE; 1412ac1dc76SMilanka Ringwald uint8_t event_id; 142ff243a1bSMilanka Ringwald 14399845bb7SMilanka Ringwald for (event_id = (uint8_t) AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; event_id < (uint8_t) AVRCP_NOTIFICATION_EVENT_LAST_INDEX; event_id++){ 1443b8b393aSMilanka Ringwald if ( (connection->target_supported_notifications & (1<<event_id)) == 0){ 145ff243a1bSMilanka Ringwald continue; 146ff243a1bSMilanka Ringwald } 1472ac1dc76SMilanka Ringwald uint8_t event[8]; 1482ac1dc76SMilanka Ringwald uint8_t pos = 0; 1492ac1dc76SMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 1502ac1dc76SMilanka Ringwald event[pos++] = sizeof(event) - 2; 1512ac1dc76SMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_GET_CAPABILITY_EVENT_ID; 1522ac1dc76SMilanka Ringwald little_endian_store_16(event, pos, connection->avrcp_cid); 1532ac1dc76SMilanka Ringwald pos += 2; 1542ac1dc76SMilanka Ringwald event[pos++] = ctype; 1552ac1dc76SMilanka Ringwald event[pos++] = 0; 1562ac1dc76SMilanka Ringwald event[pos++] = event_id; 1572ac1dc76SMilanka Ringwald UNUSED(pos); 1582ac1dc76SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 159ff243a1bSMilanka Ringwald } 160ff243a1bSMilanka Ringwald 1612ac1dc76SMilanka Ringwald uint8_t event[7]; 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_DONE; 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 UNUSED(pos); 171ff243a1bSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 172ff243a1bSMilanka Ringwald } 173ff243a1bSMilanka Ringwald 17499702381SMatthias Ringwald static void avrcp_controller_emit_notification_for_event_id(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id, 17599702381SMatthias Ringwald avrcp_command_type_t ctype, const uint8_t *payload, 17699702381SMatthias Ringwald uint16_t size) { 17716dc7cb4SMilanka Ringwald switch (event_id){ 17816dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYBACK_POS_CHANGED:{ 17999702381SMatthias Ringwald if (size < 4) break; 18016dc7cb4SMilanka Ringwald uint32_t song_position = big_endian_read_32(payload, 0); 18116dc7cb4SMilanka Ringwald uint16_t offset = 0; 18216dc7cb4SMilanka Ringwald uint8_t event[10]; 18316dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 18416dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 18516dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_PLAYBACK_POS_CHANGED; 18616dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 18716dc7cb4SMilanka Ringwald offset += 2; 18816dc7cb4SMilanka Ringwald event[offset++] = ctype; 18916dc7cb4SMilanka Ringwald little_endian_store_32(event, offset, song_position); 19016dc7cb4SMilanka Ringwald offset += 4; 19116dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 19216dc7cb4SMilanka Ringwald break; 19316dc7cb4SMilanka Ringwald } 19416dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED:{ 19599702381SMatthias Ringwald if (size < 1) break; 19616dc7cb4SMilanka Ringwald uint16_t offset = 0; 19716dc7cb4SMilanka Ringwald uint8_t event[7]; 19816dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 19916dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 20016dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_PLAYBACK_STATUS_CHANGED; 20116dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 20216dc7cb4SMilanka Ringwald offset += 2; 20316dc7cb4SMilanka Ringwald event[offset++] = ctype; 20416dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 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_TRACK_CHANGED:{ 20916dc7cb4SMilanka Ringwald uint16_t offset = 0; 21016dc7cb4SMilanka Ringwald uint8_t event[6]; 21116dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 21216dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 21316dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_TRACK_CHANGED; 21416dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 21516dc7cb4SMilanka Ringwald offset += 2; 21616dc7cb4SMilanka Ringwald event[offset++] = ctype; 21716dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 21816dc7cb4SMilanka Ringwald break; 21916dc7cb4SMilanka Ringwald } 22016dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED:{ 22116dc7cb4SMilanka Ringwald uint16_t offset = 0; 22216dc7cb4SMilanka Ringwald uint8_t event[6]; 22316dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 22416dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 22516dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_NOW_PLAYING_CONTENT_CHANGED; 22616dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 22716dc7cb4SMilanka Ringwald offset += 2; 22816dc7cb4SMilanka Ringwald event[offset++] = ctype; 22916dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 23016dc7cb4SMilanka Ringwald break; 23116dc7cb4SMilanka Ringwald } 23216dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_AVAILABLE_PLAYERS_CHANGED:{ 23316dc7cb4SMilanka Ringwald uint16_t offset = 0; 23416dc7cb4SMilanka Ringwald uint8_t event[6]; 23516dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 23616dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 23716dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_AVAILABLE_PLAYERS_CHANGED; 23816dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 23916dc7cb4SMilanka Ringwald offset += 2; 24016dc7cb4SMilanka Ringwald event[offset++] = ctype; 24116dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 24216dc7cb4SMilanka Ringwald break; 24316dc7cb4SMilanka Ringwald } 24416dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED:{ 24599702381SMatthias Ringwald if (size < 1) break; 24616dc7cb4SMilanka Ringwald uint16_t offset = 0; 24716dc7cb4SMilanka Ringwald uint8_t event[7]; 24816dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 24916dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 25016dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_VOLUME_CHANGED; 25116dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 25216dc7cb4SMilanka Ringwald offset += 2; 25316dc7cb4SMilanka Ringwald event[offset++] = ctype; 25416dc7cb4SMilanka Ringwald event[offset++] = payload[0] & 0x7F; 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_UIDS_CHANGED:{ 25999702381SMatthias Ringwald if (size < 2) break; 26016dc7cb4SMilanka Ringwald uint8_t event[8]; 26116dc7cb4SMilanka Ringwald uint16_t offset = 0; 26216dc7cb4SMilanka Ringwald uint16_t uuid = big_endian_read_16(payload, 0); 26316dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 26416dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 26516dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_UIDS_CHANGED; 26616dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 26716dc7cb4SMilanka Ringwald offset += 2; 26816dc7cb4SMilanka Ringwald event[offset++] = ctype; 26916dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, uuid); 27016dc7cb4SMilanka Ringwald offset += 2; 27116dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 27216dc7cb4SMilanka Ringwald break; 27316dc7cb4SMilanka Ringwald } 27416dc7cb4SMilanka Ringwald 27516dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_TRACK_REACHED_END:{ 27616dc7cb4SMilanka Ringwald uint16_t offset = 0; 27716dc7cb4SMilanka Ringwald uint8_t event[6]; 27816dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 27916dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 28016dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_TRACK_REACHED_END; 28116dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 28216dc7cb4SMilanka Ringwald offset += 2; 28316dc7cb4SMilanka Ringwald event[offset++] = ctype; 28416dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 28516dc7cb4SMilanka Ringwald break; 28616dc7cb4SMilanka Ringwald } 28716dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_TRACK_REACHED_START:{ 28816dc7cb4SMilanka Ringwald uint16_t offset = 0; 28916dc7cb4SMilanka Ringwald uint8_t event[6]; 29016dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 29116dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 29216dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_TRACK_REACHED_START; 29316dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 29416dc7cb4SMilanka Ringwald offset += 2; 29516dc7cb4SMilanka Ringwald event[offset++] = ctype; 29616dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 29716dc7cb4SMilanka Ringwald break; 29816dc7cb4SMilanka Ringwald } 29916dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED:{ 30099702381SMatthias Ringwald if (size < 1) break; 30116dc7cb4SMilanka Ringwald uint16_t offset = 0; 30216dc7cb4SMilanka Ringwald uint8_t event[7]; 30316dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 30416dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 30516dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_BATT_STATUS_CHANGED; 30616dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 30716dc7cb4SMilanka Ringwald offset += 2; 30816dc7cb4SMilanka Ringwald event[offset++] = ctype; 30916dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 31016dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 31116dc7cb4SMilanka Ringwald break; 31216dc7cb4SMilanka Ringwald } 31316dc7cb4SMilanka Ringwald 31416dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_SYSTEM_STATUS_CHANGED:{ 31599702381SMatthias Ringwald if (size < 1) break; 31616dc7cb4SMilanka Ringwald uint16_t offset = 0; 31716dc7cb4SMilanka Ringwald uint8_t event[7]; 31816dc7cb4SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 31916dc7cb4SMilanka Ringwald event[offset++] = sizeof(event) - 2; 32016dc7cb4SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_EVENT_SYSTEM_STATUS_CHANGED; 32116dc7cb4SMilanka Ringwald little_endian_store_16(event, offset, avrcp_cid); 32216dc7cb4SMilanka Ringwald offset += 2; 32316dc7cb4SMilanka Ringwald event[offset++] = ctype; 32416dc7cb4SMilanka Ringwald event[offset++] = payload[0]; 32516dc7cb4SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 32616dc7cb4SMilanka Ringwald break; 32716dc7cb4SMilanka Ringwald } 32816dc7cb4SMilanka Ringwald 32916dc7cb4SMilanka Ringwald case AVRCP_NOTIFICATION_EVENT_PLAYER_APPLICATION_SETTING_CHANGED: 33016dc7cb4SMilanka Ringwald default: 33116dc7cb4SMilanka Ringwald log_info("avrcp: not implemented"); 33216dc7cb4SMilanka Ringwald break; 33316dc7cb4SMilanka Ringwald } 33416dc7cb4SMilanka Ringwald } 33516dc7cb4SMilanka Ringwald 3363d9ab93fSMilanka 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){ 3373d9ab93fSMilanka Ringwald btstack_assert(callback != NULL); 3383d9ab93fSMilanka Ringwald 3393d9ab93fSMilanka Ringwald uint8_t event[8]; 3406983e65eSMilanka Ringwald int pos = 0; 3413d9ab93fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3423d9ab93fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 3433d9ab93fSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_SHUFFLE_AND_REPEAT_MODE; 3443d9ab93fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3456983e65eSMilanka Ringwald pos += 2; 3463d9ab93fSMilanka Ringwald event[pos++] = ctype; 3473d9ab93fSMilanka Ringwald event[pos++] = repeat_mode; 3483d9ab93fSMilanka Ringwald event[pos++] = shuffle_mode; 3493d9ab93fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 3501bf7a74fSMilanka Ringwald } 3511bf7a74fSMilanka Ringwald 3521bf7a74fSMilanka 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){ 3531bf7a74fSMilanka Ringwald uint8_t event[7]; 3541bf7a74fSMilanka Ringwald int pos = 0; 3551bf7a74fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3561bf7a74fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 3571bf7a74fSMilanka Ringwald event[pos++] = AVRCP_SUBEVENT_NOW_PLAYING_INFO_DONE; 3581bf7a74fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3591bf7a74fSMilanka Ringwald pos += 2; 3601bf7a74fSMilanka Ringwald event[pos++] = ctype; 3611bf7a74fSMilanka Ringwald event[pos++] = status; 3621bf7a74fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, pos); 3631bf7a74fSMilanka Ringwald } 3641bf7a74fSMilanka Ringwald 3651bf7a74fSMilanka 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){ 3661bf7a74fSMilanka Ringwald uint8_t event[HCI_EVENT_BUFFER_SIZE]; 3671bf7a74fSMilanka Ringwald int pos = 0; 3681bf7a74fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 3691bf7a74fSMilanka Ringwald // reserve one byte for subevent type and data len 3701bf7a74fSMilanka Ringwald int data_len_pos = pos; 3711bf7a74fSMilanka Ringwald pos++; 3721bf7a74fSMilanka Ringwald int subevent_type_pos = pos; 3731bf7a74fSMilanka Ringwald pos++; 3741bf7a74fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 3751bf7a74fSMilanka Ringwald pos += 2; 3761bf7a74fSMilanka Ringwald event[pos++] = ctype; 3771bf7a74fSMilanka Ringwald 3781bf7a74fSMilanka Ringwald switch (attr_id){ 3791bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_TITLE: 3801bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TITLE_INFO; 3811bf7a74fSMilanka Ringwald event[pos++] = value_len; 3826535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 3831bf7a74fSMilanka Ringwald break; 3841bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_ARTIST: 3851bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_ARTIST_INFO; 3861bf7a74fSMilanka Ringwald event[pos++] = value_len; 3876535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 3881bf7a74fSMilanka Ringwald break; 3891bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_ALBUM: 3901bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_ALBUM_INFO; 3911bf7a74fSMilanka Ringwald event[pos++] = value_len; 3926535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 3931bf7a74fSMilanka Ringwald break; 3941bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_GENRE: 3951bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_GENRE_INFO; 3961bf7a74fSMilanka Ringwald event[pos++] = value_len; 3976535961aSMatthias Ringwald (void)memcpy(event + pos, value, value_len); 3981bf7a74fSMilanka Ringwald break; 3992f511ffbSMilanka Ringwald case AVRCP_MEDIA_ATTR_SONG_LENGTH_MS: 4001bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_SONG_LENGTH_MS_INFO; 4011bf7a74fSMilanka Ringwald if (value){ 4021bf7a74fSMilanka Ringwald little_endian_store_32(event, pos, btstack_atoi((char *)value)); 4031bf7a74fSMilanka Ringwald } else { 4041bf7a74fSMilanka Ringwald little_endian_store_32(event, pos, 0); 4051bf7a74fSMilanka Ringwald } 4061bf7a74fSMilanka Ringwald pos += 4; 4071bf7a74fSMilanka Ringwald break; 4081bf7a74fSMilanka Ringwald case AVRCP_MEDIA_ATTR_TRACK: 4091bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TRACK_INFO; 4101bf7a74fSMilanka Ringwald if (value){ 4111bf7a74fSMilanka Ringwald event[pos++] = btstack_atoi((char *)value); 4121bf7a74fSMilanka Ringwald } else { 4131bf7a74fSMilanka Ringwald event[pos++] = 0; 4141bf7a74fSMilanka Ringwald } 4151bf7a74fSMilanka Ringwald break; 416864d08b0SMilanka Ringwald case AVRCP_MEDIA_ATTR_TOTAL_NUM_ITEMS: 4171bf7a74fSMilanka Ringwald event[subevent_type_pos] = AVRCP_SUBEVENT_NOW_PLAYING_TOTAL_TRACKS_INFO; 4181bf7a74fSMilanka Ringwald if (value){ 4191bf7a74fSMilanka Ringwald event[pos++] = btstack_atoi((char *)value); 4201bf7a74fSMilanka Ringwald } else { 4211bf7a74fSMilanka Ringwald event[pos++] = 0; 4221bf7a74fSMilanka Ringwald } 4231bf7a74fSMilanka Ringwald break; 4241bf7a74fSMilanka Ringwald default: 4251bf7a74fSMilanka Ringwald break; 4261bf7a74fSMilanka Ringwald } 4271bf7a74fSMilanka Ringwald event[data_len_pos] = pos - 2; 4281bf7a74fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, pos); 4291bf7a74fSMilanka Ringwald } 4301bf7a74fSMilanka Ringwald 4313d9ab93fSMilanka 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){ 4323d9ab93fSMilanka Ringwald btstack_assert(callback != NULL); 4333d9ab93fSMilanka Ringwald 4343d9ab93fSMilanka Ringwald uint8_t event[7]; 4353d9ab93fSMilanka Ringwald int pos = 0; 4363d9ab93fSMilanka Ringwald event[pos++] = HCI_EVENT_AVRCP_META; 4373d9ab93fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 4383d9ab93fSMilanka Ringwald event[pos++] = subevent; 4393d9ab93fSMilanka Ringwald little_endian_store_16(event, pos, avrcp_cid); 4403d9ab93fSMilanka Ringwald pos += 2; 4413d9ab93fSMilanka Ringwald event[pos++] = ctype; 4423d9ab93fSMilanka Ringwald event[pos++] = operation_id; 4433d9ab93fSMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 4443d9ab93fSMilanka Ringwald } 4453d9ab93fSMilanka Ringwald 4463d9ab93fSMilanka Ringwald static void avrcp_parser_reset(avrcp_connection_t * connection){ 4473d9ab93fSMilanka Ringwald connection->list_offset = 0; 4483d9ab93fSMilanka Ringwald connection->num_attributes = 0; 4493d9ab93fSMilanka Ringwald connection->num_parsed_attributes = 0; 4503d9ab93fSMilanka Ringwald connection->parser_attribute_header_pos = 0; 4513d9ab93fSMilanka Ringwald connection->num_received_fragments = 0; 4523d9ab93fSMilanka Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_HEADER; 4533d9ab93fSMilanka Ringwald } 4543d9ab93fSMilanka Ringwald 4551bf7a74fSMilanka Ringwald static void avrcp_parser_process_byte(uint8_t byte, avrcp_connection_t * connection, avrcp_command_type_t ctype){ 456836408dfSMatthias Ringwald uint16_t attribute_total_value_len; 457836408dfSMatthias Ringwald uint32_t attribute_id; 4581bf7a74fSMilanka Ringwald switch(connection->parser_state){ 459836408dfSMatthias Ringwald case AVRCP_PARSER_GET_ATTRIBUTE_HEADER: 4601bf7a74fSMilanka Ringwald connection->parser_attribute_header[connection->parser_attribute_header_pos++] = byte; 4611bf7a74fSMilanka Ringwald connection->list_offset++; 4629771e28cSMatthias Ringwald 4639771e28cSMatthias Ringwald if (connection->parser_attribute_header_pos < AVRCP_ATTRIBUTE_HEADER_LEN) return; 4649771e28cSMatthias Ringwald 465836408dfSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 4668b2b4034SMilanka Ringwald connection->attribute_value_len = btstack_min(attribute_total_value_len, AVRCP_MAX_ATTRIBUTTE_SIZE); 4679771e28cSMatthias Ringwald if (connection->attribute_value_len > 0){ 4689771e28cSMatthias Ringwald // get ready for attribute value 469836408dfSMatthias Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_VALUE; 470836408dfSMatthias Ringwald return; 4719771e28cSMatthias Ringwald } 4729771e28cSMatthias Ringwald 4739771e28cSMatthias Ringwald // emit empty attribute 4749771e28cSMatthias Ringwald attribute_id = big_endian_read_32(connection->parser_attribute_header, 0); 475dfbbc26bSMatthias 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); 4769771e28cSMatthias Ringwald 4779771e28cSMatthias Ringwald // done, see below 4789771e28cSMatthias Ringwald break; 479836408dfSMatthias Ringwald 480836408dfSMatthias Ringwald case AVRCP_PARSER_GET_ATTRIBUTE_VALUE: 4811bf7a74fSMilanka Ringwald connection->attribute_value[connection->attribute_value_offset++] = byte; 4821bf7a74fSMilanka Ringwald connection->list_offset++; 4839771e28cSMatthias Ringwald 4849771e28cSMatthias Ringwald if (connection->attribute_value_offset < connection->attribute_value_len) return; 4858b2b4034SMilanka Ringwald 486836408dfSMatthias Ringwald // emit (potentially partial) attribute 487836408dfSMatthias Ringwald attribute_id = big_endian_read_32(connection->parser_attribute_header, 0); 488dfbbc26bSMatthias 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); 4891bf7a74fSMilanka Ringwald 490836408dfSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 491836408dfSMatthias Ringwald if (connection->attribute_value_offset < attribute_total_value_len){ 4929771e28cSMatthias Ringwald // ignore rest of attribute 49314e95846SMilanka Ringwald connection->parser_state = AVRCP_PARSER_IGNORE_REST_OF_ATTRIBUTE_VALUE; 494836408dfSMatthias Ringwald return; 4951bf7a74fSMilanka Ringwald } 4969771e28cSMatthias Ringwald 4979771e28cSMatthias Ringwald // done, see below 498836408dfSMatthias Ringwald break; 4991bf7a74fSMilanka Ringwald 50014e95846SMilanka Ringwald case AVRCP_PARSER_IGNORE_REST_OF_ATTRIBUTE_VALUE: 5011bf7a74fSMilanka Ringwald connection->attribute_value_offset++; 5029771e28cSMatthias Ringwald connection->list_offset++; 5039771e28cSMatthias Ringwald 5049771e28cSMatthias Ringwald attribute_total_value_len = big_endian_read_16(connection->parser_attribute_header, 6); 5059771e28cSMatthias Ringwald if (connection->attribute_value_offset < attribute_total_value_len) return; 5069771e28cSMatthias Ringwald 5079771e28cSMatthias Ringwald // done, see below 508836408dfSMatthias Ringwald break; 5091bf7a74fSMilanka Ringwald 510836408dfSMatthias Ringwald default: 511836408dfSMatthias Ringwald return; 5121bf7a74fSMilanka Ringwald } 513836408dfSMatthias Ringwald 514836408dfSMatthias Ringwald // attribute fully read, check if more to come 515836408dfSMatthias Ringwald if (connection->list_offset < connection->list_size){ 5169771e28cSMatthias Ringwald // more to come, reset parser 5171bf7a74fSMilanka Ringwald connection->parser_state = AVRCP_PARSER_GET_ATTRIBUTE_HEADER; 5181bf7a74fSMilanka Ringwald connection->parser_attribute_header_pos = 0; 5191c7ac872SMatthias Ringwald connection->attribute_value_offset = 0; 520836408dfSMatthias Ringwald } else { 521836408dfSMatthias Ringwald // fully done 522836408dfSMatthias Ringwald avrcp_parser_reset(connection); 523836408dfSMatthias Ringwald avrcp_controller_emit_now_playing_info_event_done(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, 0); 5241bf7a74fSMilanka Ringwald } 5251bf7a74fSMilanka Ringwald } 5261bf7a74fSMilanka Ringwald 5273d9ab93fSMilanka 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){ 5281bf7a74fSMilanka Ringwald int i; 5291bf7a74fSMilanka Ringwald for (i=0;i<num_bytes_to_read;i++){ 5301bf7a74fSMilanka Ringwald avrcp_parser_process_byte(packet[i], connection, ctype); 5311bf7a74fSMilanka Ringwald } 5321bf7a74fSMilanka Ringwald } 5331bf7a74fSMilanka Ringwald 5344a23d858SMilanka Ringwald static void avrcp_send_cmd_with_avctp_fragmentation(avrcp_connection_t * connection){ 53562434ba8SMilanka Ringwald l2cap_reserve_packet_buffer(); 53662434ba8SMilanka Ringwald uint8_t * command = l2cap_get_outgoing_buffer(); 5374a23d858SMilanka Ringwald 53862434ba8SMilanka Ringwald uint16_t max_frame_size = btstack_min(l2cap_get_remote_mtu_for_local_cid(connection->l2cap_signaling_cid), AVRCP_MAX_AV_C_MESSAGE_FRAME_SIZE); 5393d9ab93fSMilanka Ringwald 5404a23d858SMilanka Ringwald avctp_packet_type_t avctp_packet_type = avrcp_get_avctp_packet_type(connection); 5414a23d858SMilanka Ringwald 5423d9ab93fSMilanka Ringwald // non-fragmented: transport header (1) + PID (2) 5433d9ab93fSMilanka Ringwald // fragmented: transport header (1) + num packets (1) + PID (2) 5443d9ab93fSMilanka Ringwald 5454a23d858SMilanka Ringwald // AVCTP header 5463d9ab93fSMilanka Ringwald // transport header : transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier) 5474a23d858SMilanka Ringwald uint16_t pos = 0; 548ecb2ff93SMilanka Ringwald command[pos++] = (connection->transaction_id << 4) | (avctp_packet_type << 2) | (AVRCP_COMMAND_FRAME << 1) | 0; 5493d9ab93fSMilanka Ringwald 5504a23d858SMilanka Ringwald switch (avctp_packet_type){ 5514a23d858SMilanka Ringwald case AVCTP_SINGLE_PACKET: 5524a23d858SMilanka Ringwald case AVCTP_START_PACKET: 553ecb2ff93SMilanka Ringwald if (avctp_packet_type == AVCTP_START_PACKET){ 5543d9ab93fSMilanka Ringwald // num packets: (3 bytes overhead (PID, num packets) + command) / (MTU - transport header). 5553d9ab93fSMilanka Ringwald // to get number of packets using integer division, we subtract 1 from the data e.g. len = 5, packet size 5 => need 1 packet 556*3a19cf32SMilanka Ringwald command[pos++] = avctp_get_num_packets(max_frame_size, connection->data_len, connection->command_opcode); 5573d9ab93fSMilanka Ringwald } 558*3a19cf32SMilanka Ringwald 5593d9ab93fSMilanka Ringwald // Profile IDentifier (PID) 5603d9ab93fSMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 5613d9ab93fSMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 5623d9ab93fSMilanka Ringwald 5633d9ab93fSMilanka Ringwald // command_type 5643d9ab93fSMilanka Ringwald command[pos++] = connection->command_type; 5653d9ab93fSMilanka Ringwald // subunit_type | subunit ID 5663d9ab93fSMilanka Ringwald command[pos++] = (connection->subunit_type << 3) | connection->subunit_id; 5673d9ab93fSMilanka Ringwald // opcode 5683d9ab93fSMilanka Ringwald command[pos++] = (uint8_t)connection->command_opcode; 5694a23d858SMilanka Ringwald 5704a23d858SMilanka Ringwald switch (connection->command_opcode){ 5714a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT: 5724a23d858SMilanka Ringwald big_endian_store_24(command, pos, connection->company_id); 5734a23d858SMilanka Ringwald pos += 3; 5744a23d858SMilanka Ringwald command[pos++] = connection->pdu_id; 5754a23d858SMilanka Ringwald command[pos++] = 0; // reserved(upper 6) | packet_type -> 0 5764a23d858SMilanka Ringwald big_endian_store_16(command, pos, connection->data_len); // parameter length 5774a23d858SMilanka Ringwald pos += 2; 5784a23d858SMilanka Ringwald break; 5794a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_PASS_THROUGH: 5804a23d858SMilanka Ringwald command[pos++] = connection->operation_id; 5814a23d858SMilanka Ringwald command[pos++] = (uint8_t)connection->data_len; // parameter length 5824a23d858SMilanka Ringwald pos += 2; 5834a23d858SMilanka Ringwald break; 5844a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_UNIT_INFO: 5854a23d858SMilanka Ringwald break; 5864a23d858SMilanka Ringwald case AVRCP_CMD_OPCODE_SUBUNIT_INFO: 5874a23d858SMilanka Ringwald break; 5884a23d858SMilanka Ringwald default: 5894a23d858SMilanka Ringwald btstack_assert(false); 5904a23d858SMilanka Ringwald return; 5914a23d858SMilanka Ringwald } 5924a23d858SMilanka Ringwald break; 5934a23d858SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 5944a23d858SMilanka Ringwald case AVCTP_END_PACKET: 5954a23d858SMilanka Ringwald break; 5964a23d858SMilanka Ringwald default: 5974a23d858SMilanka Ringwald btstack_assert(false); 5984a23d858SMilanka Ringwald return; 5993d9ab93fSMilanka Ringwald } 60066b242bbSMilanka Ringwald // compare number of bytes to store with the remaining buffer size 6014a23d858SMilanka Ringwald uint16_t bytes_to_copy = btstack_min(connection->data_len - connection->data_offset, max_frame_size - pos); 6024a23d858SMilanka Ringwald 6034a23d858SMilanka Ringwald (void)memcpy(command + pos, &connection->data[connection->data_offset], bytes_to_copy); 6043d9ab93fSMilanka Ringwald pos += bytes_to_copy; 6054a23d858SMilanka Ringwald connection->data_offset += bytes_to_copy; 6063d9ab93fSMilanka Ringwald 6074a23d858SMilanka Ringwald l2cap_send_prepared(connection->l2cap_signaling_cid, pos); 6083d9ab93fSMilanka Ringwald } 6093d9ab93fSMilanka Ringwald 6104701e250SMilanka Ringwald static int avrcp_send_register_notification(avrcp_connection_t * connection, uint8_t event_id){ 6114701e250SMilanka Ringwald uint8_t command[18]; 6124701e250SMilanka Ringwald uint16_t pos = 0; 6134701e250SMilanka Ringwald // transport header : transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier) 614022b77fcSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 615022b77fcSMilanka Ringwald command[pos++] = (connection->transaction_id << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_COMMAND_FRAME << 1) | 0; 6164701e250SMilanka Ringwald 6174701e250SMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8; 6184701e250SMilanka Ringwald command[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF; 6194701e250SMilanka Ringwald command[pos++] = AVRCP_CTYPE_NOTIFY; 6204701e250SMilanka Ringwald command[pos++] = (AVRCP_SUBUNIT_TYPE_PANEL << 3) | AVRCP_SUBUNIT_ID; 6214701e250SMilanka Ringwald command[pos++] = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT; 6224701e250SMilanka Ringwald 6234701e250SMilanka Ringwald big_endian_store_24(command, pos, BT_SIG_COMPANY_ID); 6244701e250SMilanka Ringwald pos += 3; 6254701e250SMilanka Ringwald command[pos++] = AVRCP_PDU_ID_REGISTER_NOTIFICATION; 6264701e250SMilanka Ringwald command[pos++] = 0; // reserved(upper 6) | packet_type -> 0 6274701e250SMilanka Ringwald big_endian_store_16(command, pos, 5); // parameter length 6284701e250SMilanka Ringwald pos += 2; 6294701e250SMilanka Ringwald command[pos++] = event_id; 6304701e250SMilanka Ringwald big_endian_store_32(command, pos, 1); // send notification on playback position every second, for other notifications it is ignored 6314701e250SMilanka Ringwald pos += 4; 6324701e250SMilanka Ringwald return l2cap_send(connection->l2cap_signaling_cid, command, pos); 6334701e250SMilanka Ringwald } 6344701e250SMilanka Ringwald 6353d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timeout_handler(btstack_timer_source_t * timer){ 6363d9ab93fSMilanka Ringwald UNUSED(timer); 6373d9ab93fSMilanka Ringwald avrcp_connection_t * connection = (avrcp_connection_t*) btstack_run_loop_get_timer_context(timer); 6383d9ab93fSMilanka Ringwald btstack_run_loop_set_timer(&connection->press_and_hold_cmd_timer, 2000); // 2 seconds timeout 6393d9ab93fSMilanka Ringwald btstack_run_loop_add_timer(&connection->press_and_hold_cmd_timer); 6403d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_PRESS_COMMAND; 6413d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 6423d9ab93fSMilanka Ringwald } 6433d9ab93fSMilanka Ringwald 6443d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timer_start(avrcp_connection_t * connection){ 6453d9ab93fSMilanka Ringwald btstack_run_loop_remove_timer(&connection->press_and_hold_cmd_timer); 6463d9ab93fSMilanka Ringwald btstack_run_loop_set_timer_handler(&connection->press_and_hold_cmd_timer, avrcp_press_and_hold_timeout_handler); 6473d9ab93fSMilanka Ringwald btstack_run_loop_set_timer_context(&connection->press_and_hold_cmd_timer, connection); 6483d9ab93fSMilanka Ringwald btstack_run_loop_set_timer(&connection->press_and_hold_cmd_timer, 2000); // 2 seconds timeout 6493d9ab93fSMilanka Ringwald btstack_run_loop_add_timer(&connection->press_and_hold_cmd_timer); 6503d9ab93fSMilanka Ringwald } 6513d9ab93fSMilanka Ringwald 6523d9ab93fSMilanka Ringwald static void avrcp_press_and_hold_timer_stop(avrcp_connection_t * connection){ 653b623cfebSMilanka Ringwald connection->press_and_hold_cmd_active = false; 6543d9ab93fSMilanka Ringwald btstack_run_loop_remove_timer(&connection->press_and_hold_cmd_timer); 6553d9ab93fSMilanka Ringwald } 6563d9ab93fSMilanka Ringwald 6573d9ab93fSMilanka Ringwald 6583d9ab93fSMilanka Ringwald static uint8_t avrcp_controller_request_pass_through_release_control_cmd(avrcp_connection_t * connection){ 6593d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 660b623cfebSMilanka Ringwald if (connection->press_and_hold_cmd_active){ 6613d9ab93fSMilanka Ringwald avrcp_press_and_hold_timer_stop(connection); 6623d9ab93fSMilanka Ringwald } 6635d3671d9SMilanka Ringwald connection->operation_id = 0x80 | connection->operation_id; 664022b77fcSMilanka Ringwald connection->transaction_id = avrcp_controller_get_next_transaction_label(connection); 6653d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 6663d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 6673d9ab93fSMilanka Ringwald } 6683d9ab93fSMilanka Ringwald 669b623cfebSMilanka 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){ 6703d9ab93fSMilanka Ringwald log_info("Send command %d", opid); 6713d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 6723d9ab93fSMilanka Ringwald if (!connection){ 6733d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 6743d9ab93fSMilanka Ringwald } 6753d9ab93fSMilanka Ringwald 6763d9ab93fSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 6773d9ab93fSMilanka Ringwald log_error("Connection in wrong state %d, expected %d. avrcp cid 0x%02x", connection->state, AVCTP_CONNECTION_OPENED, avrcp_cid); 6783d9ab93fSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 6793d9ab93fSMilanka Ringwald } 6803d9ab93fSMilanka Ringwald connection->state = AVCTP_W2_SEND_PRESS_COMMAND; 68166b242bbSMilanka Ringwald avrcp_controller_pass_through_command_data_init(connection, opid); 6823d9ab93fSMilanka Ringwald 6833d9ab93fSMilanka Ringwald if (playback_speed > 0){ 6845d3671d9SMilanka Ringwald connection->data[0] = playback_speed; 6855d3671d9SMilanka Ringwald connection->data_len = 1; 6863d9ab93fSMilanka Ringwald } 6873d9ab93fSMilanka Ringwald 6885d3671d9SMilanka Ringwald connection->press_and_hold_cmd_active = continuous_cmd; 689b623cfebSMilanka Ringwald if (connection->press_and_hold_cmd_active){ 6903d9ab93fSMilanka Ringwald avrcp_press_and_hold_timer_start(connection); 6913d9ab93fSMilanka Ringwald } 6923d9ab93fSMilanka Ringwald 6933d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 6943d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 6953d9ab93fSMilanka Ringwald } 6963d9ab93fSMilanka Ringwald 6973d9ab93fSMilanka Ringwald static uint8_t request_single_pass_through_press_control_cmd(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint16_t playback_speed){ 6980c436f0bSMatthias Ringwald return avrcp_controller_request_pass_through_press_control_cmd(avrcp_cid, opid, playback_speed, false); 6993d9ab93fSMilanka Ringwald } 7003d9ab93fSMilanka Ringwald 7013d9ab93fSMilanka Ringwald static uint8_t request_continuous_pass_through_press_control_cmd(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint16_t playback_speed){ 7020c436f0bSMatthias Ringwald return avrcp_controller_request_pass_through_press_control_cmd(avrcp_cid, opid, playback_speed, true); 7033d9ab93fSMilanka Ringwald } 7043d9ab93fSMilanka Ringwald 705826b3cedSMilanka Ringwald static void avrcp_controller_get_capabilities_for_connection(avrcp_connection_t * connection, uint8_t capability_id){ 706826b3cedSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 70766b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_CAPABILITIES); 7088d316b1bSMilanka Ringwald 7095d3671d9SMilanka Ringwald // Parameter Length 7105d3671d9SMilanka Ringwald connection->data_len = 1; 7115d3671d9SMilanka Ringwald connection->data[0] = capability_id; // capability ID 7125d3671d9SMilanka Ringwald 713826b3cedSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 714826b3cedSMilanka Ringwald } 7152b8461f9SMilanka Ringwald 7162b8461f9SMilanka Ringwald static uint8_t avrcp_controller_register_notification(avrcp_connection_t * connection, avrcp_notification_event_id_t event_id){ 7173b8b393aSMilanka Ringwald if (connection->target_supported_notifications_queried && (connection->target_supported_notifications & (1 << event_id)) == 0){ 7182b8461f9SMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 7192b8461f9SMilanka Ringwald } 7202b8461f9SMilanka Ringwald if ( (connection->notifications_to_deregister & (1 << event_id)) != 0){ 7212b8461f9SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 7222b8461f9SMilanka Ringwald } 7232b8461f9SMilanka Ringwald if ( (connection->notifications_enabled & (1 << event_id)) != 0){ 7242b8461f9SMilanka Ringwald return ERROR_CODE_SUCCESS; 7252b8461f9SMilanka Ringwald } 7263d9ab93fSMilanka Ringwald connection->notifications_to_register |= (1 << event_id); 7272ac1dc76SMilanka Ringwald 7283b8b393aSMilanka Ringwald if (!connection->target_supported_notifications_queried){ 7293b8b393aSMilanka Ringwald connection->target_supported_notifications_suppress_emit_result = true; 7302ac1dc76SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_EVENT); 7312ac1dc76SMilanka Ringwald return ERROR_CODE_SUCCESS; 7322ac1dc76SMilanka Ringwald } 7333d9ab93fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 7342b8461f9SMilanka Ringwald return ERROR_CODE_SUCCESS; 7353d9ab93fSMilanka Ringwald } 7363d9ab93fSMilanka Ringwald 7375d3671d9SMilanka Ringwald static uint8_t avrcp_controller_request_continuation(avrcp_connection_t * connection, avrcp_pdu_id_t pdu_id){ 7381bf7a74fSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 73966b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, pdu_id); 7408d316b1bSMilanka Ringwald 7411bf7a74fSMilanka Ringwald // Parameter Length 7425d3671d9SMilanka Ringwald connection->data_len = 3; 7435d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 0, 1); 7445d3671d9SMilanka Ringwald connection->data[2] = AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES; 7455d3671d9SMilanka Ringwald 7461bf7a74fSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 7471bf7a74fSMilanka Ringwald return ERROR_CODE_SUCCESS; 7481bf7a74fSMilanka Ringwald } 7491bf7a74fSMilanka Ringwald 7505d3671d9SMilanka Ringwald static uint8_t avrcp_controller_request_abort_continuation(avrcp_connection_t * connection){ 7515d3671d9SMilanka Ringwald return avrcp_controller_request_continuation(connection, AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE); 7525d3671d9SMilanka Ringwald } 7531bf7a74fSMilanka Ringwald 7541bf7a74fSMilanka Ringwald static uint8_t avrcp_controller_request_continue_response(avrcp_connection_t * connection){ 7555d3671d9SMilanka Ringwald return avrcp_controller_request_continuation(connection, AVRCP_PDU_ID_REQUEST_CONTINUING_RESPONSE); 7561bf7a74fSMilanka Ringwald } 7571bf7a74fSMilanka Ringwald 758737e7617SMilanka Ringwald static void avrcp_controller_handle_notification(avrcp_connection_t *connection, avrcp_command_type_t ctype, uint8_t *payload, uint16_t size) { 75999702381SMatthias Ringwald if (size < 1) return; 7604701e250SMilanka Ringwald uint16_t pos = 0; 7614701e250SMilanka Ringwald avrcp_notification_event_id_t event_id = (avrcp_notification_event_id_t) payload[pos++]; 762eebb600bSMilanka Ringwald if ( (event_id < AVRCP_NOTIFICATION_EVENT_FIRST_INDEX) || (event_id > AVRCP_NOTIFICATION_EVENT_LAST_INDEX)){ 763eebb600bSMilanka Ringwald return; 764eebb600bSMilanka Ringwald } 765eebb600bSMilanka Ringwald 7664701e250SMilanka Ringwald uint16_t event_mask = (1 << event_id); 7674701e250SMilanka Ringwald uint16_t reset_event_mask = ~event_mask; 768dac572e6SMilanka Ringwald 7694701e250SMilanka Ringwald switch (ctype){ 7707229b758SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_REJECTED: 7717229b758SMilanka Ringwald connection->notifications_to_deregister &= reset_event_mask; 7727229b758SMilanka Ringwald connection->notifications_to_register &= reset_event_mask; 7737229b758SMilanka Ringwald connection->initial_status_reported &= reset_event_mask; 7747229b758SMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE, event_id, false); 7757229b758SMilanka Ringwald return; 7767229b758SMilanka Ringwald 7774701e250SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_INTERIM: 7784701e250SMilanka Ringwald // register as enabled 7794701e250SMilanka Ringwald connection->notifications_enabled |= event_mask; 780bc3843bfSMilanka Ringwald 781bce3db21SMilanka Ringwald // check if initial value is already sent 782bc3843bfSMilanka Ringwald if ( (connection->initial_status_reported & event_mask) != 0 ){ 783dac572e6SMilanka Ringwald return; 784dac572e6SMilanka Ringwald } 785bc3843bfSMilanka Ringwald // emit event only once, initially 786b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_SUCCESS, event_id, true); 787dac572e6SMilanka Ringwald connection->initial_status_reported |= event_mask; 7887229b758SMilanka Ringwald // emit initial value after this switch 7894701e250SMilanka Ringwald break; 7907229b758SMilanka Ringwald 7914701e250SMilanka Ringwald case AVRCP_CTYPE_RESPONSE_CHANGED_STABLE: 792bce3db21SMilanka Ringwald // received change, event is considered de-registered 7934701e250SMilanka Ringwald // we are re-enabling it automatically, if it is not 7944701e250SMilanka Ringwald // explicitly disabled 7954701e250SMilanka Ringwald connection->notifications_enabled &= reset_event_mask; 79679464f8dSMilanka Ringwald if ((connection->notifications_to_deregister & event_mask) == 0){ 7974701e250SMilanka Ringwald avrcp_controller_register_notification(connection, event_id); 7984701e250SMilanka Ringwald } else { 7994701e250SMilanka Ringwald connection->notifications_to_deregister &= reset_event_mask; 800b2e02b8dSMilanka Ringwald connection->notifications_to_register &= reset_event_mask; 801b2e02b8dSMilanka Ringwald connection->initial_status_reported &= reset_event_mask; 802b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_SUCCESS, event_id, false); 8034701e250SMilanka Ringwald } 8044701e250SMilanka Ringwald break; 8057229b758SMilanka Ringwald 8064701e250SMilanka Ringwald default: 80766ec1603SMilanka Ringwald return; 8084701e250SMilanka Ringwald } 8094701e250SMilanka Ringwald 81099702381SMatthias Ringwald avrcp_controller_emit_notification_for_event_id(connection->avrcp_cid, event_id, ctype, payload + pos, size - pos); 8114701e250SMilanka Ringwald } 8124701e250SMilanka Ringwald 813c3b8c0a2SMilanka Ringwald #ifdef ENABLE_AVCTP_FRAGMENTATION 814c3b8c0a2SMilanka Ringwald static void avctp_reassemble_message(avrcp_connection_t * connection, avctp_packet_type_t packet_type, uint8_t *packet, uint16_t size){ 815c3b8c0a2SMilanka Ringwald // after header (transaction label and packet type) 816c3b8c0a2SMilanka Ringwald uint16_t pos; 817c3b8c0a2SMilanka Ringwald uint16_t bytes_to_store; 818c3b8c0a2SMilanka Ringwald 819c3b8c0a2SMilanka Ringwald switch (packet_type){ 820c3b8c0a2SMilanka Ringwald case AVCTP_START_PACKET: 821c3b8c0a2SMilanka Ringwald if (size < 2) return; 822c3b8c0a2SMilanka Ringwald 823c3b8c0a2SMilanka Ringwald // store header 824c3b8c0a2SMilanka Ringwald pos = 0; 825c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_buffer[pos] = packet[pos]; 826c3b8c0a2SMilanka Ringwald pos++; 827c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size = pos; 828c3b8c0a2SMilanka Ringwald 829c3b8c0a2SMilanka Ringwald // NOTE: num packets not needed for reassembly, ignoring it does not pose security risk -> no need to store it 830c3b8c0a2SMilanka Ringwald pos++; 831c3b8c0a2SMilanka Ringwald 832c3b8c0a2SMilanka 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 833c3b8c0a2SMilanka Ringwald 834c3b8c0a2SMilanka Ringwald bytes_to_store = btstack_min(size - pos, sizeof(connection->avctp_reassembly_buffer) - connection->avctp_reassembly_size); 835c3b8c0a2SMilanka Ringwald memcpy(&connection->avctp_reassembly_buffer[connection->avctp_reassembly_size], &packet[pos], bytes_to_store); 836c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size += bytes_to_store; 837c3b8c0a2SMilanka Ringwald break; 838c3b8c0a2SMilanka Ringwald 839c3b8c0a2SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 840c3b8c0a2SMilanka Ringwald case AVCTP_END_PACKET: 841c3b8c0a2SMilanka Ringwald if (size < 1) return; 842c3b8c0a2SMilanka Ringwald 843c3b8c0a2SMilanka Ringwald // store remaining data, ignore header 844c3b8c0a2SMilanka Ringwald pos = 1; 845c3b8c0a2SMilanka Ringwald bytes_to_store = btstack_min(size - pos, sizeof(connection->avctp_reassembly_buffer) - connection->avctp_reassembly_size); 846c3b8c0a2SMilanka Ringwald memcpy(&connection->avctp_reassembly_buffer[connection->avctp_reassembly_size], &packet[pos], bytes_to_store); 847c3b8c0a2SMilanka Ringwald connection->avctp_reassembly_size += bytes_to_store; 848c3b8c0a2SMilanka Ringwald break; 849c3b8c0a2SMilanka Ringwald 850c3b8c0a2SMilanka Ringwald default: 851c3b8c0a2SMilanka Ringwald return; 852c3b8c0a2SMilanka Ringwald } 853c3b8c0a2SMilanka Ringwald } 854c3b8c0a2SMilanka Ringwald #endif 855c3b8c0a2SMilanka Ringwald 8566983e65eSMilanka Ringwald static void avrcp_handle_l2cap_data_packet_for_signaling_connection(avrcp_connection_t * connection, uint8_t *packet, uint16_t size){ 857697b823eSMatthias Ringwald if (size < 6u) return; 8583acd1f1cSMilanka Ringwald uint8_t pdu_id; 859c3b8c0a2SMilanka Ringwald avrcp_packet_type_t vendor_dependent_packet_type; 8603acd1f1cSMilanka Ringwald 861c3b8c0a2SMilanka Ringwald uint16_t pos = 0; 862c3b8c0a2SMilanka Ringwald connection->last_confirmed_transaction_id = packet[pos] >> 4; 863c3b8c0a2SMilanka Ringwald avrcp_frame_type_t frame_type = (avrcp_frame_type_t)((packet[pos] >> 1) & 0x01); 864c3b8c0a2SMilanka Ringwald avctp_packet_type_t packet_type = (avctp_packet_type_t)((packet[pos] >> 2) & 0x03); 865c3b8c0a2SMilanka Ringwald pos++; 8666e7485d0SMilanka Ringwald 8673acd1f1cSMilanka Ringwald if (frame_type != AVRCP_RESPONSE_FRAME) return; 8683acd1f1cSMilanka Ringwald 8693acd1f1cSMilanka Ringwald switch (packet_type){ 870c3b8c0a2SMilanka Ringwald case AVCTP_SINGLE_PACKET: 8713acd1f1cSMilanka Ringwald break; 872c3b8c0a2SMilanka Ringwald 873c3b8c0a2SMilanka Ringwald #ifdef ENABLE_AVCTP_FRAGMENTATION 874c3b8c0a2SMilanka Ringwald case AVCTP_START_PACKET: 875c3b8c0a2SMilanka Ringwald case AVCTP_CONTINUE_PACKET: 876c3b8c0a2SMilanka Ringwald avctp_reassemble_message(connection, packet_type, packet, size); 877c3b8c0a2SMilanka Ringwald return; 878c3b8c0a2SMilanka Ringwald 879c3b8c0a2SMilanka Ringwald case AVCTP_END_PACKET: 880c3b8c0a2SMilanka Ringwald avctp_reassemble_message(connection, packet_type, packet, size); 881c3b8c0a2SMilanka Ringwald 882c3b8c0a2SMilanka Ringwald packet = connection->avctp_reassembly_buffer; 883c3b8c0a2SMilanka Ringwald size = connection->avctp_reassembly_size; 884c3b8c0a2SMilanka Ringwald break; 885c3b8c0a2SMilanka Ringwald #endif 886c3b8c0a2SMilanka Ringwald 8873acd1f1cSMilanka Ringwald default: 8883acd1f1cSMilanka Ringwald return; 8893acd1f1cSMilanka Ringwald } 8903acd1f1cSMilanka Ringwald 891c3b8c0a2SMilanka Ringwald pos += 2; // PID 892c3b8c0a2SMilanka Ringwald 8936983e65eSMilanka Ringwald avrcp_command_type_t ctype = (avrcp_command_type_t) packet[pos++]; 8943acd1f1cSMilanka Ringwald 895e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 896e0d13a19SMilanka Ringwald uint8_t byte_value = packet[pos]; 8976983e65eSMilanka Ringwald avrcp_subunit_type_t subunit_type = (avrcp_subunit_type_t) (byte_value >> 3); 8986983e65eSMilanka Ringwald avrcp_subunit_type_t subunit_id = (avrcp_subunit_type_t) (byte_value & 0x07); 899e0d13a19SMilanka Ringwald #endif 900e0d13a19SMilanka Ringwald pos++; 9016983e65eSMilanka Ringwald 902e0d13a19SMilanka Ringwald uint8_t opcode = packet[pos++]; 9036983e65eSMilanka Ringwald uint16_t param_length; 9043acd1f1cSMilanka Ringwald 9053acd1f1cSMilanka Ringwald switch (opcode){ 906ad75da14SMilanka Ringwald case AVRCP_CMD_OPCODE_SUBUNIT_INFO:{ 907ad75da14SMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE) return; 908ad75da14SMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 909e0d13a19SMilanka Ringwald 910e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 91199845bb7SMilanka Ringwald // page, extension code (1) 912e33c5309SMilanka Ringwald pos++; 913e33c5309SMilanka Ringwald uint8_t unit_type = packet[pos] >> 3; 914e33c5309SMilanka Ringwald uint8_t max_subunit_ID = packet[pos] & 0x07; 915ad75da14SMilanka Ringwald log_info("SUBUNIT INFO response: ctype 0x%02x (0C), subunit_type 0x%02x (1F), subunit_id 0x%02x (07), opcode 0x%02x (30), unit_type 0x%02x, max_subunit_ID %d", ctype, subunit_type, subunit_id, opcode, unit_type, max_subunit_ID); 916e0d13a19SMilanka Ringwald #endif 917ad75da14SMilanka Ringwald break; 918ad75da14SMilanka Ringwald } 9196983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_UNIT_INFO:{ 9206983e65eSMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE) return; 9216983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 922e0d13a19SMilanka Ringwald 923e0d13a19SMilanka Ringwald #ifdef ENABLE_LOG_INFO 924e33c5309SMilanka Ringwald // byte value 7 (1) 925e33c5309SMilanka Ringwald pos++; 926e33c5309SMilanka Ringwald uint8_t unit_type = packet[pos] >> 3; 927e33c5309SMilanka Ringwald uint8_t unit = packet[pos] & 0x07; 928e33c5309SMilanka Ringwald pos++; 929e33c5309SMilanka Ringwald uint32_t company_id = big_endian_read_24(packet, pos); 930adaba9f3SMatthias Ringwald log_info("UNIT INFO response: ctype 0x%02x (0C), subunit_type 0x%02x (1F), subunit_id 0x%02x (07), opcode 0x%02x (30), unit_type 0x%02x, unit %d, company_id 0x%06" PRIx32, 9316983e65eSMilanka Ringwald ctype, subunit_type, subunit_id, opcode, unit_type, unit, company_id); 932e0d13a19SMilanka Ringwald #endif 9336983e65eSMilanka Ringwald break; 9346983e65eSMilanka Ringwald } 9356983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT: 93699702381SMatthias Ringwald 93799702381SMatthias Ringwald if ((size - pos) < 7) return; 93899702381SMatthias Ringwald 939e33c5309SMilanka Ringwald // Company ID (3) 940e33c5309SMilanka Ringwald pos += 3; 941e33c5309SMilanka Ringwald pdu_id = packet[pos++]; 94261920526SMilanka Ringwald vendor_dependent_packet_type = (avrcp_packet_type_t)(packet[pos++] & 0x03); 943e33c5309SMilanka Ringwald param_length = big_endian_read_16(packet, pos); 944e33c5309SMilanka Ringwald pos += 2; 945e33c5309SMilanka Ringwald 94699702381SMatthias Ringwald if ((size - pos) < param_length) return; 9476983e65eSMilanka Ringwald 9484701e250SMilanka Ringwald // handle asynchronous notifications, without changing state 9494701e250SMilanka Ringwald if (pdu_id == AVRCP_PDU_ID_REGISTER_NOTIFICATION){ 950737e7617SMilanka Ringwald avrcp_controller_handle_notification(connection, ctype, packet + pos, size - pos); 9514701e250SMilanka Ringwald break; 9524701e250SMilanka Ringwald } 9534701e250SMilanka Ringwald 9544701e250SMilanka Ringwald if (connection->state != AVCTP_W2_RECEIVE_RESPONSE){ 9556983e65eSMilanka Ringwald log_info("AVRCP_CMD_OPCODE_VENDOR_DEPENDENT state %d", connection->state); 9566983e65eSMilanka Ringwald return; 9576983e65eSMilanka Ringwald } 9586983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 9596983e65eSMilanka Ringwald 9606983e65eSMilanka Ringwald log_info("VENDOR DEPENDENT response: pdu id 0x%02x, param_length %d, status %s", pdu_id, param_length, avrcp_ctype2str(ctype)); 9616983e65eSMilanka Ringwald switch (pdu_id){ 96208485fc4SMilanka Ringwald case AVRCP_PDU_ID_GET_CURRENT_PLAYER_APPLICATION_SETTING_VALUE:{ 9636983e65eSMilanka Ringwald uint8_t num_attributes = packet[pos++]; 9646983e65eSMilanka Ringwald int i; 9656983e65eSMilanka Ringwald avrcp_repeat_mode_t repeat_mode = AVRCP_REPEAT_MODE_INVALID; 9666983e65eSMilanka Ringwald avrcp_shuffle_mode_t shuffle_mode = AVRCP_SHUFFLE_MODE_INVALID; 9676983e65eSMilanka Ringwald for (i = 0; i < num_attributes; i++){ 9686983e65eSMilanka Ringwald uint8_t attribute_id = packet[pos++]; 9696983e65eSMilanka Ringwald uint8_t value = packet[pos++]; 9706983e65eSMilanka Ringwald switch (attribute_id){ 9716983e65eSMilanka Ringwald case 0x02: 9726983e65eSMilanka Ringwald repeat_mode = (avrcp_repeat_mode_t) value; 9736983e65eSMilanka Ringwald break; 9746983e65eSMilanka Ringwald case 0x03: 9756983e65eSMilanka Ringwald shuffle_mode = (avrcp_shuffle_mode_t) value; 9766983e65eSMilanka Ringwald break; 9776983e65eSMilanka Ringwald default: 9786983e65eSMilanka Ringwald break; 9796983e65eSMilanka Ringwald } 9806983e65eSMilanka Ringwald } 9813d9ab93fSMilanka Ringwald avrcp_controller_emit_repeat_and_shuffle_mode(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, repeat_mode, shuffle_mode); 9826983e65eSMilanka Ringwald break; 9836983e65eSMilanka Ringwald } 98416dc7cb4SMilanka Ringwald 98508485fc4SMilanka Ringwald case AVRCP_PDU_ID_SET_PLAYER_APPLICATION_SETTING_VALUE:{ 9865509e888SMatthias Ringwald uint16_t offset = 0; 9876983e65eSMilanka Ringwald uint8_t event[6]; 9886983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 9896983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 9906983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_PLAYER_APPLICATION_VALUE_RESPONSE; 9916983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 9926983e65eSMilanka Ringwald offset += 2; 9936983e65eSMilanka Ringwald event[offset++] = ctype; 9946983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 9956983e65eSMilanka Ringwald break; 9966983e65eSMilanka Ringwald } 99716dc7cb4SMilanka Ringwald 9986983e65eSMilanka Ringwald case AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME:{ 9995509e888SMatthias Ringwald uint16_t offset = 0; 10006983e65eSMilanka Ringwald uint8_t event[7]; 10016983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10026983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 10036983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_SET_ABSOLUTE_VOLUME_RESPONSE; 10046983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10056983e65eSMilanka Ringwald offset += 2; 10066983e65eSMilanka Ringwald event[offset++] = ctype; 10076983e65eSMilanka Ringwald event[offset++] = packet[pos++]; 10086983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 10096983e65eSMilanka Ringwald break; 10106983e65eSMilanka Ringwald } 101116dc7cb4SMilanka Ringwald 10126983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_CAPABILITIES:{ 10136983e65eSMilanka Ringwald avrcp_capability_id_t capability_id = (avrcp_capability_id_t) packet[pos++]; 1014cb925874SMatthias Ringwald uint8_t capability_count = 0; 1015cb925874SMatthias Ringwald if (param_length > 1){ 1016cb925874SMatthias Ringwald capability_count = packet[pos++]; 1017cb925874SMatthias Ringwald } 10185509e888SMatthias Ringwald uint16_t i; 10195509e888SMatthias Ringwald uint16_t offset = 0; 10205509e888SMatthias Ringwald uint8_t event[10]; 10214f5eb797SMilanka Ringwald 10226983e65eSMilanka Ringwald switch (capability_id){ 10234f5eb797SMilanka Ringwald 10246983e65eSMilanka Ringwald case AVRCP_CAPABILITY_ID_COMPANY: 10253032b6e1SMilanka Ringwald for (i = 0; (i < capability_count) && ((size - pos) >= 3); i++){ 10266983e65eSMilanka Ringwald uint32_t company_id = big_endian_read_24(packet, pos); 10276983e65eSMilanka Ringwald pos += 3; 1028adaba9f3SMatthias Ringwald log_info(" 0x%06" PRIx32 ", ", company_id); 10294f5eb797SMilanka Ringwald 10304f5eb797SMilanka Ringwald offset = 0; 10314f5eb797SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10324f5eb797SMilanka Ringwald event[offset++] = sizeof(event) - 2; 10334f5eb797SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_GET_CAPABILITY_COMPANY_ID; 10344f5eb797SMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10354f5eb797SMilanka Ringwald offset += 2; 10364f5eb797SMilanka Ringwald event[offset++] = ctype; 10374f5eb797SMilanka Ringwald event[offset++] = 0; 10384f5eb797SMilanka Ringwald little_endian_store_24(event, offset, company_id); 10394f5eb797SMilanka Ringwald offset += 3; 10404f5eb797SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, offset); 10414f5eb797SMilanka Ringwald } 10424f5eb797SMilanka Ringwald 10434f5eb797SMilanka Ringwald offset = 0; 10444f5eb797SMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10454f5eb797SMilanka Ringwald event[offset++] = sizeof(event) - 2; 10464f5eb797SMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_GET_CAPABILITY_COMPANY_ID_DONE; 10474f5eb797SMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 10484f5eb797SMilanka Ringwald offset += 2; 10494f5eb797SMilanka Ringwald event[offset++] = ctype; 10504f5eb797SMilanka Ringwald event[offset++] = 0; 10514f5eb797SMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, offset); 10524f5eb797SMilanka Ringwald break; 10534f5eb797SMilanka Ringwald 10546983e65eSMilanka Ringwald case AVRCP_CAPABILITY_ID_EVENT: 10553032b6e1SMilanka Ringwald for (i = 0; (i < capability_count) && ((size - pos) >= 1); i++){ 10566983e65eSMilanka Ringwald uint8_t event_id = packet[pos++]; 10573b8b393aSMilanka Ringwald connection->target_supported_notifications |= (1 << event_id); 10586983e65eSMilanka Ringwald } 1059274ca16fSMilanka Ringwald 1060274ca16fSMilanka Ringwald // if the get supported events query is triggered by avrcp_controller_enable_notification call, 1061274ca16fSMilanka Ringwald // avrcp_controller_emit_supported_events should be suppressed 10623b8b393aSMilanka Ringwald if (connection->target_supported_notifications_suppress_emit_result){ 10633b8b393aSMilanka Ringwald connection->target_supported_notifications_suppress_emit_result = false; 1064274ca16fSMilanka Ringwald // also, notification might not be supported 1065274ca16fSMilanka Ringwald // if so, emit AVRCP_SUBEVENT_ENABLE_NOTIFICATION_COMPLETE event to app, 1066274ca16fSMilanka Ringwald // and update notifications_to_register bitmap 1067274ca16fSMilanka Ringwald for (i = (uint8_t)AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; i < (uint8_t) AVRCP_NOTIFICATION_EVENT_LAST_INDEX; i++){ 1068274ca16fSMilanka Ringwald if ((connection->notifications_to_register & (1<<i)) != 0){ 10693b8b393aSMilanka Ringwald if ((connection->target_supported_notifications & (1<<i)) == 0){ 1070b2e02b8dSMilanka Ringwald avrcp_controller_emit_notification_complete(connection, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE, i, false); 1071274ca16fSMilanka Ringwald connection->notifications_to_register &= ~(1 << i); 1072274ca16fSMilanka Ringwald } 1073274ca16fSMilanka Ringwald } 1074274ca16fSMilanka Ringwald } 10752ac1dc76SMilanka Ringwald break; 10762ac1dc76SMilanka Ringwald } 1077274ca16fSMilanka Ringwald // supported events are emitted only if the get supported events query 1078274ca16fSMilanka Ringwald // is triggered by avrcp_controller_get_supported_events call 1079ff243a1bSMilanka Ringwald avrcp_controller_emit_supported_events(connection); 10806983e65eSMilanka Ringwald break; 10817bbeb3adSMilanka Ringwald 10827bbeb3adSMilanka Ringwald default: 1083cb925874SMatthias Ringwald // ignore 10847bbeb3adSMilanka Ringwald break; 10856983e65eSMilanka Ringwald } 10866983e65eSMilanka Ringwald break; 10876983e65eSMilanka Ringwald } 108816dc7cb4SMilanka Ringwald 10896983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_PLAY_STATUS:{ 10906983e65eSMilanka Ringwald uint32_t song_length = big_endian_read_32(packet, pos); 10916983e65eSMilanka Ringwald pos += 4; 10926983e65eSMilanka Ringwald uint32_t song_position = big_endian_read_32(packet, pos); 10936983e65eSMilanka Ringwald pos += 4; 10946983e65eSMilanka Ringwald uint8_t play_status = packet[pos]; 10956983e65eSMilanka Ringwald 10966983e65eSMilanka Ringwald uint8_t event[15]; 10976983e65eSMilanka Ringwald int offset = 0; 10986983e65eSMilanka Ringwald event[offset++] = HCI_EVENT_AVRCP_META; 10996983e65eSMilanka Ringwald event[offset++] = sizeof(event) - 2; 11006983e65eSMilanka Ringwald event[offset++] = AVRCP_SUBEVENT_PLAY_STATUS; 11016983e65eSMilanka Ringwald little_endian_store_16(event, offset, connection->avrcp_cid); 11026983e65eSMilanka Ringwald offset += 2; 11036983e65eSMilanka Ringwald event[offset++] = ctype; 11046983e65eSMilanka Ringwald little_endian_store_32(event, offset, song_length); 11056983e65eSMilanka Ringwald offset += 4; 11066983e65eSMilanka Ringwald little_endian_store_32(event, offset, song_position); 11076983e65eSMilanka Ringwald offset += 4; 11086983e65eSMilanka Ringwald event[offset++] = play_status; 11096983e65eSMilanka Ringwald (*avrcp_controller_context.avrcp_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 11106983e65eSMilanka Ringwald break; 11116983e65eSMilanka Ringwald } 11126983e65eSMilanka Ringwald 11136983e65eSMilanka Ringwald case AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES:{ 111461920526SMilanka Ringwald switch (vendor_dependent_packet_type){ 11151bf7a74fSMilanka Ringwald case AVRCP_START_PACKET: 11161bf7a74fSMilanka Ringwald case AVRCP_SINGLE_PACKET: 11171bf7a74fSMilanka Ringwald avrcp_parser_reset(connection); 11181bf7a74fSMilanka Ringwald connection->list_size = param_length; 11191bf7a74fSMilanka Ringwald connection->num_attributes = packet[pos++]; 11208b2b4034SMilanka Ringwald 11213d9ab93fSMilanka Ringwald avrcp_controller_parse_and_emit_element_attrs(packet+pos, size-pos, connection, ctype); 112261920526SMilanka Ringwald if (vendor_dependent_packet_type == AVRCP_START_PACKET){ 11231bf7a74fSMilanka Ringwald avrcp_controller_request_continue_response(connection); 11246983e65eSMilanka Ringwald } 11256983e65eSMilanka Ringwald break; 11261bf7a74fSMilanka Ringwald case AVRCP_CONTINUE_PACKET: 11271bf7a74fSMilanka Ringwald case AVRCP_END_PACKET: 11288b2b4034SMilanka Ringwald connection->num_received_fragments++; 112961920526SMilanka Ringwald 11308b2b4034SMilanka Ringwald if (connection->num_received_fragments < connection->max_num_fragments){ 11313d9ab93fSMilanka Ringwald avrcp_controller_parse_and_emit_element_attrs(packet+pos, size-pos, connection, ctype); 113261920526SMilanka Ringwald 113361920526SMilanka Ringwald if (vendor_dependent_packet_type == AVRCP_CONTINUE_PACKET){ 11348b2b4034SMilanka Ringwald avrcp_controller_request_continue_response(connection); 11358b2b4034SMilanka Ringwald } 11368b2b4034SMilanka Ringwald } else { 11378b2b4034SMilanka Ringwald avrcp_controller_emit_now_playing_info_event_done(avrcp_controller_context.avrcp_callback, connection->avrcp_cid, ctype, 1); 11388b2b4034SMilanka Ringwald avrcp_parser_reset(connection); 113961920526SMilanka Ringwald avrcp_controller_request_abort_continuation(connection); 11408b2b4034SMilanka Ringwald } 11411bf7a74fSMilanka Ringwald break; 11427bbeb3adSMilanka Ringwald default: 11437bbeb3adSMilanka Ringwald // TODO check 11447bbeb3adSMilanka Ringwald btstack_assert(false); 11457bbeb3adSMilanka Ringwald break; 11461bf7a74fSMilanka Ringwald } 11476983e65eSMilanka Ringwald } 11486983e65eSMilanka Ringwald default: 11496983e65eSMilanka Ringwald break; 11506983e65eSMilanka Ringwald } 11516983e65eSMilanka Ringwald break; 11526983e65eSMilanka Ringwald case AVRCP_CMD_OPCODE_PASS_THROUGH:{ 115399702381SMatthias Ringwald if ((size - pos) < 1) return; 11546983e65eSMilanka Ringwald uint8_t operation_id = packet[pos++]; 11556983e65eSMilanka Ringwald switch (connection->state){ 11566983e65eSMilanka Ringwald case AVCTP_W2_RECEIVE_PRESS_RESPONSE: 1157a2e9e6d7SMilanka Ringwald // trigger release for simple command: 1158a2e9e6d7SMilanka Ringwald if (!connection->press_and_hold_cmd_active){ 11596983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 1160a2e9e6d7SMilanka Ringwald break; 1161a2e9e6d7SMilanka Ringwald } 1162a2e9e6d7SMilanka Ringwald // for press and hold, send release if it just has been requested, otherwise, wait for next repeat 1163a2e9e6d7SMilanka Ringwald if (connection->press_and_hold_cmd_release){ 1164a2e9e6d7SMilanka Ringwald connection->press_and_hold_cmd_release = false; 1165a2e9e6d7SMilanka Ringwald connection->state = AVCTP_W2_SEND_RELEASE_COMMAND; 1166a2e9e6d7SMilanka Ringwald } else { 1167a2e9e6d7SMilanka Ringwald connection->state = AVCTP_W4_STOP; 11686983e65eSMilanka Ringwald } 11696983e65eSMilanka Ringwald break; 11706983e65eSMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 11716983e65eSMilanka Ringwald connection->state = AVCTP_CONNECTION_OPENED; 11726983e65eSMilanka Ringwald break; 11736983e65eSMilanka Ringwald default: 11746983e65eSMilanka Ringwald break; 11756983e65eSMilanka Ringwald } 11766983e65eSMilanka Ringwald if (connection->state == AVCTP_W4_STOP){ 11773d9ab93fSMilanka Ringwald avrcp_controller_emit_operation_status(avrcp_controller_context.avrcp_callback, AVRCP_SUBEVENT_OPERATION_START, connection->avrcp_cid, ctype, operation_id); 11786983e65eSMilanka Ringwald } 11796983e65eSMilanka Ringwald if (connection->state == AVCTP_CONNECTION_OPENED) { 11806983e65eSMilanka Ringwald // RELEASE response 11816983e65eSMilanka Ringwald operation_id = operation_id & 0x7F; 11823d9ab93fSMilanka Ringwald avrcp_controller_emit_operation_status(avrcp_controller_context.avrcp_callback, AVRCP_SUBEVENT_OPERATION_COMPLETE, connection->avrcp_cid, ctype, operation_id); 11836983e65eSMilanka Ringwald } 11846983e65eSMilanka Ringwald if (connection->state == AVCTP_W2_SEND_RELEASE_COMMAND){ 11856983e65eSMilanka Ringwald // PRESS response 11863d9ab93fSMilanka Ringwald avrcp_controller_request_pass_through_release_control_cmd(connection); 11876983e65eSMilanka Ringwald } 11886983e65eSMilanka Ringwald break; 11896983e65eSMilanka Ringwald } 11906983e65eSMilanka Ringwald default: 11916983e65eSMilanka Ringwald break; 11926983e65eSMilanka Ringwald } 11932a7bb97aSMatthias Ringwald 11942a7bb97aSMatthias Ringwald // trigger pending notification reqistrations 11950e588213SMatthias Ringwald if ((connection->state == AVCTP_CONNECTION_OPENED) && connection->notifications_to_register){ 11962a7bb97aSMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 11972a7bb97aSMatthias Ringwald } 11986983e65eSMilanka Ringwald } 11996983e65eSMilanka Ringwald 12006983e65eSMilanka Ringwald static void avrcp_controller_handle_can_send_now(avrcp_connection_t * connection){ 12016983e65eSMilanka Ringwald switch (connection->state){ 12026983e65eSMilanka Ringwald case AVCTP_W2_SEND_PRESS_COMMAND: 12036983e65eSMilanka Ringwald case AVCTP_W2_SEND_COMMAND: 12046983e65eSMilanka Ringwald case AVCTP_W2_SEND_RELEASE_COMMAND: 1205589c7712SMilanka Ringwald case AVCTP_W2_SEND_AVCTP_FRAGMENTED_MESSAGE: 12064a23d858SMilanka Ringwald avrcp_send_cmd_with_avctp_fragmentation(connection); 12074a23d858SMilanka Ringwald 12084a23d858SMilanka Ringwald if (connection->data_offset < connection->data_len){ 1209c4b5c3d5SMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 12104a23d858SMilanka Ringwald return; 12114a23d858SMilanka Ringwald } 12124a23d858SMilanka Ringwald if (connection->state == AVCTP_W2_SEND_PRESS_COMMAND){ 12134a23d858SMilanka Ringwald connection->state = AVCTP_W2_RECEIVE_PRESS_RESPONSE; 1214c4b5c3d5SMatthias Ringwald } else { 1215c4b5c3d5SMatthias Ringwald connection->state = AVCTP_W2_RECEIVE_RESPONSE; 1216c4b5c3d5SMatthias Ringwald } 12174a23d858SMilanka Ringwald break; 121816dc7cb4SMilanka Ringwald default: 121916dc7cb4SMilanka Ringwald break; 122016dc7cb4SMilanka Ringwald } 12214a23d858SMilanka Ringwald 122216dc7cb4SMilanka Ringwald // send register notification if queued 122316dc7cb4SMilanka Ringwald if (connection->notifications_to_register != 0){ 12244701e250SMilanka Ringwald uint8_t event_id; 122599845bb7SMilanka Ringwald for (event_id = (uint8_t)AVRCP_NOTIFICATION_EVENT_FIRST_INDEX; event_id < (uint8_t)AVRCP_NOTIFICATION_EVENT_LAST_INDEX; event_id++){ 12264701e250SMilanka Ringwald if (connection->notifications_to_register & (1<<event_id)){ 12274701e250SMilanka Ringwald connection->notifications_to_register &= ~ (1 << event_id); 12284701e250SMilanka Ringwald avrcp_send_register_notification(connection, event_id); 122916dc7cb4SMilanka Ringwald return; 123016dc7cb4SMilanka Ringwald } 123116dc7cb4SMilanka Ringwald } 12326983e65eSMilanka Ringwald } 12336983e65eSMilanka Ringwald } 12346983e65eSMilanka Ringwald 12356983e65eSMilanka Ringwald static void avrcp_controller_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 12366983e65eSMilanka Ringwald avrcp_connection_t * connection; 12376983e65eSMilanka Ringwald 12386983e65eSMilanka Ringwald switch (packet_type) { 12396983e65eSMilanka Ringwald case L2CAP_DATA_PACKET: 12401945fe3eSMilanka Ringwald connection = avrcp_get_connection_for_l2cap_signaling_cid_for_role(AVRCP_CONTROLLER, channel); 12416983e65eSMilanka Ringwald avrcp_handle_l2cap_data_packet_for_signaling_connection(connection, packet, size); 12426983e65eSMilanka Ringwald break; 12430036e267SMilanka Ringwald 12446983e65eSMilanka Ringwald case HCI_EVENT_PACKET: 12456983e65eSMilanka Ringwald switch (hci_event_packet_get_type(packet)){ 12466983e65eSMilanka Ringwald case L2CAP_EVENT_CAN_SEND_NOW: 12471945fe3eSMilanka Ringwald connection = avrcp_get_connection_for_l2cap_signaling_cid_for_role(AVRCP_CONTROLLER, channel); 12486983e65eSMilanka Ringwald avrcp_controller_handle_can_send_now(connection); 12496983e65eSMilanka Ringwald break; 12506983e65eSMilanka Ringwald default: 12516983e65eSMilanka Ringwald break; 12526983e65eSMilanka Ringwald } 12536983e65eSMilanka Ringwald default: 12546983e65eSMilanka Ringwald break; 12556983e65eSMilanka Ringwald } 12566983e65eSMilanka Ringwald } 12576983e65eSMilanka Ringwald 12583d9ab93fSMilanka 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){ 12593d9ab93fSMilanka Ringwald avrcp_create_sdp_record(1, service, service_record_handle, avrcp_controller_supports_browsing(supported_features), supported_features, service_name, service_provider_name); 12603d9ab93fSMilanka Ringwald } 12613d9ab93fSMilanka Ringwald 12626983e65eSMilanka Ringwald void avrcp_controller_init(void){ 12636983e65eSMilanka Ringwald avrcp_controller_context.role = AVRCP_CONTROLLER; 12646983e65eSMilanka Ringwald avrcp_controller_context.packet_handler = avrcp_controller_packet_handler; 1265b106f728SMilanka Ringwald avrcp_register_controller_packet_handler(&avrcp_controller_packet_handler); 12666983e65eSMilanka Ringwald } 12676983e65eSMilanka Ringwald 1268680af5dcSMatthias Ringwald void avrcp_controller_deinit(void){ 1269680af5dcSMatthias Ringwald memset(&avrcp_controller_context, 0, sizeof(avrcp_context_t)); 1270680af5dcSMatthias Ringwald } 1271680af5dcSMatthias Ringwald 12726983e65eSMilanka Ringwald void avrcp_controller_register_packet_handler(btstack_packet_handler_t callback){ 1273be4cc80aSMilanka Ringwald btstack_assert(callback != NULL); 12746983e65eSMilanka Ringwald avrcp_controller_context.avrcp_callback = callback; 12756983e65eSMilanka Ringwald } 12766983e65eSMilanka Ringwald 12773d9ab93fSMilanka Ringwald 12783d9ab93fSMilanka Ringwald uint8_t avrcp_controller_play(uint16_t avrcp_cid){ 12793d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PLAY, 0); 12803d9ab93fSMilanka Ringwald } 12813d9ab93fSMilanka Ringwald 12823d9ab93fSMilanka Ringwald uint8_t avrcp_controller_stop(uint16_t avrcp_cid){ 12833d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_STOP, 0); 12843d9ab93fSMilanka Ringwald } 12853d9ab93fSMilanka Ringwald 12863d9ab93fSMilanka Ringwald uint8_t avrcp_controller_pause(uint16_t avrcp_cid){ 12873d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PAUSE, 0); 12883d9ab93fSMilanka Ringwald } 12893d9ab93fSMilanka Ringwald 12903d9ab93fSMilanka Ringwald uint8_t avrcp_controller_forward(uint16_t avrcp_cid){ 12913d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FORWARD, 0); 12923d9ab93fSMilanka Ringwald } 12933d9ab93fSMilanka Ringwald 12943d9ab93fSMilanka Ringwald uint8_t avrcp_controller_backward(uint16_t avrcp_cid){ 12953d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_BACKWARD, 0); 12963d9ab93fSMilanka Ringwald } 12973d9ab93fSMilanka Ringwald 12983d9ab93fSMilanka Ringwald uint8_t avrcp_controller_volume_up(uint16_t avrcp_cid){ 12993d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_UP, 0); 13003d9ab93fSMilanka Ringwald } 13013d9ab93fSMilanka Ringwald 13023d9ab93fSMilanka Ringwald uint8_t avrcp_controller_volume_down(uint16_t avrcp_cid){ 13033d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_DOWN, 0); 13043d9ab93fSMilanka Ringwald } 13053d9ab93fSMilanka Ringwald 13063d9ab93fSMilanka Ringwald uint8_t avrcp_controller_mute(uint16_t avrcp_cid){ 13073d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_MUTE, 0); 13083d9ab93fSMilanka Ringwald } 13093d9ab93fSMilanka Ringwald 13103d9ab93fSMilanka Ringwald uint8_t avrcp_controller_skip(uint16_t avrcp_cid){ 13113d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_SKIP, 0); 13123d9ab93fSMilanka Ringwald } 13133d9ab93fSMilanka Ringwald 13143d9ab93fSMilanka Ringwald uint8_t avrcp_controller_fast_forward(uint16_t avrcp_cid){ 13153d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FAST_FORWARD, 0); 13163d9ab93fSMilanka Ringwald } 13173d9ab93fSMilanka Ringwald 13183d9ab93fSMilanka Ringwald uint8_t avrcp_controller_rewind(uint16_t avrcp_cid){ 13193d9ab93fSMilanka Ringwald return request_single_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_REWIND, 0); 13203d9ab93fSMilanka Ringwald } 13213d9ab93fSMilanka Ringwald 13223d9ab93fSMilanka Ringwald /* start continuous cmds */ 13233d9ab93fSMilanka Ringwald 132437a7ced0SMatthias Ringwald uint8_t avrcp_controller_start_press_and_hold_cmd(uint16_t avrcp_cid, avrcp_operation_id_t operation_id){ 132537a7ced0SMatthias Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, operation_id, 0); 132637a7ced0SMatthias Ringwald } 132737a7ced0SMatthias Ringwald 13283d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_play(uint16_t avrcp_cid){ 13293d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PLAY, 0); 13303d9ab93fSMilanka Ringwald } 13313d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_stop(uint16_t avrcp_cid){ 13323d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_STOP, 0); 13333d9ab93fSMilanka Ringwald } 13343d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_pause(uint16_t avrcp_cid){ 13353d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_PAUSE, 0); 13363d9ab93fSMilanka Ringwald } 13373d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_forward(uint16_t avrcp_cid){ 13383d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FORWARD, 0); 13393d9ab93fSMilanka Ringwald } 13403d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_backward(uint16_t avrcp_cid){ 13413d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_BACKWARD, 0); 13423d9ab93fSMilanka Ringwald } 13433d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_fast_forward(uint16_t avrcp_cid){ 13443d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_FAST_FORWARD, 0); 13453d9ab93fSMilanka Ringwald } 13463d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_rewind(uint16_t avrcp_cid){ 13473d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_REWIND, 0); 13483d9ab93fSMilanka Ringwald } 13493d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_volume_up(uint16_t avrcp_cid){ 13503d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_UP, 0); 13513d9ab93fSMilanka Ringwald } 13523d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_volume_down(uint16_t avrcp_cid){ 13533d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_VOLUME_DOWN, 0); 13543d9ab93fSMilanka Ringwald } 13553d9ab93fSMilanka Ringwald uint8_t avrcp_controller_press_and_hold_mute(uint16_t avrcp_cid){ 13563d9ab93fSMilanka Ringwald return request_continuous_pass_through_press_control_cmd(avrcp_cid, AVRCP_OPERATION_ID_MUTE, 0); 13573d9ab93fSMilanka Ringwald } 13583d9ab93fSMilanka Ringwald 13593d9ab93fSMilanka Ringwald /* stop continuous cmds */ 13603d9ab93fSMilanka Ringwald uint8_t avrcp_controller_release_press_and_hold_cmd(uint16_t avrcp_cid){ 13613d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 13623d9ab93fSMilanka Ringwald if (!connection){ 13633d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 13643d9ab93fSMilanka Ringwald } 1365a2e9e6d7SMilanka Ringwald 1366a2e9e6d7SMilanka Ringwald switch (connection->state){ 1367a2e9e6d7SMilanka Ringwald // respond when we receive response for (repeated) press command 1368a2e9e6d7SMilanka Ringwald case AVCTP_W2_RECEIVE_PRESS_RESPONSE: 1369a2e9e6d7SMilanka Ringwald connection->press_and_hold_cmd_release = true; 1370a2e9e6d7SMilanka Ringwald break; 1371a2e9e6d7SMilanka Ringwald 1372a2e9e6d7SMilanka Ringwald // release already sent or on the way, nothing to do 1373a2e9e6d7SMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 1374a2e9e6d7SMilanka Ringwald case AVCTP_W2_SEND_RELEASE_COMMAND: 1375a2e9e6d7SMilanka Ringwald break; 1376a2e9e6d7SMilanka Ringwald 1377a2e9e6d7SMilanka Ringwald // about to send next repeated press command or wait for it -> release right away 1378a2e9e6d7SMilanka Ringwald case AVCTP_W2_SEND_PRESS_COMMAND: 1379a2e9e6d7SMilanka Ringwald case AVCTP_W4_STOP: 13803d9ab93fSMilanka Ringwald return avrcp_controller_request_pass_through_release_control_cmd(connection); 1381a2e9e6d7SMilanka Ringwald 1382a2e9e6d7SMilanka Ringwald // otherwise reject request 1383a2e9e6d7SMilanka Ringwald default: 1384a2e9e6d7SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 1385a2e9e6d7SMilanka Ringwald } 1386a2e9e6d7SMilanka Ringwald return ERROR_CODE_SUCCESS; 13873d9ab93fSMilanka Ringwald } 13883d9ab93fSMilanka Ringwald 13893d9ab93fSMilanka Ringwald uint8_t avrcp_controller_enable_notification(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id){ 13903d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 13913d9ab93fSMilanka Ringwald if (!connection){ 13923d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 13933d9ab93fSMilanka Ringwald } 13942b8461f9SMilanka Ringwald return avrcp_controller_register_notification(connection, event_id); 13953d9ab93fSMilanka Ringwald } 13963d9ab93fSMilanka Ringwald 13973d9ab93fSMilanka Ringwald uint8_t avrcp_controller_disable_notification(uint16_t avrcp_cid, avrcp_notification_event_id_t event_id){ 13983d9ab93fSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 13993d9ab93fSMilanka Ringwald if (!connection){ 14003d9ab93fSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14013d9ab93fSMilanka Ringwald } 14023b8b393aSMilanka Ringwald if (!connection->target_supported_notifications_queried){ 140379464f8dSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 140479464f8dSMilanka Ringwald } 140579464f8dSMilanka Ringwald 14063b8b393aSMilanka Ringwald if ((connection->target_supported_notifications & (1 << event_id)) == 0){ 140779464f8dSMilanka Ringwald return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 140879464f8dSMilanka Ringwald } 140979464f8dSMilanka Ringwald 14101d3f7785SMilanka Ringwald if ((connection->notifications_enabled & (1 << event_id)) == 0){ 1411b2e02b8dSMilanka Ringwald return ERROR_CODE_SUCCESS; 1412b2e02b8dSMilanka Ringwald } 1413b2e02b8dSMilanka Ringwald 14143d9ab93fSMilanka Ringwald connection->notifications_to_deregister |= (1 << event_id); 14153d9ab93fSMilanka Ringwald return ERROR_CODE_SUCCESS; 14163d9ab93fSMilanka Ringwald } 14173d9ab93fSMilanka Ringwald 14186983e65eSMilanka Ringwald uint8_t avrcp_controller_unit_info(uint16_t avrcp_cid){ 14191945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14206983e65eSMilanka Ringwald if (!connection){ 14216983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14226983e65eSMilanka Ringwald } 14236983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 14246983e65eSMilanka Ringwald 14255d3671d9SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 142666b242bbSMilanka Ringwald avrcp_controller_custome_command_data_init(connection, AVRCP_CMD_OPCODE_UNIT_INFO, AVRCP_CTYPE_STATUS, AVRCP_SUBUNIT_TYPE_UNIT, AVRCP_SUBUNIT_ID_IGNORE, 0, 0); 14275d3671d9SMilanka Ringwald 14285d3671d9SMilanka Ringwald memset(connection->data, 0xFF, 5); 14295d3671d9SMilanka Ringwald connection->data_len = 5; 14306983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 14316983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 14326983e65eSMilanka Ringwald } 14336983e65eSMilanka Ringwald 1434ad75da14SMilanka Ringwald uint8_t avrcp_controller_subunit_info(uint16_t avrcp_cid){ 14351945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1436ad75da14SMilanka Ringwald if (!connection){ 1437ad75da14SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1438ad75da14SMilanka Ringwald } 1439ad75da14SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1440ad75da14SMilanka Ringwald 14415d3671d9SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 144266b242bbSMilanka Ringwald avrcp_controller_custome_command_data_init(connection, AVRCP_CMD_OPCODE_SUBUNIT_INFO, AVRCP_CTYPE_STATUS, AVRCP_SUBUNIT_TYPE_UNIT, AVRCP_SUBUNIT_ID_IGNORE, 0, 0); 14435d3671d9SMilanka Ringwald 14445d3671d9SMilanka Ringwald memset(connection->data, 0xFF, 5); 14455d3671d9SMilanka Ringwald connection->data[0] = 7; // page: 0, extention_code: 7 14465d3671d9SMilanka Ringwald connection->data_len = 5; 1447ad75da14SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1448ad75da14SMilanka Ringwald return ERROR_CODE_SUCCESS; 1449ad75da14SMilanka Ringwald } 1450ad75da14SMilanka Ringwald 14511f94eaa5SMilanka Ringwald uint8_t avrcp_controller_get_supported_company_ids(uint16_t avrcp_cid){ 14521945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14536983e65eSMilanka Ringwald if (!connection){ 14546983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14556983e65eSMilanka Ringwald } 1456826b3cedSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 1457826b3cedSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 1458826b3cedSMilanka Ringwald } 14591f94eaa5SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_COMPANY); 14601f94eaa5SMilanka Ringwald return ERROR_CODE_SUCCESS; 14616983e65eSMilanka Ringwald } 14626983e65eSMilanka Ringwald 14636983e65eSMilanka Ringwald uint8_t avrcp_controller_get_supported_events(uint16_t avrcp_cid){ 14641f94eaa5SMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14651f94eaa5SMilanka Ringwald if (!connection){ 14661f94eaa5SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14671f94eaa5SMilanka Ringwald } 14681f94eaa5SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 14691f94eaa5SMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 14701f94eaa5SMilanka Ringwald } 14711f94eaa5SMilanka Ringwald 14723b8b393aSMilanka Ringwald if (!connection->target_supported_notifications_queried){ 14733b8b393aSMilanka Ringwald connection->target_supported_notifications_queried = true; 14741f94eaa5SMilanka Ringwald avrcp_controller_get_capabilities_for_connection(connection, AVRCP_CAPABILITY_ID_EVENT); 14751f94eaa5SMilanka Ringwald return ERROR_CODE_SUCCESS; 14766983e65eSMilanka Ringwald } 14776983e65eSMilanka Ringwald 14782ac1dc76SMilanka Ringwald avrcp_controller_emit_supported_events(connection); 14792ac1dc76SMilanka Ringwald return ERROR_CODE_SUCCESS; 14802ac1dc76SMilanka Ringwald } 14812ac1dc76SMilanka Ringwald 14826983e65eSMilanka Ringwald uint8_t avrcp_controller_get_play_status(uint16_t avrcp_cid){ 14831945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 14846983e65eSMilanka Ringwald if (!connection){ 14856983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 14866983e65eSMilanka Ringwald } 14876983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 14888d316b1bSMilanka Ringwald 14896983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 149066b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_PLAY_STATUS); 14918d316b1bSMilanka Ringwald 14925d3671d9SMilanka Ringwald connection->data_len = 0; 14936983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 14946983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 14956983e65eSMilanka Ringwald } 14966983e65eSMilanka Ringwald 1497864d08b0SMilanka Ringwald uint8_t avrcp_controller_set_addressed_player(uint16_t avrcp_cid, uint16_t addressed_player_id){ 14981945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1499864d08b0SMilanka Ringwald if (!connection){ 1500864d08b0SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1501864d08b0SMilanka Ringwald } 1502864d08b0SMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1503864d08b0SMilanka Ringwald 15048d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 150566b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_ADDRESSED_PLAYER); 15068d316b1bSMilanka Ringwald 15075d3671d9SMilanka Ringwald connection->data_len = 2; 15085d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 0, addressed_player_id); 1509864d08b0SMilanka Ringwald 1510864d08b0SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1511864d08b0SMilanka Ringwald return ERROR_CODE_SUCCESS; 1512864d08b0SMilanka Ringwald } 15131bf7a74fSMilanka Ringwald 151461920526SMilanka Ringwald uint8_t avrcp_controller_get_element_attributes(uint16_t avrcp_cid, uint8_t num_attributes, avrcp_media_attribute_id_t * attributes){ 15151945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 15166983e65eSMilanka Ringwald if (!connection){ 15176983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 15186983e65eSMilanka Ringwald } 151961920526SMilanka Ringwald 15206983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 152161920526SMilanka Ringwald 152261920526SMilanka Ringwald if (num_attributes >= AVRCP_MEDIA_ATTR_RESERVED) { 152361920526SMilanka Ringwald return ERROR_CODE_INVALID_HCI_COMMAND_PARAMETERS; 152461920526SMilanka Ringwald } 15256983e65eSMilanka Ringwald 15268d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 152766b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES); 15288d316b1bSMilanka Ringwald 15295d3671d9SMilanka Ringwald uint8_t pos = 0; 15306983e65eSMilanka Ringwald // write 8 bytes value 15315d3671d9SMilanka Ringwald memset(connection->data, pos, 8); // identifier: PLAYING 15326983e65eSMilanka Ringwald pos += 8; 15336983e65eSMilanka Ringwald 15345d3671d9SMilanka Ringwald uint8_t num_attributes_index = pos; 15355d3671d9SMilanka Ringwald pos++; 153661920526SMilanka Ringwald 15375d3671d9SMilanka Ringwald // If num_attributes is set to zero, all attribute information shall be returned, 15385d3671d9SMilanka Ringwald // and the AttributeID field is omitted 15395d3671d9SMilanka Ringwald connection->data[num_attributes_index] = 0; 15405d3671d9SMilanka Ringwald uint8_t i; 154161920526SMilanka Ringwald for (i = 0; i < num_attributes; i++){ 15425d3671d9SMilanka Ringwald // ignore invalid attribute ID and "get all attributes" 15435d3671d9SMilanka Ringwald if (AVRCP_MEDIA_ATTR_ALL > attributes[i] && attributes[i] < AVRCP_MEDIA_ATTR_RESERVED){ 15446983e65eSMilanka Ringwald // every attribute is 4 bytes long 15455d3671d9SMilanka Ringwald big_endian_store_32(connection->data, pos, attributes[i]); 154661920526SMilanka Ringwald pos += 4; 15475d3671d9SMilanka Ringwald connection->data[num_attributes_index]++; 15485d3671d9SMilanka Ringwald } 154961920526SMilanka Ringwald } 15506983e65eSMilanka Ringwald 15515d3671d9SMilanka Ringwald // Parameter Length 15525d3671d9SMilanka Ringwald connection->data_len = pos; 15535d3671d9SMilanka Ringwald 15546983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 15556983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 15566983e65eSMilanka Ringwald } 15576983e65eSMilanka Ringwald 155861920526SMilanka Ringwald uint8_t avrcp_controller_get_now_playing_info(uint16_t avrcp_cid){ 155961920526SMilanka Ringwald return avrcp_controller_get_element_attributes(avrcp_cid, 0, NULL); 156061920526SMilanka Ringwald } 156161920526SMilanka Ringwald 156266e22952SMilanka 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){ 156366e22952SMilanka Ringwald if (media_attribute_id == AVRCP_MEDIA_ATTR_ALL){ 156466e22952SMilanka Ringwald return avrcp_controller_get_now_playing_info(avrcp_cid); 156566e22952SMilanka Ringwald } 156666e22952SMilanka Ringwald return avrcp_controller_get_element_attributes(avrcp_cid, 1, &media_attribute_id); 156766e22952SMilanka Ringwald } 156866e22952SMilanka Ringwald 15696983e65eSMilanka Ringwald uint8_t avrcp_controller_set_absolute_volume(uint16_t avrcp_cid, uint8_t volume){ 15701945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 15716983e65eSMilanka Ringwald if (!connection){ 15726983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 15736983e65eSMilanka Ringwald } 15746e7485d0SMilanka Ringwald 15756e7485d0SMilanka Ringwald // 15766e7485d0SMilanka Ringwald // allow sending of multiple set abs volume commands without waiting for response 15776e7485d0SMilanka Ringwald // 15786e7485d0SMilanka Ringwald uint8_t status = ERROR_CODE_COMMAND_DISALLOWED; 15796e7485d0SMilanka Ringwald switch (connection->state){ 15806e7485d0SMilanka Ringwald case AVCTP_CONNECTION_OPENED: 15816e7485d0SMilanka Ringwald status = ERROR_CODE_SUCCESS; 15826e7485d0SMilanka Ringwald break; 15836e7485d0SMilanka Ringwald case AVCTP_W2_RECEIVE_RESPONSE: 15846e7485d0SMilanka Ringwald // - is pending response also set abs volume 15856e7485d0SMilanka Ringwald if (connection->command_opcode != AVRCP_CMD_OPCODE_VENDOR_DEPENDENT) break; 15866e7485d0SMilanka Ringwald if (connection->command_type != AVRCP_CTYPE_CONTROL) break; 15876e7485d0SMilanka Ringwald if (connection->subunit_type != AVRCP_SUBUNIT_TYPE_PANEL) break; 15886e7485d0SMilanka Ringwald if (connection->subunit_id != AVRCP_SUBUNIT_ID) break; 15895d3671d9SMilanka Ringwald if (connection->pdu_id != AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME) break; 15906e7485d0SMilanka Ringwald // - is next transaction id valid in window 15916e7485d0SMilanka Ringwald if (avrcp_controller_is_transaction_id_valid(connection, avrcp_controller_calc_next_transaction_label(connection->transaction_id_counter)) == false) break; 15926e7485d0SMilanka Ringwald status = ERROR_CODE_SUCCESS; 15936e7485d0SMilanka Ringwald break; 15946e7485d0SMilanka Ringwald default: 15956e7485d0SMilanka Ringwald break; 15966e7485d0SMilanka Ringwald } 15976e7485d0SMilanka Ringwald if (status != ERROR_CODE_SUCCESS) return status; 15986e7485d0SMilanka Ringwald 15996983e65eSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 160066b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME); 16016983e65eSMilanka Ringwald 16026983e65eSMilanka Ringwald // Parameter Length 16035d3671d9SMilanka Ringwald connection->data_len = 1; 16045d3671d9SMilanka Ringwald connection->data[0] = volume; 16056983e65eSMilanka Ringwald 16066983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16076983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16086983e65eSMilanka Ringwald } 16096983e65eSMilanka Ringwald 16106983e65eSMilanka Ringwald uint8_t avrcp_controller_query_shuffle_and_repeat_modes(uint16_t avrcp_cid){ 16111945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 16126983e65eSMilanka Ringwald if (!connection){ 16136983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 16146983e65eSMilanka Ringwald } 16156983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 16166983e65eSMilanka Ringwald 16178d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 161866b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_STATUS, AVRCP_PDU_ID_GET_CURRENT_PLAYER_APPLICATION_SETTING_VALUE); 16198d316b1bSMilanka Ringwald 16205d3671d9SMilanka Ringwald connection->data_len = 5; 16215d3671d9SMilanka Ringwald connection->data[0] = 4; // NumPlayerApplicationSettingAttributeID 16226983e65eSMilanka Ringwald // PlayerApplicationSettingAttributeID1 AVRCP Spec, Appendix F, 133 16235d3671d9SMilanka Ringwald connection->data[1] = 0x01; // equalizer (1-OFF, 2-ON) 16245d3671d9SMilanka Ringwald connection->data[2] = 0x02; // repeat (1-off, 2-single track, 3-all tracks, 4-group repeat) 16255d3671d9SMilanka Ringwald connection->data[3] = 0x03; // shuffle (1-off, 2-all tracks, 3-group shuffle) 16265d3671d9SMilanka Ringwald connection->data[4] = 0x04; // scan (1-off, 2-all tracks, 3-group scan) 16275d3671d9SMilanka Ringwald 16286983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16296983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16306983e65eSMilanka Ringwald } 16316983e65eSMilanka Ringwald 16326983e65eSMilanka Ringwald static uint8_t avrcp_controller_set_current_player_application_setting_value(uint16_t avrcp_cid, uint8_t attr_id, uint8_t attr_value){ 16331945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 16346983e65eSMilanka Ringwald if (!connection){ 16356983e65eSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 16366983e65eSMilanka Ringwald } 16376983e65eSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 16386983e65eSMilanka Ringwald 16398d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 164066b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_SET_PLAYER_APPLICATION_SETTING_VALUE); 16418d316b1bSMilanka Ringwald 16426983e65eSMilanka Ringwald // Parameter Length 16435d3671d9SMilanka Ringwald connection->data_len = 3; 16445d3671d9SMilanka Ringwald connection->data[0] = 2; 16455d3671d9SMilanka Ringwald connection->data[1] = attr_id; 16465d3671d9SMilanka Ringwald connection->data[2] = attr_value; 16475d3671d9SMilanka Ringwald 16486983e65eSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 16496983e65eSMilanka Ringwald return ERROR_CODE_SUCCESS; 16506983e65eSMilanka Ringwald } 16516983e65eSMilanka Ringwald 16526983e65eSMilanka Ringwald uint8_t avrcp_controller_set_shuffle_mode(uint16_t avrcp_cid, avrcp_shuffle_mode_t mode){ 16530e588213SMatthias Ringwald if ((mode < AVRCP_SHUFFLE_MODE_OFF) || (mode > AVRCP_SHUFFLE_MODE_GROUP)) return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 16546983e65eSMilanka Ringwald return avrcp_controller_set_current_player_application_setting_value(avrcp_cid, 0x03, mode); 16556983e65eSMilanka Ringwald } 16566983e65eSMilanka Ringwald 16576983e65eSMilanka Ringwald uint8_t avrcp_controller_set_repeat_mode(uint16_t avrcp_cid, avrcp_repeat_mode_t mode){ 16580e588213SMatthias Ringwald if ((mode < AVRCP_REPEAT_MODE_OFF) || (mode > AVRCP_REPEAT_MODE_GROUP)) return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE; 16596983e65eSMilanka Ringwald return avrcp_controller_set_current_player_application_setting_value(avrcp_cid, 0x02, mode); 16606983e65eSMilanka Ringwald } 16616983e65eSMilanka Ringwald 16624614c049SMilanka 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){ 16631945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1664be65baf4SMilanka Ringwald if (!connection){ 1665be65baf4SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1666be65baf4SMilanka Ringwald } 16674931e24aSMilanka Ringwald if (connection->state != AVCTP_CONNECTION_OPENED){ 16684931e24aSMilanka Ringwald log_error("Connection in wrong state, expected %d, received %d", AVCTP_CONNECTION_OPENED, connection->state); 16694931e24aSMilanka Ringwald return ERROR_CODE_COMMAND_DISALLOWED; 16704931e24aSMilanka Ringwald } 1671be65baf4SMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 167266b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_PLAY_ITEM); 1673be65baf4SMilanka Ringwald 1674be65baf4SMilanka Ringwald // Parameter Length 16755d3671d9SMilanka Ringwald connection->data_len = 11; 16765d3671d9SMilanka Ringwald connection->data[0] = scope; 16775d3671d9SMilanka Ringwald memset(&connection->data[1], 0, 8); 1678be65baf4SMilanka Ringwald if (uid){ 16795d3671d9SMilanka Ringwald (void)memcpy(&connection->data[1], uid, 8); 1680be65baf4SMilanka Ringwald } 16815d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 9, uid_counter); 1682be65baf4SMilanka Ringwald 1683be65baf4SMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1684be65baf4SMilanka Ringwald return ERROR_CODE_SUCCESS; 1685be65baf4SMilanka Ringwald } 16868b2b4034SMilanka Ringwald 16874931e24aSMilanka 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){ 16881945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 16894931e24aSMilanka Ringwald if (!connection){ 16904931e24aSMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 16914931e24aSMilanka 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 } 16964931e24aSMilanka Ringwald 16978d316b1bSMilanka Ringwald connection->state = AVCTP_W2_SEND_COMMAND; 169866b242bbSMilanka Ringwald avrcp_controller_vendor_dependent_command_data_init(connection, AVRCP_CTYPE_CONTROL, AVRCP_PDU_ID_ADD_TO_NOW_PLAYING); 16998d316b1bSMilanka Ringwald 17004931e24aSMilanka Ringwald // Parameter Length 17015d3671d9SMilanka Ringwald connection->data_len = 11; 17025d3671d9SMilanka Ringwald connection->data[0] = scope; 17035d3671d9SMilanka Ringwald memset(&connection->data[1], 0, 8); 17044931e24aSMilanka Ringwald if (uid){ 17055d3671d9SMilanka Ringwald (void)memcpy(&connection->data[1], uid, 8); 17064931e24aSMilanka Ringwald } 17075d3671d9SMilanka Ringwald big_endian_store_16(connection->data, 9, uid_counter); 17084931e24aSMilanka Ringwald 17094931e24aSMilanka Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 17104931e24aSMilanka Ringwald return ERROR_CODE_SUCCESS; 17114931e24aSMilanka Ringwald } 17124931e24aSMilanka Ringwald 17138b2b4034SMilanka Ringwald uint8_t avrcp_controller_set_max_num_fragments(uint16_t avrcp_cid, uint8_t max_num_fragments){ 17141945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 17158b2b4034SMilanka Ringwald if (!connection){ 17168b2b4034SMilanka Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 17178b2b4034SMilanka Ringwald } 17188b2b4034SMilanka Ringwald connection->max_num_fragments = max_num_fragments; 17198b2b4034SMilanka Ringwald return ERROR_CODE_SUCCESS; 17208b2b4034SMilanka Ringwald } 1721c4b5c3d5SMatthias Ringwald 17225d3671d9SMilanka Ringwald 17235d3671d9SMilanka Ringwald uint8_t avrcp_controller_send_custom_command(uint16_t avrcp_cid, 17245d3671d9SMilanka Ringwald avrcp_command_type_t command_type, 17255d3671d9SMilanka Ringwald avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, 17265d3671d9SMilanka Ringwald avrcp_pdu_id_t pdu_id, uint32_t company_id, 17275d3671d9SMilanka Ringwald const uint8_t * data, uint16_t data_len){ 17285d3671d9SMilanka Ringwald 17291945fe3eSMilanka Ringwald avrcp_connection_t * connection = avrcp_get_connection_for_avrcp_cid_for_role(AVRCP_CONTROLLER, avrcp_cid); 1730c4b5c3d5SMatthias Ringwald if (!connection){ 1731c4b5c3d5SMatthias Ringwald return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1732c4b5c3d5SMatthias Ringwald } 1733c4b5c3d5SMatthias Ringwald if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED; 1734c4b5c3d5SMatthias Ringwald 17355d3671d9SMilanka Ringwald connection->state = AVCTP_W2_SEND_AVCTP_FRAGMENTED_MESSAGE; 173666b242bbSMilanka Ringwald avrcp_controller_custome_command_data_init(connection, AVRCP_CMD_OPCODE_VENDOR_DEPENDENT, command_type, subunit_type, subunit_id, pdu_id, company_id); 17375d3671d9SMilanka Ringwald 17385d3671d9SMilanka Ringwald connection->data = (uint8_t *)data; 17395d3671d9SMilanka Ringwald connection->data_len = data_len; 1740c4b5c3d5SMatthias Ringwald 1741c4b5c3d5SMatthias Ringwald avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid); 1742c4b5c3d5SMatthias Ringwald return ERROR_CODE_SUCCESS; 1743c4b5c3d5SMatthias Ringwald } 1744