Index: stable/9/lib/libsdp/sdp.h =================================================================== --- stable/9/lib/libsdp/sdp.h (revision 343902) +++ stable/9/lib/libsdp/sdp.h (revision 343903) @@ -1,694 +1,712 @@ /* * sdp.h * * Copyright (c) 2001-2003 Maksim Yevmenkin * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $Id: sdp.h,v 1.3 2003/09/05 00:33:59 max Exp $ * $FreeBSD$ */ #ifndef _SDP_H_ #define _SDP_H_ __BEGIN_DECLS /* * Data representation (page 349) */ /* Nil, the null type */ #define SDP_DATA_NIL 0x00 /* Unsigned integer */ #define SDP_DATA_UINT8 0x08 #define SDP_DATA_UINT16 0x09 #define SDP_DATA_UINT32 0x0A #define SDP_DATA_UINT64 0x0B #define SDP_DATA_UINT128 0x0C /* Signed two's-complement integer */ #define SDP_DATA_INT8 0x10 #define SDP_DATA_INT16 0x11 #define SDP_DATA_INT32 0x12 #define SDP_DATA_INT64 0x13 #define SDP_DATA_INT128 0x14 /* UUID, a universally unique identifier */ #define SDP_DATA_UUID16 0x19 #define SDP_DATA_UUID32 0x1A #define SDP_DATA_UUID128 0x1C /* Text string */ #define SDP_DATA_STR8 0x25 #define SDP_DATA_STR16 0x26 #define SDP_DATA_STR32 0x27 /* Boolean */ #define SDP_DATA_BOOL 0x28 /* * Data element sequence. * A data element whose data field is a sequence of data elements */ #define SDP_DATA_SEQ8 0x35 #define SDP_DATA_SEQ16 0x36 #define SDP_DATA_SEQ32 0x37 /* * Data element alternative. * A data element whose data field is a sequence of data elements from * which one data element is to be selected. */ #define SDP_DATA_ALT8 0x3D #define SDP_DATA_ALT16 0x3E #define SDP_DATA_ALT32 0x3F /* URL, a uniform resource locator */ #define SDP_DATA_URL8 0x45 #define SDP_DATA_URL16 0x46 #define SDP_DATA_URL32 0x47 /* * Protocols UUID (short) https://www.bluetooth.org/assigned-numbers/service_discovery.php * BASE UUID 00000000-0000-1000-8000-00805F9B34FB */ #define SDP_UUID_PROTOCOL_SDP 0x0001 #define SDP_UUID_PROTOCOL_UDP 0x0002 #define SDP_UUID_PROTOCOL_RFCOMM 0x0003 #define SDP_UUID_PROTOCOL_TCP 0x0004 #define SDP_UUID_PROTOCOL_TCS_BIN 0x0005 #define SDP_UUID_PROTOCOL_TCS_AT 0x0006 #define SDP_UUID_PROTOCOL_OBEX 0x0008 #define SDP_UUID_PROTOCOL_IP 0x0009 #define SDP_UUID_PROTOCOL_FTP 0x000A #define SDP_UUID_PROTOCOL_HTTP 0x000C #define SDP_UUID_PROTOCOL_WSP 0x000E #define SDP_UUID_PROTOCOL_BNEP 0x000F #define SDP_UUID_PROTOCOL_UPNP 0x0010 #define SDP_UUID_PROTOCOL_HIDP 0x0011 #define SDP_UUID_PROTOCOL_HARDCOPY_CONTROL_CHANNEL 0x0012 #define SDP_UUID_PROTOCOL_HARDCOPY_DATA_CHANNEL 0x0014 #define SDP_UUID_PROTOCOL_HARDCOPY_NOTIFICATION 0x0016 #define SDP_UUID_PROTOCOL_AVCTP 0x0017 #define SDP_UUID_PROTOCOL_AVDTP 0x0019 #define SDP_UUID_PROTOCOL_CMPT 0x001B #define SDP_UUID_PROTOCOL_UDI_C_PLANE 0x001D #define SDP_UUID_PROTOCOL_L2CAP 0x0100 /* * Service class IDs https://www.bluetooth.org/assigned-numbers/service_discovery.php */ #define SDP_SERVICE_CLASS_SERVICE_DISCOVERY_SERVER 0x1000 #define SDP_SERVICE_CLASS_BROWSE_GROUP_DESCRIPTOR 0x1001 #define SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP 0x1002 #define SDP_SERVICE_CLASS_SERIAL_PORT 0x1101 #define SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP 0x1102 #define SDP_SERVICE_CLASS_DIALUP_NETWORKING 0x1103 #define SDP_SERVICE_CLASS_IR_MC_SYNC 0x1104 #define SDP_SERVICE_CLASS_OBEX_OBJECT_PUSH 0x1105 #define SDP_SERVICE_CLASS_OBEX_FILE_TRANSFER 0x1106 #define SDP_SERVICE_CLASS_IR_MC_SYNC_COMMAND 0x1107 #define SDP_SERVICE_CLASS_HEADSET 0x1108 #define SDP_SERVICE_CLASS_CORDLESS_TELEPHONY 0x1109 #define SDP_SERVICE_CLASS_AUDIO_SOURCE 0x110A #define SDP_SERVICE_CLASS_AUDIO_SINK 0x110B #define SDP_SERVICE_CLASS_AV_REMOTE_CONTROL_TARGET 0x110C #define SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION 0x110D #define SDP_SERVICE_CLASS_AV_REMOTE_CONTROL 0x110E #define SDP_SERVICE_CLASS_VIDEO_CONFERENCING 0x110F #define SDP_SERVICE_CLASS_INTERCOM 0x1110 #define SDP_SERVICE_CLASS_FAX 0x1111 #define SDP_SERVICE_CLASS_HEADSET_AUDIO_GATEWAY 0x1112 #define SDP_SERVICE_CLASS_WAP 0x1113 #define SDP_SERVICE_CLASS_WAP_CLIENT 0x1114 #define SDP_SERVICE_CLASS_PANU 0x1115 #define SDP_SERVICE_CLASS_NAP 0x1116 #define SDP_SERVICE_CLASS_GN 0x1117 #define SDP_SERVICE_CLASS_DIRECT_PRINTING 0x1118 #define SDP_SERVICE_CLASS_REFERENCE_PRINTING 0x1119 #define SDP_SERVICE_CLASS_IMAGING 0x111A #define SDP_SERVICE_CLASS_IMAGING_RESPONDER 0x111B #define SDP_SERVICE_CLASS_IMAGING_AUTOMATIC_ARCHIVE 0x111C #define SDP_SERVICE_CLASS_IMAGING_REFERENCED_OBJECTS 0x111D #define SDP_SERVICE_CLASS_HANDSFREE 0x111E #define SDP_SERVICE_CLASS_HANDSFREE_AUDIO_GATEWAY 0x111F #define SDP_SERVICE_CLASS_DIRECT_PRINTING_REFERENCE_OBJECTS 0x1120 #define SDP_SERVICE_CLASS_REFLECTED_UI 0x1121 #define SDP_SERVICE_CLASS_BASIC_PRINTING 0x1122 #define SDP_SERVICE_CLASS_PRINTING_STATUS 0x1123 #define SDP_SERVICE_CLASS_HUMAN_INTERFACE_DEVICE 0x1124 #define SDP_SERVICE_CLASS_HARDCOPY_CABLE_REPLACEMENT 0x1125 #define SDP_SERVICE_CLASS_HCR_PRINT 0x1126 #define SDP_SERVICE_CLASS_HCR_SCAN 0x1127 #define SDP_SERVICE_CLASS_COMMON_ISDN_ACCESS 0x1128 #define SDP_SERVICE_CLASS_VIDEO_CONFERENCING_GW 0x1129 #define SDP_SERVICE_CLASS_UDI_MT 0x112A #define SDP_SERVICE_CLASS_UDI_TA 0x112B #define SDP_SERVICE_CLASS_AUDIO_VIDEO 0x112C #define SDP_SERVICE_CLASS_SIM_ACCESS 0x112D #define SDP_SERVICE_CLASS_PHONEBOOK_ACCESS_PCE 0x112E #define SDP_SERVICE_CLASS_PHONEBOOK_ACCESS_PSE 0x112F #define SDP_SERVICE_CLASS_PHONEBOOK_ACCESS 0x1130 #define SDP_SERVICE_CLASS_PNP_INFORMATION 0x1200 #define SDP_SERVICE_CLASS_GENERIC_NETWORKING 0x1201 #define SDP_SERVICE_CLASS_GENERIC_FILE_TRANSFER 0x1202 #define SDP_SERVICE_CLASS_GENERIC_AUDIO 0x1203 #define SDP_SERVICE_CLASS_GENERIC_TELEPHONY 0x1204 #define SDP_SERVICE_CLASS_UPNP 0x1205 #define SDP_SERVICE_CLASS_UPNP_IP 0x1206 #define SDP_SERVICE_CLASS_ESDP_UPNP_IP_PAN 0x1300 #define SDP_SERVICE_CLASS_ESDP_UPNP_IP_LAP 0x1301 #define SDP_SERVICE_CLASS_ESDP_UPNP_L2CAP 0x1302 #define SDP_SERVICE_CLASS_VIDEO_SOURCE 0x1303 #define SDP_SERVICE_CLASS_VIDEO_SINK 0x1304 #define SDP_SERVICE_CLASS_VIDEO_DISTRIBUTION 0x1305 /* * Universal attribute definitions (page 366) and * https://www.bluetooth.org/assigned-numbers/service_discovery.php */ #define SDP_ATTR_RANGE(lo, hi) \ (uint32_t)(((uint16_t)(lo) << 16) | ((uint16_t)(hi))) #define SDP_ATTR_SERVICE_RECORD_HANDLE 0x0000 #define SDP_ATTR_SERVICE_CLASS_ID_LIST 0x0001 #define SDP_ATTR_SERVICE_RECORD_STATE 0x0002 #define SDP_ATTR_SERVICE_ID 0x0003 #define SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST 0x0004 #define SDP_ATTR_BROWSE_GROUP_LIST 0x0005 #define SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST 0x0006 #define SDP_ATTR_SERVICE_INFO_TIME_TO_LIVE 0x0007 #define SDP_ATTR_SERVICE_AVAILABILITY 0x0008 #define SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST 0x0009 #define SDP_ATTR_DOCUMENTATION_URL 0x000A #define SDP_ATTR_CLIENT_EXECUTABLE_URL 0x000B #define SDP_ATTR_ICON_URL 0x000C #define SDP_ATTR_ADDITIONAL_PROTOCOL_DESCRIPTOR_LISTS 0x000D #define SDP_ATTR_GROUP_ID 0x0200 #define SDP_ATTR_IP_SUBNET 0x0200 #define SDP_ATTR_VERSION_NUMBER_LIST 0x0200 #define SDP_ATTR_SERVICE_DATABASE_STATE 0x0201 #define SDP_ATTR_SERVICE_VERSION 0x0300 #define SDP_ATTR_EXTERNAL_NETWORK 0x0301 #define SDP_ATTR_NETWORK 0x0301 #define SDP_ATTR_SUPPORTED_DATA_STORES_LIST 0x0301 #define SDP_ATTR_FAX_CLASS1_SUPPORT 0x0302 #define SDP_ATTR_REMOTE_AUDIO_VOLUME_CONTROL 0x0302 #define SDP_ATTR_FAX_CLASS20_SUPPORT 0x0303 #define SDP_ATTR_SUPPORTED_FORMATS_LIST 0x0303 #define SDP_ATTR_FAX_CLASS2_SUPPORT 0x0304 #define SDP_ATTR_AUDIO_FEEDBACK_SUPPORT 0x0305 #define SDP_ATTR_NETWORK_ADDRESS 0x0306 #define SDP_ATTR_WAP_GATEWAY 0x0307 #define SDP_ATTR_HOME_PAGE_URL 0x0308 #define SDP_ATTR_WAP_STACK_TYPE 0x0309 #define SDP_ATTR_SECURITY_DESCRIPTION 0x030A #define SDP_ATTR_NET_ACCESS_TYPE 0x030B #define SDP_ATTR_MAX_NET_ACCESS_RATE 0x030C #define SDP_ATTR_IPV4_SUBNET 0x030D #define SDP_ATTR_IPV6_SUBNET 0x030E #define SDP_ATTR_SUPPORTED_CAPABALITIES 0x0310 #define SDP_ATTR_SUPPORTED_FEATURES 0x0311 #define SDP_ATTR_SUPPORTED_FUNCTIONS 0x0312 #define SDP_ATTR_TOTAL_IMAGING_DATA_CAPACITY 0x0313 #define SDP_ATTR_SUPPORTED_REPOSITORIES 0x0314 /* * The offset must be added to the attribute ID base (contained in the * LANGUAGE_BASE_ATTRIBUTE_ID_LIST attribute) in order to compute the * attribute ID for these attributes. */ #define SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID 0x0100 #define SDP_ATTR_SERVICE_NAME_OFFSET 0x0000 #define SDP_ATTR_SERVICE_DESCRIPTION_OFFSET 0x0001 #define SDP_ATTR_PROVIDER_NAME_OFFSET 0x0002 /* * Protocol data unit (PDU) format (page 352) */ #define SDP_PDU_ERROR_RESPONSE 0x01 #define SDP_PDU_SERVICE_SEARCH_REQUEST 0x02 #define SDP_PDU_SERVICE_SEARCH_RESPONSE 0x03 #define SDP_PDU_SERVICE_ATTRIBUTE_REQUEST 0x04 #define SDP_PDU_SERVICE_ATTRIBUTE_RESPONSE 0x05 #define SDP_PDU_SERVICE_SEARCH_ATTRIBUTE_REQUEST 0x06 #define SDP_PDU_SERVICE_SEARCH_ATTRIBUTE_RESPONSE 0x07 struct sdp_pdu { uint8_t pid; /* PDU ID - SDP_PDU_xxx */ uint16_t tid; /* transaction ID */ uint16_t len; /* parameters length (in bytes) */ } __attribute__ ((packed)); typedef struct sdp_pdu sdp_pdu_t; typedef struct sdp_pdu * sdp_pdu_p; /* * Error codes for SDP_PDU_ERROR_RESPONSE */ #define SDP_ERROR_CODE_INVALID_SDP_VERSION 0x0001 #define SDP_ERROR_CODE_INVALID_SERVICE_RECORD_HANDLE 0x0002 #define SDP_ERROR_CODE_INVALID_REQUEST_SYNTAX 0x0003 #define SDP_ERROR_CODE_INVALID_PDU_SIZE 0x0004 #define SDP_ERROR_CODE_INVALID_CONTINUATION_STATE 0x0005 #define SDP_ERROR_CODE_INSUFFICIENT_RESOURCES 0x0006 /* * SDP int128/uint128 parameter */ struct int128 { int8_t b[16]; }; typedef struct int128 int128_t; typedef struct int128 uint128_t; /* * SDP attribute */ struct sdp_attr { uint16_t flags; #define SDP_ATTR_OK (0 << 0) #define SDP_ATTR_INVALID (1 << 0) #define SDP_ATTR_TRUNCATED (1 << 1) uint16_t attr; /* SDP_ATTR_xxx */ uint32_t vlen; /* length of the value[] in bytes */ uint8_t *value; /* base pointer */ }; typedef struct sdp_attr sdp_attr_t; typedef struct sdp_attr * sdp_attr_p; /****************************************************************************** * User interface *****************************************************************************/ /* Inline versions of get/put byte/short/long. Pointer is advanced */ #define SDP_GET8(b, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (b) = *t_cp; \ (cp) ++; \ } #define SDP_GET16(s, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (s) = ((uint16_t)t_cp[0] << 8) \ | ((uint16_t)t_cp[1]) \ ; \ (cp) += 2; \ } #define SDP_GET32(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (l) = ((uint32_t)t_cp[0] << 24) \ | ((uint32_t)t_cp[1] << 16) \ | ((uint32_t)t_cp[2] << 8) \ | ((uint32_t)t_cp[3]) \ ; \ (cp) += 4; \ } #define SDP_GET64(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (l) = ((uint64_t)t_cp[0] << 56) \ | ((uint64_t)t_cp[1] << 48) \ | ((uint64_t)t_cp[2] << 40) \ | ((uint64_t)t_cp[3] << 32) \ | ((uint64_t)t_cp[4] << 24) \ | ((uint64_t)t_cp[5] << 16) \ | ((uint64_t)t_cp[6] << 8) \ | ((uint64_t)t_cp[7]) \ ; \ (cp) += 8; \ } #if BYTE_ORDER == LITTLE_ENDIAN #define SDP_GET128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (l)->b[15] = *t_cp++; \ (l)->b[14] = *t_cp++; \ (l)->b[13] = *t_cp++; \ (l)->b[12] = *t_cp++; \ (l)->b[11] = *t_cp++; \ (l)->b[10] = *t_cp++; \ (l)->b[9] = *t_cp++; \ (l)->b[8] = *t_cp++; \ (l)->b[7] = *t_cp++; \ (l)->b[6] = *t_cp++; \ (l)->b[5] = *t_cp++; \ (l)->b[4] = *t_cp++; \ (l)->b[3] = *t_cp++; \ (l)->b[2] = *t_cp++; \ (l)->b[1] = *t_cp++; \ (l)->b[0] = *t_cp++; \ (cp) += 16; \ } #define SDP_GET_UUID128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (l)->b[0] = *t_cp++; \ (l)->b[1] = *t_cp++; \ (l)->b[2] = *t_cp++; \ (l)->b[3] = *t_cp++; \ (l)->b[4] = *t_cp++; \ (l)->b[5] = *t_cp++; \ (l)->b[6] = *t_cp++; \ (l)->b[7] = *t_cp++; \ (l)->b[8] = *t_cp++; \ (l)->b[9] = *t_cp++; \ (l)->b[10] = *t_cp++; \ (l)->b[11] = *t_cp++; \ (l)->b[12] = *t_cp++; \ (l)->b[13] = *t_cp++; \ (l)->b[14] = *t_cp++; \ (l)->b[15] = *t_cp++; \ (cp) += 16; \ } #elif BYTE_ORDER == BIG_ENDIAN #define SDP_GET128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ (l)->b[0] = *t_cp++; \ (l)->b[1] = *t_cp++; \ (l)->b[2] = *t_cp++; \ (l)->b[3] = *t_cp++; \ (l)->b[4] = *t_cp++; \ (l)->b[5] = *t_cp++; \ (l)->b[6] = *t_cp++; \ (l)->b[7] = *t_cp++; \ (l)->b[8] = *t_cp++; \ (l)->b[9] = *t_cp++; \ (l)->b[10] = *t_cp++; \ (l)->b[11] = *t_cp++; \ (l)->b[12] = *t_cp++; \ (l)->b[13] = *t_cp++; \ (l)->b[14] = *t_cp++; \ (l)->b[15] = *t_cp++; \ (cp) += 16; \ } #define SDP_GET_UUID128(l, cp) SDP_GET128(l, cp) #else #error "Unsupported BYTE_ORDER" #endif /* BYTE_ORDER */ #define SDP_PUT8(b, cp) { \ register uint8_t t_b = (uint8_t)(b); \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp = t_b; \ (cp) ++; \ } #define SDP_PUT16(s, cp) { \ register uint16_t t_s = (uint16_t)(s); \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = t_s >> 8; \ *t_cp = t_s; \ (cp) += 2; \ } #define SDP_PUT32(l, cp) { \ register uint32_t t_l = (uint32_t)(l); \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = t_l >> 24; \ *t_cp++ = t_l >> 16; \ *t_cp++ = t_l >> 8; \ *t_cp = t_l; \ (cp) += 4; \ } #define SDP_PUT64(l, cp) { \ register uint64_t t_l = (uint64_t)(l); \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = t_l >> 56; \ *t_cp++ = t_l >> 48; \ *t_cp++ = t_l >> 40; \ *t_cp++ = t_l >> 32; \ *t_cp++ = t_l >> 24; \ *t_cp++ = t_l >> 16; \ *t_cp++ = t_l >> 8; \ *t_cp = t_l; \ (cp) += 8; \ } #if BYTE_ORDER == LITTLE_ENDIAN #define SDP_PUT128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = (l)->b[15]; \ *t_cp++ = (l)->b[14]; \ *t_cp++ = (l)->b[13]; \ *t_cp++ = (l)->b[12]; \ *t_cp++ = (l)->b[11]; \ *t_cp++ = (l)->b[10]; \ *t_cp++ = (l)->b[9]; \ *t_cp++ = (l)->b[8]; \ *t_cp++ = (l)->b[7]; \ *t_cp++ = (l)->b[6]; \ *t_cp++ = (l)->b[5]; \ *t_cp++ = (l)->b[4]; \ *t_cp++ = (l)->b[3]; \ *t_cp++ = (l)->b[2]; \ *t_cp++ = (l)->b[1]; \ *t_cp = (l)->b[0]; \ (cp) += 16; \ } #define SDP_PUT_UUID128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = (l)->b[0]; \ *t_cp++ = (l)->b[1]; \ *t_cp++ = (l)->b[2]; \ *t_cp++ = (l)->b[3]; \ *t_cp++ = (l)->b[4]; \ *t_cp++ = (l)->b[5]; \ *t_cp++ = (l)->b[6]; \ *t_cp++ = (l)->b[7]; \ *t_cp++ = (l)->b[8]; \ *t_cp++ = (l)->b[9]; \ *t_cp++ = (l)->b[10]; \ *t_cp++ = (l)->b[11]; \ *t_cp++ = (l)->b[12]; \ *t_cp++ = (l)->b[13]; \ *t_cp++ = (l)->b[14]; \ *t_cp = (l)->b[15]; \ (cp) += 16; \ } #elif BYTE_ORDER == BIG_ENDIAN #define SDP_PUT128(l, cp) { \ register uint8_t *t_cp = (uint8_t *)(cp); \ *t_cp++ = (l)->b[0]; \ *t_cp++ = (l)->b[1]; \ *t_cp++ = (l)->b[2]; \ *t_cp++ = (l)->b[3]; \ *t_cp++ = (l)->b[4]; \ *t_cp++ = (l)->b[5]; \ *t_cp++ = (l)->b[6]; \ *t_cp++ = (l)->b[7]; \ *t_cp++ = (l)->b[8]; \ *t_cp++ = (l)->b[9]; \ *t_cp++ = (l)->b[10]; \ *t_cp++ = (l)->b[11]; \ *t_cp++ = (l)->b[12]; \ *t_cp++ = (l)->b[13]; \ *t_cp++ = (l)->b[14]; \ *t_cp = (l)->b[15]; \ (cp) += 16; \ } #define SDP_PUT_UUID128(l, cp) SDP_PUT128(l, cp) #else #error "Unsupported BYTE_ORDER" #endif /* BYTE_ORDER */ void * sdp_open (bdaddr_t const *l, bdaddr_t const *r); void * sdp_open_local (char const *control); int32_t sdp_close (void *xs); int32_t sdp_error (void *xs); int32_t sdp_search (void *xs, uint32_t plen, uint16_t const *pp, uint32_t alen, uint32_t const *ap, uint32_t vlen, sdp_attr_t *vp); char const * sdp_attr2desc (uint16_t attr); char const * sdp_uuid2desc (uint16_t uuid); void sdp_print (uint32_t level, uint8_t const *start, uint8_t const *end); /****************************************************************************** * sdpd interface and Bluetooth profiles data *****************************************************************************/ #define SDP_LOCAL_PATH "/var/run/sdp" #define SDP_LOCAL_MTU 4096 /* * These are NOT defined in spec and only accepted on control sockets. * The response to these request always will be SDP_PDU_ERROR_RESPONSE. * The first 2 bytes (after PDU header) is an error code (in network * byte order). The rest of the data (pdu->len - 2) is a response data * and depend on the request. * * SDP_PDU_SERVICE_REGISTER_REQUEST * pdu_header_t hdr; * u_int16_t uuid; service class UUID (network byte order) * bdaddr_t bdaddr; local BD_ADDR (or ANY) * profile data[pdu->len - sizeof(uuid) - sizeof(bdaddr)] * * in successful reponse additional data will contain 4 bytes record handle * * * SDP_PDU_SERVICE_UNREGISTER_REQUEST * pdu_header_t hdr; * u_int32_t record_handle; (network byte order) * * no additional data in response. * * * SDP_PDU_SERVICE_CHANGE_REQUEST * pdu_header_t hdr; * u_int32_t record_handle; (network byte order) * profile data[pdu->len - sizeof(record_handle)] * * no additional data in response. */ #define SDP_PDU_SERVICE_REGISTER_REQUEST 0x81 #define SDP_PDU_SERVICE_UNREGISTER_REQUEST 0x82 #define SDP_PDU_SERVICE_CHANGE_REQUEST 0x83 +struct sdp_audio_sink_profile +{ + uint16_t psm; + uint16_t protover; + uint16_t features; +}; +typedef struct sdp_audio_sink_profile sdp_audio_sink_profile_t; +typedef struct sdp_audio_sink_profile *sdp_audio_sink_profile_p; + +struct sdp_audio_source_profile +{ + uint16_t psm; + uint16_t protover; + uint16_t features; +}; +typedef struct sdp_audio_source_profile sdp_audio_source_profile_t; +typedef struct sdp_audio_source_profile *sdp_audio_source_profile_p; + struct sdp_dun_profile { uint8_t server_channel; uint8_t audio_feedback_support; uint8_t reserved[2]; }; typedef struct sdp_dun_profile sdp_dun_profile_t; typedef struct sdp_dun_profile * sdp_dun_profile_p; struct sdp_ftrn_profile { uint8_t server_channel; uint8_t reserved[3]; }; typedef struct sdp_ftrn_profile sdp_ftrn_profile_t; typedef struct sdp_ftrn_profile * sdp_ftrn_profile_p; /* Keep this in sync with sdp_opush_profile */ struct sdp_irmc_profile { uint8_t server_channel; uint8_t supported_formats_size; uint8_t supported_formats[30]; }; typedef struct sdp_irmc_profile sdp_irmc_profile_t; typedef struct sdp_irmc_profile * sdp_irmc_profile_p; struct sdp_irmc_command_profile { uint8_t server_channel; uint8_t reserved[3]; }; typedef struct sdp_irmc_command_profile sdp_irmc_command_profile_t; typedef struct sdp_irmc_command_profile * sdp_irmc_command_profile_p; struct sdp_lan_profile { uint8_t server_channel; uint8_t load_factor; uint8_t reserved; uint8_t ip_subnet_radius; uint32_t ip_subnet; }; typedef struct sdp_lan_profile sdp_lan_profile_t; typedef struct sdp_lan_profile * sdp_lan_profile_p; /* Keep this in sync with sdp_irmc_profile */ struct sdp_opush_profile { uint8_t server_channel; uint8_t supported_formats_size; uint8_t supported_formats[30]; }; typedef struct sdp_opush_profile sdp_opush_profile_t; typedef struct sdp_opush_profile * sdp_opush_profile_p; struct sdp_sp_profile { uint8_t server_channel; uint8_t reserved[3]; }; typedef struct sdp_sp_profile sdp_sp_profile_t; typedef struct sdp_sp_profile * sdp_sp_profile_p; struct sdp_nap_profile { uint8_t reserved; uint8_t load_factor; uint16_t psm; /* HBO */ uint16_t security_description; /* HBO */ uint16_t net_access_type; /* HBO */ uint32_t max_net_access_rate; /* HBO */ }; typedef struct sdp_nap_profile sdp_nap_profile_t; typedef struct sdp_nap_profile * sdp_nap_profile_p; struct sdp_gn_profile { uint8_t reserved; uint8_t load_factor; uint16_t psm; /* HBO */ uint16_t security_description; /* HBO */ uint16_t reserved2; }; typedef struct sdp_gn_profile sdp_gn_profile_t; typedef struct sdp_gn_profile * sdp_gn_profile_p; struct sdp_panu_profile { uint8_t reserved; uint8_t load_factor; uint16_t psm; /* HBO */ uint16_t security_description; /* HBO */ uint16_t reserved2; }; typedef struct sdp_panu_profile sdp_panu_profile_t; typedef struct sdp_panu_profile * sdp_panu_profile_p; int32_t sdp_register_service (void *xss, uint16_t uuid, bdaddr_p const bdaddr, uint8_t const *data, uint32_t datalen, uint32_t *handle); int32_t sdp_unregister_service (void *xss, uint32_t handle); int32_t sdp_change_service (void *xss, uint32_t handle, uint8_t const *data, uint32_t datalen); __END_DECLS #endif /* ndef _SDP_H_ */ Index: stable/9/lib =================================================================== --- stable/9/lib (revision 343902) +++ stable/9/lib (revision 343903) Property changes on: stable/9/lib ___________________________________________________________________ Modified: svn:mergeinfo ## -0,0 +0,1 ## Merged /head/lib:r343572 Index: stable/9/usr.sbin/bluetooth/sdpd/Makefile =================================================================== --- stable/9/usr.sbin/bluetooth/sdpd/Makefile (revision 343902) +++ stable/9/usr.sbin/bluetooth/sdpd/Makefile (revision 343903) @@ -1,13 +1,14 @@ # $Id: Makefile,v 1.1 2004/01/20 21:27:55 max Exp $ # $FreeBSD$ PROG= sdpd MAN= sdpd.8 -SRCS= bgd.c dun.c ftrn.c gn.c irmc.c irmc_command.c lan.c log.c \ +SRCS= audio_sink.c audio_source.c \ + bgd.c dun.c ftrn.c gn.c irmc.c irmc_command.c lan.c log.c \ main.c nap.c opush.c panu.c profile.c provider.c sar.c scr.c \ sd.c server.c sp.c srr.c ssar.c ssr.c sur.c uuid.c CFLAGS+= -I${.CURDIR} WARNS?= 2 .include Index: stable/9/usr.sbin/bluetooth/sdpd/audio_sink.c =================================================================== --- stable/9/usr.sbin/bluetooth/sdpd/audio_sink.c (nonexistent) +++ stable/9/usr.sbin/bluetooth/sdpd/audio_sink.c (revision 343903) @@ -0,0 +1,188 @@ +/*- + * SPDX-License-Identifier: BSD-2-Clause-FreeBSD + * + * Copyright (c) 2019 Hans Petter Selasky + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * $FreeBSD$ + */ + +#include +#define L2CAP_SOCKET_CHECKED +#include +#include +#include +#include "profile.h" +#include "provider.h" + +static int32_t +audio_sink_profile_create_service_class_id_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const uint16_t service_classes[] = { + SDP_SERVICE_CLASS_AUDIO_SINK, + }; + + return (common_profile_create_service_class_id_list( + buf, eob, + (uint8_t const *)service_classes, + sizeof(service_classes))); +} + +static int32_t +audio_sink_profile_create_protocol_descriptor_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + provider_p provider = (provider_p) data; + sdp_audio_sink_profile_p audio_sink = (sdp_audio_sink_profile_p) provider->data; + + if (buf + 18 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(16, buf); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(6, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_sink->psm, buf); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(6, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_UUID_PROTOCOL_AVDTP, buf); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_sink->protover, buf); + + return (18); +} + +static int32_t +audio_sink_profile_create_browse_group_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + + if (buf + 5 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(3, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, buf); + + return (5); +} + +static int32_t +audio_sink_profile_create_bluetooth_profile_descriptor_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const uint16_t profile_descriptor_list[] = { + SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION, + 0x0100 + }; + + return (common_profile_create_bluetooth_profile_descriptor_list( + buf, eob, + (uint8_t const *)profile_descriptor_list, + sizeof(profile_descriptor_list))); +} + +static int32_t +audio_sink_profile_create_service_name( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const char service_name[] = "Audio SNK"; + + return (common_profile_create_string8( + buf, eob, + (uint8_t const *)service_name, strlen(service_name))); +} + +static int32_t +audio_sink_create_supported_features( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + provider_p provider = (provider_p) data; + sdp_audio_sink_profile_p audio_sink = (sdp_audio_sink_profile_p) provider->data; + + if (buf + 3 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_sink->features, buf); + + return (3); +} + +static int32_t +audio_sink_profile_valid(uint8_t const *data, uint32_t datalen) +{ + + if (datalen < sizeof(struct sdp_audio_sink_profile)) + return (0); + return (1); +} + +static const attr_t audio_sink_profile_attrs[] = { + {SDP_ATTR_SERVICE_RECORD_HANDLE, + common_profile_create_service_record_handle}, + {SDP_ATTR_SERVICE_CLASS_ID_LIST, + audio_sink_profile_create_service_class_id_list}, + {SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST, + audio_sink_profile_create_protocol_descriptor_list}, + {SDP_ATTR_BROWSE_GROUP_LIST, + audio_sink_profile_create_browse_group_list}, + {SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST, + common_profile_create_language_base_attribute_id_list}, + {SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST, + audio_sink_profile_create_bluetooth_profile_descriptor_list}, + {SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_SERVICE_NAME_OFFSET, + audio_sink_profile_create_service_name}, + {SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_PROVIDER_NAME_OFFSET, + common_profile_create_service_provider_name}, + {SDP_ATTR_SUPPORTED_FEATURES, + audio_sink_create_supported_features}, + {} /* end entry */ +}; + +profile_t audio_sink_profile_descriptor = { + SDP_SERVICE_CLASS_AUDIO_SINK, + sizeof(sdp_audio_sink_profile_t), + audio_sink_profile_valid, + (attr_t const *const)&audio_sink_profile_attrs +}; Property changes on: stable/9/usr.sbin/bluetooth/sdpd/audio_sink.c ___________________________________________________________________ Added: svn:eol-style ## -0,0 +1 ## +native \ No newline at end of property Added: svn:keywords ## -0,0 +1 ## +FreeBSD=%H \ No newline at end of property Added: svn:mime-type ## -0,0 +1 ## +text/plain \ No newline at end of property Index: stable/9/usr.sbin/bluetooth/sdpd/audio_source.c =================================================================== --- stable/9/usr.sbin/bluetooth/sdpd/audio_source.c (nonexistent) +++ stable/9/usr.sbin/bluetooth/sdpd/audio_source.c (revision 343903) @@ -0,0 +1,188 @@ +/*- + * SPDX-License-Identifier: BSD-2-Clause-FreeBSD + * + * Copyright (c) 2019 Hans Petter Selasky + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * $FreeBSD$ + */ + +#include +#define L2CAP_SOCKET_CHECKED +#include +#include +#include +#include "profile.h" +#include "provider.h" + +static int32_t +audio_source_profile_create_service_class_id_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const uint16_t service_classes[] = { + SDP_SERVICE_CLASS_AUDIO_SOURCE, + }; + + return (common_profile_create_service_class_id_list( + buf, eob, + (uint8_t const *)service_classes, + sizeof(service_classes))); +} + +static int32_t +audio_source_profile_create_protocol_descriptor_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + provider_p provider = (provider_p) data; + sdp_audio_source_profile_p audio_source = (sdp_audio_source_profile_p) provider->data; + + if (buf + 18 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(16, buf); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(6, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_source->psm, buf); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(6, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_UUID_PROTOCOL_AVDTP, buf); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_source->protover, buf); + + return (18); +} + +static int32_t +audio_source_profile_create_browse_group_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + + if (buf + 5 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_SEQ8, buf); + SDP_PUT8(3, buf); + + SDP_PUT8(SDP_DATA_UUID16, buf); + SDP_PUT16(SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, buf); + + return (5); +} + +static int32_t +audio_source_profile_create_bluetooth_profile_descriptor_list( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const uint16_t profile_descriptor_list[] = { + SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION, + 0x0100 + }; + + return (common_profile_create_bluetooth_profile_descriptor_list( + buf, eob, + (uint8_t const *)profile_descriptor_list, + sizeof(profile_descriptor_list))); +} + +static int32_t +audio_source_profile_create_service_name( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + static const char service_name[] = "Audio SRC"; + + return (common_profile_create_string8( + buf, eob, + (uint8_t const *)service_name, strlen(service_name))); +} + +static int32_t +audio_source_create_supported_features( + uint8_t *buf, uint8_t const *const eob, + uint8_t const *data, uint32_t datalen) +{ + provider_p provider = (provider_p) data; + sdp_audio_source_profile_p audio_source = (sdp_audio_source_profile_p) provider->data; + + if (buf + 3 > eob) + return (-1); + + SDP_PUT8(SDP_DATA_UINT16, buf); + SDP_PUT16(audio_source->features, buf); + + return (3); +} + +static int32_t +audio_source_profile_valid(uint8_t const *data, uint32_t datalen) +{ + + if (datalen < sizeof(struct sdp_audio_source_profile)) + return (0); + return (1); +} + +static const attr_t audio_source_profile_attrs[] = { + {SDP_ATTR_SERVICE_RECORD_HANDLE, + common_profile_create_service_record_handle}, + {SDP_ATTR_SERVICE_CLASS_ID_LIST, + audio_source_profile_create_service_class_id_list}, + {SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST, + audio_source_profile_create_protocol_descriptor_list}, + {SDP_ATTR_BROWSE_GROUP_LIST, + audio_source_profile_create_browse_group_list}, + {SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST, + common_profile_create_language_base_attribute_id_list}, + {SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST, + audio_source_profile_create_bluetooth_profile_descriptor_list}, + {SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_SERVICE_NAME_OFFSET, + audio_source_profile_create_service_name}, + {SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID + SDP_ATTR_PROVIDER_NAME_OFFSET, + common_profile_create_service_provider_name}, + {SDP_ATTR_SUPPORTED_FEATURES, + audio_source_create_supported_features}, + {} /* end entry */ +}; + +profile_t audio_source_profile_descriptor = { + SDP_SERVICE_CLASS_AUDIO_SOURCE, + sizeof(sdp_audio_source_profile_t), + audio_source_profile_valid, + (attr_t const *const)&audio_source_profile_attrs +}; Property changes on: stable/9/usr.sbin/bluetooth/sdpd/audio_source.c ___________________________________________________________________ Added: svn:eol-style ## -0,0 +1 ## +native \ No newline at end of property Added: svn:keywords ## -0,0 +1 ## +FreeBSD=%H \ No newline at end of property Added: svn:mime-type ## -0,0 +1 ## +text/plain \ No newline at end of property Index: stable/9/usr.sbin/bluetooth/sdpd/profile.c =================================================================== --- stable/9/usr.sbin/bluetooth/sdpd/profile.c (revision 343902) +++ stable/9/usr.sbin/bluetooth/sdpd/profile.c (revision 343903) @@ -1,497 +1,501 @@ /* * profile.c */ /*- * Copyright (c) 2004 Maksim Yevmenkin * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $Id: profile.c,v 1.6 2004/01/13 19:31:54 max Exp $ * $FreeBSD$ */ #include #include #include #include #include "profile.h" #include "provider.h" /* * Lookup profile descriptor */ profile_p profile_get_descriptor(uint16_t uuid) { + extern profile_t audio_sink_profile_descriptor; + extern profile_t audio_source_profile_descriptor; extern profile_t dun_profile_descriptor; extern profile_t ftrn_profile_descriptor; extern profile_t irmc_profile_descriptor; extern profile_t irmc_command_profile_descriptor; extern profile_t lan_profile_descriptor; extern profile_t opush_profile_descriptor; extern profile_t sp_profile_descriptor; extern profile_t nap_profile_descriptor; extern profile_t gn_profile_descriptor; extern profile_t panu_profile_descriptor; static const profile_p profiles[] = { + &audio_sink_profile_descriptor, + &audio_source_profile_descriptor, &dun_profile_descriptor, &ftrn_profile_descriptor, &irmc_profile_descriptor, &irmc_command_profile_descriptor, &lan_profile_descriptor, &opush_profile_descriptor, &sp_profile_descriptor, &nap_profile_descriptor, &gn_profile_descriptor, &panu_profile_descriptor }; int32_t i; for (i = 0; i < sizeof(profiles)/sizeof(profiles[0]); i++) if (profiles[i]->uuid == uuid) return (profiles[i]); return (NULL); } /* * Look attribute in the profile descripror */ profile_attr_create_p profile_get_attr(const profile_p profile, uint16_t attr) { attr_p ad = (attr_p) profile->attrs; for (; ad->create != NULL; ad ++) if (ad->attr == attr) return (ad->create); return (NULL); } /* * uint32 value32 - 5 bytes */ int32_t common_profile_create_service_record_handle( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (buf + 5 > eob) return (-1); SDP_PUT8(SDP_DATA_UINT32, buf); SDP_PUT32(((provider_p) data)->handle, buf); return (5); } /* * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes * [ uuid16 value ] */ int32_t common_profile_create_service_class_id_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { int32_t len = 3 * (datalen >>= 1); if (len <= 0 || len > 0xff || buf + 2 + len > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(len, buf); for (; datalen > 0; datalen --) { SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(*((uint16_t const *)data), buf); data += sizeof(uint16_t); } return (2 + len); } /* * seq8 len8 - 2 bytes * seq 8 len8 - 2 bytes * uuid16 value16 - 3 bytes * uint16 value16 - 3 bytes * [ seq 8 len8 * uuid16 value16 * uint16 value16 ] */ int32_t common_profile_create_bluetooth_profile_descriptor_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { int32_t len = 8 * (datalen >>= 2); if (len <= 0 || len > 0xff || buf + 2 + len > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(len, buf); for (; datalen > 0; datalen --) { SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(6, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(*((uint16_t const *)data), buf); data += sizeof(uint16_t); SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(*((uint16_t const *)data), buf); data += sizeof(uint16_t); } return (2 + len); } /* * seq8 len8 - 2 bytes * uint16 value16 - 3 bytes * uint16 value16 - 3 bytes * uint16 value16 - 3 bytes */ int32_t common_profile_create_language_base_attribute_id_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (buf + 11 > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(9, buf); /* * Language code per ISO 639:1988. Use "en". */ SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(((0x65 << 8) | 0x6e), buf); /* * Encoding. Recommended is UTF-8. ISO639 UTF-8 MIBenum is 106 * (http://www.iana.org/assignments/character-sets) */ SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(106, buf); /* * Offset (Primary Language Base is 0x100) */ SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID, buf); return (11); } /* * Common provider name is "FreeBSD" */ int32_t common_profile_create_service_provider_name( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { char provider_name[] = "FreeBSD"; return (common_profile_create_string8(buf, eob, (uint8_t const *) provider_name, strlen(provider_name))); } /* * str8 len8 string */ int32_t common_profile_create_string8( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (datalen == 0 || datalen > 0xff || buf + 2 + datalen > eob) return (-1); SDP_PUT8(SDP_DATA_STR8, buf); SDP_PUT8(datalen, buf); memcpy(buf, data, datalen); return (2 + datalen); } /* * Service Availability */ int32_t common_profile_create_service_availability( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (datalen != 1 || buf + 2 > eob) return (-1); SDP_PUT8(SDP_DATA_UINT8, buf); SDP_PUT8(data[0], buf); return (2); } /* * seq8 len8 - 2 bytes * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes * uint8 value8 - 2 bytes */ int32_t rfcomm_profile_create_protocol_descriptor_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (datalen != 1 || buf + 14 > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(12, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(3, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(5, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_RFCOMM, buf); SDP_PUT8(SDP_DATA_UINT8, buf); SDP_PUT8(*data, buf); return (14); } /* * seq8 len8 - 2 bytes * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes * uint8 value8 - 2 bytes * seq8 len8 - 2 bytes * uuid16 value16 - 3 bytes */ int32_t obex_profile_create_protocol_descriptor_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { if (datalen != 1 || buf + 19 > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(17, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(3, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(5, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_RFCOMM, buf); SDP_PUT8(SDP_DATA_UINT8, buf); SDP_PUT8(*data, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(3, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_OBEX, buf); return (19); } /* * seq8 len8 * uint8 value8 - bytes * [ uint8 value 8 ] */ int32_t obex_profile_create_supported_formats_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { int32_t len = 2 * datalen; if (len <= 0 || len > 0xff || buf + 2 + len > eob) return (-1); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(len, buf); for (; datalen > 0; datalen --) { SDP_PUT8(SDP_DATA_UINT8, buf); SDP_PUT8(*data++, buf); } return (2 + len); } /* * do not check anything */ int32_t common_profile_always_valid(uint8_t const *data, uint32_t datalen) { return (1); } /* * verify server channel number (the first byte in the data) */ int32_t common_profile_server_channel_valid(uint8_t const *data, uint32_t datalen) { if (data[0] < 1 || data[0] > 30) return (0); return (1); } /* * verify server channel number and supported_formats_size * sdp_opush_profile and sdp_irmc_profile */ int32_t obex_profile_data_valid(uint8_t const *data, uint32_t datalen) { sdp_opush_profile_p opush = (sdp_opush_profile_p) data; if (opush->server_channel < 1 || opush->server_channel > 30 || opush->supported_formats_size == 0 || opush->supported_formats_size > sizeof(opush->supported_formats)) return (0); return (1); } /* * BNEP protocol descriptor */ int32_t bnep_profile_create_protocol_descriptor_list( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { /* supported protocol types */ uint16_t ptype[] = { 0x0800, /* IPv4 */ 0x0806, /* ARP */ #ifdef INET6 0x86dd, /* IPv6 */ #endif }; uint16_t i, psm, version = 0x0100, nptypes = sizeof(ptype)/sizeof(ptype[0]), nptypes_size = nptypes * 3; if (datalen != 2 || 18 + nptypes_size > 255 || buf + 20 + nptypes_size > eob) return (-1); memcpy(&psm, data, sizeof(psm)); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(18 + nptypes_size, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(6, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_L2CAP, buf); SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(psm, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(8 + nptypes_size, buf); SDP_PUT8(SDP_DATA_UUID16, buf); SDP_PUT16(SDP_UUID_PROTOCOL_BNEP, buf); SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(version, buf); SDP_PUT8(SDP_DATA_SEQ8, buf); SDP_PUT8(nptypes_size, buf); for (i = 0; i < nptypes; i ++) { SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(ptype[i], buf); } return (20 + nptypes_size); } /* * BNEP security description */ int32_t bnep_profile_create_security_description( uint8_t *buf, uint8_t const * const eob, uint8_t const *data, uint32_t datalen) { uint16_t security_descr; if (datalen != 2 || buf + 3 > eob) return (-1); memcpy(&security_descr, data, sizeof(security_descr)); SDP_PUT8(SDP_DATA_UINT16, buf); SDP_PUT16(security_descr, buf); return (3); } Index: stable/9/usr.sbin/bluetooth/sdpd =================================================================== --- stable/9/usr.sbin/bluetooth/sdpd (revision 343902) +++ stable/9/usr.sbin/bluetooth/sdpd (revision 343903) Property changes on: stable/9/usr.sbin/bluetooth/sdpd ___________________________________________________________________ Modified: svn:mergeinfo ## -0,0 +0,1 ## Merged /head/usr.sbin/bluetooth/sdpd:r343572 Index: stable/9/usr.sbin =================================================================== --- stable/9/usr.sbin (revision 343902) +++ stable/9/usr.sbin (revision 343903) Property changes on: stable/9/usr.sbin ___________________________________________________________________ Modified: svn:mergeinfo ## -0,0 +0,1 ## Merged /head/usr.sbin:r343572