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