1/*- 2 * util.c 3 * 4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 5 * 6 * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com> 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 * 30 * $Id: util.c,v 1.5 2003/09/08 02:29:35 max Exp $ 31 * $FreeBSD$ 32 */ 33 34#include <netinet/in.h> 35#define L2CAP_SOCKET_CHECKED 36#include <bluetooth.h> 37#include <stdio.h> 38#include <sdp.h> 39 40/* 41 * SDP attribute description 42 */ 43 44struct sdp_attr_desc { 45 uint32_t attr; 46 char const *desc; 47}; 48typedef struct sdp_attr_desc sdp_attr_desc_t; 49typedef struct sdp_attr_desc * sdp_attr_desc_p; 50 51static sdp_attr_desc_t sdp_uuids_desc[] = { 52{ SDP_UUID_PROTOCOL_SDP, "SDP", }, 53{ SDP_UUID_PROTOCOL_UDP, "UDP", }, 54{ SDP_UUID_PROTOCOL_RFCOMM, "RFCOMM", }, 55{ SDP_UUID_PROTOCOL_TCP, "TCP", }, 56{ SDP_UUID_PROTOCOL_TCS_BIN, "TCS BIN", }, 57{ SDP_UUID_PROTOCOL_TCS_AT, "TCS AT", }, 58{ SDP_UUID_PROTOCOL_OBEX, "OBEX", }, 59{ SDP_UUID_PROTOCOL_IP, "IP", }, 60{ SDP_UUID_PROTOCOL_FTP, "FTP", }, 61{ SDP_UUID_PROTOCOL_HTTP, "HTTP", }, 62{ SDP_UUID_PROTOCOL_WSP, "WSP", }, 63{ SDP_UUID_PROTOCOL_BNEP, "BNEP", }, 64{ SDP_UUID_PROTOCOL_UPNP, "UPNP", }, 65{ SDP_UUID_PROTOCOL_HIDP, "HIDP", }, 66{ SDP_UUID_PROTOCOL_HARDCOPY_CONTROL_CHANNEL, "Hardcopy Control Channel", }, 67{ SDP_UUID_PROTOCOL_HARDCOPY_DATA_CHANNEL, "Hardcopy Data Channel", }, 68{ SDP_UUID_PROTOCOL_HARDCOPY_NOTIFICATION, "Hardcopy Notification", }, 69{ SDP_UUID_PROTOCOL_AVCTP, "AVCTP", }, 70{ SDP_UUID_PROTOCOL_AVDTP, "AVDTP", }, 71{ SDP_UUID_PROTOCOL_CMPT, "CMPT", }, 72{ SDP_UUID_PROTOCOL_UDI_C_PLANE, "UDI C-Plane", }, 73{ SDP_UUID_PROTOCOL_L2CAP, "L2CAP", }, 74/* Service Class IDs/Bluetooth Profile IDs */ 75{ SDP_SERVICE_CLASS_SERVICE_DISCOVERY_SERVER, "Service Discovery Server", }, 76{ SDP_SERVICE_CLASS_BROWSE_GROUP_DESCRIPTOR, "Browse Group Descriptor", }, 77{ SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, "Public Browse Group", }, 78{ SDP_SERVICE_CLASS_SERIAL_PORT, "Serial Port", }, 79{ SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP, "LAN Access Using PPP", }, 80{ SDP_SERVICE_CLASS_DIALUP_NETWORKING, "Dial-Up Networking", }, 81{ SDP_SERVICE_CLASS_IR_MC_SYNC, "IrMC Sync", }, 82{ SDP_SERVICE_CLASS_OBEX_OBJECT_PUSH, "OBEX Object Push", }, 83{ SDP_SERVICE_CLASS_OBEX_FILE_TRANSFER, "OBEX File Transfer", }, 84{ SDP_SERVICE_CLASS_IR_MC_SYNC_COMMAND, "IrMC Sync Command", }, 85{ SDP_SERVICE_CLASS_HEADSET, "Headset", }, 86{ SDP_SERVICE_CLASS_CORDLESS_TELEPHONY, "Cordless Telephony", }, 87{ SDP_SERVICE_CLASS_AUDIO_SOURCE, "Audio Source", }, 88{ SDP_SERVICE_CLASS_AUDIO_SINK, "Audio Sink", }, 89{ SDP_SERVICE_CLASS_AV_REMOTE_CONTROL_TARGET, "A/V Remote Control Target", }, 90{ SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION, "Advanced Audio Distribution", }, 91{ SDP_SERVICE_CLASS_AV_REMOTE_CONTROL, "A/V Remote Control", }, 92{ SDP_SERVICE_CLASS_VIDEO_CONFERENCING, "Video Conferencing", }, 93{ SDP_SERVICE_CLASS_INTERCOM, "Intercom", }, 94{ SDP_SERVICE_CLASS_FAX, "Fax", }, 95{ SDP_SERVICE_CLASS_HEADSET_AUDIO_GATEWAY, "Headset Audio Gateway", }, 96{ SDP_SERVICE_CLASS_WAP, "WAP", }, 97{ SDP_SERVICE_CLASS_WAP_CLIENT, "WAP Client", }, 98{ SDP_SERVICE_CLASS_PANU, "PANU", }, 99{ SDP_SERVICE_CLASS_NAP, "Network Access Point", }, 100{ SDP_SERVICE_CLASS_GN, "GN", }, 101{ SDP_SERVICE_CLASS_DIRECT_PRINTING, "Direct Printing", }, 102{ SDP_SERVICE_CLASS_REFERENCE_PRINTING, "Reference Printing", }, 103{ SDP_SERVICE_CLASS_IMAGING, "Imaging", }, 104{ SDP_SERVICE_CLASS_IMAGING_RESPONDER, "Imaging Responder", }, 105{ SDP_SERVICE_CLASS_IMAGING_AUTOMATIC_ARCHIVE, "Imaging Automatic Archive", }, 106{ SDP_SERVICE_CLASS_IMAGING_REFERENCED_OBJECTS, "Imaging Referenced Objects", }, 107{ SDP_SERVICE_CLASS_HANDSFREE, "Handsfree", }, 108{ SDP_SERVICE_CLASS_HANDSFREE_AUDIO_GATEWAY, "Handsfree Audio Gateway", }, 109{ SDP_SERVICE_CLASS_DIRECT_PRINTING_REFERENCE_OBJECTS, "Direct Printing Reference Objects", }, 110{ SDP_SERVICE_CLASS_REFLECTED_UI, "Reflected UI", }, 111{ SDP_SERVICE_CLASS_BASIC_PRINTING, "Basic Printing", }, 112{ SDP_SERVICE_CLASS_PRINTING_STATUS, "Printing Status", }, 113{ SDP_SERVICE_CLASS_HUMAN_INTERFACE_DEVICE, "Human Interface Device", }, 114{ SDP_SERVICE_CLASS_HARDCOPY_CABLE_REPLACEMENT, "Hardcopy Cable Replacement", }, 115{ SDP_SERVICE_CLASS_HCR_PRINT, "HCR Print", }, 116{ SDP_SERVICE_CLASS_HCR_SCAN, "HCR Scan", }, 117{ SDP_SERVICE_CLASS_COMMON_ISDN_ACCESS, "Common ISDN Access", }, 118{ SDP_SERVICE_CLASS_VIDEO_CONFERENCING_GW, "Video Conferencing Gateway", }, 119{ SDP_SERVICE_CLASS_UDI_MT, "UDI MT", }, 120{ SDP_SERVICE_CLASS_UDI_TA, "UDI TA", }, 121{ SDP_SERVICE_CLASS_AUDIO_VIDEO, "Audio/Video", }, 122{ SDP_SERVICE_CLASS_SIM_ACCESS, "SIM Access", }, 123{ SDP_SERVICE_CLASS_PHONEBOOK_ACCESS_PCE, "Phonebook Access - PCE", }, 124{ SDP_SERVICE_CLASS_PHONEBOOK_ACCESS_PSE, "Phonebook Access - PSE", }, 125{ SDP_SERVICE_CLASS_PHONEBOOK_ACCESS, "Phonebook Access", }, 126{ SDP_SERVICE_CLASS_PNP_INFORMATION, "PNP Information", }, 127{ SDP_SERVICE_CLASS_GENERIC_NETWORKING, "Generic Networking", }, 128{ SDP_SERVICE_CLASS_GENERIC_FILE_TRANSFER, "Generic File Transfer", }, 129{ SDP_SERVICE_CLASS_GENERIC_AUDIO, "Generic Audio", }, 130{ SDP_SERVICE_CLASS_GENERIC_TELEPHONY, "Generic Telephony", }, 131{ SDP_SERVICE_CLASS_UPNP, "UPNP", }, 132{ SDP_SERVICE_CLASS_UPNP_IP, "UPNP IP", }, 133{ SDP_SERVICE_CLASS_ESDP_UPNP_IP_PAN, "ESDP UPNP IP PAN", }, 134{ SDP_SERVICE_CLASS_ESDP_UPNP_IP_LAP, "ESDP UPNP IP LAP", }, 135{ SDP_SERVICE_CLASS_ESDP_UPNP_L2CAP, "ESDP UPNP L2CAP", }, 136{ SDP_SERVICE_CLASS_VIDEO_SOURCE, "Video Source", }, 137{ SDP_SERVICE_CLASS_VIDEO_SINK, "Video Sink", }, 138{ SDP_SERVICE_CLASS_VIDEO_DISTRIBUTION, "Video Distribution", }, 139{ 0xffff, NULL, } 140}; 141 142static sdp_attr_desc_t sdp_attrs_desc[] = { 143{ SDP_ATTR_SERVICE_RECORD_HANDLE, 144 "Record handle", 145 }, 146{ SDP_ATTR_SERVICE_CLASS_ID_LIST, 147 "Service Class ID list", 148 }, 149{ SDP_ATTR_SERVICE_RECORD_STATE, 150 "Service Record State", 151 }, 152{ SDP_ATTR_SERVICE_ID, 153 "Service ID", 154 }, 155{ SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST, 156 "Protocol Descriptor List", 157 }, 158{ SDP_ATTR_BROWSE_GROUP_LIST, 159 "Browse Group List", 160 }, 161{ SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST, 162 "Language Base Attribute ID List", 163 }, 164{ SDP_ATTR_SERVICE_INFO_TIME_TO_LIVE, 165 "Service Info Time-To-Live", 166 }, 167{ SDP_ATTR_SERVICE_AVAILABILITY, 168 "Service Availability", 169 }, 170{ SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST, 171 "Bluetooh Profile Descriptor List", 172 }, 173{ SDP_ATTR_DOCUMENTATION_URL, 174 "Documentation URL", 175 }, 176{ SDP_ATTR_CLIENT_EXECUTABLE_URL, 177 "Client Executable URL", 178 }, 179{ SDP_ATTR_ICON_URL, 180 "Icon URL", 181 }, 182{ SDP_ATTR_ADDITIONAL_PROTOCOL_DESCRIPTOR_LISTS, 183 "Additional Protocol Descriptor Lists" }, 184{ SDP_ATTR_GROUP_ID, 185/*SDP_ATTR_IP_SUBNET, 186 SDP_ATTR_VERSION_NUMBER_LIST*/ 187 "Group ID/IP Subnet/Version Number List", 188 }, 189{ SDP_ATTR_SERVICE_DATABASE_STATE, 190 "Service Database State", 191 }, 192{ SDP_ATTR_SERVICE_VERSION, 193 "Service Version", 194 }, 195{ SDP_ATTR_EXTERNAL_NETWORK, 196/*SDP_ATTR_NETWORK, 197 SDP_ATTR_SUPPORTED_DATA_STORES_LIST*/ 198 "External Network/Network/Supported Data Stores List", 199 }, 200{ SDP_ATTR_FAX_CLASS1_SUPPORT, 201/*SDP_ATTR_REMOTE_AUDIO_VOLUME_CONTROL*/ 202 "Fax Class1 Support/Remote Audio Volume Control", 203 }, 204{ SDP_ATTR_FAX_CLASS20_SUPPORT, 205/*SDP_ATTR_SUPPORTED_FORMATS_LIST*/ 206 "Fax Class20 Support/Supported Formats List", 207 }, 208{ SDP_ATTR_FAX_CLASS2_SUPPORT, 209 "Fax Class2 Support", 210 }, 211{ SDP_ATTR_AUDIO_FEEDBACK_SUPPORT, 212 "Audio Feedback Support", 213 }, 214{ SDP_ATTR_NETWORK_ADDRESS, 215 "Network Address", 216 }, 217{ SDP_ATTR_WAP_GATEWAY, 218 "WAP Gateway", 219 }, 220{ SDP_ATTR_HOME_PAGE_URL, 221 "Home Page URL", 222 }, 223{ SDP_ATTR_WAP_STACK_TYPE, 224 "WAP Stack Type", 225 }, 226{ SDP_ATTR_SECURITY_DESCRIPTION, 227 "Security Description", 228 }, 229{ SDP_ATTR_NET_ACCESS_TYPE, 230 "Net Access Type", 231 }, 232{ SDP_ATTR_MAX_NET_ACCESS_RATE, 233 "Max Net Access Rate", 234 }, 235{ SDP_ATTR_IPV4_SUBNET, 236 "IPv4 Subnet", 237 }, 238{ SDP_ATTR_IPV6_SUBNET, 239 "IPv6 Subnet", 240 }, 241{ SDP_ATTR_SUPPORTED_CAPABALITIES, 242 "Supported Capabalities", 243 }, 244{ SDP_ATTR_SUPPORTED_FEATURES, 245 "Supported Features", 246 }, 247{ SDP_ATTR_SUPPORTED_FUNCTIONS, 248 "Supported Functions", 249 }, 250{ SDP_ATTR_TOTAL_IMAGING_DATA_CAPACITY, 251 "Total Imaging Data Capacity", 252 }, 253{ SDP_ATTR_SUPPORTED_REPOSITORIES, 254 "Supported Repositories", 255 }, 256{ 0xffff, NULL, } 257}; 258 259char const * 260sdp_attr2desc(uint16_t attr) 261{ 262 register sdp_attr_desc_p a = sdp_attrs_desc; 263 264 for (; a->desc != NULL; a++) 265 if (attr == a->attr) 266 break; 267 268 return ((a->desc != NULL)? a->desc : "Unknown"); 269} 270 271char const * 272sdp_uuid2desc(uint16_t uuid) 273{ 274 register sdp_attr_desc_p a = sdp_uuids_desc; 275 276 for (; a->desc != NULL; a++) 277 if (uuid == a->attr) 278 break; 279 280 return ((a->desc != NULL)? a->desc : "Unknown"); 281} 282 283void 284sdp_print(uint32_t level, uint8_t const *start, uint8_t const *end) 285{ 286 union { 287 int8_t int8; 288 int16_t int16; 289 int32_t int32; 290 int64_t int64; 291 int128_t int128; 292 uint8_t uint8; 293 uint16_t uint16; 294 uint32_t uint32; 295 uint64_t uint64; 296 } value; 297 uint8_t type; 298 uint32_t i; 299 300 if (start == NULL || end == NULL) 301 return; 302 303 while (start < end) { 304 for (i = 0; i < level; i++) 305 printf("\t"); 306 307 SDP_GET8(type, start); 308 309 switch (type) { 310 case SDP_DATA_NIL: 311 printf("nil\n"); 312 break; 313 314 case SDP_DATA_UINT8: 315 SDP_GET8(value.uint8, start); 316 printf("uint8 %u\n", value.uint8); 317 break; 318 case SDP_DATA_UINT16: 319 SDP_GET16(value.uint16, start); 320 printf("uint16 %u\n", value.uint16); 321 break; 322 case SDP_DATA_UINT32: 323 SDP_GET32(value.uint32, start); 324 printf("uint32 %u\n", value.uint32); 325 break; 326 case SDP_DATA_UINT64: 327 SDP_GET64(value.uint64, start); 328 printf("uint64 %ju\n", value.uint64); 329 break; 330 331 case SDP_DATA_UINT128: 332 case SDP_DATA_INT128: 333 SDP_GET128(&value.int128, start); 334 printf("u/int128 %#8.8x%8.8x%8.8x%8.8x\n", 335 *(uint32_t *)&value.int128.b[0], 336 *(uint32_t *)&value.int128.b[4], 337 *(uint32_t *)&value.int128.b[8], 338 *(uint32_t *)&value.int128.b[12]); 339 break; 340 341 case SDP_DATA_UUID128: 342 SDP_GET_UUID128(&value.int128, start); 343 printf("uuid128 %#8.8x-%4.4x-%4.4x-%4.4x-%4.4x%8.8x\n", 344 ntohl(*(uint32_t *)&value.int128.b[0]), 345 ntohs(*(uint16_t *)&value.int128.b[4]), 346 ntohs(*(uint16_t *)&value.int128.b[6]), 347 ntohs(*(uint16_t *)&value.int128.b[8]), 348 ntohs(*(uint16_t *)&value.int128.b[10]), 349 ntohl(*(uint32_t *)&value.int128.b[12])); 350 break; 351 352 case SDP_DATA_INT8: 353 SDP_GET8(value.int8, start); 354 printf("int8 %d\n", value.int8); 355 break; 356 case SDP_DATA_INT16: 357 SDP_GET16(value.int16, start); 358 printf("int16 %d\n", value.int16); 359 break; 360 case SDP_DATA_INT32: 361 SDP_GET32(value.int32, start); 362 printf("int32 %d\n", value.int32); 363 break; 364 case SDP_DATA_INT64: 365 SDP_GET64(value.int64, start); 366 printf("int64 %ju\n", value.int64); 367 break; 368 369 case SDP_DATA_UUID16: 370 SDP_GET16(value.uint16, start); 371 printf("uuid16 %#4.4x - %s\n", value.uint16, 372 sdp_uuid2desc(value.uint16)); 373 break; 374 case SDP_DATA_UUID32: 375 SDP_GET32(value.uint32, start); 376 printf("uuid32 %#8.8x\n", value.uint32); 377 break; 378 379 case SDP_DATA_STR8: 380 SDP_GET8(value.uint8, start); 381 printf("str8 %*.*s\n", value.uint8, value.uint8, start); 382 start += value.uint8; 383 break; 384 case SDP_DATA_STR16: 385 SDP_GET16(value.uint16, start); 386 printf("str16 %*.*s\n", value.uint16, value.uint16, start); 387 start += value.uint16; 388 break; 389 case SDP_DATA_STR32: 390 SDP_GET32(value.uint32, start); 391 printf("str32 %*.*s\n", value.uint32, value.uint32, start); 392 start += value.uint32; 393 break; 394 395 case SDP_DATA_BOOL: 396 SDP_GET8(value.uint8, start); 397 printf("bool %d\n", value.uint8); 398 break; 399 400 case SDP_DATA_SEQ8: 401 SDP_GET8(value.uint8, start); 402 printf("seq8 %d\n", value.uint8); 403 sdp_print(level + 1, start, start + value.uint8); 404 start += value.uint8; 405 break; 406 case SDP_DATA_SEQ16: 407 SDP_GET16(value.uint16, start); 408 printf("seq16 %d\n", value.uint16); 409 sdp_print(level + 1, start, start + value.uint16); 410 start += value.uint16; 411 break; 412 case SDP_DATA_SEQ32: 413 SDP_GET32(value.uint32, start); 414 printf("seq32 %d\n", value.uint32); 415 sdp_print(level + 1, start, start + value.uint32); 416 start += value.uint32; 417 break; 418 419 case SDP_DATA_ALT8: 420 SDP_GET8(value.uint8, start); 421 printf("alt8 %d\n", value.uint8); 422 sdp_print(level + 1, start, start + value.uint8); 423 start += value.uint8; 424 break; 425 case SDP_DATA_ALT16: 426 SDP_GET16(value.uint16, start); 427 printf("alt16 %d\n", value.uint16); 428 sdp_print(level + 1, start, start + value.uint16); 429 start += value.uint16; 430 break; 431 case SDP_DATA_ALT32: 432 SDP_GET32(value.uint32, start); 433 printf("alt32 %d\n", value.uint32); 434 sdp_print(level + 1, start, start + value.uint32); 435 start += value.uint32; 436 break; 437 438 case SDP_DATA_URL8: 439 SDP_GET8(value.uint8, start); 440 printf("url8 %*.*s\n", value.uint8, value.uint8, start); 441 start += value.uint8; 442 break; 443 case SDP_DATA_URL16: 444 SDP_GET16(value.uint16, start); 445 printf("url16 %*.*s\n", value.uint16, value.uint16, start); 446 start += value.uint16; 447 break; 448 case SDP_DATA_URL32: 449 SDP_GET32(value.uint32, start); 450 printf("url32 %*.*s\n", value.uint32, value.uint32, start); 451 start += value.uint32; 452 break; 453 454 default: 455 printf("unknown data type: %#02x\n", *start ++); 456 break; 457 } 458 } 459} 460 461