xref: /btstack/src/classic/avrcp_target.c (revision e3d57ee2cf777da36858b158bf0f9b68f9e5811c)
101dc6e35SMilanka Ringwald /*
201dc6e35SMilanka Ringwald  * Copyright (C) 2016 BlueKitchen GmbH
301dc6e35SMilanka Ringwald  *
401dc6e35SMilanka Ringwald  * Redistribution and use in source and binary forms, with or without
501dc6e35SMilanka Ringwald  * modification, are permitted provided that the following conditions
601dc6e35SMilanka Ringwald  * are met:
701dc6e35SMilanka Ringwald  *
801dc6e35SMilanka Ringwald  * 1. Redistributions of source code must retain the above copyright
901dc6e35SMilanka Ringwald  *    notice, this list of conditions and the following disclaimer.
1001dc6e35SMilanka Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
1101dc6e35SMilanka Ringwald  *    notice, this list of conditions and the following disclaimer in the
1201dc6e35SMilanka Ringwald  *    documentation and/or other materials provided with the distribution.
1301dc6e35SMilanka Ringwald  * 3. Neither the name of the copyright holders nor the names of
1401dc6e35SMilanka Ringwald  *    contributors may be used to endorse or promote products derived
1501dc6e35SMilanka Ringwald  *    from this software without specific prior written permission.
1601dc6e35SMilanka Ringwald  * 4. Any redistribution, use, or modification is done solely for
1701dc6e35SMilanka Ringwald  *    personal benefit and not for any commercial purpose or for
1801dc6e35SMilanka Ringwald  *    monetary gain.
1901dc6e35SMilanka Ringwald  *
2001dc6e35SMilanka Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
2101dc6e35SMilanka Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
2201dc6e35SMilanka Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
2301dc6e35SMilanka Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
2401dc6e35SMilanka Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
2501dc6e35SMilanka Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
2601dc6e35SMilanka Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
2701dc6e35SMilanka Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
2801dc6e35SMilanka Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
2901dc6e35SMilanka Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
3001dc6e35SMilanka Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3101dc6e35SMilanka Ringwald  * SUCH DAMAGE.
3201dc6e35SMilanka Ringwald  *
3301dc6e35SMilanka Ringwald  * Please inquire about commercial licensing options at
3401dc6e35SMilanka Ringwald  * [email protected]
3501dc6e35SMilanka Ringwald  *
3601dc6e35SMilanka Ringwald  */
3701dc6e35SMilanka Ringwald 
38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avrcp_target.c"
3901dc6e35SMilanka Ringwald 
4001dc6e35SMilanka Ringwald #include <stdint.h>
4101dc6e35SMilanka Ringwald #include <stdio.h>
4201dc6e35SMilanka Ringwald #include <stdlib.h>
4301dc6e35SMilanka Ringwald #include <string.h>
44adaba9f3SMatthias Ringwald #include <inttypes.h>
4501dc6e35SMilanka Ringwald 
4601dc6e35SMilanka Ringwald #include "btstack.h"
4701dc6e35SMilanka Ringwald #include "classic/avrcp.h"
4801dc6e35SMilanka Ringwald 
49d1207cd8SMilanka Ringwald #define AVRCP_ATTR_HEADER_LEN  8
50d1207cd8SMilanka Ringwald 
51d1207cd8SMilanka Ringwald static const uint8_t AVRCP_NOTIFICATION_TRACK_SELECTED[] = {0,0,0,0,0,0,0,0};
52d1207cd8SMilanka Ringwald static const uint8_t AVRCP_NOTIFICATION_TRACK_NOT_SELECTED[] = {0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF};
53d1207cd8SMilanka Ringwald 
54*e3d57ee2SMilanka Ringwald avrcp_context_t avrcp_target_context;
5501dc6e35SMilanka Ringwald 
5611014891SMilanka Ringwald static int avrcp_target_supports_browsing(uint16_t target_supported_features){
5711014891SMilanka Ringwald     return target_supported_features & (1 << AVRCP_TARGET_SUPPORTED_FEATURE_BROWSING);
5811014891SMilanka Ringwald }
5911014891SMilanka Ringwald 
604f0111ebSMilanka Ringwald void avrcp_target_create_sdp_record(uint8_t * service, uint32_t service_record_handle, uint16_t supported_features, const char * service_name, const char * service_provider_name){
6111014891SMilanka Ringwald     avrcp_create_sdp_record(0, service, service_record_handle, avrcp_target_supports_browsing(supported_features), supported_features, service_name, service_provider_name);
6201dc6e35SMilanka Ringwald }
6301dc6e35SMilanka Ringwald 
64831d3fd5SMilanka Ringwald static void avrcp_target_emit_operation(btstack_packet_handler_t callback, uint16_t avrcp_cid, avrcp_operation_id_t operation_id, uint8_t operands_length, uint8_t operand){
65be4cc80aSMilanka Ringwald     btstack_assert(callback != NULL);
66be4cc80aSMilanka Ringwald 
67831d3fd5SMilanka Ringwald     uint8_t event[8];
68831d3fd5SMilanka Ringwald     int pos = 0;
69831d3fd5SMilanka Ringwald     event[pos++] = HCI_EVENT_AVRCP_META;
70831d3fd5SMilanka Ringwald     event[pos++] = sizeof(event) - 2;
71831d3fd5SMilanka Ringwald     event[pos++] = AVRCP_SUBEVENT_OPERATION;
72831d3fd5SMilanka Ringwald     little_endian_store_16(event, pos, avrcp_cid);
73831d3fd5SMilanka Ringwald     pos += 2;
74831d3fd5SMilanka Ringwald     event[pos++] = operation_id;
75831d3fd5SMilanka Ringwald     event[pos++] = operands_length;
76831d3fd5SMilanka Ringwald     event[pos++] = operand;
77831d3fd5SMilanka Ringwald     (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event));
78831d3fd5SMilanka Ringwald }
79831d3fd5SMilanka Ringwald 
800ec79bd0SMilanka Ringwald static void avrcp_target_emit_volume_changed(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t absolute_volume){
81be4cc80aSMilanka Ringwald     btstack_assert(callback != NULL);
82be4cc80aSMilanka Ringwald 
830ec79bd0SMilanka Ringwald     uint8_t event[7];
840ec79bd0SMilanka Ringwald     int offset = 0;
850ec79bd0SMilanka Ringwald     event[offset++] = HCI_EVENT_AVRCP_META;
860ec79bd0SMilanka Ringwald     event[offset++] = sizeof(event) - 2;
870ec79bd0SMilanka Ringwald     event[offset++] = AVRCP_SUBEVENT_NOTIFICATION_VOLUME_CHANGED;
880ec79bd0SMilanka Ringwald     little_endian_store_16(event, offset, avrcp_cid);
890ec79bd0SMilanka Ringwald     offset += 2;
900ec79bd0SMilanka Ringwald     event[offset++] = AVRCP_CTYPE_NOTIFY;
910ec79bd0SMilanka Ringwald     event[offset++] = absolute_volume;
920ec79bd0SMilanka Ringwald     (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event));
930ec79bd0SMilanka Ringwald }
940ec79bd0SMilanka Ringwald 
95c045af99SMilanka Ringwald static void avrcp_target_emit_respond_vendor_dependent_query(btstack_packet_handler_t callback, uint16_t avrcp_cid, uint8_t subevent_id){
96be4cc80aSMilanka Ringwald     btstack_assert(callback != NULL);
97be4cc80aSMilanka Ringwald 
98c045af99SMilanka Ringwald     uint8_t event[5];
99e0bbf3edSMilanka Ringwald     int pos = 0;
100e0bbf3edSMilanka Ringwald     event[pos++] = HCI_EVENT_AVRCP_META;
101e0bbf3edSMilanka Ringwald     event[pos++] = sizeof(event) - 2;
102e0bbf3edSMilanka Ringwald     event[pos++] = subevent_id;
103e0bbf3edSMilanka Ringwald     little_endian_store_16(event, pos, avrcp_cid);
1044b338011SMilanka Ringwald     (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event));
1054b338011SMilanka Ringwald }
1064b338011SMilanka Ringwald 
1075e845fceSMatthias Ringwald // returns number of bytes stored
108b68ca59fSMatthias Ringwald static uint16_t avrcp_target_pack_single_element_header(uint8_t * packet, uint16_t pos, avrcp_media_attribute_id_t attr_id, uint16_t attr_value_size){
1095e845fceSMatthias Ringwald     btstack_assert(attr_id >= 1);
1105e845fceSMatthias Ringwald     btstack_assert(attr_id <= AVRCP_MEDIA_ATTR_COUNT);
1115e845fceSMatthias Ringwald 
1125e845fceSMatthias Ringwald     big_endian_store_32(packet, pos, attr_id);
113b68ca59fSMatthias Ringwald     big_endian_store_16(packet, pos+4, RFC2978_CHARSET_MIB_UTF8);
1145e845fceSMatthias Ringwald     big_endian_store_16(packet, pos+6, attr_value_size);
1155e845fceSMatthias Ringwald     return 8;
1165e845fceSMatthias Ringwald }
1175e845fceSMatthias Ringwald 
1185e845fceSMatthias Ringwald // returns number of bytes stored
119d1207cd8SMilanka Ringwald static uint16_t avrcp_target_pack_single_element_attribute_number(uint8_t * packet, uint16_t pos, avrcp_media_attribute_id_t attr_id, uint32_t value){
120adaba9f3SMatthias Ringwald     uint16_t attr_value_length = sprintf((char *)(packet+pos+8), "%0" PRIu32, value);
121b68ca59fSMatthias Ringwald     (void) avrcp_target_pack_single_element_header(packet, pos, attr_id, attr_value_length);
1225e3d4d2bSMilanka Ringwald     return 8 + attr_value_length;
1235e3d4d2bSMilanka Ringwald }
1245e3d4d2bSMilanka Ringwald 
1255e845fceSMatthias Ringwald // returns number of bytes stored
126b68ca59fSMatthias Ringwald static uint16_t avrcp_target_pack_single_element_attribute_string_fragment(uint8_t * packet, uint16_t pos, avrcp_media_attribute_id_t attr_id, uint8_t * attr_value, uint16_t attr_value_to_copy, uint16_t attr_value_size, bool header){
127d1207cd8SMilanka Ringwald     if (attr_value_size == 0) return 0;
1285e845fceSMatthias Ringwald     uint16_t bytes_stored = 0;
129d1207cd8SMilanka Ringwald     if (header){
130b68ca59fSMatthias Ringwald         bytes_stored += avrcp_target_pack_single_element_header(packet, pos, attr_id, attr_value_size);
1315e3d4d2bSMilanka Ringwald     }
1325e845fceSMatthias Ringwald     (void)memcpy(packet + pos + bytes_stored, attr_value, attr_value_to_copy);
1335e845fceSMatthias Ringwald     bytes_stored += attr_value_to_copy;
1345e845fceSMatthias Ringwald     return bytes_stored;
135d1207cd8SMilanka Ringwald }
136d1207cd8SMilanka Ringwald 
1371bf7a74fSMilanka Ringwald static int avrcp_target_abort_continue_response(uint16_t cid, avrcp_connection_t * connection){
1381bf7a74fSMilanka Ringwald     uint16_t pos = 0;
1391bf7a74fSMilanka Ringwald     l2cap_reserve_packet_buffer();
1401bf7a74fSMilanka Ringwald     uint8_t * packet = l2cap_get_outgoing_buffer();
1411bf7a74fSMilanka Ringwald 
1421bf7a74fSMilanka Ringwald     connection->command_opcode  = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT;
1431bf7a74fSMilanka Ringwald     connection->command_type    = AVRCP_CTYPE_RESPONSE_ACCEPTED;
1441bf7a74fSMilanka Ringwald     connection->subunit_type    = AVRCP_SUBUNIT_TYPE_PANEL;
1451bf7a74fSMilanka Ringwald     connection->subunit_id      = AVRCP_SUBUNIT_ID;
1461bf7a74fSMilanka Ringwald 
1471bf7a74fSMilanka Ringwald     packet[pos++] = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0;
1481bf7a74fSMilanka Ringwald     // Profile IDentifier (PID)
1491bf7a74fSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8;
1501bf7a74fSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF;
1511bf7a74fSMilanka Ringwald 
1521bf7a74fSMilanka Ringwald     // command_type
1531bf7a74fSMilanka Ringwald     packet[pos++] = connection->command_type;
1541bf7a74fSMilanka Ringwald     // subunit_type | subunit ID
1551bf7a74fSMilanka Ringwald     packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id;
1561bf7a74fSMilanka Ringwald     // opcode
1571bf7a74fSMilanka Ringwald     packet[pos++] = (uint8_t)connection->command_opcode;
1581bf7a74fSMilanka Ringwald 
1591bf7a74fSMilanka Ringwald     // company id is 3 bytes long
1601bf7a74fSMilanka Ringwald     big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID);
1611bf7a74fSMilanka Ringwald     pos += 3;
1621bf7a74fSMilanka Ringwald 
1631bf7a74fSMilanka Ringwald     packet[pos++] = AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE;
1641bf7a74fSMilanka Ringwald 
1651bf7a74fSMilanka Ringwald     // reserve byte for packet type
1661bf7a74fSMilanka Ringwald     packet[pos++] = AVRCP_SINGLE_PACKET;
1671bf7a74fSMilanka Ringwald     big_endian_store_16(packet, pos, 0);
1681bf7a74fSMilanka Ringwald     pos += 2;
1691bf7a74fSMilanka Ringwald     return l2cap_send_prepared(cid, pos);
1701bf7a74fSMilanka Ringwald }
1715e3d4d2bSMilanka Ringwald 
1725e3d4d2bSMilanka Ringwald static int avrcp_target_send_now_playing_info(uint16_t cid, avrcp_connection_t * connection){
1735e3d4d2bSMilanka Ringwald     uint16_t pos = 0;
1745e3d4d2bSMilanka Ringwald     l2cap_reserve_packet_buffer();
1755e3d4d2bSMilanka Ringwald     uint8_t * packet = l2cap_get_outgoing_buffer();
1765e3d4d2bSMilanka Ringwald     uint16_t  size   = l2cap_get_remote_mtu_for_local_cid(connection->l2cap_signaling_cid);
1775e3d4d2bSMilanka Ringwald 
1785e3d4d2bSMilanka Ringwald     packet[pos++] = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0;
1794b338011SMilanka Ringwald     // Profile IDentifier (PID)
1805e3d4d2bSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8;
1815e3d4d2bSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF;
1824b338011SMilanka Ringwald 
1834b338011SMilanka Ringwald     // command_type
1845e3d4d2bSMilanka Ringwald     packet[pos++] = connection->command_type;
1854b338011SMilanka Ringwald     // subunit_type | subunit ID
1865e3d4d2bSMilanka Ringwald     packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id;
1874b338011SMilanka Ringwald     // opcode
1885e3d4d2bSMilanka Ringwald     packet[pos++] = (uint8_t)connection->command_opcode;
1895e3d4d2bSMilanka Ringwald 
1905e3d4d2bSMilanka Ringwald     // company id is 3 bytes long
1915e3d4d2bSMilanka Ringwald     big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID);
1925e3d4d2bSMilanka Ringwald     pos += 3;
1935e3d4d2bSMilanka Ringwald 
1945e3d4d2bSMilanka Ringwald     packet[pos++] = AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES;
1955e3d4d2bSMilanka Ringwald 
196d1207cd8SMilanka Ringwald     // reserve byte for packet type
197d1207cd8SMilanka Ringwald     uint8_t pos_packet_type = pos;
198d1207cd8SMilanka Ringwald     pos++;
1995e3d4d2bSMilanka Ringwald 
2005e3d4d2bSMilanka Ringwald     uint16_t playing_info_buffer_len_position = pos;
201d1207cd8SMilanka Ringwald     pos += 2;
202d1207cd8SMilanka Ringwald     if (connection->next_attr_id == AVRCP_MEDIA_ATTR_NONE){
203d1207cd8SMilanka Ringwald         packet[pos_packet_type] = AVRCP_SINGLE_PACKET;
204d1207cd8SMilanka Ringwald         connection->packet_type = AVRCP_SINGLE_PACKET;
205d1207cd8SMilanka Ringwald         packet[pos++] = count_set_bits_uint32(connection->now_playing_info_attr_bitmap);
20618bcdd55SMatthias Ringwald         connection->next_attr_id = AVRCP_MEDIA_ATTR_ALL;
207d1207cd8SMilanka Ringwald     }
2085e3d4d2bSMilanka Ringwald 
209d1207cd8SMilanka Ringwald     uint8_t fragmented = 0;
210d1207cd8SMilanka Ringwald     int num_free_bytes = size - pos - 2;
211d1207cd8SMilanka Ringwald     uint8_t MAX_NUMBER_ATTR_LEN = 10;
212d1207cd8SMilanka Ringwald 
2130e588213SMatthias Ringwald     while (!fragmented && (num_free_bytes > 0) && (connection->next_attr_id <= AVRCP_MEDIA_ATTR_SONG_LENGTH_MS)){
214d1207cd8SMilanka Ringwald         avrcp_media_attribute_id_t attr_id = connection->next_attr_id;
215d1207cd8SMilanka Ringwald         int attr_index = attr_id - 1;
216d1207cd8SMilanka Ringwald 
217d1207cd8SMilanka Ringwald         if (connection->now_playing_info_attr_bitmap & (1 << attr_id)){
218d1207cd8SMilanka Ringwald             int num_written_bytes = 0;
219d1207cd8SMilanka Ringwald             int num_bytes_to_write = 0;
2205e3d4d2bSMilanka Ringwald             switch (attr_id){
2212f511ffbSMilanka Ringwald                 case AVRCP_MEDIA_ATTR_ALL:
222d1207cd8SMilanka Ringwald                 case AVRCP_MEDIA_ATTR_NONE:
223d1207cd8SMilanka Ringwald                     break;
2245e3d4d2bSMilanka Ringwald                 case AVRCP_MEDIA_ATTR_TRACK:
225d1207cd8SMilanka Ringwald                     num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN;
226d1207cd8SMilanka Ringwald                     if (num_free_bytes >= num_bytes_to_write){
227d1207cd8SMilanka Ringwald                         num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->track_nr);
228d1207cd8SMilanka Ringwald                         break;
229d1207cd8SMilanka Ringwald                     }
230d1207cd8SMilanka Ringwald                     fragmented = 1;
2311bf7a74fSMilanka Ringwald                     connection->attribute_value_offset = 0;
2325e3d4d2bSMilanka Ringwald                     break;
233864d08b0SMilanka Ringwald                 case AVRCP_MEDIA_ATTR_TOTAL_NUM_ITEMS:
234d1207cd8SMilanka Ringwald                     num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN;
235d1207cd8SMilanka Ringwald                     if (num_free_bytes >= num_bytes_to_write){
236d1207cd8SMilanka Ringwald                         num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->total_tracks);
237d1207cd8SMilanka Ringwald                         break;
238d1207cd8SMilanka Ringwald                     }
239d1207cd8SMilanka Ringwald                     fragmented = 1;
2401bf7a74fSMilanka Ringwald                     connection->attribute_value_offset = 0;
2415e3d4d2bSMilanka Ringwald                     break;
2422f511ffbSMilanka Ringwald                 case AVRCP_MEDIA_ATTR_SONG_LENGTH_MS:
243d1207cd8SMilanka Ringwald                     num_bytes_to_write = AVRCP_ATTR_HEADER_LEN + MAX_NUMBER_ATTR_LEN;
244d1207cd8SMilanka Ringwald                     if (num_free_bytes >= num_bytes_to_write){
245d1207cd8SMilanka Ringwald                         num_written_bytes = avrcp_target_pack_single_element_attribute_number(packet, pos, attr_id, connection->song_length_ms);
246d1207cd8SMilanka Ringwald                         break;
247d1207cd8SMilanka Ringwald                     }
248d1207cd8SMilanka Ringwald                     fragmented = 1;
2491bf7a74fSMilanka Ringwald                     connection->attribute_value_offset = 0;
250d1207cd8SMilanka Ringwald                     break;
251d1207cd8SMilanka Ringwald                 default:{
252b68ca59fSMatthias Ringwald                     bool      header = connection->attribute_value_offset == 0;
2531bf7a74fSMilanka Ringwald                     uint8_t * attr_value =     (uint8_t *) (connection->now_playing_info[attr_index].value + connection->attribute_value_offset);
2541bf7a74fSMilanka Ringwald                     uint16_t  attr_value_len = connection->now_playing_info[attr_index].len - connection->attribute_value_offset;
255d1207cd8SMilanka Ringwald 
256c1ab6cc1SMatthias Ringwald                     num_bytes_to_write = attr_value_len + (header * AVRCP_ATTR_HEADER_LEN);
257d1207cd8SMilanka Ringwald                     if (num_bytes_to_write <= num_free_bytes){
2581bf7a74fSMilanka Ringwald                         connection->attribute_value_offset = 0;
259d1207cd8SMilanka Ringwald                         num_written_bytes = num_bytes_to_write;
260b68ca59fSMatthias Ringwald                         avrcp_target_pack_single_element_attribute_string_fragment(packet, pos, attr_id, attr_value, attr_value_len, connection->now_playing_info[attr_index].len, header);
261d1207cd8SMilanka Ringwald                         break;
262d1207cd8SMilanka Ringwald                     }
263d1207cd8SMilanka Ringwald                     fragmented = 1;
264d1207cd8SMilanka Ringwald                     num_written_bytes = num_free_bytes;
265c1ab6cc1SMatthias Ringwald                     attr_value_len = num_free_bytes - (header * AVRCP_ATTR_HEADER_LEN);
266b68ca59fSMatthias Ringwald                     avrcp_target_pack_single_element_attribute_string_fragment(packet, pos, attr_id, attr_value, attr_value_len, connection->now_playing_info[attr_index].len, header);
2671bf7a74fSMilanka Ringwald                     connection->attribute_value_offset += attr_value_len;
268d1207cd8SMilanka Ringwald                     break;
269d1207cd8SMilanka Ringwald                 }
270d1207cd8SMilanka Ringwald             }
271d1207cd8SMilanka Ringwald             pos += num_written_bytes;
272d1207cd8SMilanka Ringwald             num_free_bytes -= num_written_bytes;
273d1207cd8SMilanka Ringwald         }
274d1207cd8SMilanka Ringwald         if (!fragmented){
275dfbbc26bSMatthias Ringwald             // C++ compatible version of connection->next_attr_id++
276dfbbc26bSMatthias Ringwald             connection->next_attr_id = (avrcp_media_attribute_id_t) (((int) connection->next_attr_id) + 1);
277d1207cd8SMilanka Ringwald         }
278d1207cd8SMilanka Ringwald     }
279d1207cd8SMilanka Ringwald 
280d1207cd8SMilanka Ringwald     if (fragmented){
281d1207cd8SMilanka Ringwald         switch (connection->packet_type){
282d1207cd8SMilanka Ringwald             case AVRCP_SINGLE_PACKET:
283d1207cd8SMilanka Ringwald                 connection->packet_type = AVRCP_START_PACKET;
2845e3d4d2bSMilanka Ringwald                 break;
2855e3d4d2bSMilanka Ringwald             default:
286d1207cd8SMilanka Ringwald                 connection->packet_type = AVRCP_CONTINUE_PACKET;
2875e3d4d2bSMilanka Ringwald                 break;
2885e3d4d2bSMilanka Ringwald         }
289d1207cd8SMilanka Ringwald     } else {
2902f511ffbSMilanka Ringwald         if (connection->next_attr_id >= AVRCP_MEDIA_ATTR_SONG_LENGTH_MS){ // DONE
291d1207cd8SMilanka Ringwald             if (connection->packet_type != AVRCP_SINGLE_PACKET){
292d1207cd8SMilanka Ringwald                 connection->packet_type = AVRCP_END_PACKET;
2935e3d4d2bSMilanka Ringwald             }
2945e3d4d2bSMilanka Ringwald         }
295d1207cd8SMilanka Ringwald     }
296d1207cd8SMilanka Ringwald     packet[pos_packet_type] = connection->packet_type;
297d1207cd8SMilanka Ringwald     // store attr value length
298d1207cd8SMilanka Ringwald     big_endian_store_16(packet, playing_info_buffer_len_position, pos - playing_info_buffer_len_position - 2);
299d1207cd8SMilanka Ringwald     return l2cap_send_prepared(cid, size);
3005e3d4d2bSMilanka Ringwald }
3015e3d4d2bSMilanka Ringwald 
302d1207cd8SMilanka Ringwald 
3035e3d4d2bSMilanka Ringwald 
3045e3d4d2bSMilanka Ringwald static int avrcp_target_send_response(uint16_t cid, avrcp_connection_t * connection){
3055e3d4d2bSMilanka Ringwald     int pos = 0;
3065e3d4d2bSMilanka Ringwald     l2cap_reserve_packet_buffer();
3075e3d4d2bSMilanka Ringwald     uint8_t * packet = l2cap_get_outgoing_buffer();
3085e3d4d2bSMilanka Ringwald 
3095e3d4d2bSMilanka Ringwald     // transport header
3105e3d4d2bSMilanka Ringwald     // Transaction label | Packet_type | C/R | IPID (1 == invalid profile identifier)
311d1207cd8SMilanka Ringwald 
312d1207cd8SMilanka Ringwald     // TODO: check for fragmentation
313d1207cd8SMilanka Ringwald     connection->packet_type = AVRCP_SINGLE_PACKET;
314d1207cd8SMilanka Ringwald 
315d1207cd8SMilanka Ringwald     packet[pos++] = (connection->transaction_label << 4) | (connection->packet_type << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0;
3165e3d4d2bSMilanka Ringwald     // Profile IDentifier (PID)
3175e3d4d2bSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8;
3185e3d4d2bSMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF;
3195e3d4d2bSMilanka Ringwald     // command_type
3205e3d4d2bSMilanka Ringwald     packet[pos++] = connection->command_type;
3215e3d4d2bSMilanka Ringwald     // subunit_type | subunit ID
3225e3d4d2bSMilanka Ringwald     packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id;
3235e3d4d2bSMilanka Ringwald     // opcode
3245e3d4d2bSMilanka Ringwald     packet[pos++] = (uint8_t)connection->command_opcode;
3250ec79bd0SMilanka Ringwald 
3266535961aSMatthias Ringwald     (void)memcpy(packet + pos, connection->cmd_operands,
3276535961aSMatthias Ringwald                  connection->cmd_operands_length);
3284b338011SMilanka Ringwald     pos += connection->cmd_operands_length;
3290ec79bd0SMilanka Ringwald 
330d1386928SMilanka Ringwald     connection->wait_to_send = 0;
3315e3d4d2bSMilanka Ringwald     return l2cap_send_prepared(cid, pos);
3324b338011SMilanka Ringwald }
3334b338011SMilanka Ringwald 
3346649facbSMatthias Ringwald static void avrcp_target_response_setup(avrcp_connection_t * connection, avrcp_command_type_t command_type, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id,
3356649facbSMatthias Ringwald                                         avrcp_command_opcode_t opcode){
3366649facbSMatthias Ringwald     connection->command_type = command_type;
33712b7c8ecSMilanka Ringwald     connection->subunit_type = subunit_type;
33812b7c8ecSMilanka Ringwald     connection->subunit_id =   subunit_id;
33912b7c8ecSMilanka Ringwald     connection->command_opcode = opcode;
3406649facbSMatthias Ringwald }
3416649facbSMatthias Ringwald 
3426649facbSMatthias Ringwald static uint8_t avrcp_target_response_accept(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, uint8_t status){
3436649facbSMatthias Ringwald     // AVRCP_CTYPE_RESPONSE_REJECTED
3446649facbSMatthias Ringwald     avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_ACCEPTED, subunit_type, subunit_id, opcode);
34512b7c8ecSMilanka Ringwald     // company id is 3 bytes long
34612b7c8ecSMilanka Ringwald     int pos = connection->cmd_operands_length;
34712b7c8ecSMilanka Ringwald     connection->cmd_operands[pos++] = pdu_id;
34812b7c8ecSMilanka Ringwald     connection->cmd_operands[pos++] = 0;
34912b7c8ecSMilanka Ringwald     // param length
35012b7c8ecSMilanka Ringwald     big_endian_store_16(connection->cmd_operands, pos, 1);
35112b7c8ecSMilanka Ringwald     pos += 2;
35212b7c8ecSMilanka Ringwald     connection->cmd_operands[pos++] = status;
35312b7c8ecSMilanka Ringwald     connection->cmd_operands_length = pos;
3540ec79bd0SMilanka Ringwald     connection->accept_response = 1;
35512b7c8ecSMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
35612b7c8ecSMilanka Ringwald     return ERROR_CODE_SUCCESS;
35712b7c8ecSMilanka Ringwald }
35812b7c8ecSMilanka Ringwald 
359e0bbf3edSMilanka Ringwald static uint8_t avrcp_target_response_reject(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, avrcp_status_code_t status){
360e0bbf3edSMilanka Ringwald     // AVRCP_CTYPE_RESPONSE_REJECTED
3616649facbSMatthias Ringwald     avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_REJECTED, subunit_type, subunit_id, opcode);
362e0bbf3edSMilanka Ringwald     // company id is 3 bytes long
363e0bbf3edSMilanka Ringwald     int pos = connection->cmd_operands_length;
364e0bbf3edSMilanka Ringwald     connection->cmd_operands[pos++] = pdu_id;
365e0bbf3edSMilanka Ringwald     connection->cmd_operands[pos++] = 0;
366e0bbf3edSMilanka Ringwald     // param length
367c045af99SMilanka Ringwald     big_endian_store_16(connection->cmd_operands, pos, 1);
368e0bbf3edSMilanka Ringwald     pos += 2;
369e0bbf3edSMilanka Ringwald     connection->cmd_operands[pos++] = status;
370e0bbf3edSMilanka Ringwald     connection->cmd_operands_length = pos;
371d1207cd8SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
372d1207cd8SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
373d1207cd8SMilanka Ringwald     return ERROR_CODE_SUCCESS;
374d1207cd8SMilanka Ringwald }
375d1207cd8SMilanka Ringwald 
376d1207cd8SMilanka Ringwald static uint8_t avrcp_target_response_not_implemented(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id, uint8_t event_id){
3776649facbSMatthias Ringwald     avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_NOT_IMPLEMENTED, subunit_type, subunit_id, opcode);
378d1207cd8SMilanka Ringwald     // company id is 3 bytes long
379d1207cd8SMilanka Ringwald     int pos = connection->cmd_operands_length;
380d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = pdu_id;
381d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = 0;
382d1207cd8SMilanka Ringwald     // param length
383d1207cd8SMilanka Ringwald     big_endian_store_16(connection->cmd_operands, pos, 1);
384d1207cd8SMilanka Ringwald     pos += 2;
385d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = event_id;
386d1207cd8SMilanka Ringwald     connection->cmd_operands_length = pos;
387d1386928SMilanka Ringwald 
388d1386928SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
389d1386928SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
390d1386928SMilanka Ringwald     return ERROR_CODE_SUCCESS;
391e0bbf3edSMilanka Ringwald }
392e0bbf3edSMilanka Ringwald 
393d8133c09SMatthias Ringwald static uint8_t avrcp_target_response_vendor_dependent_interim(avrcp_connection_t * connection, avrcp_pdu_id_t pdu_id, uint8_t event_id, const uint8_t * value, uint16_t value_len){
394d1207cd8SMilanka Ringwald 
395d1207cd8SMilanka Ringwald     // company id is 3 bytes long
396d1207cd8SMilanka Ringwald     int pos = connection->cmd_operands_length;
397d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = pdu_id;
398d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = 0;
399d1207cd8SMilanka Ringwald     // param length
400d1207cd8SMilanka Ringwald     big_endian_store_16(connection->cmd_operands, pos, 1 + value_len);
401d1207cd8SMilanka Ringwald     pos += 2;
402d1207cd8SMilanka Ringwald     connection->cmd_operands[pos++] = event_id;
403c1ab6cc1SMatthias Ringwald     if (value && (value_len > 0)){
4046535961aSMatthias Ringwald         (void)memcpy(connection->cmd_operands + pos, value, value_len);
405d1207cd8SMilanka Ringwald         pos += value_len;
406d1207cd8SMilanka Ringwald     }
407d1207cd8SMilanka Ringwald     connection->cmd_operands_length = pos;
408d1207cd8SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
409d1207cd8SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
410d1207cd8SMilanka Ringwald     return ERROR_CODE_SUCCESS;
411d1207cd8SMilanka Ringwald }
412d1207cd8SMilanka Ringwald 
4136568eb54SMilanka Ringwald static uint8_t avrcp_target_response_addressed_player_changed_interim(avrcp_connection_t * connection, avrcp_subunit_type_t subunit_type, avrcp_subunit_id_t subunit_id, avrcp_command_opcode_t opcode, avrcp_pdu_id_t pdu_id){
4146649facbSMatthias Ringwald     avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
4150a2feef4SMilanka Ringwald 
4166568eb54SMilanka Ringwald     // company id is 3 bytes long
4176568eb54SMilanka Ringwald     int pos = connection->cmd_operands_length;
4186568eb54SMilanka Ringwald     connection->cmd_operands[pos++] = pdu_id;
4196568eb54SMilanka Ringwald     connection->cmd_operands[pos++] = 0;
4206568eb54SMilanka Ringwald     // param length
4216568eb54SMilanka Ringwald     big_endian_store_16(connection->cmd_operands, pos, 5);
4226568eb54SMilanka Ringwald     pos += 2;
4236568eb54SMilanka Ringwald     connection->cmd_operands[pos++] = AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED;
4246568eb54SMilanka Ringwald     big_endian_read_16( &connection->cmd_operands[pos], connection->addressed_player_id);
4256568eb54SMilanka Ringwald     pos += 2;
4266568eb54SMilanka Ringwald     big_endian_read_16( &connection->cmd_operands[pos], connection->uid_counter);
4276568eb54SMilanka Ringwald     pos += 2;
4286568eb54SMilanka Ringwald 
4296568eb54SMilanka Ringwald     connection->cmd_operands_length = pos;
4306568eb54SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
4316568eb54SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
4326568eb54SMilanka Ringwald     return ERROR_CODE_SUCCESS;
4336568eb54SMilanka Ringwald }
4346568eb54SMilanka Ringwald 
435831d3fd5SMilanka Ringwald static uint8_t avrcp_target_pass_through_response(uint16_t avrcp_cid, avrcp_command_type_t cmd_type, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){
43616d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
437831d3fd5SMilanka Ringwald     if (!connection){
43864971d1eSMilanka Ringwald         log_error("Could not find a connection.");
439831d3fd5SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
440831d3fd5SMilanka Ringwald     }
4416649facbSMatthias Ringwald     avrcp_target_response_setup(connection, cmd_type, AVRCP_SUBUNIT_TYPE_PANEL, AVRCP_SUBUNIT_ID, AVRCP_CMD_OPCODE_PASS_THROUGH);
442831d3fd5SMilanka Ringwald 
443831d3fd5SMilanka Ringwald     int pos = 0;
444831d3fd5SMilanka Ringwald     connection->cmd_operands[pos++] = opid;
445831d3fd5SMilanka Ringwald     connection->cmd_operands[pos++] = operands_length;
446831d3fd5SMilanka Ringwald     if (operands_length == 1){
447831d3fd5SMilanka Ringwald         connection->cmd_operands[pos++] = operand;
448831d3fd5SMilanka Ringwald     }
449831d3fd5SMilanka Ringwald     connection->cmd_operands_length = pos;
450831d3fd5SMilanka Ringwald 
451831d3fd5SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
452831d3fd5SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
453831d3fd5SMilanka Ringwald     return ERROR_CODE_SUCCESS;
454831d3fd5SMilanka Ringwald }
455831d3fd5SMilanka Ringwald 
456831d3fd5SMilanka Ringwald uint8_t avrcp_target_operation_rejected(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){
457831d3fd5SMilanka Ringwald     return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_REJECTED, opid, operands_length, operand);
458831d3fd5SMilanka Ringwald }
459831d3fd5SMilanka Ringwald 
460831d3fd5SMilanka Ringwald uint8_t avrcp_target_operation_accepted(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){
461831d3fd5SMilanka Ringwald     return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_ACCEPTED, opid, operands_length, operand);
462831d3fd5SMilanka Ringwald }
463831d3fd5SMilanka Ringwald 
464831d3fd5SMilanka Ringwald uint8_t avrcp_target_operation_not_implemented(uint16_t avrcp_cid, avrcp_operation_id_t opid, uint8_t operands_length, uint8_t operand){
465831d3fd5SMilanka Ringwald     return avrcp_target_pass_through_response(avrcp_cid, AVRCP_CTYPE_RESPONSE_ACCEPTED, opid, operands_length, operand);
466831d3fd5SMilanka Ringwald }
467831d3fd5SMilanka Ringwald 
468d1207cd8SMilanka Ringwald void avrcp_target_set_unit_info(uint16_t avrcp_cid, avrcp_subunit_type_t unit_type, uint32_t company_id){
46916d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
4704b338011SMilanka Ringwald     if (!connection){
471be4cc80aSMilanka Ringwald         log_error("avrcp_target_set_unit_info: could not find a connection.");
472d1207cd8SMilanka Ringwald         return;
4734b338011SMilanka Ringwald     }
474d1207cd8SMilanka Ringwald     connection->unit_type = unit_type;
475d1207cd8SMilanka Ringwald     connection->company_id = company_id;
476d1207cd8SMilanka Ringwald }
477d1207cd8SMilanka Ringwald 
478d1207cd8SMilanka Ringwald void avrcp_target_set_subunit_info(uint16_t avrcp_cid, avrcp_subunit_type_t subunit_type, const uint8_t * subunit_info_data, uint16_t subunit_info_data_size){
47916d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
480d1207cd8SMilanka Ringwald     if (!connection){
481be4cc80aSMilanka Ringwald         log_error("avrcp_target_set_subunit_info: could not find a connection.");
482d1207cd8SMilanka Ringwald         return;
483d1207cd8SMilanka Ringwald     }
484d1207cd8SMilanka Ringwald     connection->subunit_info_type = subunit_type;
485d1207cd8SMilanka Ringwald     connection->subunit_info_data = subunit_info_data;
486d1207cd8SMilanka Ringwald     connection->subunit_info_data_size = subunit_info_data_size;
487d1207cd8SMilanka Ringwald }
488d1207cd8SMilanka Ringwald 
489d1207cd8SMilanka Ringwald static uint8_t avrcp_target_unit_info(avrcp_connection_t * connection){
4904b338011SMilanka Ringwald     if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED;
4914b338011SMilanka Ringwald 
4924b338011SMilanka Ringwald     uint8_t unit = 0;
4934b338011SMilanka Ringwald     connection->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE;
4944b338011SMilanka Ringwald     connection->subunit_type = AVRCP_SUBUNIT_TYPE_UNIT; //vendor unique
4954b338011SMilanka Ringwald     connection->subunit_id =   AVRCP_SUBUNIT_ID_IGNORE;
496e0bbf3edSMilanka Ringwald     connection->command_opcode = AVRCP_CMD_OPCODE_UNIT_INFO;
4974b338011SMilanka Ringwald 
4984b338011SMilanka Ringwald     connection->cmd_operands_length = 5;
4994b338011SMilanka Ringwald     connection->cmd_operands[0] = 0x07;
500d1207cd8SMilanka Ringwald     connection->cmd_operands[1] = (connection->unit_type << 4) | unit;
5014b338011SMilanka Ringwald     // company id is 3 bytes long
502d1207cd8SMilanka Ringwald     big_endian_store_32(connection->cmd_operands, 2, connection->company_id);
503d1386928SMilanka Ringwald 
504d1386928SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
505d1386928SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
506d1386928SMilanka Ringwald     return ERROR_CODE_SUCCESS;
5074b338011SMilanka Ringwald }
5084b338011SMilanka Ringwald 
50967049435SMilanka Ringwald 
510d1207cd8SMilanka Ringwald static uint8_t avrcp_target_subunit_info(avrcp_connection_t * connection, uint8_t offset){
5114b338011SMilanka Ringwald     if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED;
512c1ab6cc1SMatthias Ringwald     if ((offset - 4) > connection->subunit_info_data_size) return AVRCP_STATUS_INVALID_PARAMETER;
5134b338011SMilanka Ringwald 
5144b338011SMilanka Ringwald     connection->command_opcode = AVRCP_CMD_OPCODE_SUBUNIT_INFO;
5154b338011SMilanka Ringwald     connection->command_type = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE;
516d1207cd8SMilanka Ringwald     connection->subunit_type = AVRCP_SUBUNIT_TYPE_UNIT; //vendor unique
5174b338011SMilanka Ringwald     connection->subunit_id =   AVRCP_SUBUNIT_ID_IGNORE;
5181bf7a74fSMilanka Ringwald     // printf("avrcp_target_subunit_info  subunit_type %d\n", connection->subunit_type);
5194b338011SMilanka Ringwald 
5204b338011SMilanka Ringwald     uint8_t page = offset / 4;
5214b338011SMilanka Ringwald     uint8_t extension_code = 7;
5224b338011SMilanka Ringwald     connection->cmd_operands_length = 5;
5234b338011SMilanka Ringwald     connection->cmd_operands[0] = (page << 4) | extension_code;
524d1207cd8SMilanka Ringwald 
5256535961aSMatthias Ringwald     (void)memcpy(connection->cmd_operands + 1,
5266535961aSMatthias Ringwald                  connection->subunit_info_data + offset, 4);
527d1386928SMilanka Ringwald 
528d1386928SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
529d1386928SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
530d1386928SMilanka Ringwald     return ERROR_CODE_SUCCESS;
5314b338011SMilanka Ringwald }
5324b338011SMilanka Ringwald 
5335e3d4d2bSMilanka Ringwald static inline uint8_t avrcp_prepare_vendor_dependent_response(uint16_t avrcp_cid, avrcp_connection_t ** out_connection, avrcp_pdu_id_t pdu_id, uint16_t param_length){
53416d860d2SMilanka Ringwald     *out_connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
5355e3d4d2bSMilanka Ringwald     if (!*out_connection){
5365e3d4d2bSMilanka Ringwald         log_error("avrcp tartget: could not find a connection.");
5375e3d4d2bSMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
5385e3d4d2bSMilanka Ringwald     }
5395e3d4d2bSMilanka Ringwald 
5405e3d4d2bSMilanka Ringwald     if ((*out_connection)->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED;
5415e3d4d2bSMilanka Ringwald     (*out_connection)->command_opcode  = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT;
5425e3d4d2bSMilanka Ringwald     (*out_connection)->command_type    = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE;
5435e3d4d2bSMilanka Ringwald     (*out_connection)->subunit_type    = AVRCP_SUBUNIT_TYPE_PANEL;
5445e3d4d2bSMilanka Ringwald     (*out_connection)->subunit_id      = AVRCP_SUBUNIT_ID;
5455e3d4d2bSMilanka Ringwald 
5465e3d4d2bSMilanka Ringwald     (*out_connection)->cmd_operands[(*out_connection)->cmd_operands_length++] = pdu_id;
5475e3d4d2bSMilanka Ringwald     // reserved
5485e3d4d2bSMilanka Ringwald     (*out_connection)->cmd_operands[(*out_connection)->cmd_operands_length++] = 0;
5495e3d4d2bSMilanka Ringwald     // param length
5505e3d4d2bSMilanka Ringwald     big_endian_store_16((*out_connection)->cmd_operands, (*out_connection)->cmd_operands_length, param_length);
5515e3d4d2bSMilanka Ringwald     (*out_connection)->cmd_operands_length += 2;
5525e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
5535e3d4d2bSMilanka Ringwald }
5545e3d4d2bSMilanka Ringwald 
555e0bbf3edSMilanka Ringwald static uint8_t avrcp_target_capability(uint16_t avrcp_cid, avrcp_capability_id_t capability_id, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size){
5565e3d4d2bSMilanka Ringwald     avrcp_connection_t * connection = NULL;
5575e3d4d2bSMilanka Ringwald     uint8_t status = avrcp_prepare_vendor_dependent_response(avrcp_cid, &connection, AVRCP_PDU_ID_GET_CAPABILITIES, 2+size);
5585e3d4d2bSMilanka Ringwald     if (status != ERROR_CODE_SUCCESS) return status;
559e0bbf3edSMilanka Ringwald 
5605e3d4d2bSMilanka Ringwald     connection->cmd_operands[connection->cmd_operands_length++] = capability_id;
5615e3d4d2bSMilanka Ringwald     connection->cmd_operands[connection->cmd_operands_length++] = capabilities_num;
5626535961aSMatthias Ringwald     (void)memcpy(connection->cmd_operands + connection->cmd_operands_length,
5636535961aSMatthias Ringwald                  capabilities, size);
5645e3d4d2bSMilanka Ringwald     connection->cmd_operands_length += size;
565e0bbf3edSMilanka Ringwald 
566d1386928SMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
567d1386928SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
568d1386928SMilanka Ringwald     return ERROR_CODE_SUCCESS;
569e0bbf3edSMilanka Ringwald }
570e0bbf3edSMilanka Ringwald 
571e0bbf3edSMilanka Ringwald uint8_t avrcp_target_supported_events(uint16_t avrcp_cid, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size){
572e0bbf3edSMilanka Ringwald     return avrcp_target_capability(avrcp_cid, AVRCP_CAPABILITY_ID_EVENT, capabilities_num, capabilities, size);
573e0bbf3edSMilanka Ringwald }
574e0bbf3edSMilanka Ringwald 
5755e3d4d2bSMilanka Ringwald uint8_t avrcp_target_supported_companies(uint16_t avrcp_cid, uint8_t capabilities_num, uint8_t * capabilities, uint8_t size ){
5765e3d4d2bSMilanka Ringwald     return avrcp_target_capability(avrcp_cid, AVRCP_CAPABILITY_ID_COMPANY, capabilities_num, capabilities, size);
5775e3d4d2bSMilanka Ringwald }
5785e3d4d2bSMilanka Ringwald 
579d1207cd8SMilanka Ringwald uint8_t avrcp_target_play_status(uint16_t avrcp_cid, uint32_t song_length_ms, uint32_t song_position_ms, avrcp_playback_status_t play_status){
5805e3d4d2bSMilanka Ringwald     avrcp_connection_t * connection = NULL;
5815e3d4d2bSMilanka Ringwald     uint8_t status = avrcp_prepare_vendor_dependent_response(avrcp_cid, &connection, AVRCP_PDU_ID_GET_PLAY_STATUS, 11);
5825e3d4d2bSMilanka Ringwald     if (status != ERROR_CODE_SUCCESS) return status;
5835e3d4d2bSMilanka Ringwald 
5845e3d4d2bSMilanka Ringwald     big_endian_store_32(connection->cmd_operands, connection->cmd_operands_length, song_length_ms);
5855e3d4d2bSMilanka Ringwald     connection->cmd_operands_length += 4;
5865e3d4d2bSMilanka Ringwald     big_endian_store_32(connection->cmd_operands, connection->cmd_operands_length, song_position_ms);
5875e3d4d2bSMilanka Ringwald     connection->cmd_operands_length += 4;
5885e3d4d2bSMilanka Ringwald     connection->cmd_operands[connection->cmd_operands_length++] = play_status;
5895e3d4d2bSMilanka Ringwald 
5905e3d4d2bSMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
5915e3d4d2bSMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
5925e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
5935e3d4d2bSMilanka Ringwald }
5945e3d4d2bSMilanka Ringwald 
595d1207cd8SMilanka Ringwald static uint8_t avrcp_target_now_playing_info(avrcp_connection_t * connection){
5965e3d4d2bSMilanka Ringwald     if (connection->state != AVCTP_CONNECTION_OPENED) return ERROR_CODE_COMMAND_DISALLOWED;
597355a220fSMilanka Ringwald     connection->now_playing_info_response = 1;
5985e3d4d2bSMilanka Ringwald     connection->command_opcode  = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT;
5995e3d4d2bSMilanka Ringwald     connection->command_type    = AVRCP_CTYPE_RESPONSE_IMPLEMENTED_STABLE;
6005e3d4d2bSMilanka Ringwald     connection->subunit_type    = AVRCP_SUBUNIT_TYPE_PANEL;
6015e3d4d2bSMilanka Ringwald     connection->subunit_id      = AVRCP_SUBUNIT_ID;
6025e3d4d2bSMilanka Ringwald 
6035e3d4d2bSMilanka Ringwald     connection->state = AVCTP_W2_SEND_RESPONSE;
6045e3d4d2bSMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
6055e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
6065e3d4d2bSMilanka Ringwald }
6075e3d4d2bSMilanka Ringwald 
608d1207cd8SMilanka Ringwald static uint8_t avrcp_target_store_media_attr(avrcp_connection_t * connection, avrcp_media_attribute_id_t attr_id, const char * value){
6095e3d4d2bSMilanka Ringwald     int index = attr_id - 1;
610d1207cd8SMilanka Ringwald     if (!value) return AVRCP_STATUS_INVALID_PARAMETER;
6115e3d4d2bSMilanka Ringwald     connection->now_playing_info[index].value = (uint8_t*)value;
6125e3d4d2bSMilanka Ringwald     connection->now_playing_info[index].len   = strlen(value);
6131bf7a74fSMilanka Ringwald     // printf("store %lu bytes, %s\n",  strlen(value), value);
6145e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
6155e3d4d2bSMilanka Ringwald }
6165e3d4d2bSMilanka Ringwald 
617d1207cd8SMilanka Ringwald uint8_t avrcp_target_set_playback_status(uint16_t avrcp_cid, avrcp_playback_status_t playback_status){
61816d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
6195e3d4d2bSMilanka Ringwald     if (!connection){
6205e3d4d2bSMilanka Ringwald         log_error("avrcp_unit_info: could not find a connection.");
6215e3d4d2bSMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
6225e3d4d2bSMilanka Ringwald     }
623d1207cd8SMilanka Ringwald     if (connection->playback_status == playback_status) return ERROR_CODE_SUCCESS;
624d1207cd8SMilanka Ringwald 
625d1207cd8SMilanka Ringwald     connection->playback_status = playback_status;
626d1207cd8SMilanka Ringwald     connection->playback_status_changed = 1;
627d1207cd8SMilanka Ringwald     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
6285e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
6295e3d4d2bSMilanka Ringwald }
6305e3d4d2bSMilanka Ringwald 
631d1207cd8SMilanka Ringwald void avrcp_target_set_now_playing_info(uint16_t avrcp_cid, const avrcp_track_t * current_track, uint16_t total_tracks){
63216d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
6335e3d4d2bSMilanka Ringwald     if (!connection){
6343dfa93f5SMilanka Ringwald         log_error("avrcp_unit_info: could not find a connection. cid 0x%02x\n", avrcp_cid);
635d1207cd8SMilanka Ringwald         return;
6365e3d4d2bSMilanka Ringwald     }
637d1207cd8SMilanka Ringwald     if (!current_track){
638d1207cd8SMilanka Ringwald         connection->track_selected = 0;
639d1207cd8SMilanka Ringwald         connection->playback_status = AVRCP_PLAYBACK_STATUS_ERROR;
640d1207cd8SMilanka Ringwald         return;
641d1207cd8SMilanka Ringwald     }
6426535961aSMatthias Ringwald     (void)memcpy(connection->track_id, current_track->track_id, 8);
643d1207cd8SMilanka Ringwald     connection->song_length_ms = current_track->song_length_ms;
644d1207cd8SMilanka Ringwald     connection->track_nr = current_track->track_nr;
6455e3d4d2bSMilanka Ringwald     connection->total_tracks = total_tracks;
646d1207cd8SMilanka Ringwald     avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_TITLE, current_track->title);
647d1207cd8SMilanka Ringwald     avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_ARTIST, current_track->artist);
648d1207cd8SMilanka Ringwald     avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_ALBUM, current_track->album);
649d1207cd8SMilanka Ringwald     avrcp_target_store_media_attr(connection, AVRCP_MEDIA_ATTR_GENRE, current_track->genre);
650d1207cd8SMilanka Ringwald     connection->track_selected = 1;
651d1207cd8SMilanka Ringwald 
652d1207cd8SMilanka Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED)) {
653d1207cd8SMilanka Ringwald         connection->track_changed = 1;
654d1207cd8SMilanka Ringwald         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
655d1207cd8SMilanka Ringwald     }
656d1207cd8SMilanka Ringwald     return;
6575e3d4d2bSMilanka Ringwald }
6585e3d4d2bSMilanka Ringwald 
65912b7c8ecSMilanka Ringwald uint8_t avrcp_target_track_changed(uint16_t avrcp_cid, uint8_t * track_id){
66016d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
66112b7c8ecSMilanka Ringwald     if (!connection){
66212b7c8ecSMilanka Ringwald         log_error("avrcp_target_track_changed: could not find connection.");
66312b7c8ecSMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
66412b7c8ecSMilanka Ringwald     }
66512b7c8ecSMilanka Ringwald     if (!track_id) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
66612b7c8ecSMilanka Ringwald 
66712b7c8ecSMilanka Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED)) {
66812b7c8ecSMilanka Ringwald         connection->track_changed = 1;
6696535961aSMatthias Ringwald         (void)memcpy(connection->track_id, track_id, 8);
67012b7c8ecSMilanka Ringwald         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
67112b7c8ecSMilanka Ringwald     }
67212b7c8ecSMilanka Ringwald     return ERROR_CODE_SUCCESS;
67312b7c8ecSMilanka Ringwald }
67412b7c8ecSMilanka Ringwald 
675d1207cd8SMilanka Ringwald uint8_t avrcp_target_playing_content_changed(uint16_t avrcp_cid){
67616d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
6775e3d4d2bSMilanka Ringwald     if (!connection){
6786568eb54SMilanka Ringwald         log_error("avrcp_target_playing_content_changed: could not find a connection.");
6795e3d4d2bSMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
6805e3d4d2bSMilanka Ringwald     }
68112b7c8ecSMilanka Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED)) {
682d1207cd8SMilanka Ringwald         connection->playing_content_changed = 1;
683d1207cd8SMilanka Ringwald         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
68412b7c8ecSMilanka Ringwald     }
6855e3d4d2bSMilanka Ringwald     return ERROR_CODE_SUCCESS;
6865e3d4d2bSMilanka Ringwald }
687e0bbf3edSMilanka Ringwald 
6886568eb54SMilanka Ringwald uint8_t avrcp_target_addressed_player_changed(uint16_t avrcp_cid, uint16_t player_id, uint16_t uid_counter){
68916d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
6906568eb54SMilanka Ringwald     if (!connection){
6916568eb54SMilanka Ringwald         log_error("avrcp_unit_info: could not find a connection.");
6926568eb54SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
6936568eb54SMilanka Ringwald     }
6946568eb54SMilanka Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED)) {
6958a518194SMilanka Ringwald         connection->uid_counter = uid_counter;
6968a518194SMilanka Ringwald         connection->addressed_player_id = player_id;
6976568eb54SMilanka Ringwald     }
6986568eb54SMilanka Ringwald     return ERROR_CODE_SUCCESS;
6996568eb54SMilanka Ringwald }
7006568eb54SMilanka Ringwald 
701d1207cd8SMilanka Ringwald uint8_t avrcp_target_battery_status_changed(uint16_t avrcp_cid, avrcp_battery_status_t battery_status){
70216d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
703d1207cd8SMilanka Ringwald     if (!connection){
704d1207cd8SMilanka Ringwald         log_error("avrcp_unit_info: could not find a connection.");
705d1207cd8SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
706d1207cd8SMilanka Ringwald     }
707d1207cd8SMilanka Ringwald     if (connection->battery_status == battery_status) return ERROR_CODE_SUCCESS;
70812b7c8ecSMilanka Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED)) {
709d1207cd8SMilanka Ringwald         connection->battery_status = battery_status;
710d1207cd8SMilanka Ringwald         connection->battery_status_changed = 1;
711d1207cd8SMilanka Ringwald         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
71212b7c8ecSMilanka Ringwald     }
713d1207cd8SMilanka Ringwald     return ERROR_CODE_SUCCESS;
714d1207cd8SMilanka Ringwald }
715d1207cd8SMilanka Ringwald 
716d1207cd8SMilanka Ringwald uint8_t avrcp_target_volume_changed(uint16_t avrcp_cid, uint8_t volume_percentage){
71716d860d2SMilanka Ringwald     avrcp_connection_t * connection = get_avrcp_connection_for_avrcp_cid_for_role(AVRCP_TARGET, avrcp_cid);
718d1207cd8SMilanka Ringwald     if (!connection){
719d1207cd8SMilanka Ringwald         log_error("avrcp_unit_info: could not find a connection.");
720d1207cd8SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
721d1207cd8SMilanka Ringwald     }
722d1207cd8SMilanka Ringwald     connection->volume_percentage = volume_percentage;
7233e5c3c5bSMatthias Ringwald     if (connection->notifications_enabled & (1 << AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED )) {
7240ec79bd0SMilanka Ringwald         connection->notify_volume_percentage_changed = 1;
725d1207cd8SMilanka Ringwald         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
72612b7c8ecSMilanka Ringwald     }
727d1207cd8SMilanka Ringwald     return ERROR_CODE_SUCCESS;
728d1207cd8SMilanka Ringwald }
729d1207cd8SMilanka Ringwald 
7300ec79bd0SMilanka Ringwald static void avrcp_target_set_transaction_label_for_notification(avrcp_connection_t * connection, avrcp_notification_event_id_t notification, uint8_t transaction_label){
731fe934656SMatthias Ringwald     if (notification > AVRCP_NOTIFICATION_EVENT_MAX_VALUE) return;
7320ec79bd0SMilanka Ringwald     connection->notifications_transaction_label[notification] = transaction_label;
7330ec79bd0SMilanka Ringwald }
7340ec79bd0SMilanka Ringwald 
7350ec79bd0SMilanka Ringwald static uint8_t avrcp_target_get_transaction_label_for_notification(avrcp_connection_t * connection, avrcp_notification_event_id_t notification){
736fe934656SMatthias Ringwald     if (notification > AVRCP_NOTIFICATION_EVENT_MAX_VALUE) return 0;
7370ec79bd0SMilanka Ringwald     return connection->notifications_transaction_label[notification];
7380ec79bd0SMilanka Ringwald }
739d1207cd8SMilanka Ringwald 
740e0bbf3edSMilanka Ringwald static uint8_t * avrcp_get_company_id(uint8_t *packet, uint16_t size){
741e0bbf3edSMilanka Ringwald     UNUSED(size);
742e0bbf3edSMilanka Ringwald     return packet + 6;
743e0bbf3edSMilanka Ringwald }
744e0bbf3edSMilanka Ringwald 
745e0bbf3edSMilanka Ringwald static uint8_t * avrcp_get_pdu(uint8_t *packet, uint16_t size){
746e0bbf3edSMilanka Ringwald     UNUSED(size);
747e0bbf3edSMilanka Ringwald     return packet + 9;
748e0bbf3edSMilanka Ringwald }
749e0bbf3edSMilanka Ringwald 
750d1207cd8SMilanka Ringwald static uint8_t avrcp_is_receive_pass_through_cmd(uint8_t operation_id){
751d1207cd8SMilanka Ringwald     return operation_id & 0x80;
752d1207cd8SMilanka Ringwald }
753d1207cd8SMilanka Ringwald 
75401dc6e35SMilanka Ringwald static void avrcp_handle_l2cap_data_packet_for_signaling_connection(avrcp_connection_t * connection, uint8_t *packet, uint16_t size){
75501dc6e35SMilanka Ringwald     UNUSED(connection);
75601dc6e35SMilanka Ringwald     UNUSED(packet);
75701dc6e35SMilanka Ringwald     UNUSED(size);
7584b338011SMilanka Ringwald 
759355a220fSMilanka Ringwald     uint16_t pid = 0;
7604b338011SMilanka Ringwald     uint8_t transport_header = packet[0];
7614b338011SMilanka Ringwald     connection->transaction_label = transport_header >> 4;
762be4cc80aSMilanka Ringwald 
763dfbbc26bSMatthias Ringwald     avrcp_packet_type_t packet_type = (avrcp_packet_type_t) ((transport_header & 0x0F) >> 2);
764355a220fSMilanka Ringwald     switch (packet_type){
765355a220fSMilanka Ringwald         case AVRCP_SINGLE_PACKET:
766355a220fSMilanka Ringwald             pid =  big_endian_read_16(packet, 1);
767355a220fSMilanka Ringwald             break;
768355a220fSMilanka Ringwald         case AVRCP_START_PACKET:
769355a220fSMilanka Ringwald             pid =  big_endian_read_16(packet, 2);
770355a220fSMilanka Ringwald             break;
771355a220fSMilanka Ringwald         default:
772355a220fSMilanka Ringwald             break;
773355a220fSMilanka Ringwald     }
77467049435SMilanka Ringwald 
775355a220fSMilanka Ringwald     switch (packet_type){
776355a220fSMilanka Ringwald         case AVRCP_SINGLE_PACKET:
777355a220fSMilanka Ringwald         case AVRCP_START_PACKET:
77867049435SMilanka Ringwald             if (pid != BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL){
779355a220fSMilanka Ringwald                 log_info("Invalid pid 0x%02x, expected 0x%02x", connection->invalid_pid, BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL);
78067049435SMilanka Ringwald                 connection->reject_transport_header = 1;
781355a220fSMilanka Ringwald                 connection->invalid_pid = pid;
782355a220fSMilanka Ringwald                 connection->transport_header = (connection->transaction_label << 4) | (AVRCP_SINGLE_PACKET << 2 ) | (AVRCP_RESPONSE_FRAME << 1) | 1;
78367049435SMilanka Ringwald                 connection->state = AVCTP_W2_SEND_RESPONSE;
78467049435SMilanka Ringwald                 avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
78567049435SMilanka Ringwald                 return;
78667049435SMilanka Ringwald             }
787355a220fSMilanka Ringwald             break;
788355a220fSMilanka Ringwald         default:
789355a220fSMilanka Ringwald             break;
790355a220fSMilanka Ringwald     }
79167049435SMilanka Ringwald 
792e0bbf3edSMilanka Ringwald     avrcp_subunit_type_t subunit_type = (avrcp_subunit_type_t) (packet[4] >> 3);
793e0bbf3edSMilanka Ringwald     avrcp_subunit_id_t   subunit_id   = (avrcp_subunit_id_t) (packet[4] & 0x07);
7944b338011SMilanka Ringwald 
795dfbbc26bSMatthias Ringwald     avrcp_command_opcode_t opcode = (avrcp_command_opcode_t) avrcp_cmd_opcode(packet,size);
796e0bbf3edSMilanka Ringwald     uint8_t * company_id = avrcp_get_company_id(packet, size);
797e0bbf3edSMilanka Ringwald     uint8_t * pdu = avrcp_get_pdu(packet, size);
798e0bbf3edSMilanka Ringwald 
7995e3d4d2bSMilanka Ringwald     int pos = 4;
800dfbbc26bSMatthias Ringwald     uint16_t length;
801dfbbc26bSMatthias Ringwald     avrcp_pdu_id_t   pdu_id;
802e0bbf3edSMilanka Ringwald     connection->cmd_operands_length = 0;
803e0bbf3edSMilanka Ringwald 
804e0bbf3edSMilanka Ringwald     switch (opcode){
8054b338011SMilanka Ringwald         case AVRCP_CMD_OPCODE_UNIT_INFO:
806d1207cd8SMilanka Ringwald             avrcp_target_unit_info(connection);
8074b338011SMilanka Ringwald             break;
808e0bbf3edSMilanka Ringwald         case AVRCP_CMD_OPCODE_SUBUNIT_INFO:{
8095e3d4d2bSMilanka Ringwald             uint8_t offset =  4 * (packet[pos+2]>>4);
810d1207cd8SMilanka Ringwald             avrcp_target_subunit_info(connection, offset);
811e0bbf3edSMilanka Ringwald             break;
812e0bbf3edSMilanka Ringwald         }
813d1207cd8SMilanka Ringwald         case AVRCP_CMD_OPCODE_PASS_THROUGH:{
814831d3fd5SMilanka Ringwald             log_info("AVRCP_OPERATION_ID 0x%02x, operands length %d, operand %d", packet[6], packet[7], packet[8]);
815dfbbc26bSMatthias Ringwald             avrcp_operation_id_t operation_id = (avrcp_operation_id_t) packet[6];
816d1207cd8SMilanka Ringwald 
817d1207cd8SMilanka Ringwald             if (avrcp_is_receive_pass_through_cmd(operation_id)){
818dfbbc26bSMatthias Ringwald                 operation_id = (avrcp_operation_id_t) (packet[6] & 0x7F);
819dfbbc26bSMatthias Ringwald                 avrcp_target_operation_accepted(connection->avrcp_cid, (avrcp_operation_id_t) packet[6], packet[7], packet[8]);
82064971d1eSMilanka Ringwald                 break;
821d1207cd8SMilanka Ringwald             }
822d1207cd8SMilanka Ringwald 
823d1207cd8SMilanka Ringwald             switch (operation_id){
824d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_PLAY:
825d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_PAUSE:
826d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_STOP:
82764971d1eSMilanka Ringwald                 case AVRCP_OPERATION_ID_VOLUME_UP:
82864971d1eSMilanka Ringwald                 case AVRCP_OPERATION_ID_VOLUME_DOWN:
829d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_REWIND:
830d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_FAST_FORWARD:
831d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_FORWARD:
832d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_BACKWARD:
833d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_SKIP:
834d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_MUTE:
83512b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_CHANNEL_UP:
83612b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_CHANNEL_DOWN:
83712b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_SELECT:
83812b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_UP:
83912b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_DOWN:
84012b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_LEFT:
84112b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_RIGHT:
84212b7c8ecSMilanka Ringwald                 case AVRCP_OPERATION_ID_ROOT_MENU:
843dfbbc26bSMatthias Ringwald                     avrcp_target_operation_accepted(connection->avrcp_cid, (avrcp_operation_id_t) packet[6], packet[7], packet[8]);
84464971d1eSMilanka Ringwald                     avrcp_target_emit_operation(avrcp_target_context.avrcp_callback, connection->avrcp_cid, operation_id, packet[7], packet[8]);
84564971d1eSMilanka Ringwald                     break;
846d1207cd8SMilanka Ringwald                 case AVRCP_OPERATION_ID_UNDEFINED:
847dfbbc26bSMatthias Ringwald                     avrcp_target_operation_not_implemented(connection->avrcp_cid, (avrcp_operation_id_t) packet[6], packet[7], packet[8]);
848d1207cd8SMilanka Ringwald                     return;
849d1207cd8SMilanka Ringwald                 default:
850dfbbc26bSMatthias Ringwald                     avrcp_target_operation_not_implemented(connection->avrcp_cid, (avrcp_operation_id_t) packet[6], packet[7], packet[8]);
85164971d1eSMilanka Ringwald                     return;
852d1207cd8SMilanka Ringwald             }
853d1207cd8SMilanka Ringwald             break;
854d1207cd8SMilanka Ringwald         }
855d1207cd8SMilanka Ringwald 
856e0bbf3edSMilanka Ringwald         case AVRCP_CMD_OPCODE_VENDOR_DEPENDENT:
857dfbbc26bSMatthias Ringwald             pdu_id = (avrcp_pdu_id_t) pdu[0];
858e0bbf3edSMilanka Ringwald             // 1 - reserved
859e0bbf3edSMilanka Ringwald             // 2-3 param length,
860dfbbc26bSMatthias Ringwald             length = big_endian_read_16(pdu, 2);
8616535961aSMatthias Ringwald             (void)memcpy(connection->cmd_operands, company_id, 3);
862c045af99SMilanka Ringwald             connection->cmd_operands_length = 3;
863e0bbf3edSMilanka Ringwald             switch (pdu_id){
8646568eb54SMilanka Ringwald                 case AVRCP_PDU_ID_SET_ADDRESSED_PLAYER:{
8656568eb54SMilanka Ringwald                     if (length == 0){
8666568eb54SMilanka Ringwald                         avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PLAYER_ID);
8676568eb54SMilanka Ringwald                         break;
8686568eb54SMilanka Ringwald                     }
8696568eb54SMilanka Ringwald                     avrcp_target_response_accept(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_SUCCESS);
8706568eb54SMilanka Ringwald                     break;
8716568eb54SMilanka Ringwald                 }
872e0bbf3edSMilanka Ringwald                 case AVRCP_PDU_ID_GET_CAPABILITIES:{
8735e3d4d2bSMilanka Ringwald                     avrcp_capability_id_t capability_id = (avrcp_capability_id_t) pdu[pos];
874e0bbf3edSMilanka Ringwald                     switch (capability_id){
875e0bbf3edSMilanka Ringwald                         case AVRCP_CAPABILITY_ID_EVENT:
876c045af99SMilanka Ringwald                             avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_EVENT_IDS_QUERY);
877e0bbf3edSMilanka Ringwald                             break;
878e0bbf3edSMilanka Ringwald                         case AVRCP_CAPABILITY_ID_COMPANY:
879c045af99SMilanka Ringwald                             avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_COMPANY_IDS_QUERY);
880e0bbf3edSMilanka Ringwald                             break;
881e0bbf3edSMilanka Ringwald                         default:
882e0bbf3edSMilanka Ringwald                             avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER);
883e0bbf3edSMilanka Ringwald                             break;
884e0bbf3edSMilanka Ringwald                     }
885e0bbf3edSMilanka Ringwald                     break;
886e0bbf3edSMilanka Ringwald                 }
887c045af99SMilanka Ringwald                 case AVRCP_PDU_ID_GET_PLAY_STATUS:
888c045af99SMilanka Ringwald                     avrcp_target_emit_respond_vendor_dependent_query(avrcp_target_context.avrcp_callback, connection->avrcp_cid, AVRCP_SUBEVENT_PLAY_STATUS_QUERY);
889c045af99SMilanka Ringwald                     break;
8901bf7a74fSMilanka Ringwald                 case AVRCP_PDU_ID_REQUEST_ABORT_CONTINUING_RESPONSE:
8911bf7a74fSMilanka Ringwald                     connection->cmd_operands[0] = pdu[4];
8921bf7a74fSMilanka Ringwald                     connection->abort_continue_response = 1;
8931bf7a74fSMilanka Ringwald                     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
8941bf7a74fSMilanka Ringwald                     break;
895d1207cd8SMilanka Ringwald                 case AVRCP_PDU_ID_REQUEST_CONTINUING_RESPONSE:
896d1207cd8SMilanka Ringwald                     if (pdu[4] != AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES){
897d1207cd8SMilanka Ringwald                         avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND);
898d1207cd8SMilanka Ringwald                         return;
899d1207cd8SMilanka Ringwald                     }
900d1207cd8SMilanka Ringwald                     connection->now_playing_info_response = 1;
901d1207cd8SMilanka Ringwald                     avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
902d1207cd8SMilanka Ringwald                     break;
9035e3d4d2bSMilanka Ringwald                 case AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES:{
9045e3d4d2bSMilanka Ringwald                     uint8_t play_identifier[8];
9055e3d4d2bSMilanka Ringwald                     memset(play_identifier, 0, 8);
9065e3d4d2bSMilanka Ringwald                     if (memcmp(pdu+pos, play_identifier, 8) != 0) {
9075e3d4d2bSMilanka Ringwald                         avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER);
9085e3d4d2bSMilanka Ringwald                         return;
9095e3d4d2bSMilanka Ringwald                     }
910d1207cd8SMilanka Ringwald                     pos += 8;
911d1207cd8SMilanka Ringwald                     uint8_t attribute_count = pdu[pos++];
9121bf7a74fSMilanka Ringwald                     // printf("AVRCP_PDU_ID_GET_ELEMENT_ATTRIBUTES attribute count %d\n", attribute_count);
913d1207cd8SMilanka Ringwald                     connection->next_attr_id = AVRCP_MEDIA_ATTR_NONE;
914d1207cd8SMilanka Ringwald                     if (!attribute_count){
915d1207cd8SMilanka Ringwald                         connection->now_playing_info_attr_bitmap = 0xFE;
916d1207cd8SMilanka Ringwald                     } else {
917d1207cd8SMilanka Ringwald                         int i;
918d1207cd8SMilanka Ringwald                         connection->now_playing_info_attr_bitmap = 0;
919d1207cd8SMilanka Ringwald                         for (i=0; i < attribute_count; i++){
920d1207cd8SMilanka Ringwald                             uint16_t attr_id = big_endian_read_16(pdu, pos);
921d1207cd8SMilanka Ringwald                             pos += 2;
922d1207cd8SMilanka Ringwald                             connection->now_playing_info_attr_bitmap |= (1 << attr_id);
923d1207cd8SMilanka Ringwald                         }
924d1207cd8SMilanka Ringwald                     }
925d1207cd8SMilanka Ringwald                     log_info("now_playing_info_attr_bitmap 0x%02x", connection->now_playing_info_attr_bitmap);
926d1207cd8SMilanka Ringwald                     avrcp_target_now_playing_info(connection);
927d1207cd8SMilanka Ringwald                     break;
928d1207cd8SMilanka Ringwald                 }
929d1207cd8SMilanka Ringwald                 case AVRCP_PDU_ID_REGISTER_NOTIFICATION:{
930d1207cd8SMilanka Ringwald                     // 0 - pdu id
931d1207cd8SMilanka Ringwald                     // 1 - reserved
932d1207cd8SMilanka Ringwald                     // 2-3 param length
933d1207cd8SMilanka Ringwald                     avrcp_notification_event_id_t event_id = (avrcp_notification_event_id_t) pdu[4];
934d1207cd8SMilanka Ringwald                     uint16_t event_mask = (1 << event_id);
9350ec79bd0SMilanka Ringwald                     avrcp_target_set_transaction_label_for_notification(connection, event_id, connection->transaction_label);
936d1207cd8SMilanka Ringwald 
937d1207cd8SMilanka Ringwald                     switch (event_id){
938d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED:
939d1207cd8SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
940d8133c09SMatthias Ringwald                             avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
941d1207cd8SMilanka Ringwald                             if (connection->track_selected){
942d8133c09SMatthias Ringwald                                 avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, AVRCP_NOTIFICATION_TRACK_SELECTED, 8);
943d1207cd8SMilanka Ringwald                             } else {
944d8133c09SMatthias Ringwald                                 avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, AVRCP_NOTIFICATION_TRACK_NOT_SELECTED, 8);
945d1207cd8SMilanka Ringwald                             }
946d1207cd8SMilanka Ringwald                             break;
947d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED:
948d1207cd8SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
949d8133c09SMatthias Ringwald                             avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
950d8133c09SMatthias Ringwald                             avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, (const uint8_t *)&connection->playback_status, 1);
951d1207cd8SMilanka Ringwald                             break;
952d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED:
953d1207cd8SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
954d8133c09SMatthias Ringwald                             avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
955d8133c09SMatthias Ringwald                             avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, NULL, 0);
956d1207cd8SMilanka Ringwald                             break;
957d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED:
9580ec79bd0SMilanka Ringwald                             connection->notify_volume_percentage_changed = 0;
959d1207cd8SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
960d8133c09SMatthias Ringwald                             avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
961d8133c09SMatthias Ringwald                             avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, (const uint8_t *)&connection->volume_percentage, 1);
962d1207cd8SMilanka Ringwald                             break;
963d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED:
964d1207cd8SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
965d8133c09SMatthias Ringwald                             avrcp_target_response_setup(connection, AVRCP_CTYPE_RESPONSE_INTERIM, subunit_type, subunit_id, opcode);
966d8133c09SMatthias Ringwald                             avrcp_target_response_vendor_dependent_interim(connection, pdu_id, event_id, (const uint8_t *)&connection->battery_status, 1);
967d1207cd8SMilanka Ringwald                             break;
968d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_AVAILABLE_PLAYERS_CHANGED:
969d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_PLAYER_APPLICATION_SETTING_CHANGED:
970d1207cd8SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_UIDS_CHANGED:
971d1207cd8SMilanka Ringwald                             avrcp_target_response_not_implemented(connection, subunit_type, subunit_id, opcode, pdu_id, event_id);
972d1207cd8SMilanka Ringwald                             return;
9736568eb54SMilanka Ringwald                         case AVRCP_NOTIFICATION_EVENT_ADDRESSED_PLAYER_CHANGED:
9746568eb54SMilanka Ringwald                             connection->notifications_enabled |= event_mask;
9756568eb54SMilanka Ringwald                             avrcp_target_response_addressed_player_changed_interim(connection, subunit_type, subunit_id, opcode, pdu_id);
9766568eb54SMilanka Ringwald                             return;
977d1207cd8SMilanka Ringwald                         default:
978d1207cd8SMilanka Ringwald                             avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_PARAMETER);
979d1207cd8SMilanka Ringwald                             return;
980d1207cd8SMilanka Ringwald                     }
9815e3d4d2bSMilanka Ringwald                     break;
9825e3d4d2bSMilanka Ringwald                 }
98312b7c8ecSMilanka Ringwald                 case AVRCP_PDU_ID_SET_ABSOLUTE_VOLUME: {
9840a2feef4SMilanka Ringwald                     if (length != 1){
98512b7c8ecSMilanka Ringwald                         avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND);
98612b7c8ecSMilanka Ringwald                         break;
98712b7c8ecSMilanka Ringwald                     }
98812b7c8ecSMilanka Ringwald 
98912b7c8ecSMilanka Ringwald                     uint8_t absolute_volume = pdu[4];
9900a2feef4SMilanka Ringwald                     if (absolute_volume < 0x80){
99112b7c8ecSMilanka Ringwald                         connection->volume_percentage = absolute_volume;
9920a2feef4SMilanka Ringwald                     }
9930ec79bd0SMilanka Ringwald                     avrcp_target_response_accept(connection, subunit_type, subunit_id, opcode, pdu_id, connection->volume_percentage);
9940ec79bd0SMilanka Ringwald                     avrcp_target_emit_volume_changed(avrcp_target_context.avrcp_callback, connection->avrcp_cid, connection->volume_percentage);
99512b7c8ecSMilanka Ringwald                     break;
99612b7c8ecSMilanka Ringwald                 }
997e0bbf3edSMilanka Ringwald                 default:
9981bf7a74fSMilanka Ringwald                     log_info("AVRCP target: unhandled pdu id 0x%02x", pdu_id);
999c045af99SMilanka Ringwald                     avrcp_target_response_reject(connection, subunit_type, subunit_id, opcode, pdu_id, AVRCP_STATUS_INVALID_COMMAND);
1000e0bbf3edSMilanka Ringwald                     break;
1001e0bbf3edSMilanka Ringwald             }
10024b338011SMilanka Ringwald             break;
10034b338011SMilanka Ringwald         default:
10041bf7a74fSMilanka Ringwald             log_info("AVRCP target: opcode 0x%02x not implemented", avrcp_cmd_opcode(packet,size));
10054b338011SMilanka Ringwald             break;
10064b338011SMilanka Ringwald     }
100701dc6e35SMilanka Ringwald }
100801dc6e35SMilanka Ringwald 
10090ec79bd0SMilanka Ringwald static int avrcp_target_send_notification(uint16_t cid, avrcp_connection_t * connection, avrcp_notification_event_id_t notification_id, uint8_t * value, uint16_t value_len){
1010d1207cd8SMilanka Ringwald     if (!connection){
1011d1207cd8SMilanka Ringwald         log_error("avrcp tartget: could not find a connection.");
1012d1207cd8SMilanka Ringwald         return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER;
1013d1207cd8SMilanka Ringwald     }
1014d1207cd8SMilanka Ringwald 
1015d1207cd8SMilanka Ringwald     connection->command_opcode  = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT;
1016d1207cd8SMilanka Ringwald     connection->command_type    = AVRCP_CTYPE_RESPONSE_CHANGED_STABLE;
1017d1207cd8SMilanka Ringwald     connection->subunit_type    = AVRCP_SUBUNIT_TYPE_PANEL;
1018d1207cd8SMilanka Ringwald     connection->subunit_id      = AVRCP_SUBUNIT_ID;
10190ec79bd0SMilanka Ringwald     connection->transaction_label = avrcp_target_get_transaction_label_for_notification(connection, notification_id);
1020d1207cd8SMilanka Ringwald 
1021d1207cd8SMilanka Ringwald     uint16_t pos = 0;
1022d1207cd8SMilanka Ringwald     l2cap_reserve_packet_buffer();
1023d1207cd8SMilanka Ringwald     uint8_t * packet = l2cap_get_outgoing_buffer();
1024d1207cd8SMilanka Ringwald     uint16_t  size   = l2cap_get_remote_mtu_for_local_cid(connection->l2cap_signaling_cid);
1025d1207cd8SMilanka Ringwald 
1026d1207cd8SMilanka Ringwald     connection->packet_type = AVRCP_SINGLE_PACKET;
1027d1207cd8SMilanka Ringwald     packet[pos++] = (connection->transaction_label << 4) | (connection->packet_type << 2) | (AVRCP_RESPONSE_FRAME << 1) | 0;
1028d1207cd8SMilanka Ringwald     // Profile IDentifier (PID)
1029d1207cd8SMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL >> 8;
1030d1207cd8SMilanka Ringwald     packet[pos++] = BLUETOOTH_SERVICE_CLASS_AV_REMOTE_CONTROL & 0x00FF;
1031d1207cd8SMilanka Ringwald 
1032d1207cd8SMilanka Ringwald     // command_type
1033d1207cd8SMilanka Ringwald     packet[pos++] = connection->command_type;
1034d1207cd8SMilanka Ringwald     // subunit_type | subunit ID
1035d1207cd8SMilanka Ringwald     packet[pos++] = (connection->subunit_type << 3) | connection->subunit_id;
1036d1207cd8SMilanka Ringwald     // opcode
1037d1207cd8SMilanka Ringwald     packet[pos++] = (uint8_t)connection->command_opcode;
1038d1207cd8SMilanka Ringwald 
1039d1207cd8SMilanka Ringwald     // company id is 3 bytes long
1040d1207cd8SMilanka Ringwald     big_endian_store_24(packet, pos, BT_SIG_COMPANY_ID);
1041d1207cd8SMilanka Ringwald     pos += 3;
1042d1207cd8SMilanka Ringwald 
1043d1207cd8SMilanka Ringwald     packet[pos++] = AVRCP_PDU_ID_REGISTER_NOTIFICATION;
1044d1207cd8SMilanka Ringwald     packet[pos++] = 0;
10450ec79bd0SMilanka Ringwald     uint16_t remainig_outgoing_buffer_size = size - pos - 2;
10460ec79bd0SMilanka Ringwald 
10470ec79bd0SMilanka Ringwald     uint16_t caped_value_len = btstack_min(value_len + 1, remainig_outgoing_buffer_size);
1048d1207cd8SMilanka Ringwald     big_endian_store_16(packet, pos, caped_value_len);
1049d1207cd8SMilanka Ringwald     pos += 2;
1050d1207cd8SMilanka Ringwald     packet[pos++] = notification_id;
10516535961aSMatthias Ringwald     (void)memcpy(packet + pos, value, caped_value_len - 1);
10520ec79bd0SMilanka Ringwald     pos += caped_value_len - 1;
1053d1207cd8SMilanka Ringwald     connection->wait_to_send = 0;
1054d1207cd8SMilanka Ringwald     return l2cap_send_prepared(cid, pos);
1055d1207cd8SMilanka Ringwald }
1056d1207cd8SMilanka Ringwald 
10570ec79bd0SMilanka Ringwald static void avrcp_target_reset_notification(avrcp_connection_t * connection, avrcp_notification_event_id_t notification_id){
105812b7c8ecSMilanka Ringwald     if (!connection){
105912b7c8ecSMilanka Ringwald         log_error("avrcp tartget: could not find a connection.");
106012b7c8ecSMilanka Ringwald         return;
106112b7c8ecSMilanka Ringwald     }
106212b7c8ecSMilanka Ringwald     connection->notifications_enabled &= ~(1 << notification_id);
106312b7c8ecSMilanka Ringwald     connection->command_opcode  = AVRCP_CMD_OPCODE_VENDOR_DEPENDENT;
10640ec79bd0SMilanka Ringwald     avrcp_target_set_transaction_label_for_notification(connection, notification_id, 0);
106512b7c8ecSMilanka Ringwald }
106612b7c8ecSMilanka Ringwald 
1067654724deSMilanka Ringwald static void avrcp_target_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
106801dc6e35SMilanka Ringwald     avrcp_connection_t * connection;
106901dc6e35SMilanka Ringwald     switch (packet_type) {
107001dc6e35SMilanka Ringwald         case L2CAP_DATA_PACKET:
107116d860d2SMilanka Ringwald             connection = get_avrcp_connection_for_l2cap_signaling_cid_for_role(AVRCP_TARGET, channel);
107201dc6e35SMilanka Ringwald             avrcp_handle_l2cap_data_packet_for_signaling_connection(connection, packet, size);
107301dc6e35SMilanka Ringwald             break;
107401dc6e35SMilanka Ringwald         case HCI_EVENT_PACKET:
107501dc6e35SMilanka Ringwald             switch (hci_event_packet_get_type(packet)){
1076d1207cd8SMilanka Ringwald                 case L2CAP_EVENT_CAN_SEND_NOW:{
107716d860d2SMilanka Ringwald                     connection = get_avrcp_connection_for_l2cap_signaling_cid_for_role(AVRCP_TARGET, channel);
1078d1207cd8SMilanka Ringwald 
1079*e3d57ee2SMilanka Ringwald                     if (connection->accept_response){
10800ec79bd0SMilanka Ringwald                         connection->accept_response = 0;
10810ec79bd0SMilanka Ringwald                         avrcp_target_send_response(connection->l2cap_signaling_cid, connection);
10820ec79bd0SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
10830ec79bd0SMilanka Ringwald                         break;
10840ec79bd0SMilanka Ringwald                     }
1085fa06a5d9SMatthias Ringwald 
1086fa06a5d9SMatthias Ringwald                     else if (connection->abort_continue_response){
10871bf7a74fSMilanka Ringwald                         connection->abort_continue_response = 0;
10881bf7a74fSMilanka Ringwald                         connection->now_playing_info_response = 0;
10891bf7a74fSMilanka Ringwald                         avrcp_target_abort_continue_response(connection->l2cap_signaling_cid, connection);
109064971d1eSMilanka Ringwald                         break;
10911bf7a74fSMilanka Ringwald                     }
10921bf7a74fSMilanka Ringwald 
1093fa06a5d9SMatthias Ringwald                     else if (connection->now_playing_info_response){
10945e3d4d2bSMilanka Ringwald                         connection->now_playing_info_response = 0;
10955e3d4d2bSMilanka Ringwald                         avrcp_target_send_now_playing_info(connection->l2cap_signaling_cid, connection);
10965e3d4d2bSMilanka Ringwald                         break;
10975e3d4d2bSMilanka Ringwald                     }
1098d1207cd8SMilanka Ringwald 
1099fa06a5d9SMatthias Ringwald                     else if (connection->track_changed){
1100d1207cd8SMilanka Ringwald                         connection->track_changed = 0;
1101d1207cd8SMilanka Ringwald                         avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED, connection->track_id, 8);
110212b7c8ecSMilanka Ringwald                         avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_TRACK_CHANGED);
1103d1207cd8SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1104d1207cd8SMilanka Ringwald                         break;
1105d1207cd8SMilanka Ringwald                     }
1106d1207cd8SMilanka Ringwald 
1107fa06a5d9SMatthias Ringwald                     else if (connection->playback_status_changed){
1108d1207cd8SMilanka Ringwald                         connection->playback_status_changed = 0;
1109c57adf92SMilanka Ringwald                         uint8_t playback_status = (uint8_t) connection->playback_status;
1110c57adf92SMilanka Ringwald                         avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED, &playback_status, 1);
111112b7c8ecSMilanka Ringwald                         avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_PLAYBACK_STATUS_CHANGED);
1112d1207cd8SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1113d1207cd8SMilanka Ringwald                         break;
1114d1207cd8SMilanka Ringwald                     }
1115d1207cd8SMilanka Ringwald 
1116fa06a5d9SMatthias Ringwald                     else if (connection->playing_content_changed){
1117d1207cd8SMilanka Ringwald                         connection->playing_content_changed = 0;
1118d1207cd8SMilanka Ringwald                         avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED, NULL, 0);
111912b7c8ecSMilanka Ringwald                         avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_NOW_PLAYING_CONTENT_CHANGED);
1120d1207cd8SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1121d1207cd8SMilanka Ringwald                         break;
1122d1207cd8SMilanka Ringwald                     }
1123d1207cd8SMilanka Ringwald 
1124fa06a5d9SMatthias Ringwald                     else if (connection->battery_status_changed){
1125d1207cd8SMilanka Ringwald                         connection->battery_status_changed = 0;
1126d1207cd8SMilanka Ringwald                         avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED, (uint8_t *)&connection->battery_status, 1);
112712b7c8ecSMilanka Ringwald                         avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_BATT_STATUS_CHANGED);
1128d1207cd8SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1129d1207cd8SMilanka Ringwald                         break;
1130d1207cd8SMilanka Ringwald                     }
1131d1207cd8SMilanka Ringwald 
1132fa06a5d9SMatthias Ringwald                     else if (connection->notify_volume_percentage_changed){
11330ec79bd0SMilanka Ringwald                         // printf("emit new volume %d\n", connection->volume_percentage);
11340ec79bd0SMilanka Ringwald                         connection->notify_volume_percentage_changed = 0;
1135d1207cd8SMilanka Ringwald                         avrcp_target_send_notification(connection->l2cap_signaling_cid, connection, AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED, &connection->volume_percentage, 1);
113612b7c8ecSMilanka Ringwald                         avrcp_target_reset_notification(connection, AVRCP_NOTIFICATION_EVENT_VOLUME_CHANGED);
1137d1207cd8SMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1138d1207cd8SMilanka Ringwald                         break;
1139d1207cd8SMilanka Ringwald                     }
1140d1207cd8SMilanka Ringwald 
1141fa06a5d9SMatthias Ringwald                     else if (connection->reject_transport_header){
1142355a220fSMilanka Ringwald                         connection->state = AVCTP_CONNECTION_OPENED;
1143355a220fSMilanka Ringwald                         connection->reject_transport_header = 0;
1144355a220fSMilanka Ringwald                         l2cap_reserve_packet_buffer();
1145355a220fSMilanka Ringwald                         uint8_t * out_buffer = l2cap_get_outgoing_buffer();
1146355a220fSMilanka Ringwald                         out_buffer[0] = connection->transport_header;
1147355a220fSMilanka Ringwald                         big_endian_store_16(out_buffer, 1, connection->invalid_pid);
1148355a220fSMilanka Ringwald                         l2cap_send_prepared(connection->l2cap_signaling_cid, 3);
1149355a220fSMilanka Ringwald                         avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1150355a220fSMilanka Ringwald                         break;
1151355a220fSMilanka Ringwald                     }
1152355a220fSMilanka Ringwald 
1153d1207cd8SMilanka Ringwald                     switch (connection->state){
1154d1207cd8SMilanka Ringwald                         case AVCTP_W2_SEND_RESPONSE:
1155d1207cd8SMilanka Ringwald                             connection->state = AVCTP_CONNECTION_OPENED;
11565e3d4d2bSMilanka Ringwald                             avrcp_target_send_response(connection->l2cap_signaling_cid, connection);
11570ec79bd0SMilanka Ringwald                             avrcp_request_can_send_now(connection, connection->l2cap_signaling_cid);
1158d1386928SMilanka Ringwald                             return;
11590ec79bd0SMilanka Ringwald                         default:
11600ec79bd0SMilanka Ringwald                             break;
1161d1386928SMilanka Ringwald                     }
11620ec79bd0SMilanka Ringwald 
116301dc6e35SMilanka Ringwald                     break;
1164d1207cd8SMilanka Ringwald             }
116501dc6e35SMilanka Ringwald             default:
116601dc6e35SMilanka Ringwald                 break;
116701dc6e35SMilanka Ringwald         }
116801dc6e35SMilanka Ringwald         default:
116901dc6e35SMilanka Ringwald             break;
117001dc6e35SMilanka Ringwald     }
117101dc6e35SMilanka Ringwald }
117201dc6e35SMilanka Ringwald 
117301dc6e35SMilanka Ringwald void avrcp_target_init(void){
117401dc6e35SMilanka Ringwald     avrcp_target_context.role = AVRCP_TARGET;
1175654724deSMilanka Ringwald     avrcp_target_context.packet_handler = avrcp_target_packet_handler;
11760ec79bd0SMilanka Ringwald     avrcp_register_target_packet_handler(&avrcp_target_packet_handler);
117701dc6e35SMilanka Ringwald }
117801dc6e35SMilanka Ringwald 
117901dc6e35SMilanka Ringwald void avrcp_target_register_packet_handler(btstack_packet_handler_t callback){
1180be4cc80aSMilanka Ringwald     btstack_assert(callback != NULL);
118101dc6e35SMilanka Ringwald     avrcp_target_context.avrcp_callback = callback;
118201dc6e35SMilanka Ringwald }
118301dc6e35SMilanka Ringwald 
118401dc6e35SMilanka Ringwald 
1185