18ef7100fSMilanka Ringwald /* 28ef7100fSMilanka Ringwald * Copyright (C) 2016 BlueKitchen GmbH 38ef7100fSMilanka Ringwald * 48ef7100fSMilanka Ringwald * Redistribution and use in source and binary forms, with or without 58ef7100fSMilanka Ringwald * modification, are permitted provided that the following conditions 68ef7100fSMilanka Ringwald * are met: 78ef7100fSMilanka Ringwald * 88ef7100fSMilanka Ringwald * 1. Redistributions of source code must retain the above copyright 98ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer. 108ef7100fSMilanka Ringwald * 2. Redistributions in binary form must reproduce the above copyright 118ef7100fSMilanka Ringwald * notice, this list of conditions and the following disclaimer in the 128ef7100fSMilanka Ringwald * documentation and/or other materials provided with the distribution. 138ef7100fSMilanka Ringwald * 3. Neither the name of the copyright holders nor the names of 148ef7100fSMilanka Ringwald * contributors may be used to endorse or promote products derived 158ef7100fSMilanka Ringwald * from this software without specific prior written permission. 168ef7100fSMilanka Ringwald * 4. Any redistribution, use, or modification is done solely for 178ef7100fSMilanka Ringwald * personal benefit and not for any commercial purpose or for 188ef7100fSMilanka Ringwald * monetary gain. 198ef7100fSMilanka Ringwald * 208ef7100fSMilanka Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 218ef7100fSMilanka Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 228ef7100fSMilanka Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 238ef7100fSMilanka Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 248ef7100fSMilanka Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 258ef7100fSMilanka Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 268ef7100fSMilanka Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 278ef7100fSMilanka Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 288ef7100fSMilanka Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 298ef7100fSMilanka Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 308ef7100fSMilanka Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 318ef7100fSMilanka Ringwald * SUCH DAMAGE. 328ef7100fSMilanka Ringwald * 338ef7100fSMilanka Ringwald * Please inquire about commercial licensing options at 348ef7100fSMilanka Ringwald * [email protected] 358ef7100fSMilanka Ringwald * 368ef7100fSMilanka Ringwald */ 378ef7100fSMilanka Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "avdtp_util.c" 39ab2c6ae4SMatthias Ringwald 408ef7100fSMilanka Ringwald #include <stdint.h> 418ef7100fSMilanka Ringwald #include <string.h> 428ef7100fSMilanka Ringwald 438ef7100fSMilanka Ringwald #include "btstack.h" 448ef7100fSMilanka Ringwald #include "avdtp.h" 458ef7100fSMilanka Ringwald #include "avdtp_util.h" 468ef7100fSMilanka Ringwald 4721b232ceSMilanka Ringwald #define MAX_MEDIA_CODEC_INFORMATION_LENGTH 100 4821b232ceSMilanka Ringwald 49ee230fc4SMilanka Ringwald static const char * avdtp_si_name[] = { 50ee230fc4SMilanka Ringwald "ERROR", 51ee230fc4SMilanka Ringwald "AVDTP_SI_DISCOVER", 52ee230fc4SMilanka Ringwald "AVDTP_SI_GET_CAPABILITIES", 53ee230fc4SMilanka Ringwald "AVDTP_SI_SET_CONFIGURATION", 54ee230fc4SMilanka Ringwald "AVDTP_SI_GET_CONFIGURATION", 55ee230fc4SMilanka Ringwald "AVDTP_SI_RECONFIGURE", 56ee230fc4SMilanka Ringwald "AVDTP_SI_OPEN", 57ee230fc4SMilanka Ringwald "AVDTP_SI_START", 58ee230fc4SMilanka Ringwald "AVDTP_SI_CLOSE", 59ee230fc4SMilanka Ringwald "AVDTP_SI_SUSPEND", 60ee230fc4SMilanka Ringwald "AVDTP_SI_ABORT", 61ee230fc4SMilanka Ringwald "AVDTP_SI_SECURITY_CONTROL", 62ee230fc4SMilanka Ringwald "AVDTP_SI_GET_ALL_CAPABILITIES", 63ee230fc4SMilanka Ringwald "AVDTP_SI_DELAY_REPORT" 64ee230fc4SMilanka Ringwald }; 65ee230fc4SMilanka Ringwald const char * avdtp_si2str(uint16_t index){ 66c1e2cdaaSaroldxd if ((index <= 0) || (index >= sizeof(avdtp_si_name)/sizeof(avdtp_si_name[0]) )) return avdtp_si_name[0]; 67ee230fc4SMilanka Ringwald return avdtp_si_name[index]; 68ee230fc4SMilanka Ringwald } 69ee230fc4SMilanka Ringwald 70485c0a4cSMilanka Ringwald void avdtp_reset_stream_endpoint(avdtp_stream_endpoint_t * stream_endpoint){ 71485c0a4cSMilanka Ringwald stream_endpoint->media_con_handle = 0; 72485c0a4cSMilanka Ringwald stream_endpoint->l2cap_media_cid = 0; 73485c0a4cSMilanka Ringwald stream_endpoint->l2cap_reporting_cid = 0; 74485c0a4cSMilanka Ringwald stream_endpoint->l2cap_recovery_cid = 0; 75485c0a4cSMilanka Ringwald 76747ec646SMilanka Ringwald stream_endpoint->connection = NULL; 77747ec646SMilanka Ringwald stream_endpoint->state = AVDTP_STREAM_ENDPOINT_IDLE; 78747ec646SMilanka Ringwald stream_endpoint->acceptor_config_state = AVDTP_ACCEPTOR_STREAM_CONFIG_IDLE; 79747ec646SMilanka Ringwald stream_endpoint->initiator_config_state = AVDTP_INITIATOR_STREAM_CONFIG_IDLE; 80485c0a4cSMilanka Ringwald 81747ec646SMilanka Ringwald stream_endpoint->sep.in_use = 0; 82485c0a4cSMilanka Ringwald memset(&stream_endpoint->remote_sep, 0, sizeof(avdtp_sep_t)); 83bc18ee1aSMilanka Ringwald // memset(&stream_endpoint->remote_capabilities, 0, sizeof(avdtp_capabilities_t)); 84bc18ee1aSMilanka Ringwald // memset(&stream_endpoint->remote_configuration, 0, sizeof(avdtp_capabilities_t)); 85485c0a4cSMilanka Ringwald 86485c0a4cSMilanka Ringwald stream_endpoint->remote_capabilities_bitmap = 0; 87485c0a4cSMilanka Ringwald stream_endpoint->remote_configuration_bitmap = 0; 88485c0a4cSMilanka Ringwald 89485c0a4cSMilanka Ringwald stream_endpoint->media_disconnect = 0; 90485c0a4cSMilanka Ringwald stream_endpoint->media_connect = 0; 91485c0a4cSMilanka Ringwald stream_endpoint->start_stream = 0; 92485c0a4cSMilanka Ringwald stream_endpoint->stop_stream = 0; 93485c0a4cSMilanka Ringwald stream_endpoint->send_stream = 0; 94485c0a4cSMilanka Ringwald stream_endpoint->abort_stream = 0; 95485c0a4cSMilanka Ringwald stream_endpoint->suspend_stream = 0; 96485c0a4cSMilanka Ringwald stream_endpoint->sequence_number = 0; 97747ec646SMilanka Ringwald } 98747ec646SMilanka Ringwald 998ef7100fSMilanka Ringwald int get_bit16(uint16_t bitmap, int position){ 1008ef7100fSMilanka Ringwald return (bitmap >> position) & 1; 1018ef7100fSMilanka Ringwald } 1028ef7100fSMilanka Ringwald 103ea6072afSMilanka Ringwald uint16_t store_bit16(uint16_t bitmap, int position, uint8_t value){ 1048ef7100fSMilanka Ringwald if (value){ 1058ef7100fSMilanka Ringwald bitmap |= 1 << position; 1068ef7100fSMilanka Ringwald } else { 1078ef7100fSMilanka Ringwald bitmap &= ~ (1 << position); 1088ef7100fSMilanka Ringwald } 1098ef7100fSMilanka Ringwald return bitmap; 1108ef7100fSMilanka Ringwald } 1118ef7100fSMilanka Ringwald 112c1c40ea1SMatthias Ringwald avdtp_message_type_t avdtp_get_signaling_packet_type(uint8_t * packet){ 113c1c40ea1SMatthias Ringwald return (avdtp_message_type_t) (packet[0] & 0x03); 114c1c40ea1SMatthias Ringwald } 115c1c40ea1SMatthias Ringwald 1168ef7100fSMilanka Ringwald int avdtp_read_signaling_header(avdtp_signaling_packet_t * signaling_header, uint8_t * packet, uint16_t size){ 1178ef7100fSMilanka Ringwald int pos = 0; 1188ef7100fSMilanka Ringwald if (size < 2) return pos; 1198ef7100fSMilanka Ringwald signaling_header->transaction_label = packet[pos] >> 4; 1208ef7100fSMilanka Ringwald signaling_header->packet_type = (avdtp_packet_type_t)((packet[pos] >> 2) & 0x03); 1218ef7100fSMilanka Ringwald signaling_header->message_type = (avdtp_message_type_t) (packet[pos] & 0x03); 1228ef7100fSMilanka Ringwald pos++; 1238ef7100fSMilanka Ringwald memset(signaling_header->command, 0, sizeof(signaling_header->command)); 1248ef7100fSMilanka Ringwald switch (signaling_header->packet_type){ 1258ef7100fSMilanka Ringwald case AVDTP_SINGLE_PACKET: 1268ef7100fSMilanka Ringwald signaling_header->num_packets = 0; 1278ef7100fSMilanka Ringwald signaling_header->offset = 0; 1288ef7100fSMilanka Ringwald signaling_header->size = 0; 1298ef7100fSMilanka Ringwald break; 1308ef7100fSMilanka Ringwald case AVDTP_END_PACKET: 1318ef7100fSMilanka Ringwald signaling_header->num_packets = 0; 1328ef7100fSMilanka Ringwald break; 1338ef7100fSMilanka Ringwald case AVDTP_START_PACKET: 1348ef7100fSMilanka Ringwald signaling_header->num_packets = packet[pos++]; 1358ef7100fSMilanka Ringwald signaling_header->size = 0; 1368ef7100fSMilanka Ringwald signaling_header->offset = 0; 1378ef7100fSMilanka Ringwald break; 1388ef7100fSMilanka Ringwald case AVDTP_CONTINUE_PACKET: 1398ef7100fSMilanka Ringwald if (signaling_header->num_packets <= 0) { 1408587e32cSMilanka Ringwald log_info(" ERROR: wrong num fragmented packets\n"); 1418ef7100fSMilanka Ringwald break; 1428ef7100fSMilanka Ringwald } 1438ef7100fSMilanka Ringwald signaling_header->num_packets--; 1448ef7100fSMilanka Ringwald break; 1458ef7100fSMilanka Ringwald } 146b0920f25SMilanka Ringwald signaling_header->signal_identifier = (avdtp_signal_identifier_t)(packet[pos++] & 0x3f); 1478ef7100fSMilanka Ringwald return pos; 1488ef7100fSMilanka Ringwald } 1498ef7100fSMilanka Ringwald 15050d5c6caSMatthias Ringwald static bool avdtp_is_basic_capability(int service_category){ 15150d5c6caSMatthias Ringwald return (AVDTP_MEDIA_TRANSPORT <= service_category) && (service_category <= AVDTP_MEDIA_CODEC); 15250d5c6caSMatthias Ringwald } 15350d5c6caSMatthias Ringwald 15450d5c6caSMatthias Ringwald int avdtp_pack_service_capabilities(uint8_t *buffer, int size, avdtp_capabilities_t caps, avdtp_service_category_t category) { 1558ef7100fSMilanka Ringwald UNUSED(size); 1568ef7100fSMilanka Ringwald 1578ef7100fSMilanka Ringwald int i; 1588ef7100fSMilanka Ringwald // pos = 0 reserved for length 1598ef7100fSMilanka Ringwald int pos = 1; 1608ef7100fSMilanka Ringwald switch(category){ 1618ef7100fSMilanka Ringwald case AVDTP_MEDIA_TRANSPORT: 1628ef7100fSMilanka Ringwald case AVDTP_REPORTING: 1638ef7100fSMilanka Ringwald case AVDTP_DELAY_REPORTING: 1648ef7100fSMilanka Ringwald break; 1658ef7100fSMilanka Ringwald case AVDTP_RECOVERY: 1668ef7100fSMilanka Ringwald buffer[pos++] = caps.recovery.recovery_type; // 0x01=RFC2733 1678ef7100fSMilanka Ringwald buffer[pos++] = caps.recovery.maximum_recovery_window_size; 1688ef7100fSMilanka Ringwald buffer[pos++] = caps.recovery.maximum_number_media_packets; 1698ef7100fSMilanka Ringwald break; 1708ef7100fSMilanka Ringwald case AVDTP_CONTENT_PROTECTION: 1718ef7100fSMilanka Ringwald buffer[pos++] = caps.content_protection.cp_type_value_len + 2; 1728ef7100fSMilanka Ringwald big_endian_store_16(buffer, pos, caps.content_protection.cp_type); 1738ef7100fSMilanka Ringwald pos += 2; 1746535961aSMatthias Ringwald (void)memcpy(buffer + pos, caps.content_protection.cp_type_value, 1756535961aSMatthias Ringwald caps.content_protection.cp_type_value_len); 1768ef7100fSMilanka Ringwald break; 1778ef7100fSMilanka Ringwald case AVDTP_HEADER_COMPRESSION: 1788ef7100fSMilanka Ringwald buffer[pos++] = (caps.header_compression.back_ch << 7) | (caps.header_compression.media << 6) | (caps.header_compression.recovery << 5); 1798ef7100fSMilanka Ringwald break; 1808ef7100fSMilanka Ringwald case AVDTP_MULTIPLEXING: 1818ef7100fSMilanka Ringwald buffer[pos++] = caps.multiplexing_mode.fragmentation << 7; 1828ef7100fSMilanka Ringwald for (i=0; i<caps.multiplexing_mode.transport_identifiers_num; i++){ 1838ef7100fSMilanka Ringwald buffer[pos++] = caps.multiplexing_mode.transport_session_identifiers[i] << 7; 1848ef7100fSMilanka Ringwald buffer[pos++] = caps.multiplexing_mode.tcid[i] << 7; 1858ef7100fSMilanka Ringwald // media, reporting. recovery 1868ef7100fSMilanka Ringwald } 1878ef7100fSMilanka Ringwald break; 1888ef7100fSMilanka Ringwald case AVDTP_MEDIA_CODEC: 1898ef7100fSMilanka Ringwald buffer[pos++] = ((uint8_t)caps.media_codec.media_type) << 4; 1908ef7100fSMilanka Ringwald buffer[pos++] = (uint8_t)caps.media_codec.media_codec_type; 1918ef7100fSMilanka Ringwald for (i = 0; i<caps.media_codec.media_codec_information_len; i++){ 1928ef7100fSMilanka Ringwald buffer[pos++] = caps.media_codec.media_codec_information[i]; 1938ef7100fSMilanka Ringwald } 1948ef7100fSMilanka Ringwald break; 1958ef7100fSMilanka Ringwald default: 1968ef7100fSMilanka Ringwald break; 1978ef7100fSMilanka Ringwald } 1988ef7100fSMilanka Ringwald buffer[0] = pos - 1; // length 1998ef7100fSMilanka Ringwald return pos; 2008ef7100fSMilanka Ringwald } 2018ef7100fSMilanka Ringwald 202390aa582SMatthias Ringwald static int avdtp_unpack_service_capabilities_has_errors(avdtp_connection_t * connection, avdtp_signal_identifier_t signal_identifier, avdtp_service_category_t category, uint8_t cap_len){ 2038ef7100fSMilanka Ringwald connection->error_code = 0; 2048ef7100fSMilanka Ringwald 2050e588213SMatthias Ringwald if ((category == AVDTP_SERVICE_CATEGORY_INVALID_0) || 206390aa582SMatthias Ringwald ((category == AVDTP_SERVICE_CATEGORY_INVALID_FF) && (signal_identifier == AVDTP_SI_RECONFIGURE))){ 2078587e32cSMilanka Ringwald log_info(" ERROR: BAD SERVICE CATEGORY %d\n", category); 2088ef7100fSMilanka Ringwald connection->reject_service_category = category; 2098ef7100fSMilanka Ringwald connection->error_code = BAD_SERV_CATEGORY; 2108ef7100fSMilanka Ringwald return 1; 2118ef7100fSMilanka Ringwald } 2128ef7100fSMilanka Ringwald 213390aa582SMatthias Ringwald if (signal_identifier == AVDTP_SI_RECONFIGURE){ 2140e588213SMatthias Ringwald if ( (category != AVDTP_CONTENT_PROTECTION) && (category != AVDTP_MEDIA_CODEC)){ 2158587e32cSMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, INVALID_CAPABILITIES\n"); 2168ef7100fSMilanka Ringwald connection->reject_service_category = category; 2178ef7100fSMilanka Ringwald connection->error_code = INVALID_CAPABILITIES; 2188ef7100fSMilanka Ringwald return 1; 2198ef7100fSMilanka Ringwald } 2208ef7100fSMilanka Ringwald } 2218ef7100fSMilanka Ringwald 2228ef7100fSMilanka Ringwald switch(category){ 2238ef7100fSMilanka Ringwald case AVDTP_MEDIA_TRANSPORT: 2248ef7100fSMilanka Ringwald if (cap_len != 0){ 2258587e32cSMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, BAD_MEDIA_TRANSPORT\n"); 2268ef7100fSMilanka Ringwald connection->reject_service_category = category; 2278ef7100fSMilanka Ringwald connection->error_code = BAD_MEDIA_TRANSPORT_FORMAT; 2288ef7100fSMilanka Ringwald return 1; 2298ef7100fSMilanka Ringwald } 2308ef7100fSMilanka Ringwald break; 2318ef7100fSMilanka Ringwald case AVDTP_REPORTING: 2328ef7100fSMilanka Ringwald case AVDTP_DELAY_REPORTING: 2338ef7100fSMilanka Ringwald if (cap_len != 0){ 2348587e32cSMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, BAD_LENGTH\n"); 2358ef7100fSMilanka Ringwald connection->reject_service_category = category; 2368ef7100fSMilanka Ringwald connection->error_code = BAD_LENGTH; 2378ef7100fSMilanka Ringwald return 1; 2388ef7100fSMilanka Ringwald } 2398ef7100fSMilanka Ringwald break; 2408ef7100fSMilanka Ringwald case AVDTP_RECOVERY: 241f6f3c903SMilanka Ringwald if (cap_len != 3){ 2428587e32cSMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, BAD_MEDIA_TRANSPORT\n"); 2438ef7100fSMilanka Ringwald connection->reject_service_category = category; 2448ef7100fSMilanka Ringwald connection->error_code = BAD_RECOVERY_FORMAT; 2458ef7100fSMilanka Ringwald return 1; 2468ef7100fSMilanka Ringwald } 2478ef7100fSMilanka Ringwald break; 2488ef7100fSMilanka Ringwald case AVDTP_CONTENT_PROTECTION: 2498ef7100fSMilanka Ringwald if (cap_len < 2){ 2508587e32cSMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, BAD_CP_FORMAT\n"); 2518ef7100fSMilanka Ringwald connection->reject_service_category = category; 2528ef7100fSMilanka Ringwald connection->error_code = BAD_CP_FORMAT; 2538ef7100fSMilanka Ringwald return 1; 2548ef7100fSMilanka Ringwald } 2558ef7100fSMilanka Ringwald break; 2568ef7100fSMilanka Ringwald case AVDTP_HEADER_COMPRESSION: 257f6f3c903SMilanka Ringwald // TODO: find error code for bad header compression 258f6f3c903SMilanka Ringwald if (cap_len != 1){ 259f6f3c903SMilanka Ringwald log_info(" ERROR: REJECT CATEGORY, BAD_HEADER_COMPRESSION\n"); 260f6f3c903SMilanka Ringwald connection->reject_service_category = category; 261f6f3c903SMilanka Ringwald connection->error_code = BAD_RECOVERY_FORMAT; 262f6f3c903SMilanka Ringwald return 1; 263f6f3c903SMilanka Ringwald } 2648ef7100fSMilanka Ringwald break; 2658ef7100fSMilanka Ringwald case AVDTP_MULTIPLEXING: 2668ef7100fSMilanka Ringwald break; 2678ef7100fSMilanka Ringwald case AVDTP_MEDIA_CODEC: 2688ef7100fSMilanka Ringwald break; 2698ef7100fSMilanka Ringwald default: 2708ef7100fSMilanka Ringwald break; 2718ef7100fSMilanka Ringwald } 2728ef7100fSMilanka Ringwald return 0; 2738ef7100fSMilanka Ringwald } 2748ef7100fSMilanka Ringwald 275afc28e0aSMatthias Ringwald uint16_t avdtp_unpack_service_capabilities(avdtp_connection_t * connection, avdtp_signal_identifier_t signal_identifier, avdtp_capabilities_t * caps, uint8_t * packet, uint16_t size){ 276f6f3c903SMilanka Ringwald 277f6f3c903SMilanka Ringwald int i; 2788ef7100fSMilanka Ringwald 2798ef7100fSMilanka Ringwald uint16_t registered_service_categories = 0; 280f6f3c903SMilanka Ringwald uint16_t to_process = size; 281f6f3c903SMilanka Ringwald 282f6f3c903SMilanka Ringwald while (to_process >= 2){ 283f6f3c903SMilanka Ringwald 284f6f3c903SMilanka Ringwald avdtp_service_category_t category = (avdtp_service_category_t) packet[0]; 285f6f3c903SMilanka Ringwald uint8_t cap_len = packet[1]; 286f6f3c903SMilanka Ringwald packet += 2; 287f6f3c903SMilanka Ringwald to_process -= 2; 288f6f3c903SMilanka Ringwald 289f6f3c903SMilanka Ringwald if (cap_len > to_process){ 2908ef7100fSMilanka Ringwald connection->reject_service_category = category; 2918ef7100fSMilanka Ringwald connection->error_code = BAD_LENGTH; 2928ef7100fSMilanka Ringwald return 0; 2938ef7100fSMilanka Ringwald } 29467ae582dSMilanka Ringwald 295afc28e0aSMatthias Ringwald if (avdtp_unpack_service_capabilities_has_errors(connection, signal_identifier, category, cap_len)) return 0; 29667ae582dSMilanka Ringwald 297f6f3c903SMilanka Ringwald int category_valid = 1; 29867ae582dSMilanka Ringwald 299f6f3c903SMilanka Ringwald uint8_t * data = packet; 300f6f3c903SMilanka Ringwald uint16_t pos = 0; 301f6f3c903SMilanka Ringwald 3028ef7100fSMilanka Ringwald switch(category){ 3038ef7100fSMilanka Ringwald case AVDTP_RECOVERY: 304f6f3c903SMilanka Ringwald caps->recovery.recovery_type = data[pos++]; 305f6f3c903SMilanka Ringwald caps->recovery.maximum_recovery_window_size = data[pos++]; 306f6f3c903SMilanka Ringwald caps->recovery.maximum_number_media_packets = data[pos++]; 3078ef7100fSMilanka Ringwald break; 3088ef7100fSMilanka Ringwald case AVDTP_CONTENT_PROTECTION: 309f6f3c903SMilanka Ringwald caps->content_protection.cp_type = big_endian_read_16(data, 0); 3108ef7100fSMilanka Ringwald caps->content_protection.cp_type_value_len = cap_len - 2; 3118ef7100fSMilanka Ringwald // connection->reject_service_category = category; 3128ef7100fSMilanka Ringwald // connection->error_code = UNSUPPORTED_CONFIGURATION; 3138ef7100fSMilanka Ringwald // support for content protection goes here 3148ef7100fSMilanka Ringwald break; 3158ef7100fSMilanka Ringwald case AVDTP_HEADER_COMPRESSION: 316f6f3c903SMilanka Ringwald caps->header_compression.back_ch = (data[0] >> 7) & 1; 317f6f3c903SMilanka Ringwald caps->header_compression.media = (data[0] >> 6) & 1; 318f6f3c903SMilanka Ringwald caps->header_compression.recovery = (data[0] >> 5) & 1; 3198ef7100fSMilanka Ringwald break; 3208ef7100fSMilanka Ringwald case AVDTP_MULTIPLEXING: 321f6f3c903SMilanka Ringwald caps->multiplexing_mode.fragmentation = (data[pos++] >> 7) & 1; 3228ef7100fSMilanka Ringwald // read [tsid, tcid] for media, reporting. recovery respectively 3238ef7100fSMilanka Ringwald caps->multiplexing_mode.transport_identifiers_num = 3; 3248ef7100fSMilanka Ringwald for (i=0; i<caps->multiplexing_mode.transport_identifiers_num; i++){ 325f6f3c903SMilanka Ringwald caps->multiplexing_mode.transport_session_identifiers[i] = (data[pos++] >> 7) & 1; 326f6f3c903SMilanka Ringwald caps->multiplexing_mode.tcid[i] = (data[pos++] >> 7) & 1; 3278ef7100fSMilanka Ringwald } 3288ef7100fSMilanka Ringwald break; 3298ef7100fSMilanka Ringwald case AVDTP_MEDIA_CODEC: 330f6f3c903SMilanka Ringwald caps->media_codec.media_type = (avdtp_media_type_t)(data[pos++] >> 4); 331f6f3c903SMilanka Ringwald caps->media_codec.media_codec_type = (avdtp_media_codec_type_t)(data[pos++]); 3328ef7100fSMilanka Ringwald caps->media_codec.media_codec_information_len = cap_len - 2; 333f6f3c903SMilanka Ringwald caps->media_codec.media_codec_information = &data[pos++]; 3348ef7100fSMilanka Ringwald break; 3358ef7100fSMilanka Ringwald case AVDTP_MEDIA_TRANSPORT: 3368ef7100fSMilanka Ringwald case AVDTP_REPORTING: 3378ef7100fSMilanka Ringwald case AVDTP_DELAY_REPORTING: 3388ef7100fSMilanka Ringwald break; 3398ef7100fSMilanka Ringwald default: 340f6f3c903SMilanka Ringwald category_valid = 0; 3418ef7100fSMilanka Ringwald break; 3428ef7100fSMilanka Ringwald } 3438ef7100fSMilanka Ringwald 344f6f3c903SMilanka Ringwald if (category_valid) { 3458ef7100fSMilanka Ringwald registered_service_categories = store_bit16(registered_service_categories, category, 1); 3468ef7100fSMilanka Ringwald } 347f6f3c903SMilanka Ringwald 348f6f3c903SMilanka Ringwald packet += cap_len; 349f6f3c903SMilanka Ringwald to_process -= cap_len; 35067ae582dSMilanka Ringwald } 351f6f3c903SMilanka Ringwald 3528ef7100fSMilanka Ringwald return registered_service_categories; 3538ef7100fSMilanka Ringwald } 3548ef7100fSMilanka Ringwald 35550d5c6caSMatthias Ringwald void avdtp_prepare_capabilities(avdtp_signaling_packet_t * signaling_packet, uint8_t transaction_label, uint16_t service_categories, avdtp_capabilities_t capabilities, uint8_t identifier){ 3568ef7100fSMilanka Ringwald if (signaling_packet->offset) return; 35750d5c6caSMatthias Ringwald bool basic_capabilities_only = false; 3588ef7100fSMilanka Ringwald signaling_packet->message_type = AVDTP_RESPONSE_ACCEPT_MSG; 3598ef7100fSMilanka Ringwald int i; 360747ec646SMilanka Ringwald 361747ec646SMilanka Ringwald signaling_packet->size = 0; 362747ec646SMilanka Ringwald memset(signaling_packet->command, 0 , sizeof(signaling_packet->command)); 363747ec646SMilanka Ringwald 3648ef7100fSMilanka Ringwald switch (identifier) { 3658ef7100fSMilanka Ringwald case AVDTP_SI_GET_CAPABILITIES: 36650d5c6caSMatthias Ringwald basic_capabilities_only = true; 3678ef7100fSMilanka Ringwald break; 3688ef7100fSMilanka Ringwald case AVDTP_SI_GET_ALL_CAPABILITIES: 3698ef7100fSMilanka Ringwald break; 3708ef7100fSMilanka Ringwald case AVDTP_SI_SET_CONFIGURATION: 371747ec646SMilanka Ringwald signaling_packet->command[signaling_packet->size++] = signaling_packet->acp_seid << 2; 3728ef7100fSMilanka Ringwald signaling_packet->command[signaling_packet->size++] = signaling_packet->int_seid << 2; 3738ef7100fSMilanka Ringwald signaling_packet->message_type = AVDTP_CMD_MSG; 3748ef7100fSMilanka Ringwald break; 3758ef7100fSMilanka Ringwald case AVDTP_SI_RECONFIGURE: 376747ec646SMilanka Ringwald signaling_packet->command[signaling_packet->size++] = signaling_packet->acp_seid << 2; 3778ef7100fSMilanka Ringwald signaling_packet->message_type = AVDTP_CMD_MSG; 3788ef7100fSMilanka Ringwald break; 3798ef7100fSMilanka Ringwald default: 3808ef7100fSMilanka Ringwald log_error("avdtp_prepare_capabilities wrong identifier %d", identifier); 3818ef7100fSMilanka Ringwald break; 3828ef7100fSMilanka Ringwald } 3838ef7100fSMilanka Ringwald 38450d5c6caSMatthias Ringwald for (i = AVDTP_MEDIA_TRANSPORT; i <= AVDTP_DELAY_REPORTING; i++){ 38550d5c6caSMatthias Ringwald int registered_category = get_bit16(service_categories, i); 3862bb3471fSMilanka Ringwald if (!registered_category && (identifier == AVDTP_SI_SET_CONFIGURATION)){ 387747ec646SMilanka Ringwald // TODO: introduce bitmap of mandatory categories 38850d5c6caSMatthias Ringwald if (i == AVDTP_MEDIA_TRANSPORT){ 38950d5c6caSMatthias Ringwald registered_category = true; 390747ec646SMilanka Ringwald } 391747ec646SMilanka Ringwald } 39250d5c6caSMatthias Ringwald // AVDTP_SI_GET_CAPABILITIES reports only basic capabilities (i.e., it skips non-basic categories) 39350d5c6caSMatthias Ringwald if (basic_capabilities_only && !avdtp_is_basic_capability(i)){ 39450d5c6caSMatthias Ringwald registered_category = false; 39550d5c6caSMatthias Ringwald } 39650d5c6caSMatthias Ringwald 397747ec646SMilanka Ringwald if (registered_category){ 3988ef7100fSMilanka Ringwald // service category 3998ef7100fSMilanka Ringwald signaling_packet->command[signaling_packet->size++] = i; 40050d5c6caSMatthias Ringwald signaling_packet->size += avdtp_pack_service_capabilities(signaling_packet->command + signaling_packet->size, 40150d5c6caSMatthias Ringwald sizeof(signaling_packet->command) - signaling_packet->size, capabilities, (avdtp_service_category_t) i); 4028ef7100fSMilanka Ringwald } 4038ef7100fSMilanka Ringwald } 404b0920f25SMilanka Ringwald signaling_packet->signal_identifier = (avdtp_signal_identifier_t)identifier; 4058ef7100fSMilanka Ringwald signaling_packet->transaction_label = transaction_label; 4068ef7100fSMilanka Ringwald } 4078ef7100fSMilanka Ringwald 4088ef7100fSMilanka Ringwald int avdtp_signaling_create_fragment(uint16_t cid, avdtp_signaling_packet_t * signaling_packet, uint8_t * out_buffer) { 4098ef7100fSMilanka Ringwald int mtu = l2cap_get_remote_mtu_for_local_cid(cid); 4108ef7100fSMilanka Ringwald int data_len = 0; 4118ef7100fSMilanka Ringwald 4128ef7100fSMilanka Ringwald uint16_t offset = signaling_packet->offset; 4138ef7100fSMilanka Ringwald uint16_t pos = 1; 4148ef7100fSMilanka Ringwald 4158ef7100fSMilanka Ringwald if (offset == 0){ 416c1ab6cc1SMatthias Ringwald if (signaling_packet->size <= (mtu - 2)){ 4178ef7100fSMilanka Ringwald signaling_packet->packet_type = AVDTP_SINGLE_PACKET; 4188ef7100fSMilanka Ringwald out_buffer[pos++] = signaling_packet->signal_identifier; 4198ef7100fSMilanka Ringwald data_len = signaling_packet->size; 4208ef7100fSMilanka Ringwald } else { 4218ef7100fSMilanka Ringwald signaling_packet->packet_type = AVDTP_START_PACKET; 4228ef7100fSMilanka Ringwald out_buffer[pos++] = (mtu + signaling_packet->size)/ (mtu-1); 4238ef7100fSMilanka Ringwald out_buffer[pos++] = signaling_packet->signal_identifier; 4248ef7100fSMilanka Ringwald data_len = mtu - 3; 4258ef7100fSMilanka Ringwald signaling_packet->offset = data_len; 4268ef7100fSMilanka Ringwald } 4278ef7100fSMilanka Ringwald } else { 4288ef7100fSMilanka Ringwald int remaining_bytes = signaling_packet->size - offset; 429c1ab6cc1SMatthias Ringwald if (remaining_bytes <= (mtu - 1)){ 4308ef7100fSMilanka Ringwald signaling_packet->packet_type = AVDTP_END_PACKET; 4318ef7100fSMilanka Ringwald data_len = remaining_bytes; 4328ef7100fSMilanka Ringwald signaling_packet->offset = 0; 4338ef7100fSMilanka Ringwald } else{ 4348ef7100fSMilanka Ringwald signaling_packet->packet_type = AVDTP_CONTINUE_PACKET; 4358ef7100fSMilanka Ringwald data_len = mtu - 1; 4368ef7100fSMilanka Ringwald signaling_packet->offset += data_len; 4378ef7100fSMilanka Ringwald } 4388ef7100fSMilanka Ringwald } 4398ef7100fSMilanka Ringwald out_buffer[0] = avdtp_header(signaling_packet->transaction_label, signaling_packet->packet_type, signaling_packet->message_type); 4406535961aSMatthias Ringwald (void)memcpy(out_buffer + pos, signaling_packet->command + offset, 4416535961aSMatthias Ringwald data_len); 4428ef7100fSMilanka Ringwald pos += data_len; 4438ef7100fSMilanka Ringwald return pos; 4448ef7100fSMilanka Ringwald } 4458ef7100fSMilanka Ringwald 4468ef7100fSMilanka Ringwald 447c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_connection_established(uint16_t avdtp_cid, bd_addr_t addr, uint8_t status) { 4488ef7100fSMilanka Ringwald uint8_t event[12]; 4498ef7100fSMilanka Ringwald int pos = 0; 4508ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 4518ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 4528ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_CONNECTION_ESTABLISHED; 453f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 4548ef7100fSMilanka Ringwald pos += 2; 4558ef7100fSMilanka Ringwald reverse_bd_addr(addr,&event[pos]); 4568ef7100fSMilanka Ringwald pos += 6; 4578ef7100fSMilanka Ringwald event[pos++] = status; 458c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 4598ef7100fSMilanka Ringwald } 4608ef7100fSMilanka Ringwald 461c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_connection_released(uint16_t avdtp_cid) { 46234b22aacSMilanka Ringwald uint8_t event[5]; 46334b22aacSMilanka Ringwald int pos = 0; 46434b22aacSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 46534b22aacSMilanka Ringwald event[pos++] = sizeof(event) - 2; 46634b22aacSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_CONNECTION_RELEASED; 46734b22aacSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 46834b22aacSMilanka Ringwald pos += 2; 469c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 47034b22aacSMilanka Ringwald } 47134b22aacSMilanka Ringwald 472c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_sep(uint16_t avdtp_cid, avdtp_sep_t sep) { 4738ef7100fSMilanka Ringwald uint8_t event[9]; 4748ef7100fSMilanka Ringwald int pos = 0; 4758ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 4768ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 4778ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_SEP_FOUND; 478f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 4798ef7100fSMilanka Ringwald pos += 2; 4808ef7100fSMilanka Ringwald event[pos++] = sep.seid; 4818ef7100fSMilanka Ringwald event[pos++] = sep.in_use; 4828ef7100fSMilanka Ringwald event[pos++] = sep.media_type; 4838ef7100fSMilanka Ringwald event[pos++] = sep.type; 484c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 4858ef7100fSMilanka Ringwald } 4868ef7100fSMilanka Ringwald 487c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_sep_done(uint16_t avdtp_cid) { 488485c0a4cSMilanka Ringwald uint8_t event[5]; 489485c0a4cSMilanka Ringwald int pos = 0; 490485c0a4cSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 491485c0a4cSMilanka Ringwald event[pos++] = sizeof(event) - 2; 492485c0a4cSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_SEP_DICOVERY_DONE; 493485c0a4cSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 494485c0a4cSMilanka Ringwald pos += 2; 495c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 496485c0a4cSMilanka Ringwald } 497485c0a4cSMilanka Ringwald 498c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_accept(uint16_t avdtp_cid, uint8_t local_seid, avdtp_signal_identifier_t identifier, bool is_initiator) { 49963274943SMilanka Ringwald uint8_t event[8]; 5008ef7100fSMilanka Ringwald int pos = 0; 5018ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 5028ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 5038ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_ACCEPT; 504f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 5058ef7100fSMilanka Ringwald pos += 2; 5064ccacc40SMilanka Ringwald event[pos++] = local_seid; 50763274943SMilanka Ringwald event[pos++] = is_initiator ? 1 : 0; 5088ef7100fSMilanka Ringwald event[pos++] = identifier; 509c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 5108ef7100fSMilanka Ringwald } 5118ef7100fSMilanka Ringwald 512c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_reject(uint16_t avdtp_cid, uint8_t local_seid, avdtp_signal_identifier_t identifier, bool is_initiator) { 51363274943SMilanka Ringwald uint8_t event[8]; 5148ef7100fSMilanka Ringwald int pos = 0; 5158ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 5168ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 5178ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_REJECT; 518f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 5198ef7100fSMilanka Ringwald pos += 2; 5204ccacc40SMilanka Ringwald event[pos++] = local_seid; 52163274943SMilanka Ringwald event[pos++] = is_initiator ? 1 : 0; 5228ef7100fSMilanka Ringwald event[pos++] = identifier; 523c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 5248ef7100fSMilanka Ringwald } 5258ef7100fSMilanka Ringwald 526c69f4ba5SMatthias Ringwald void avdtp_signaling_emit_general_reject(uint16_t avdtp_cid, uint8_t local_seid, avdtp_signal_identifier_t identifier, bool is_initiator) { 52763274943SMilanka Ringwald uint8_t event[8]; 5288ef7100fSMilanka Ringwald int pos = 0; 5298ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 5308ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 5318ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_GENERAL_REJECT; 532f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 5338ef7100fSMilanka Ringwald pos += 2; 5344ccacc40SMilanka Ringwald event[pos++] = local_seid; 53563274943SMilanka Ringwald event[pos++] = is_initiator ? 1 : 0; 5368ef7100fSMilanka Ringwald event[pos++] = identifier; 537c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 5388ef7100fSMilanka Ringwald } 5398ef7100fSMilanka Ringwald 540*4b7d40bbSMatthias Ringwald static inline void 541*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_capability(uint8_t capability_subevent_id, uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid) { 542*4b7d40bbSMatthias Ringwald uint8_t event[7]; 543*4b7d40bbSMatthias Ringwald int pos = 0; 544*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 545*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 546*4b7d40bbSMatthias Ringwald event[pos++] = capability_subevent_id; 547*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 548*4b7d40bbSMatthias Ringwald pos += 2; 549*4b7d40bbSMatthias Ringwald event[pos++] = local_seid; 550*4b7d40bbSMatthias Ringwald event[pos++] = remote_seid; 551*4b7d40bbSMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 552*4b7d40bbSMatthias Ringwald } 553*4b7d40bbSMatthias Ringwald 554c69f4ba5SMatthias Ringwald static void avdtp_signaling_emit_media_codec_sbc_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 555c69f4ba5SMatthias Ringwald adtvp_media_codec_capabilities_t media_codec) { 556ba155c22SMilanka Ringwald uint8_t event[15]; 5578ef7100fSMilanka Ringwald int pos = 0; 5588ef7100fSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 5598ef7100fSMilanka Ringwald event[pos++] = sizeof(event) - 2; 5608ef7100fSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_SBC_CAPABILITY; 561f9bca1f3SMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 5628ef7100fSMilanka Ringwald pos += 2; 5634ccacc40SMilanka Ringwald event[pos++] = local_seid; 5644ccacc40SMilanka Ringwald event[pos++] = remote_seid; 5658ef7100fSMilanka Ringwald event[pos++] = media_codec.media_type; 5668ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[0] >> 4; 5678ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[0] & 0x0F; 5688ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[1] >> 4; 5698ef7100fSMilanka Ringwald event[pos++] = (media_codec.media_codec_information[1] & 0x0F) >> 2; 5708ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[1] & 0x03; 5718ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[2]; 5728ef7100fSMilanka Ringwald event[pos++] = media_codec.media_codec_information[3]; 573c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 5748ef7100fSMilanka Ringwald } 5758ef7100fSMilanka Ringwald 576*4b7d40bbSMatthias Ringwald static void avdtp_signaling_emit_media_codec_other_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 577*4b7d40bbSMatthias Ringwald adtvp_media_codec_capabilities_t media_codec) { 578*4b7d40bbSMatthias Ringwald uint8_t event[MAX_MEDIA_CODEC_INFORMATION_LENGTH + 12]; 57967ae582dSMilanka Ringwald int pos = 0; 58067ae582dSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 58167ae582dSMilanka Ringwald event[pos++] = sizeof(event) - 2; 582*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_OTHER_CAPABILITY; 58367ae582dSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 58467ae582dSMilanka Ringwald pos += 2; 58567ae582dSMilanka Ringwald event[pos++] = local_seid; 58667ae582dSMilanka Ringwald event[pos++] = remote_seid; 587*4b7d40bbSMatthias Ringwald event[pos++] = media_codec.media_type; 588*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, media_codec.media_codec_type); 589*4b7d40bbSMatthias Ringwald pos += 2; 590*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, media_codec.media_codec_information_len); 591*4b7d40bbSMatthias Ringwald pos += 2; 592*4b7d40bbSMatthias Ringwald (void)memcpy(event + pos, media_codec.media_codec_information, 593*4b7d40bbSMatthias Ringwald btstack_min(media_codec.media_codec_information_len, MAX_MEDIA_CODEC_INFORMATION_LENGTH)); 594c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 59567ae582dSMilanka Ringwald } 59667ae582dSMilanka Ringwald 597c69f4ba5SMatthias Ringwald static void 598c69f4ba5SMatthias Ringwald avdtp_signaling_emit_media_transport_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid) { 599c69f4ba5SMatthias Ringwald avdtp_signaling_emit_capability(AVDTP_SUBEVENT_SIGNALING_MEDIA_TRANSPORT_CAPABILITY, avdtp_cid, local_seid, 600c69f4ba5SMatthias Ringwald remote_seid); 60167ae582dSMilanka Ringwald } 60267ae582dSMilanka Ringwald 603c69f4ba5SMatthias Ringwald static void avdtp_signaling_emit_reporting_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid) { 604c69f4ba5SMatthias Ringwald avdtp_signaling_emit_capability(AVDTP_SUBEVENT_SIGNALING_REPORTING_CAPABILITY, avdtp_cid, local_seid, remote_seid); 60567ae582dSMilanka Ringwald } 60667ae582dSMilanka Ringwald 607c69f4ba5SMatthias Ringwald static void 608c69f4ba5SMatthias Ringwald avdtp_signaling_emit_delay_reporting_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid) { 609c69f4ba5SMatthias Ringwald avdtp_signaling_emit_capability(AVDTP_SUBEVENT_SIGNALING_DELAY_REPORTING_CAPABILITY, avdtp_cid, local_seid, 610c69f4ba5SMatthias Ringwald remote_seid); 61167ae582dSMilanka Ringwald } 61267ae582dSMilanka Ringwald 613c69f4ba5SMatthias Ringwald static void avdtp_signaling_emit_recovery_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 614c69f4ba5SMatthias Ringwald avdtp_recovery_capabilities_t *recovery) { 61567ae582dSMilanka Ringwald uint8_t event[10]; 61667ae582dSMilanka Ringwald int pos = 0; 61767ae582dSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 61867ae582dSMilanka Ringwald event[pos++] = sizeof(event) - 2; 61967ae582dSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_RECOVERY_CAPABILITY; 62067ae582dSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 62167ae582dSMilanka Ringwald pos += 2; 62267ae582dSMilanka Ringwald event[pos++] = local_seid; 62367ae582dSMilanka Ringwald event[pos++] = remote_seid; 62467ae582dSMilanka Ringwald event[pos++] = recovery->recovery_type; 62567ae582dSMilanka Ringwald event[pos++] = recovery->maximum_recovery_window_size; 62667ae582dSMilanka Ringwald event[pos++] = recovery->maximum_number_media_packets; 627c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 62867ae582dSMilanka Ringwald } 62967ae582dSMilanka Ringwald 630c69f4ba5SMatthias Ringwald static void 631c69f4ba5SMatthias Ringwald avdtp_signaling_emit_content_protection_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 632c69f4ba5SMatthias Ringwald adtvp_content_protection_t *content_protection) { 63367ae582dSMilanka Ringwald uint8_t event[22]; 63467ae582dSMilanka Ringwald int pos = 0; 63567ae582dSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 63667ae582dSMilanka Ringwald event[pos++] = sizeof(event) - 2; 63767ae582dSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_CONTENT_PROTECTION_CAPABILITY; 63867ae582dSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 63967ae582dSMilanka Ringwald pos += 2; 64067ae582dSMilanka Ringwald event[pos++] = local_seid; 64167ae582dSMilanka Ringwald event[pos++] = remote_seid; 64267ae582dSMilanka Ringwald 64367ae582dSMilanka Ringwald little_endian_store_16(event, pos, content_protection->cp_type); 64467ae582dSMilanka Ringwald pos += 2; 64567ae582dSMilanka Ringwald little_endian_store_16(event, pos, content_protection->cp_type_value_len); 64667ae582dSMilanka Ringwald pos += 2; 64767ae582dSMilanka Ringwald 64867ae582dSMilanka Ringwald //TODO: reserve place for value 64967ae582dSMilanka Ringwald if (content_protection->cp_type_value_len < 10){ 6506535961aSMatthias Ringwald (void)memcpy(event + pos, content_protection->cp_type_value, 6516535961aSMatthias Ringwald content_protection->cp_type_value_len); 65267ae582dSMilanka Ringwald } 653c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 65467ae582dSMilanka Ringwald } 65567ae582dSMilanka Ringwald 65667ae582dSMilanka Ringwald 657c69f4ba5SMatthias Ringwald static void 658c69f4ba5SMatthias Ringwald avdtp_signaling_emit_header_compression_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 659c69f4ba5SMatthias Ringwald avdtp_header_compression_capabilities_t *header_compression) { 66067ae582dSMilanka Ringwald uint8_t event[10]; 66167ae582dSMilanka Ringwald int pos = 0; 66267ae582dSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 66367ae582dSMilanka Ringwald event[pos++] = sizeof(event) - 2; 66467ae582dSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_HEADER_COMPRESSION_CAPABILITY; 66567ae582dSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 66667ae582dSMilanka Ringwald pos += 2; 66767ae582dSMilanka Ringwald event[pos++] = local_seid; 66867ae582dSMilanka Ringwald event[pos++] = remote_seid; 66967ae582dSMilanka Ringwald event[pos++] = header_compression->back_ch; 67067ae582dSMilanka Ringwald event[pos++] = header_compression->media; 67167ae582dSMilanka Ringwald event[pos++] = header_compression->recovery; 672c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 67367ae582dSMilanka Ringwald } 67467ae582dSMilanka Ringwald 675c69f4ba5SMatthias Ringwald static void 676c69f4ba5SMatthias Ringwald avdtp_signaling_emit_content_multiplexing_capability(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, 677c69f4ba5SMatthias Ringwald avdtp_multiplexing_mode_capabilities_t *multiplexing_mode) { 67867ae582dSMilanka Ringwald uint8_t event[15]; 67967ae582dSMilanka Ringwald int pos = 0; 68067ae582dSMilanka Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 68167ae582dSMilanka Ringwald event[pos++] = sizeof(event) - 2; 68267ae582dSMilanka Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_MULTIPLEXING_CAPABILITY; 68367ae582dSMilanka Ringwald little_endian_store_16(event, pos, avdtp_cid); 68467ae582dSMilanka Ringwald pos += 2; 68567ae582dSMilanka Ringwald event[pos++] = local_seid; 68667ae582dSMilanka Ringwald event[pos++] = remote_seid; 68767ae582dSMilanka Ringwald 68867ae582dSMilanka Ringwald event[pos++] = multiplexing_mode->fragmentation; 68967ae582dSMilanka Ringwald event[pos++] = multiplexing_mode->transport_identifiers_num; 69067ae582dSMilanka Ringwald 69167ae582dSMilanka Ringwald int i; 69267ae582dSMilanka Ringwald for (i = 0; i < 3; i++){ 69367ae582dSMilanka Ringwald event[pos++] = multiplexing_mode->transport_session_identifiers[i]; 69467ae582dSMilanka Ringwald } 69567ae582dSMilanka Ringwald for (i = 0; i < 3; i++){ 69667ae582dSMilanka Ringwald event[pos++] = multiplexing_mode->tcid[i]; 69767ae582dSMilanka Ringwald } 698c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 69967ae582dSMilanka Ringwald } 70067ae582dSMilanka Ringwald 701c69f4ba5SMatthias Ringwald static void avdtp_signaling_emit_capability_done(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid) { 702f08f4934SMatthias Ringwald uint8_t event[7]; 703f08f4934SMatthias Ringwald int pos = 0; 704f08f4934SMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 705f08f4934SMatthias Ringwald event[pos++] = sizeof(event) - 2; 706f08f4934SMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_CAPABILITIES_DONE; 707f08f4934SMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 708f08f4934SMatthias Ringwald pos += 2; 709f08f4934SMatthias Ringwald event[pos++] = local_seid; 710f08f4934SMatthias Ringwald event[pos++] = remote_seid; 711c69f4ba5SMatthias Ringwald avdtp_emit_sink_and_source(event, pos); 712f08f4934SMatthias Ringwald } 713f08f4934SMatthias Ringwald 714*4b7d40bbSMatthias Ringwald // emit events for all capabilities incl. final done event 715*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_capabilities(uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, avdtp_capabilities_t *capabilities, 716c69f4ba5SMatthias Ringwald uint16_t registered_service_categories) { 71767ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_MEDIA_CODEC)){ 71867ae582dSMilanka Ringwald switch (capabilities->media_codec.media_codec_type){ 71967ae582dSMilanka Ringwald case AVDTP_CODEC_SBC: 720c69f4ba5SMatthias Ringwald avdtp_signaling_emit_media_codec_sbc_capability(avdtp_cid, local_seid, remote_seid, capabilities->media_codec); 72167ae582dSMilanka Ringwald break; 72267ae582dSMilanka Ringwald default: 723c69f4ba5SMatthias Ringwald avdtp_signaling_emit_media_codec_other_capability(avdtp_cid, local_seid, remote_seid, capabilities->media_codec); 72467ae582dSMilanka Ringwald break; 72567ae582dSMilanka Ringwald } 72667ae582dSMilanka Ringwald } 72767ae582dSMilanka Ringwald 72867ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_MEDIA_TRANSPORT)){ 729c69f4ba5SMatthias Ringwald avdtp_signaling_emit_media_transport_capability(avdtp_cid, local_seid, remote_seid); 73067ae582dSMilanka Ringwald } 73167ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_REPORTING)){ 732c69f4ba5SMatthias Ringwald avdtp_signaling_emit_reporting_capability(avdtp_cid, local_seid, remote_seid); 73367ae582dSMilanka Ringwald } 73467ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_RECOVERY)){ 735c69f4ba5SMatthias Ringwald avdtp_signaling_emit_recovery_capability(avdtp_cid, local_seid, remote_seid, &capabilities->recovery); 73667ae582dSMilanka Ringwald } 73767ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_CONTENT_PROTECTION)){ 738c69f4ba5SMatthias Ringwald avdtp_signaling_emit_content_protection_capability(avdtp_cid, local_seid, remote_seid, 739c69f4ba5SMatthias Ringwald &capabilities->content_protection); 74067ae582dSMilanka Ringwald } 74167ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_HEADER_COMPRESSION)){ 742c69f4ba5SMatthias Ringwald avdtp_signaling_emit_header_compression_capability(avdtp_cid, local_seid, remote_seid, 743c69f4ba5SMatthias Ringwald &capabilities->header_compression); 74467ae582dSMilanka Ringwald } 74567ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_MULTIPLEXING)){ 746c69f4ba5SMatthias Ringwald avdtp_signaling_emit_content_multiplexing_capability(avdtp_cid, local_seid, remote_seid, 747c69f4ba5SMatthias Ringwald &capabilities->multiplexing_mode); 74867ae582dSMilanka Ringwald } 74967ae582dSMilanka Ringwald if (get_bit16(registered_service_categories, AVDTP_DELAY_REPORTING)){ 750c69f4ba5SMatthias Ringwald avdtp_signaling_emit_delay_reporting_capability(avdtp_cid, local_seid, remote_seid); 75167ae582dSMilanka Ringwald } 752c69f4ba5SMatthias Ringwald avdtp_signaling_emit_capability_done(avdtp_cid, local_seid, remote_seid); 75367ae582dSMilanka Ringwald } 75467ae582dSMilanka Ringwald 755*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_media_codec_sbc(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 756*4b7d40bbSMatthias Ringwald avdtp_media_type_t media_type, const uint8_t *media_codec_information, 757*4b7d40bbSMatthias Ringwald uint8_t reconfigure) { 758*4b7d40bbSMatthias Ringwald 759*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 760*4b7d40bbSMatthias Ringwald uint8_t local_seid = avdtp_local_seid(stream_endpoint); 761*4b7d40bbSMatthias Ringwald uint8_t remote_seid = avdtp_remote_seid(stream_endpoint); 762*4b7d40bbSMatthias Ringwald 763*4b7d40bbSMatthias Ringwald uint8_t event[16 + 2]; 764*4b7d40bbSMatthias Ringwald int pos = 0; 765*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 766*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 767*4b7d40bbSMatthias Ringwald 768*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_SBC_CONFIGURATION; 769*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 770*4b7d40bbSMatthias Ringwald pos += 2; 771*4b7d40bbSMatthias Ringwald event[pos++] = local_seid; 772*4b7d40bbSMatthias Ringwald event[pos++] = remote_seid; 773*4b7d40bbSMatthias Ringwald event[pos++] = reconfigure; 774*4b7d40bbSMatthias Ringwald 775*4b7d40bbSMatthias Ringwald 776*4b7d40bbSMatthias Ringwald uint8_t sampling_frequency_bitmap = media_codec_information[0] >> 4; 777*4b7d40bbSMatthias Ringwald uint8_t channel_mode_bitmap = media_codec_information[0] & 0x0F; 778*4b7d40bbSMatthias Ringwald uint8_t block_length_bitmap = media_codec_information[1] >> 4; 779*4b7d40bbSMatthias Ringwald uint8_t subbands_bitmap = (media_codec_information[1] & 0x0F) >> 2; 780*4b7d40bbSMatthias Ringwald 781*4b7d40bbSMatthias Ringwald uint8_t num_channels = 0; 782*4b7d40bbSMatthias Ringwald if ((channel_mode_bitmap & AVDTP_SBC_JOINT_STEREO) || 783*4b7d40bbSMatthias Ringwald (channel_mode_bitmap & AVDTP_SBC_STEREO) || 784*4b7d40bbSMatthias Ringwald (channel_mode_bitmap & AVDTP_SBC_DUAL_CHANNEL)) { 785*4b7d40bbSMatthias Ringwald num_channels = 2; 786*4b7d40bbSMatthias Ringwald } else if (channel_mode_bitmap & AVDTP_SBC_MONO) { 787*4b7d40bbSMatthias Ringwald num_channels = 1; 788*4b7d40bbSMatthias Ringwald } 789*4b7d40bbSMatthias Ringwald 790*4b7d40bbSMatthias Ringwald uint16_t sampling_frequency = 0; 791*4b7d40bbSMatthias Ringwald if (sampling_frequency_bitmap & AVDTP_SBC_48000) { 792*4b7d40bbSMatthias Ringwald sampling_frequency = 48000; 793*4b7d40bbSMatthias Ringwald } else if (sampling_frequency_bitmap & AVDTP_SBC_44100) { 794*4b7d40bbSMatthias Ringwald sampling_frequency = 44100; 795*4b7d40bbSMatthias Ringwald } else if (sampling_frequency_bitmap & AVDTP_SBC_32000) { 796*4b7d40bbSMatthias Ringwald sampling_frequency = 32000; 797*4b7d40bbSMatthias Ringwald } else if (sampling_frequency_bitmap & AVDTP_SBC_16000) { 798*4b7d40bbSMatthias Ringwald sampling_frequency = 16000; 799*4b7d40bbSMatthias Ringwald } 800*4b7d40bbSMatthias Ringwald 801*4b7d40bbSMatthias Ringwald uint8_t subbands = 0; 802*4b7d40bbSMatthias Ringwald if (subbands_bitmap & AVDTP_SBC_SUBBANDS_8){ 803*4b7d40bbSMatthias Ringwald subbands = 8; 804*4b7d40bbSMatthias Ringwald } else if (subbands_bitmap & AVDTP_SBC_SUBBANDS_4){ 805*4b7d40bbSMatthias Ringwald subbands = 4; 806*4b7d40bbSMatthias Ringwald } 807*4b7d40bbSMatthias Ringwald 808*4b7d40bbSMatthias Ringwald uint8_t block_length = 0; 809*4b7d40bbSMatthias Ringwald if (block_length_bitmap & AVDTP_SBC_BLOCK_LENGTH_16){ 810*4b7d40bbSMatthias Ringwald block_length = 16; 811*4b7d40bbSMatthias Ringwald } else if (block_length_bitmap & AVDTP_SBC_BLOCK_LENGTH_12){ 812*4b7d40bbSMatthias Ringwald block_length = 12; 813*4b7d40bbSMatthias Ringwald } else if (block_length_bitmap & AVDTP_SBC_BLOCK_LENGTH_8){ 814*4b7d40bbSMatthias Ringwald block_length = 8; 815*4b7d40bbSMatthias Ringwald } else if (block_length_bitmap & AVDTP_SBC_BLOCK_LENGTH_4){ 816*4b7d40bbSMatthias Ringwald block_length = 4; 817*4b7d40bbSMatthias Ringwald } 818*4b7d40bbSMatthias Ringwald 819*4b7d40bbSMatthias Ringwald event[pos++] = media_type; 820*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, sampling_frequency); 821*4b7d40bbSMatthias Ringwald pos += 2; 822*4b7d40bbSMatthias Ringwald 823*4b7d40bbSMatthias Ringwald event[pos++] = channel_mode_bitmap; 824*4b7d40bbSMatthias Ringwald event[pos++] = num_channels; 825*4b7d40bbSMatthias Ringwald event[pos++] = block_length; 826*4b7d40bbSMatthias Ringwald event[pos++] = subbands; 827*4b7d40bbSMatthias Ringwald event[pos++] = media_codec_information[1] & 0x03; 828*4b7d40bbSMatthias Ringwald event[pos++] = media_codec_information[2]; 829*4b7d40bbSMatthias Ringwald event[pos++] = media_codec_information[3]; 830*4b7d40bbSMatthias Ringwald (*packet_handler)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 831*4b7d40bbSMatthias Ringwald } 832*4b7d40bbSMatthias Ringwald 833*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_media_codec_other(btstack_packet_handler_t callback, uint16_t avdtp_cid, uint8_t local_seid, uint8_t remote_seid, adtvp_media_codec_capabilities_t media_codec, uint8_t reconfigure){ 834*4b7d40bbSMatthias Ringwald btstack_assert(callback != NULL); 835*4b7d40bbSMatthias Ringwald uint8_t event[MAX_MEDIA_CODEC_INFORMATION_LENGTH + 13]; 836*4b7d40bbSMatthias Ringwald int pos = 0; 837*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 838*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 839*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_OTHER_CONFIGURATION; 840*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 841*4b7d40bbSMatthias Ringwald pos += 2; 842*4b7d40bbSMatthias Ringwald event[pos++] = local_seid; 843*4b7d40bbSMatthias Ringwald event[pos++] = remote_seid; 844*4b7d40bbSMatthias Ringwald event[pos++] = reconfigure; 845*4b7d40bbSMatthias Ringwald event[pos++] = media_codec.media_type; 846*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, media_codec.media_codec_type); 847*4b7d40bbSMatthias Ringwald pos += 2; 848*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, media_codec.media_codec_information_len); 849*4b7d40bbSMatthias Ringwald pos += 2; 850*4b7d40bbSMatthias Ringwald 851*4b7d40bbSMatthias Ringwald int media_codec_len = btstack_min(MAX_MEDIA_CODEC_INFORMATION_LENGTH, media_codec.media_codec_information_len); 852*4b7d40bbSMatthias Ringwald (void)memcpy(event + pos, media_codec.media_codec_information, 853*4b7d40bbSMatthias Ringwald media_codec_len); 854*4b7d40bbSMatthias Ringwald 855*4b7d40bbSMatthias Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 856*4b7d40bbSMatthias Ringwald } 857*4b7d40bbSMatthias Ringwald 858*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_delay(uint16_t avdtp_cid, uint8_t local_seid, uint16_t delay) { 859*4b7d40bbSMatthias Ringwald uint8_t event[8]; 860*4b7d40bbSMatthias Ringwald int pos = 0; 861*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 862*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 863*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_SIGNALING_DELAY_REPORT; 864*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 865*4b7d40bbSMatthias Ringwald pos += 2; 866*4b7d40bbSMatthias Ringwald event[pos++] = local_seid; 867*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, delay); 868*4b7d40bbSMatthias Ringwald pos += 2; 869*4b7d40bbSMatthias Ringwald avdtp_emit_source(event, sizeof(event)); 870*4b7d40bbSMatthias Ringwald } 871*4b7d40bbSMatthias Ringwald 872*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_media_codec_sbc_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 873*4b7d40bbSMatthias Ringwald avdtp_media_type_t media_type, 874*4b7d40bbSMatthias Ringwald const uint8_t *media_codec_information) { 875*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_sbc(stream_endpoint, avdtp_cid, media_type, 876*4b7d40bbSMatthias Ringwald media_codec_information, 0); 877*4b7d40bbSMatthias Ringwald } 878*4b7d40bbSMatthias Ringwald 879*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_media_codec_sbc_reconfiguration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 880*4b7d40bbSMatthias Ringwald avdtp_media_type_t media_type, 881*4b7d40bbSMatthias Ringwald const uint8_t *media_codec_information) { 882*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_sbc(stream_endpoint, avdtp_cid, media_type, 883*4b7d40bbSMatthias Ringwald media_codec_information, 1); 884*4b7d40bbSMatthias Ringwald } 885*4b7d40bbSMatthias Ringwald 886*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_media_codec_other_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 887*4b7d40bbSMatthias Ringwald uint8_t local_seid, uint8_t remote_seid, 888*4b7d40bbSMatthias Ringwald adtvp_media_codec_capabilities_t media_codec) { 889*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 890*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_other(packet_handler, avdtp_cid, local_seid, remote_seid, media_codec, 0); 891*4b7d40bbSMatthias Ringwald } 892*4b7d40bbSMatthias Ringwald 893*4b7d40bbSMatthias Ringwald void 894*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_other_reconfiguration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 895*4b7d40bbSMatthias Ringwald uint8_t local_seid, uint8_t remote_seid, 896*4b7d40bbSMatthias Ringwald adtvp_media_codec_capabilities_t media_codec) { 897*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 898*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_other(packet_handler, avdtp_cid, local_seid, remote_seid, media_codec, 1); 899*4b7d40bbSMatthias Ringwald } 900*4b7d40bbSMatthias Ringwald 901*4b7d40bbSMatthias Ringwald void avdtp_signaling_emit_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, 902*4b7d40bbSMatthias Ringwald avdtp_capabilities_t *configuration, uint16_t configured_service_categories) { 903*4b7d40bbSMatthias Ringwald 904*4b7d40bbSMatthias Ringwald uint8_t local_seid = avdtp_local_seid(stream_endpoint); 905*4b7d40bbSMatthias Ringwald uint8_t remote_seid = avdtp_remote_seid(stream_endpoint); 906*4b7d40bbSMatthias Ringwald 907*4b7d40bbSMatthias Ringwald if (get_bit16(configured_service_categories, AVDTP_MEDIA_CODEC)){ 908*4b7d40bbSMatthias Ringwald switch (configuration->media_codec.media_codec_type){ 909*4b7d40bbSMatthias Ringwald case AVDTP_CODEC_SBC: 910*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_sbc_configuration( 911*4b7d40bbSMatthias Ringwald stream_endpoint, avdtp_cid, 912*4b7d40bbSMatthias Ringwald configuration->media_codec.media_type, 913*4b7d40bbSMatthias Ringwald configuration->media_codec.media_codec_information); 914*4b7d40bbSMatthias Ringwald break; 915*4b7d40bbSMatthias Ringwald default: 916*4b7d40bbSMatthias Ringwald avdtp_signaling_emit_media_codec_other_configuration(stream_endpoint, avdtp_cid, 917*4b7d40bbSMatthias Ringwald local_seid, remote_seid, 918*4b7d40bbSMatthias Ringwald configuration->media_codec); 919*4b7d40bbSMatthias Ringwald break; 920*4b7d40bbSMatthias Ringwald } 921*4b7d40bbSMatthias Ringwald } 922*4b7d40bbSMatthias Ringwald } 923*4b7d40bbSMatthias Ringwald 924*4b7d40bbSMatthias Ringwald void avdtp_streaming_emit_connection_established(avdtp_stream_endpoint_t *stream_endpoint, uint8_t status) { 925*4b7d40bbSMatthias Ringwald uint8_t event[14]; 926*4b7d40bbSMatthias Ringwald int pos = 0; 927*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 928*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 929*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_STREAMING_CONNECTION_ESTABLISHED; 930*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, stream_endpoint->connection->avdtp_cid); 931*4b7d40bbSMatthias Ringwald pos += 2; 932*4b7d40bbSMatthias Ringwald reverse_bd_addr(stream_endpoint->connection->remote_addr, &event[pos]); 933*4b7d40bbSMatthias Ringwald pos += 6; 934*4b7d40bbSMatthias Ringwald event[pos++] = avdtp_local_seid(stream_endpoint); 935*4b7d40bbSMatthias Ringwald event[pos++] = avdtp_remote_seid(stream_endpoint); 936*4b7d40bbSMatthias Ringwald event[pos++] = status; 937*4b7d40bbSMatthias Ringwald 938*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 939*4b7d40bbSMatthias Ringwald (*packet_handler)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 940*4b7d40bbSMatthias Ringwald } 941*4b7d40bbSMatthias Ringwald 942*4b7d40bbSMatthias Ringwald void avdtp_streaming_emit_connection_released(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, uint8_t local_seid) { 943*4b7d40bbSMatthias Ringwald uint8_t event[6]; 944*4b7d40bbSMatthias Ringwald int pos = 0; 945*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 946*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 947*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_STREAMING_CONNECTION_RELEASED; 948*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, avdtp_cid); 949*4b7d40bbSMatthias Ringwald pos += 2; 950*4b7d40bbSMatthias Ringwald event[pos++] = local_seid; 951*4b7d40bbSMatthias Ringwald 952*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 953*4b7d40bbSMatthias Ringwald (*packet_handler)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 954*4b7d40bbSMatthias Ringwald } 955*4b7d40bbSMatthias Ringwald 956*4b7d40bbSMatthias Ringwald void avdtp_streaming_emit_can_send_media_packet_now(avdtp_stream_endpoint_t *stream_endpoint, uint16_t sequence_number) { 957*4b7d40bbSMatthias Ringwald uint8_t event[8]; 958*4b7d40bbSMatthias Ringwald int pos = 0; 959*4b7d40bbSMatthias Ringwald event[pos++] = HCI_EVENT_AVDTP_META; 960*4b7d40bbSMatthias Ringwald event[pos++] = sizeof(event) - 2; 961*4b7d40bbSMatthias Ringwald event[pos++] = AVDTP_SUBEVENT_STREAMING_CAN_SEND_MEDIA_PACKET_NOW; 962*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, stream_endpoint->connection->avdtp_cid); 963*4b7d40bbSMatthias Ringwald pos += 2; 964*4b7d40bbSMatthias Ringwald event[pos++] = avdtp_local_seid(stream_endpoint); 965*4b7d40bbSMatthias Ringwald little_endian_store_16(event, pos, sequence_number); 966*4b7d40bbSMatthias Ringwald pos += 2; 967*4b7d40bbSMatthias Ringwald 968*4b7d40bbSMatthias Ringwald btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint); 969*4b7d40bbSMatthias Ringwald (*packet_handler)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 970*4b7d40bbSMatthias Ringwald } 971*4b7d40bbSMatthias Ringwald 9729974aee0SMilanka Ringwald uint8_t avdtp_request_can_send_now_acceptor(avdtp_connection_t * connection, uint16_t l2cap_cid){ 97323edb87eSMilanka Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9748ef7100fSMilanka Ringwald connection->wait_to_send_acceptor = 1; 9758ef7100fSMilanka Ringwald l2cap_request_can_send_now_event(l2cap_cid); 9769974aee0SMilanka Ringwald return ERROR_CODE_SUCCESS; 9778ef7100fSMilanka Ringwald } 9789974aee0SMilanka Ringwald 9799974aee0SMilanka Ringwald uint8_t avdtp_request_can_send_now_initiator(avdtp_connection_t * connection, uint16_t l2cap_cid){ 98023edb87eSMilanka Ringwald if (!connection) return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 9818ef7100fSMilanka Ringwald connection->wait_to_send_initiator = 1; 9828ef7100fSMilanka Ringwald l2cap_request_can_send_now_event(l2cap_cid); 9839974aee0SMilanka Ringwald return ERROR_CODE_SUCCESS; 9848ef7100fSMilanka Ringwald } 9859974aee0SMilanka Ringwald 9864ccacc40SMilanka Ringwald uint8_t avdtp_local_seid(avdtp_stream_endpoint_t * stream_endpoint){ 9874ccacc40SMilanka Ringwald if (!stream_endpoint) return 0; 9884ccacc40SMilanka Ringwald return stream_endpoint->sep.seid; 9894ccacc40SMilanka Ringwald 9904ccacc40SMilanka Ringwald } 9914ccacc40SMilanka Ringwald 9924ccacc40SMilanka Ringwald uint8_t avdtp_remote_seid(avdtp_stream_endpoint_t * stream_endpoint){ 993485c0a4cSMilanka Ringwald if (!stream_endpoint) return AVDTP_INVALID_SEP_SEID; 994485c0a4cSMilanka Ringwald return stream_endpoint->remote_sep.seid; 9954ccacc40SMilanka Ringwald } 996ef5ad9d6SMilanka Ringwald 997*4b7d40bbSMatthias Ringwald // helper for A2DP 998*4b7d40bbSMatthias Ringwald 999ab389ce7SMilanka Ringwald void a2dp_replace_subevent_id_and_emit_cmd(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size, uint8_t subevent_id){ 1000ab389ce7SMilanka Ringwald UNUSED(size); 1001a699c169SMilanka Ringwald btstack_assert(callback != NULL); 1002ab389ce7SMilanka Ringwald packet[0] = HCI_EVENT_A2DP_META; 1003ab389ce7SMilanka Ringwald packet[2] = subevent_id; 1004ab389ce7SMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 1005ab389ce7SMilanka Ringwald } 1006ab389ce7SMilanka Ringwald 1007ab389ce7SMilanka Ringwald void a2dp_emit_streaming_connection_established(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size, uint8_t status){ 1008ab389ce7SMilanka Ringwald btstack_assert(callback != NULL); 1009ab389ce7SMilanka Ringwald packet[0] = HCI_EVENT_A2DP_META; 1010ab389ce7SMilanka Ringwald packet[2] = A2DP_SUBEVENT_STREAM_ESTABLISHED; 1011ab389ce7SMilanka Ringwald packet[12] = status; 1012ab389ce7SMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 1013ab389ce7SMilanka Ringwald } 1014ab389ce7SMilanka Ringwald 1015ab389ce7SMilanka Ringwald void a2dp_emit_signaling_connection_established(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size, uint8_t status){ 1016ab389ce7SMilanka Ringwald btstack_assert(callback != NULL); 1017ab389ce7SMilanka Ringwald packet[0] = HCI_EVENT_A2DP_META; 1018ab389ce7SMilanka Ringwald packet[2] = A2DP_SUBEVENT_SIGNALING_CONNECTION_ESTABLISHED; 1019ab389ce7SMilanka Ringwald packet[10] = status; 1020ab389ce7SMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 1021ab389ce7SMilanka Ringwald } 1022ab389ce7SMilanka Ringwald 102326f6cd9dSMilanka Ringwald void a2dp_emit_stream_event(btstack_packet_handler_t callback, uint16_t cid, uint8_t local_seid, uint8_t subevent_id){ 1024ab389ce7SMilanka Ringwald uint8_t event[6]; 1025ef5ad9d6SMilanka Ringwald int pos = 0; 1026ef5ad9d6SMilanka Ringwald event[pos++] = HCI_EVENT_A2DP_META; 1027ef5ad9d6SMilanka Ringwald event[pos++] = sizeof(event) - 2; 102826f6cd9dSMilanka Ringwald event[pos++] = subevent_id; 1029ef5ad9d6SMilanka Ringwald little_endian_store_16(event, pos, cid); 1030ef5ad9d6SMilanka Ringwald pos += 2; 1031ef5ad9d6SMilanka Ringwald event[pos++] = local_seid; 1032ef5ad9d6SMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, event, sizeof(event)); 1033ef5ad9d6SMilanka Ringwald } 1034