util.c revision 122451
1107590Sobrien/* 2169689Skan * util.c 3169689Skan * 4107590Sobrien * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com> 5107590Sobrien * All rights reserved. 6107590Sobrien * 7132718Skan * Redistribution and use in source and binary forms, with or without 8107590Sobrien * modification, are permitted provided that the following conditions 9132718Skan * are met: 10132718Skan * 1. Redistributions of source code must retain the above copyright 11132718Skan * notice, this list of conditions and the following disclaimer. 12132718Skan * 2. Redistributions in binary form must reproduce the above copyright 13107590Sobrien * notice, this list of conditions and the following disclaimer in the 14132718Skan * documentation and/or other materials provided with the distribution. 15132718Skan * 16132718Skan * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17132718Skan * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18107590Sobrien * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19107590Sobrien * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20132718Skan * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21169689Skan * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22169689Skan * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23107590Sobrien * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24107590Sobrien * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25107590Sobrien * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26107590Sobrien * SUCH DAMAGE. 27107590Sobrien * 28107590Sobrien * $Id: util.c,v 1.5 2003/09/08 02:29:35 max Exp $ 29107590Sobrien * $FreeBSD: head/lib/libsdp/util.c 122451 2003-11-11 02:43:10Z emax $ 30107590Sobrien */ 31107590Sobrien 32107590Sobrien#include <bluetooth.h> 33107590Sobrien#include <stdio.h> 34107590Sobrien#include <sdp.h> 35107590Sobrien 36107590Sobrien/* 37107590Sobrien * SDP attribute description 38107590Sobrien */ 39107590Sobrien 40107590Sobrienstruct sdp_attr_desc { 41107590Sobrien u_int32_t attr; 42107590Sobrien char const *desc; 43107590Sobrien}; 44107590Sobrientypedef struct sdp_attr_desc sdp_attr_desc_t; 45107590Sobrientypedef struct sdp_attr_desc * sdp_attr_desc_p; 46107590Sobrien 47107590Sobrienstatic sdp_attr_desc_t sdp_uuids_desc[] = { 48107590Sobrien{ SDP_UUID_PROTOCOL_SDP, "SDP", }, 49107590Sobrien{ SDP_UUID_PROTOCOL_UDP, "UDP", }, 50107590Sobrien{ SDP_UUID_PROTOCOL_RFCOMM, "RFCOMM", }, 51107590Sobrien{ SDP_UUID_PROTOCOL_TCP, "TCP", }, 52107590Sobrien{ SDP_UUID_PROTOCOL_TCS_BIN, "TCS BIN", }, 53107590Sobrien{ SDP_UUID_PROTOCOL_TCS_AT, "TCS AT", }, 54117395Skan{ SDP_UUID_PROTOCOL_OBEX, "OBEX", }, 55117395Skan{ SDP_UUID_PROTOCOL_IP, "IP", }, 56117395Skan{ SDP_UUID_PROTOCOL_FTP, "FTP", }, 57132718Skan{ SDP_UUID_PROTOCOL_HTTP, "HTTP", }, 58117395Skan{ SDP_UUID_PROTOCOL_WSP, "WSP", }, 59117395Skan{ SDP_UUID_PROTOCOL_BNEP, "BNEP", }, 60107590Sobrien{ SDP_UUID_PROTOCOL_UPNP, "UPNP", }, 61107590Sobrien{ SDP_UUID_PROTOCOL_HIDP, "HIDP", }, 62107590Sobrien{ SDP_UUID_PROTOCOL_HARDCOPY_CONTROL_CHANNEL, "Hardcopy Control Channel", }, 63107590Sobrien{ SDP_UUID_PROTOCOL_HARDCOPY_DATA_CHANNEL, "Hardcopy Data Channel", }, 64107590Sobrien{ SDP_UUID_PROTOCOL_HARDCOPY_NOTIFICATION, "Hardcopy Notification", }, 65132718Skan{ SDP_UUID_PROTOCOL_AVCTP, "AVCTP", }, 66107590Sobrien{ SDP_UUID_PROTOCOL_AVDTP, "AVDTP", }, 67107590Sobrien{ SDP_UUID_PROTOCOL_CMPT, "CMPT", }, 68107590Sobrien{ SDP_UUID_PROTOCOL_UDI_C_PLANE, "UDI C-Plane", }, 69107590Sobrien{ SDP_UUID_PROTOCOL_L2CAP, "L2CAP", }, 70117395Skan/* Service Class IDs/Bluetooth Profile IDs */ 71117395Skan{ SDP_SERVICE_CLASS_SERVICE_DISCOVERY_SERVER, "Service Discovery Server", }, 72117395Skan{ SDP_SERVICE_CLASS_BROWSE_GROUP_DESCRIPTOR, "Browse Group Descriptor", }, 73117395Skan{ SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP, "Public Browse Group", }, 74117395Skan{ SDP_SERVICE_CLASS_SERIAL_PORT, "Serial Port", }, 75117395Skan{ SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP, "LAN Access Using PPP", }, 76169689Skan{ SDP_SERVICE_CLASS_DIALUP_NETWORKING, "Dial-Up Networking", }, 77169689Skan{ SDP_SERVICE_CLASS_IR_MC_SYNC, "IrMC Sync", }, 78169689Skan{ SDP_SERVICE_CLASS_OBEX_OBJECT_PUSH, "OBEX Object Push", }, 79132718Skan{ SDP_SERVICE_CLASS_OBEX_FILE_TRANSFER, "OBEX File Transfer", }, 80132718Skan{ SDP_SERVICE_CLASS_IR_MC_SYNC_COMMAND, "IrMC Sync Command", }, 81132718Skan{ SDP_SERVICE_CLASS_HEADSET, "Headset", }, 82107590Sobrien{ SDP_SERVICE_CLASS_CORDLESS_TELEPHONY, "Cordless Telephony", }, 83107590Sobrien{ SDP_SERVICE_CLASS_AUDIO_SOURCE, "Audio Source", }, 84107590Sobrien{ SDP_SERVICE_CLASS_AUDIO_SINK, "Audio Sink", }, 85107590Sobrien{ SDP_SERVICE_CLASS_AV_REMOTE_CONTROL_TARGET, "A/V Remote Control Target", }, 86107590Sobrien{ SDP_SERVICE_CLASS_ADVANCED_AUDIO_DISTRIBUTION, "Advanced Audio Distribution", }, 87132718Skan{ SDP_SERVICE_CLASS_AV_REMOTE_CONTROL, "A/V Remote Control", }, 88169689Skan{ SDP_SERVICE_CLASS_VIDEO_CONFERENCING, "Video Conferencing", }, 89169689Skan{ SDP_SERVICE_CLASS_INTERCOM, "Intercom", }, 90107590Sobrien{ SDP_SERVICE_CLASS_FAX, "Fax", }, 91169689Skan{ SDP_SERVICE_CLASS_HEADSET_AUDIO_GATEWAY, "Headset Audio Gateway", }, 92107590Sobrien{ SDP_SERVICE_CLASS_WAP, "WAP", }, 93132718Skan{ SDP_SERVICE_CLASS_WAP_CLIENT, "WAP Client", }, 94107590Sobrien{ SDP_SERVICE_CLASS_PANU, "PANU", }, 95169689Skan{ SDP_SERVICE_CLASS_NAP, "Network Access Point", }, 96107590Sobrien{ SDP_SERVICE_CLASS_GN, "GN", }, 97169689Skan{ SDP_SERVICE_CLASS_DIRECT_PRINTING, "Direct Printing", }, 98169689Skan{ SDP_SERVICE_CLASS_REFERENCE_PRINTING, "Reference Printing", }, 99169689Skan{ SDP_SERVICE_CLASS_IMAGING, "Imaging", }, 100169689Skan{ SDP_SERVICE_CLASS_IMAGING_RESPONDER, "Imaging Responder", }, 101169689Skan{ SDP_SERVICE_CLASS_IMAGING_AUTOMATIC_ARCHIVE, "Imaging Automatic Archive", }, 102107590Sobrien{ SDP_SERVICE_CLASS_IMAGING_REFERENCED_OBJECTS, "Imaging Referenced Objects", }, 103169689Skan{ SDP_SERVICE_CLASS_HANDSFREE, "Handsfree", }, 104169689Skan{ SDP_SERVICE_CLASS_HANDSFREE_AUDIO_GATEWAY, "Handsfree Audio Gateway", }, 105169689Skan{ SDP_SERVICE_CLASS_DIRECT_PRINTING_REFERENCE_OBJECTS, "Direct Printing Reference Objects", }, 106107590Sobrien{ SDP_SERVICE_CLASS_REFLECTED_UI, "Reflected UI", }, 107{ SDP_SERVICE_CLASS_BASIC_PRINTING, "Basic Printing", }, 108{ SDP_SERVICE_CLASS_PRINTING_STATUS, "Printing Status", }, 109{ SDP_SERVICE_CLASS_HUMAN_INTERFACE_DEVICE, "Human Interface Device", }, 110{ SDP_SERVICE_CLASS_HARDCOPY_CABLE_REPLACEMENT, "Hardcopy Cable Replacement", }, 111{ SDP_SERVICE_CLASS_HCR_PRINT, "HCR Print", }, 112{ SDP_SERVICE_CLASS_HCR_SCAN, "HCR Scan", }, 113{ SDP_SERVICE_CLASS_COMMON_ISDN_ACCESS, "Common ISDN Access", }, 114{ SDP_SERVICE_CLASS_VIDEO_CONFERENCING_GW, "Video Conferencing Gateway", }, 115{ SDP_SERVICE_CLASS_UDI_MT, "UDI MT", }, 116{ SDP_SERVICE_CLASS_UDI_TA, "UDI TA", }, 117{ SDP_SERVICE_CLASS_AUDIO_VIDEO, "Audio/Video", }, 118{ SDP_SERVICE_CLASS_SIM_ACCESS, "SIM Access", }, 119{ SDP_SERVICE_CLASS_PNP_INFORMATION, "PNP Information", }, 120{ SDP_SERVICE_CLASS_GENERIC_NETWORKING, "Generic Networking", }, 121{ SDP_SERVICE_CLASS_GENERIC_FILE_TRANSFER, "Generic File Transfer", }, 122{ SDP_SERVICE_CLASS_GENERIC_AUDIO, "Generic Audio", }, 123{ SDP_SERVICE_CLASS_GENERIC_TELEPHONY, "Generic Telephony", }, 124{ SDP_SERVICE_CLASS_UPNP, "UPNP", }, 125{ SDP_SERVICE_CLASS_UPNP_IP, "UPNP IP", }, 126{ SDP_SERVICE_CLASS_ESDP_UPNP_IP_PAN, "ESDP UPNP IP PAN", }, 127{ SDP_SERVICE_CLASS_ESDP_UPNP_IP_LAP, "ESDP UPNP IP LAP", }, 128{ SDP_SERVICE_CLASS_ESDP_UPNP_L2CAP, "ESDP UPNP L2CAP", }, 129{ 0xffff, NULL, } 130}; 131 132static sdp_attr_desc_t sdp_attrs_desc[] = { 133{ SDP_ATTR_SERVICE_RECORD_HANDLE, 134 "Record handle", 135 }, 136{ SDP_ATTR_SERVICE_CLASS_ID_LIST, 137 "Service Class ID list", 138 }, 139{ SDP_ATTR_SERVICE_RECORD_STATE, 140 "Service Record State", 141 }, 142{ SDP_ATTR_SERVICE_ID, 143 "Service ID", 144 }, 145{ SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST, 146 "Protocol Descriptor List", 147 }, 148{ SDP_ATTR_BROWSE_GROUP_LIST, 149 "Browse Group List", 150 }, 151{ SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST, 152 "Language Base Attribute ID List", 153 }, 154{ SDP_ATTR_SERVICE_INFO_TIME_TO_LIVE, 155 "Service Info Time-To-Live", 156 }, 157{ SDP_ATTR_SERVICE_AVAILABILITY, 158 "Service Availability", 159 }, 160{ SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST, 161 "Bluetooh Profile Descriptor List", 162 }, 163{ SDP_ATTR_DOCUMENTATION_URL, 164 "Documentation URL", 165 }, 166{ SDP_ATTR_CLIENT_EXECUTABLE_URL, 167 "Client Executable URL", 168 }, 169{ SDP_ATTR_ICON_URL, 170 "Icon URL", 171 }, 172{ SDP_ATTR_ADDITIONAL_PROTOCOL_DESCRIPTOR_LISTS, 173 "Additional Protocol Descriptor Lists" }, 174{ SDP_ATTR_GROUP_ID, 175/*SDP_ATTR_IP_SUBNET, 176 SDP_ATTR_VERSION_NUMBER_LIST*/ 177 "Group ID/IP Subnet/Version Number List", 178 }, 179{ SDP_ATTR_SERVICE_DATABASE_STATE, 180 "Service Database State", 181 }, 182{ SDP_ATTR_SERVICE_VERSION, 183 "Service Version", 184 }, 185{ SDP_ATTR_EXTERNAL_NETWORK, 186/*SDP_ATTR_NETWORK, 187 SDP_ATTR_SUPPORTED_DATA_STORES_LIST*/ 188 "External Network/Network/Supported Data Stores List", 189 }, 190{ SDP_ATTR_FAX_CLASS1_SUPPORT, 191/*SDP_ATTR_REMOTE_AUDIO_VOLUME_CONTROL*/ 192 "Fax Class1 Support/Remote Audio Volume Control", 193 }, 194{ SDP_ATTR_FAX_CLASS20_SUPPORT, 195/*SDP_ATTR_SUPPORTED_FORMATS_LIST*/ 196 "Fax Class20 Support/Supported Formats List", 197 }, 198{ SDP_ATTR_FAX_CLASS2_SUPPORT, 199 "Fax Class2 Support", 200 }, 201{ SDP_ATTR_AUDIO_FEEDBACK_SUPPORT, 202 "Audio Feedback Support", 203 }, 204{ SDP_ATTR_NETWORK_ADDRESS, 205 "Network Address", 206 }, 207{ SDP_ATTR_WAP_GATEWAY, 208 "WAP Gateway", 209 }, 210{ SDP_ATTR_HOME_PAGE_URL, 211 "Home Page URL", 212 }, 213{ SDP_ATTR_WAP_STACK_TYPE, 214 "WAP Stack Type", 215 }, 216{ SDP_ATTR_SECURITY_DESCRIPTION, 217 "Security Description", 218 }, 219{ SDP_ATTR_NET_ACCESS_TYPE, 220 "Net Access Type", 221 }, 222{ SDP_ATTR_MAX_NET_ACCESS_RATE, 223 "Max Net Access Rate", 224 }, 225{ SDP_ATTR_IPV4_SUBNET, 226 "IPv4 Subnet", 227 }, 228{ SDP_ATTR_IPV6_SUBNET, 229 "IPv6 Subnet", 230 }, 231{ SDP_ATTR_SUPPORTED_CAPABALITIES, 232 "Supported Capabalities", 233 }, 234{ SDP_ATTR_SUPPORTED_FEATURES, 235 "Supported Features", 236 }, 237{ SDP_ATTR_SUPPORTED_FUNCTIONS, 238 "Supported Functions", 239 }, 240{ SDP_ATTR_TOTAL_IMAGING_DATA_CAPACITY, 241 "Total Imaging Data Capacity", 242 }, 243{ 0xffff, NULL, } 244}; 245 246char const * const 247sdp_attr2desc(u_int16_t attr) 248{ 249 register sdp_attr_desc_p a = sdp_attrs_desc; 250 251 for (; a->desc != NULL; a++) 252 if (attr == a->attr) 253 break; 254 255 return ((a->desc != NULL)? a->desc : "Unknown"); 256} 257 258char const * const 259sdp_uuid2desc(u_int16_t uuid) 260{ 261 register sdp_attr_desc_p a = sdp_uuids_desc; 262 263 for (; a->desc != NULL; a++) 264 if (uuid == a->attr) 265 break; 266 267 return ((a->desc != NULL)? a->desc : "Unknown"); 268} 269 270void 271sdp_print(u_int32_t level, u_int8_t const *start, u_int8_t const *end) 272{ 273 union { 274 int8_t int8; 275 int16_t int16; 276 int32_t int32; 277 int64_t int64; 278 int128_t int128; 279 uint8_t uint8; 280 uint16_t uint16; 281 uint32_t uint32; 282 uint64_t uint64; 283 } value; 284 u_int8_t type; 285 u_int32_t i; 286 287 if (start == NULL || end == NULL) 288 return; 289 290 while (start < end) { 291 for (i = 0; i < level; i++) 292 printf("\t"); 293 294 SDP_GET8(type, start); 295 296 switch (type) { 297 case SDP_DATA_NIL: 298 printf("nil\n"); 299 break; 300 301 case SDP_DATA_UINT8: 302 SDP_GET8(value.uint8, start); 303 printf("uint8 %u\n", value.uint8); 304 break; 305 case SDP_DATA_UINT16: 306 SDP_GET16(value.uint16, start); 307 printf("uint16 %u\n", value.uint16); 308 break; 309 case SDP_DATA_UINT32: 310 SDP_GET32(value.uint32, start); 311 printf("uint32 %u\n", value.uint32); 312 break; 313 case SDP_DATA_UINT64: 314 SDP_GET64(value.uint64, start); 315 printf("uint64 %llu\n", value.uint64); 316 break; 317 318 case SDP_DATA_UINT128: 319 case SDP_DATA_INT128: 320 case SDP_DATA_UUID128: 321 SDP_GET128(&value.int128, start); 322 printf("int128/uuid128 %#8.8x-%4.4x-%4.4x-%4.4x-%4.4x%8.8x\n", 323 *(u_int32_t *)&value.int128.b[0], 324 *(u_int16_t *)&value.int128.b[4], 325 *(u_int16_t *)&value.int128.b[6], 326 *(u_int16_t *)&value.int128.b[8], 327 *(u_int16_t *)&value.int128.b[10], 328 *(u_int32_t *)&value.int128.b[12]); 329 break; 330 331 case SDP_DATA_INT8: 332 SDP_GET8(value.int8, start); 333 printf("int8 %d\n", value.int8); 334 break; 335 case SDP_DATA_INT16: 336 SDP_GET16(value.int16, start); 337 printf("int16 %d\n", value.int16); 338 break; 339 case SDP_DATA_INT32: 340 SDP_GET32(value.int32, start); 341 printf("int32 %d\n", value.int32); 342 break; 343 case SDP_DATA_INT64: 344 SDP_GET64(value.int64, start); 345 printf("int64 %lld\n", value.int64); 346 break; 347 348 case SDP_DATA_UUID16: 349 SDP_GET16(value.uint16, start); 350 printf("uuid16 %#4.4x - %s\n", value.uint16, 351 sdp_uuid2desc(value.uint16)); 352 break; 353 case SDP_DATA_UUID32: 354 SDP_GET32(value.uint32, start); 355 printf("uuid32 %#8.8x\n", value.uint32); 356 break; 357 358 case SDP_DATA_STR8: 359 SDP_GET8(value.uint8, start); 360 printf("str8 %*.*s\n", value.uint8, value.uint8, start); 361 start += value.uint8; 362 break; 363 case SDP_DATA_STR16: 364 SDP_GET16(value.uint16, start); 365 printf("str16 %*.*s\n", value.uint16, value.uint16, start); 366 start += value.uint16; 367 break; 368 case SDP_DATA_STR32: 369 SDP_GET32(value.uint32, start); 370 printf("str32 %*.*s\n", value.uint32, value.uint32, start); 371 start += value.uint32; 372 break; 373 374 case SDP_DATA_BOOL: 375 SDP_GET8(value.uint8, start); 376 printf("bool %d\n", value.uint8); 377 break; 378 379 case SDP_DATA_SEQ8: 380 SDP_GET8(value.uint8, start); 381 printf("seq8 %d\n", value.uint8); 382 sdp_print(level + 1, start, start + value.uint8); 383 start += value.uint8; 384 break; 385 case SDP_DATA_SEQ16: 386 SDP_GET16(value.uint16, start); 387 printf("seq16 %d\n", value.uint16); 388 sdp_print(level + 1, start, start + value.uint16); 389 start += value.uint16; 390 break; 391 case SDP_DATA_SEQ32: 392 SDP_GET32(value.uint32, start); 393 printf("seq32 %d\n", value.uint32); 394 sdp_print(level + 1, start, start + value.uint32); 395 start += value.uint32; 396 break; 397 398 case SDP_DATA_ALT8: 399 SDP_GET8(value.uint8, start); 400 printf("alt8 %d\n", value.uint8); 401 sdp_print(level + 1, start, start + value.uint8); 402 start += value.uint8; 403 break; 404 case SDP_DATA_ALT16: 405 SDP_GET16(value.uint16, start); 406 printf("alt16 %d\n", value.uint16); 407 sdp_print(level + 1, start, start + value.uint16); 408 start += value.uint16; 409 break; 410 case SDP_DATA_ALT32: 411 SDP_GET32(value.uint32, start); 412 printf("alt32 %d\n", value.uint32); 413 sdp_print(level + 1, start, start + value.uint32); 414 start += value.uint32; 415 break; 416 417 case SDP_DATA_URL8: 418 SDP_GET8(value.uint8, start); 419 printf("url8 %*.*s\n", value.uint8, value.uint8, start); 420 start += value.uint8; 421 break; 422 case SDP_DATA_URL16: 423 SDP_GET16(value.uint16, start); 424 printf("url16 %*.*s\n", value.uint16, value.uint16, start); 425 start += value.uint16; 426 break; 427 case SDP_DATA_URL32: 428 SDP_GET32(value.uint32, start); 429 printf("url32 %*.*s\n", value.uint32, value.uint32, start); 430 start += value.uint32; 431 break; 432 433 default: 434 printf("unknown data type: %#02x\n", *start ++); 435 break; 436 } 437 } 438} 439 440