17718ced0SMaksim Yevmenkin /* $NetBSD: sdp.c,v 1.2 2008/12/06 20:01:14 plunky Exp $ */ 27718ced0SMaksim Yevmenkin 37718ced0SMaksim Yevmenkin /*- 47718ced0SMaksim Yevmenkin * Copyright (c) 2008 Iain Hibbert 57718ced0SMaksim Yevmenkin * All rights reserved. 67718ced0SMaksim Yevmenkin * 77718ced0SMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 87718ced0SMaksim Yevmenkin * modification, are permitted provided that the following conditions 97718ced0SMaksim Yevmenkin * are met: 107718ced0SMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 117718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 127718ced0SMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 137718ced0SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 147718ced0SMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 157718ced0SMaksim Yevmenkin * 167718ced0SMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 177718ced0SMaksim Yevmenkin * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 187718ced0SMaksim Yevmenkin * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 197718ced0SMaksim Yevmenkin * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 207718ced0SMaksim Yevmenkin * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 217718ced0SMaksim Yevmenkin * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 227718ced0SMaksim Yevmenkin * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 237718ced0SMaksim Yevmenkin * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 247718ced0SMaksim Yevmenkin * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 257718ced0SMaksim Yevmenkin * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 267718ced0SMaksim Yevmenkin */ 277718ced0SMaksim Yevmenkin 287718ced0SMaksim Yevmenkin /* $FreeBSD$ */ 297718ced0SMaksim Yevmenkin 307718ced0SMaksim Yevmenkin #include <sys/cdefs.h> 317718ced0SMaksim Yevmenkin __RCSID("$NetBSD: sdp.c,v 1.2 2008/12/06 20:01:14 plunky Exp $"); 327718ced0SMaksim Yevmenkin 337718ced0SMaksim Yevmenkin #include <string.h> 347718ced0SMaksim Yevmenkin 358d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED 367718ced0SMaksim Yevmenkin #include "sdp.h" 377718ced0SMaksim Yevmenkin 387718ced0SMaksim Yevmenkin /* 397718ced0SMaksim Yevmenkin * SDP data stream manipulation routines 407718ced0SMaksim Yevmenkin */ 417718ced0SMaksim Yevmenkin 427718ced0SMaksim Yevmenkin /* Bluetooth Base UUID */ 437718ced0SMaksim Yevmenkin static const uuid_t BASE_UUID = { 447718ced0SMaksim Yevmenkin 0x00000000, 457718ced0SMaksim Yevmenkin 0x0000, 467718ced0SMaksim Yevmenkin 0x1000, 477718ced0SMaksim Yevmenkin 0x80, 487718ced0SMaksim Yevmenkin 0x00, 497718ced0SMaksim Yevmenkin { 0x00, 0x80, 0x5f, 0x9b, 0x34, 0xfb } 507718ced0SMaksim Yevmenkin }; 517718ced0SMaksim Yevmenkin 527718ced0SMaksim Yevmenkin /* 537718ced0SMaksim Yevmenkin * _sdp_match_uuid16(ptr, limit, uuid) 547718ced0SMaksim Yevmenkin * 557718ced0SMaksim Yevmenkin * examine SDP data stream at ptr for a UUID, and return 567718ced0SMaksim Yevmenkin * true if it matches the supplied short alias bluetooth UUID. 577718ced0SMaksim Yevmenkin * limit is the first address past the end of valid data. 587718ced0SMaksim Yevmenkin */ 597718ced0SMaksim Yevmenkin bool 607718ced0SMaksim Yevmenkin _sdp_match_uuid16(uint8_t **ptr, uint8_t *limit, uint16_t uuid) 617718ced0SMaksim Yevmenkin { 627718ced0SMaksim Yevmenkin uint8_t *p = *ptr; 637718ced0SMaksim Yevmenkin uuid_t u1, u2; 647718ced0SMaksim Yevmenkin 657718ced0SMaksim Yevmenkin memcpy(&u1, &BASE_UUID, sizeof(uuid_t)); 667718ced0SMaksim Yevmenkin u1.time_low = uuid; 677718ced0SMaksim Yevmenkin 687718ced0SMaksim Yevmenkin if (!_sdp_get_uuid(&p, limit, &u2) 697718ced0SMaksim Yevmenkin || !uuid_equal(&u1, &u2, NULL)) 707718ced0SMaksim Yevmenkin return false; 717718ced0SMaksim Yevmenkin 727718ced0SMaksim Yevmenkin *ptr = p; 737718ced0SMaksim Yevmenkin return true; 747718ced0SMaksim Yevmenkin } 757718ced0SMaksim Yevmenkin 767718ced0SMaksim Yevmenkin /* 777718ced0SMaksim Yevmenkin * _sdp_get_uuid(ptr, limit, uuid) 787718ced0SMaksim Yevmenkin * 797718ced0SMaksim Yevmenkin * examine SDP data stream at ptr for a UUID, and extract 807718ced0SMaksim Yevmenkin * to given storage, advancing ptr. 817718ced0SMaksim Yevmenkin * limit is the first address past the end of valid data. 827718ced0SMaksim Yevmenkin */ 837718ced0SMaksim Yevmenkin bool 847718ced0SMaksim Yevmenkin _sdp_get_uuid(uint8_t **ptr, uint8_t *limit, uuid_t *uuid) 857718ced0SMaksim Yevmenkin { 867718ced0SMaksim Yevmenkin uint8_t *p = *ptr; 877718ced0SMaksim Yevmenkin 887718ced0SMaksim Yevmenkin if (p + 1 > limit) 897718ced0SMaksim Yevmenkin return false; 907718ced0SMaksim Yevmenkin 917718ced0SMaksim Yevmenkin switch (*p++) { 927718ced0SMaksim Yevmenkin case SDP_DATA_UUID16: 937718ced0SMaksim Yevmenkin if (p + 2 > limit) 947718ced0SMaksim Yevmenkin return false; 957718ced0SMaksim Yevmenkin 967718ced0SMaksim Yevmenkin memcpy(uuid, &BASE_UUID, sizeof(uuid_t)); 977718ced0SMaksim Yevmenkin uuid->time_low = be16dec(p); 987718ced0SMaksim Yevmenkin p += 2; 997718ced0SMaksim Yevmenkin break; 1007718ced0SMaksim Yevmenkin 1017718ced0SMaksim Yevmenkin case SDP_DATA_UUID32: 1027718ced0SMaksim Yevmenkin if (p + 4 > limit) 1037718ced0SMaksim Yevmenkin return false; 1047718ced0SMaksim Yevmenkin 1057718ced0SMaksim Yevmenkin memcpy(uuid, &BASE_UUID, sizeof(uuid_t)); 1067718ced0SMaksim Yevmenkin uuid->time_low = be32dec(p); 1077718ced0SMaksim Yevmenkin p += 4; 1087718ced0SMaksim Yevmenkin break; 1097718ced0SMaksim Yevmenkin 1107718ced0SMaksim Yevmenkin case SDP_DATA_UUID128: 1117718ced0SMaksim Yevmenkin if (p + 16 > limit) 1127718ced0SMaksim Yevmenkin return false; 1137718ced0SMaksim Yevmenkin 1147718ced0SMaksim Yevmenkin uuid_dec_be(p, uuid); 1157718ced0SMaksim Yevmenkin p += 16; 1167718ced0SMaksim Yevmenkin break; 1177718ced0SMaksim Yevmenkin 1187718ced0SMaksim Yevmenkin default: 1197718ced0SMaksim Yevmenkin return false; 1207718ced0SMaksim Yevmenkin } 1217718ced0SMaksim Yevmenkin 1227718ced0SMaksim Yevmenkin *ptr = p; 1237718ced0SMaksim Yevmenkin return true; 1247718ced0SMaksim Yevmenkin } 1257718ced0SMaksim Yevmenkin 1267718ced0SMaksim Yevmenkin /* 1277718ced0SMaksim Yevmenkin * _sdp_get_seq(ptr, limit, seq) 1287718ced0SMaksim Yevmenkin * 1297718ced0SMaksim Yevmenkin * examine SDP data stream at ptr for a sequence. return 1307718ced0SMaksim Yevmenkin * seq pointer if found and advance ptr to next object. 1317718ced0SMaksim Yevmenkin * limit is the first address past the end of valid data. 1327718ced0SMaksim Yevmenkin */ 1337718ced0SMaksim Yevmenkin bool 1347718ced0SMaksim Yevmenkin _sdp_get_seq(uint8_t **ptr, uint8_t *limit, uint8_t **seq) 1357718ced0SMaksim Yevmenkin { 1367718ced0SMaksim Yevmenkin uint8_t *p = *ptr; 1377718ced0SMaksim Yevmenkin int32_t l; 1387718ced0SMaksim Yevmenkin 1397718ced0SMaksim Yevmenkin if (p + 1 > limit) 1407718ced0SMaksim Yevmenkin return false; 1417718ced0SMaksim Yevmenkin 1427718ced0SMaksim Yevmenkin switch (*p++) { 1437718ced0SMaksim Yevmenkin case SDP_DATA_SEQ8: 1447718ced0SMaksim Yevmenkin if (p + 1 > limit) 1457718ced0SMaksim Yevmenkin return false; 1467718ced0SMaksim Yevmenkin 1477718ced0SMaksim Yevmenkin l = *p; 1487718ced0SMaksim Yevmenkin p += 1; 1497718ced0SMaksim Yevmenkin break; 1507718ced0SMaksim Yevmenkin 1517718ced0SMaksim Yevmenkin case SDP_DATA_SEQ16: 1527718ced0SMaksim Yevmenkin if (p + 2 > limit) 1537718ced0SMaksim Yevmenkin return false; 1547718ced0SMaksim Yevmenkin 1557718ced0SMaksim Yevmenkin l = be16dec(p); 1567718ced0SMaksim Yevmenkin p += 2; 1577718ced0SMaksim Yevmenkin break; 1587718ced0SMaksim Yevmenkin 1597718ced0SMaksim Yevmenkin case SDP_DATA_SEQ32: 1607718ced0SMaksim Yevmenkin if (p + 4 > limit) 1617718ced0SMaksim Yevmenkin return false; 1627718ced0SMaksim Yevmenkin 1637718ced0SMaksim Yevmenkin l = be32dec(p); 1647718ced0SMaksim Yevmenkin p += 4; 1657718ced0SMaksim Yevmenkin break; 1667718ced0SMaksim Yevmenkin 1677718ced0SMaksim Yevmenkin default: 1687718ced0SMaksim Yevmenkin return false; 1697718ced0SMaksim Yevmenkin } 1707718ced0SMaksim Yevmenkin if (p + l > limit) 1717718ced0SMaksim Yevmenkin return false; 1727718ced0SMaksim Yevmenkin 1737718ced0SMaksim Yevmenkin *seq = p; 1747718ced0SMaksim Yevmenkin *ptr = p + l; 1757718ced0SMaksim Yevmenkin return true; 1767718ced0SMaksim Yevmenkin } 1777718ced0SMaksim Yevmenkin 1787718ced0SMaksim Yevmenkin /* 1797718ced0SMaksim Yevmenkin * _sdp_get_uint16(ptr, limit, value) 1807718ced0SMaksim Yevmenkin * 1817718ced0SMaksim Yevmenkin * examine SDP data stream at ptr for a uint16_t, and 1827718ced0SMaksim Yevmenkin * extract to given storage, advancing ptr. 1837718ced0SMaksim Yevmenkin * limit is the first address past the end of valid data. 1847718ced0SMaksim Yevmenkin */ 1857718ced0SMaksim Yevmenkin bool 1867718ced0SMaksim Yevmenkin _sdp_get_uint16(uint8_t **ptr, uint8_t *limit, uint16_t *value) 1877718ced0SMaksim Yevmenkin { 1887718ced0SMaksim Yevmenkin uint8_t *p = *ptr; 1897718ced0SMaksim Yevmenkin uint16_t v; 1907718ced0SMaksim Yevmenkin 1917718ced0SMaksim Yevmenkin if (p + 1 > limit) 1927718ced0SMaksim Yevmenkin return false; 1937718ced0SMaksim Yevmenkin 1947718ced0SMaksim Yevmenkin switch (*p++) { 1957718ced0SMaksim Yevmenkin case SDP_DATA_UINT16: 1967718ced0SMaksim Yevmenkin if (p + 2 > limit) 1977718ced0SMaksim Yevmenkin return false; 1987718ced0SMaksim Yevmenkin 1997718ced0SMaksim Yevmenkin v = be16dec(p); 2007718ced0SMaksim Yevmenkin p += 2; 2017718ced0SMaksim Yevmenkin break; 2027718ced0SMaksim Yevmenkin 2037718ced0SMaksim Yevmenkin default: 2047718ced0SMaksim Yevmenkin return false; 2057718ced0SMaksim Yevmenkin } 2067718ced0SMaksim Yevmenkin 2077718ced0SMaksim Yevmenkin *value = v; 2087718ced0SMaksim Yevmenkin *ptr = p; 2097718ced0SMaksim Yevmenkin return true; 2107718ced0SMaksim Yevmenkin } 211