xref: /dflybsd-src/lib/libsdp/search.c (revision 86d7f5d305c6adaa56ff4582ece9859d73106103)
1*86d7f5d3SJohn Marino /* $NetBSD: search.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $ */
2*86d7f5d3SJohn Marino /* $DragonFly: src/lib/libsdp/search.c,v 1.1 2008/01/03 11:47:53 hasso Exp $ */
3*86d7f5d3SJohn Marino 
4*86d7f5d3SJohn Marino /*
5*86d7f5d3SJohn Marino  * search.c
6*86d7f5d3SJohn Marino  *
7*86d7f5d3SJohn Marino  * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
8*86d7f5d3SJohn Marino  * All rights reserved.
9*86d7f5d3SJohn Marino  *
10*86d7f5d3SJohn Marino  * Redistribution and use in source and binary forms, with or without
11*86d7f5d3SJohn Marino  * modification, are permitted provided that the following conditions
12*86d7f5d3SJohn Marino  * are met:
13*86d7f5d3SJohn Marino  * 1. Redistributions of source code must retain the above copyright
14*86d7f5d3SJohn Marino  *    notice, this list of conditions and the following disclaimer.
15*86d7f5d3SJohn Marino  * 2. Redistributions in binary form must reproduce the above copyright
16*86d7f5d3SJohn Marino  *    notice, this list of conditions and the following disclaimer in the
17*86d7f5d3SJohn Marino  *    documentation and/or other materials provided with the distribution.
18*86d7f5d3SJohn Marino  *
19*86d7f5d3SJohn Marino  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20*86d7f5d3SJohn Marino  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21*86d7f5d3SJohn Marino  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22*86d7f5d3SJohn Marino  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23*86d7f5d3SJohn Marino  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24*86d7f5d3SJohn Marino  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25*86d7f5d3SJohn Marino  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26*86d7f5d3SJohn Marino  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27*86d7f5d3SJohn Marino  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28*86d7f5d3SJohn Marino  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29*86d7f5d3SJohn Marino  * SUCH DAMAGE.
30*86d7f5d3SJohn Marino  *
31*86d7f5d3SJohn Marino  * $Id: search.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $
32*86d7f5d3SJohn Marino  * $FreeBSD: src/lib/libsdp/search.c,v 1.7 2004/12/09 18:57:12 emax Exp $
33*86d7f5d3SJohn Marino  */
34*86d7f5d3SJohn Marino 
35*86d7f5d3SJohn Marino #include <sys/uio.h>
36*86d7f5d3SJohn Marino #include <netinet/in.h>
37*86d7f5d3SJohn Marino #include <arpa/inet.h>
38*86d7f5d3SJohn Marino #include <bluetooth.h>
39*86d7f5d3SJohn Marino #include <errno.h>
40*86d7f5d3SJohn Marino #include <stdio.h>
41*86d7f5d3SJohn Marino #include <stdlib.h>
42*86d7f5d3SJohn Marino #include <string.h>
43*86d7f5d3SJohn Marino #include <unistd.h>
44*86d7f5d3SJohn Marino 
45*86d7f5d3SJohn Marino #include <sdp-int.h>
46*86d7f5d3SJohn Marino #include <sdp.h>
47*86d7f5d3SJohn Marino 
48*86d7f5d3SJohn Marino int32_t
sdp_search(void * xss,uint32_t plen,uint16_t const * pp,uint32_t alen,uint32_t const * ap,uint32_t vlen,sdp_attr_t * vp)49*86d7f5d3SJohn Marino sdp_search(void *xss,
50*86d7f5d3SJohn Marino 		uint32_t plen, uint16_t const *pp,
51*86d7f5d3SJohn Marino 		uint32_t alen, uint32_t const *ap,
52*86d7f5d3SJohn Marino 		uint32_t vlen, sdp_attr_t *vp)
53*86d7f5d3SJohn Marino {
54*86d7f5d3SJohn Marino 	struct sdp_xpdu {
55*86d7f5d3SJohn Marino 		sdp_pdu_t		 pdu;
56*86d7f5d3SJohn Marino 		uint16_t		 len;
57*86d7f5d3SJohn Marino 	} __attribute__ ((packed))	 xpdu;
58*86d7f5d3SJohn Marino 
59*86d7f5d3SJohn Marino 	sdp_session_p			 ss = (sdp_session_p) xss;
60*86d7f5d3SJohn Marino 	uint8_t				*req = NULL, *rsp = NULL, *rsp_tmp = NULL;
61*86d7f5d3SJohn Marino 	int32_t				 t, len;
62*86d7f5d3SJohn Marino 	uint16_t			 lo, hi;
63*86d7f5d3SJohn Marino 
64*86d7f5d3SJohn Marino 	if (ss == NULL)
65*86d7f5d3SJohn Marino 		return (-1);
66*86d7f5d3SJohn Marino 
67*86d7f5d3SJohn Marino 	if (ss->req == NULL || ss->rsp == NULL ||
68*86d7f5d3SJohn Marino 	    plen == 0 || pp == NULL || alen == 0 || ap == NULL) {
69*86d7f5d3SJohn Marino 		ss->error = EINVAL;
70*86d7f5d3SJohn Marino 		return (-1);
71*86d7f5d3SJohn Marino 	}
72*86d7f5d3SJohn Marino 
73*86d7f5d3SJohn Marino 	req = ss->req;
74*86d7f5d3SJohn Marino 
75*86d7f5d3SJohn Marino 	/* Calculate ServiceSearchPattern length */
76*86d7f5d3SJohn Marino 	plen = plen * (sizeof(pp[0]) + 1);
77*86d7f5d3SJohn Marino 
78*86d7f5d3SJohn Marino 	/* Calculate AttributeIDList length */
79*86d7f5d3SJohn Marino 	for (len = 0, t = 0; t < alen; t ++) {
80*86d7f5d3SJohn Marino 		lo = (uint16_t) (ap[t] >> 16);
81*86d7f5d3SJohn Marino 		hi = (uint16_t) (ap[t]);
82*86d7f5d3SJohn Marino 
83*86d7f5d3SJohn Marino 		if (lo > hi) {
84*86d7f5d3SJohn Marino 			ss->error = EINVAL;
85*86d7f5d3SJohn Marino 			return (-1);
86*86d7f5d3SJohn Marino 		}
87*86d7f5d3SJohn Marino 
88*86d7f5d3SJohn Marino 		if (lo != hi)
89*86d7f5d3SJohn Marino 			len += (sizeof(ap[t]) + 1);
90*86d7f5d3SJohn Marino 		else
91*86d7f5d3SJohn Marino 			len += (sizeof(lo) + 1);
92*86d7f5d3SJohn Marino 	}
93*86d7f5d3SJohn Marino 	alen = len;
94*86d7f5d3SJohn Marino 
95*86d7f5d3SJohn Marino 	/* Calculate length of the request */
96*86d7f5d3SJohn Marino 	len =	plen + sizeof(uint8_t) + sizeof(uint16_t) +
97*86d7f5d3SJohn Marino 			/* ServiceSearchPattern */
98*86d7f5d3SJohn Marino 		sizeof(uint16_t) +
99*86d7f5d3SJohn Marino 			/* MaximumAttributeByteCount */
100*86d7f5d3SJohn Marino 		alen + sizeof(uint8_t) + sizeof(uint16_t);
101*86d7f5d3SJohn Marino 			/* AttributeIDList */
102*86d7f5d3SJohn Marino 
103*86d7f5d3SJohn Marino 	if (ss->req_e - req < len) {
104*86d7f5d3SJohn Marino 		ss->error = ENOBUFS;
105*86d7f5d3SJohn Marino 		return (-1);
106*86d7f5d3SJohn Marino 	}
107*86d7f5d3SJohn Marino 
108*86d7f5d3SJohn Marino 	/* Put ServiceSearchPattern */
109*86d7f5d3SJohn Marino 	SDP_PUT8(SDP_DATA_SEQ16, req);
110*86d7f5d3SJohn Marino 	SDP_PUT16(plen, req);
111*86d7f5d3SJohn Marino 	for (; plen > 0; pp ++, plen -= (sizeof(pp[0]) + 1)) {
112*86d7f5d3SJohn Marino 		SDP_PUT8(SDP_DATA_UUID16, req);
113*86d7f5d3SJohn Marino 		SDP_PUT16(*pp, req);
114*86d7f5d3SJohn Marino 	}
115*86d7f5d3SJohn Marino 
116*86d7f5d3SJohn Marino 	/* Put MaximumAttributeByteCount */
117*86d7f5d3SJohn Marino 	SDP_PUT16(0xffff, req);
118*86d7f5d3SJohn Marino 
119*86d7f5d3SJohn Marino 	/* Put AttributeIDList */
120*86d7f5d3SJohn Marino 	SDP_PUT8(SDP_DATA_SEQ16, req);
121*86d7f5d3SJohn Marino 	SDP_PUT16(alen, req);
122*86d7f5d3SJohn Marino 	for (; alen > 0; ap ++) {
123*86d7f5d3SJohn Marino 		lo = (uint16_t) (*ap >> 16);
124*86d7f5d3SJohn Marino 		hi = (uint16_t) (*ap);
125*86d7f5d3SJohn Marino 
126*86d7f5d3SJohn Marino 		if (lo != hi) {
127*86d7f5d3SJohn Marino 			/* Put attribute range */
128*86d7f5d3SJohn Marino 			SDP_PUT8(SDP_DATA_UINT32, req);
129*86d7f5d3SJohn Marino 			SDP_PUT32(*ap, req);
130*86d7f5d3SJohn Marino 			alen -= (sizeof(ap[0]) + 1);
131*86d7f5d3SJohn Marino 		} else {
132*86d7f5d3SJohn Marino 			/* Put attribute */
133*86d7f5d3SJohn Marino 			SDP_PUT8(SDP_DATA_UINT16, req);
134*86d7f5d3SJohn Marino 			SDP_PUT16(lo, req);
135*86d7f5d3SJohn Marino 			alen -= (sizeof(lo) + 1);
136*86d7f5d3SJohn Marino 		}
137*86d7f5d3SJohn Marino 	}
138*86d7f5d3SJohn Marino 
139*86d7f5d3SJohn Marino 	/* Submit ServiceSearchAttributeRequest and wait for response */
140*86d7f5d3SJohn Marino 	ss->cslen = 0;
141*86d7f5d3SJohn Marino 	rsp = ss->rsp;
142*86d7f5d3SJohn Marino 
143*86d7f5d3SJohn Marino 	do {
144*86d7f5d3SJohn Marino 		struct iovec	 iov[2];
145*86d7f5d3SJohn Marino 		uint8_t		*req_cs = req;
146*86d7f5d3SJohn Marino 
147*86d7f5d3SJohn Marino 		/* Add continuation state (if any) */
148*86d7f5d3SJohn Marino 		if (ss->req_e - req_cs < ss->cslen + 1) {
149*86d7f5d3SJohn Marino 			ss->error = ENOBUFS;
150*86d7f5d3SJohn Marino 			return (-1);
151*86d7f5d3SJohn Marino 		}
152*86d7f5d3SJohn Marino 
153*86d7f5d3SJohn Marino 		SDP_PUT8(ss->cslen, req_cs);
154*86d7f5d3SJohn Marino 		if (ss->cslen > 0) {
155*86d7f5d3SJohn Marino 			memcpy(req_cs, ss->cs, ss->cslen);
156*86d7f5d3SJohn Marino 			req_cs += ss->cslen;
157*86d7f5d3SJohn Marino 		}
158*86d7f5d3SJohn Marino 
159*86d7f5d3SJohn Marino 		/* Prepare SDP PDU header */
160*86d7f5d3SJohn Marino 		xpdu.pdu.pid = SDP_PDU_SERVICE_SEARCH_ATTRIBUTE_REQUEST;
161*86d7f5d3SJohn Marino 		xpdu.pdu.tid = htons(ss->tid);
162*86d7f5d3SJohn Marino 		xpdu.pdu.len = htons(req_cs - ss->req);
163*86d7f5d3SJohn Marino 
164*86d7f5d3SJohn Marino 		/* Submit request */
165*86d7f5d3SJohn Marino 		iov[0].iov_base = (void *) &xpdu;
166*86d7f5d3SJohn Marino 		iov[0].iov_len = sizeof(xpdu.pdu);
167*86d7f5d3SJohn Marino 		iov[1].iov_base = (void *) ss->req;
168*86d7f5d3SJohn Marino 		iov[1].iov_len = req_cs - ss->req;
169*86d7f5d3SJohn Marino 
170*86d7f5d3SJohn Marino 		do {
171*86d7f5d3SJohn Marino 			len = writev(ss->s, iov, sizeof(iov)/sizeof(iov[0]));
172*86d7f5d3SJohn Marino 		} while (len < 0 && errno == EINTR);
173*86d7f5d3SJohn Marino 
174*86d7f5d3SJohn Marino 		if (len < 0) {
175*86d7f5d3SJohn Marino 			ss->error = errno;
176*86d7f5d3SJohn Marino 			return (-1);
177*86d7f5d3SJohn Marino 		}
178*86d7f5d3SJohn Marino 
179*86d7f5d3SJohn Marino 		/* Read response */
180*86d7f5d3SJohn Marino 		iov[0].iov_base = (void *) &xpdu;
181*86d7f5d3SJohn Marino 		iov[0].iov_len = sizeof(xpdu);
182*86d7f5d3SJohn Marino 		iov[1].iov_base = (void *) rsp;
183*86d7f5d3SJohn Marino 		iov[1].iov_len = ss->imtu;
184*86d7f5d3SJohn Marino 
185*86d7f5d3SJohn Marino 		do {
186*86d7f5d3SJohn Marino 			len = readv(ss->s, iov, sizeof(iov)/sizeof(iov[0]));
187*86d7f5d3SJohn Marino 		} while (len < 0 && errno == EINTR);
188*86d7f5d3SJohn Marino 
189*86d7f5d3SJohn Marino 		if (len < 0) {
190*86d7f5d3SJohn Marino 			ss->error = errno;
191*86d7f5d3SJohn Marino 			return (-1);
192*86d7f5d3SJohn Marino 		}
193*86d7f5d3SJohn Marino 		if (len < sizeof(xpdu)) {
194*86d7f5d3SJohn Marino 			ss->error = ENOMSG;
195*86d7f5d3SJohn Marino 			return (-1);
196*86d7f5d3SJohn Marino 		}
197*86d7f5d3SJohn Marino 
198*86d7f5d3SJohn Marino 		xpdu.pdu.tid = ntohs(xpdu.pdu.tid);
199*86d7f5d3SJohn Marino 		xpdu.pdu.len = ntohs(xpdu.pdu.len);
200*86d7f5d3SJohn Marino 		xpdu.len = ntohs(xpdu.len);
201*86d7f5d3SJohn Marino 
202*86d7f5d3SJohn Marino 		if (xpdu.pdu.pid == SDP_PDU_ERROR_RESPONSE ||
203*86d7f5d3SJohn Marino 		    xpdu.pdu.tid != ss->tid ||
204*86d7f5d3SJohn Marino 		    xpdu.pdu.len > len ||
205*86d7f5d3SJohn Marino 		    xpdu.len > xpdu.pdu.len) {
206*86d7f5d3SJohn Marino 			ss->error = EIO;
207*86d7f5d3SJohn Marino 			return (-1);
208*86d7f5d3SJohn Marino 		}
209*86d7f5d3SJohn Marino 
210*86d7f5d3SJohn Marino 		/* Save continuation state (if any) */
211*86d7f5d3SJohn Marino 		ss->cslen = rsp[xpdu.len];
212*86d7f5d3SJohn Marino 		if (ss->cslen > 0) {
213*86d7f5d3SJohn Marino 			if (ss->cslen > sizeof(ss->cs)) {
214*86d7f5d3SJohn Marino 				ss->error = ENOBUFS;
215*86d7f5d3SJohn Marino 				return (-1);
216*86d7f5d3SJohn Marino 			}
217*86d7f5d3SJohn Marino 
218*86d7f5d3SJohn Marino 			memcpy(ss->cs, rsp + xpdu.len + 1, ss->cslen);
219*86d7f5d3SJohn Marino 
220*86d7f5d3SJohn Marino 			/*
221*86d7f5d3SJohn Marino 			 * Ensure that we always have ss->imtu bytes
222*86d7f5d3SJohn Marino 			 * available in the ss->rsp buffer
223*86d7f5d3SJohn Marino 			 */
224*86d7f5d3SJohn Marino 
225*86d7f5d3SJohn Marino 			if (ss->rsp_e - rsp <= ss->imtu) {
226*86d7f5d3SJohn Marino 				uint32_t	 size, offset;
227*86d7f5d3SJohn Marino 
228*86d7f5d3SJohn Marino 				size = ss->rsp_e - ss->rsp + ss->imtu;
229*86d7f5d3SJohn Marino 				offset = rsp - ss->rsp;
230*86d7f5d3SJohn Marino 
231*86d7f5d3SJohn Marino 				rsp_tmp = realloc(ss->rsp, size);
232*86d7f5d3SJohn Marino 				if (rsp_tmp == NULL) {
233*86d7f5d3SJohn Marino 					ss->error = ENOMEM;
234*86d7f5d3SJohn Marino 					return (-1);
235*86d7f5d3SJohn Marino 				}
236*86d7f5d3SJohn Marino 
237*86d7f5d3SJohn Marino 				ss->rsp = rsp_tmp;
238*86d7f5d3SJohn Marino 				ss->rsp_e = ss->rsp + size;
239*86d7f5d3SJohn Marino 				rsp = ss->rsp + offset;
240*86d7f5d3SJohn Marino 			}
241*86d7f5d3SJohn Marino 		}
242*86d7f5d3SJohn Marino 
243*86d7f5d3SJohn Marino 		rsp += xpdu.len;
244*86d7f5d3SJohn Marino 		ss->tid ++;
245*86d7f5d3SJohn Marino 	} while (ss->cslen > 0);
246*86d7f5d3SJohn Marino 
247*86d7f5d3SJohn Marino 	/*
248*86d7f5d3SJohn Marino 	 * If we got here then we have completed SDP transaction and now
249*86d7f5d3SJohn Marino 	 * we must populate attribute values into vp array. At this point
250*86d7f5d3SJohn Marino 	 * ss->rsp points to the beginning of the response and rsp points
251*86d7f5d3SJohn Marino 	 * to the end of the response.
252*86d7f5d3SJohn Marino 	 *
253*86d7f5d3SJohn Marino 	 * From Bluetooth v1.1 spec page 364
254*86d7f5d3SJohn Marino 	 *
255*86d7f5d3SJohn Marino 	 * The AttributeLists is a data element sequence where each element
256*86d7f5d3SJohn Marino 	 * in turn is a data element sequence representing an attribute list.
257*86d7f5d3SJohn Marino 	 * Each attribute list contains attribute IDs and attribute values
258*86d7f5d3SJohn Marino 	 * from one service record. The first element in each attribute list
259*86d7f5d3SJohn Marino 	 * contains the attribute ID of the first attribute to be returned for
260*86d7f5d3SJohn Marino 	 * that service record. The second element in each attribute list
261*86d7f5d3SJohn Marino 	 * contains the corresponding attribute value. Successive pairs of
262*86d7f5d3SJohn Marino 	 * elements in each attribute list contain additional attribute ID
263*86d7f5d3SJohn Marino 	 * and value pairs. Only attributes that have non-null values within
264*86d7f5d3SJohn Marino 	 * the service record and whose attribute IDs were specified in the
265*86d7f5d3SJohn Marino 	 * SDP_ServiceSearchAttributeRequest are contained in the AttributeLists
266*86d7f5d3SJohn Marino 	 * Neither an attribute ID nor attribute value is placed in
267*86d7f5d3SJohn Marino 	 * AttributeLists for attributes in the service record that have no
268*86d7f5d3SJohn Marino 	 * value. Within each attribute list, the attributes are listed in
269*86d7f5d3SJohn Marino 	 * ascending order of attribute ID value.
270*86d7f5d3SJohn Marino 	 */
271*86d7f5d3SJohn Marino 
272*86d7f5d3SJohn Marino 	if (vp == NULL)
273*86d7f5d3SJohn Marino 		goto done;
274*86d7f5d3SJohn Marino 
275*86d7f5d3SJohn Marino 	rsp_tmp = ss->rsp;
276*86d7f5d3SJohn Marino 
277*86d7f5d3SJohn Marino 	/* Skip the first SEQ */
278*86d7f5d3SJohn Marino 	SDP_GET8(t, rsp_tmp);
279*86d7f5d3SJohn Marino 	switch (t) {
280*86d7f5d3SJohn Marino 	case SDP_DATA_SEQ8:
281*86d7f5d3SJohn Marino 		SDP_GET8(len, rsp_tmp);
282*86d7f5d3SJohn Marino 		break;
283*86d7f5d3SJohn Marino 
284*86d7f5d3SJohn Marino 	case SDP_DATA_SEQ16:
285*86d7f5d3SJohn Marino 		SDP_GET16(len, rsp_tmp);
286*86d7f5d3SJohn Marino 		break;
287*86d7f5d3SJohn Marino 
288*86d7f5d3SJohn Marino 	case SDP_DATA_SEQ32:
289*86d7f5d3SJohn Marino 		SDP_GET32(len, rsp_tmp);
290*86d7f5d3SJohn Marino 		break;
291*86d7f5d3SJohn Marino 
292*86d7f5d3SJohn Marino 	default:
293*86d7f5d3SJohn Marino 		ss->error = ENOATTR;
294*86d7f5d3SJohn Marino 		return (-1);
295*86d7f5d3SJohn Marino 		/* NOT REACHED */
296*86d7f5d3SJohn Marino 	}
297*86d7f5d3SJohn Marino 
298*86d7f5d3SJohn Marino 	for (; rsp_tmp < rsp && vlen > 0; ) {
299*86d7f5d3SJohn Marino 		/* Get set of attributes for the next record */
300*86d7f5d3SJohn Marino 		SDP_GET8(t, rsp_tmp);
301*86d7f5d3SJohn Marino 		switch (t) {
302*86d7f5d3SJohn Marino 		case SDP_DATA_SEQ8:
303*86d7f5d3SJohn Marino 			SDP_GET8(len, rsp_tmp);
304*86d7f5d3SJohn Marino 			break;
305*86d7f5d3SJohn Marino 
306*86d7f5d3SJohn Marino 		case SDP_DATA_SEQ16:
307*86d7f5d3SJohn Marino 			SDP_GET16(len, rsp_tmp);
308*86d7f5d3SJohn Marino 			break;
309*86d7f5d3SJohn Marino 
310*86d7f5d3SJohn Marino 		case SDP_DATA_SEQ32:
311*86d7f5d3SJohn Marino 			SDP_GET32(len, rsp_tmp);
312*86d7f5d3SJohn Marino 			break;
313*86d7f5d3SJohn Marino 
314*86d7f5d3SJohn Marino 		default:
315*86d7f5d3SJohn Marino 			ss->error = ENOATTR;
316*86d7f5d3SJohn Marino 			return (-1);
317*86d7f5d3SJohn Marino 			/* NOT REACHED */
318*86d7f5d3SJohn Marino 		}
319*86d7f5d3SJohn Marino 
320*86d7f5d3SJohn Marino 		/* Now rsp_tmp points to list of (attr,value) pairs */
321*86d7f5d3SJohn Marino 		for (; len > 0 && vlen > 0; vp ++, vlen --) {
322*86d7f5d3SJohn Marino 			/* Attribute */
323*86d7f5d3SJohn Marino 			SDP_GET8(t, rsp_tmp);
324*86d7f5d3SJohn Marino 			if (t != SDP_DATA_UINT16) {
325*86d7f5d3SJohn Marino 				ss->error = ENOATTR;
326*86d7f5d3SJohn Marino 				return (-1);
327*86d7f5d3SJohn Marino 			}
328*86d7f5d3SJohn Marino 			SDP_GET16(vp->attr, rsp_tmp);
329*86d7f5d3SJohn Marino 
330*86d7f5d3SJohn Marino 			/* Attribute value */
331*86d7f5d3SJohn Marino 			switch (rsp_tmp[0]) {
332*86d7f5d3SJohn Marino 			case SDP_DATA_NIL:
333*86d7f5d3SJohn Marino 				alen = 0;
334*86d7f5d3SJohn Marino 				break;
335*86d7f5d3SJohn Marino 
336*86d7f5d3SJohn Marino 			case SDP_DATA_UINT8:
337*86d7f5d3SJohn Marino 			case SDP_DATA_INT8:
338*86d7f5d3SJohn Marino 			case SDP_DATA_BOOL:
339*86d7f5d3SJohn Marino 				alen = sizeof(uint8_t);
340*86d7f5d3SJohn Marino 				break;
341*86d7f5d3SJohn Marino 
342*86d7f5d3SJohn Marino 			case SDP_DATA_UINT16:
343*86d7f5d3SJohn Marino 			case SDP_DATA_INT16:
344*86d7f5d3SJohn Marino 			case SDP_DATA_UUID16:
345*86d7f5d3SJohn Marino 				alen = sizeof(uint16_t);
346*86d7f5d3SJohn Marino 				break;
347*86d7f5d3SJohn Marino 
348*86d7f5d3SJohn Marino 			case SDP_DATA_UINT32:
349*86d7f5d3SJohn Marino 			case SDP_DATA_INT32:
350*86d7f5d3SJohn Marino 			case SDP_DATA_UUID32:
351*86d7f5d3SJohn Marino 				alen = sizeof(uint32_t);
352*86d7f5d3SJohn Marino 				break;
353*86d7f5d3SJohn Marino 
354*86d7f5d3SJohn Marino 			case SDP_DATA_UINT64:
355*86d7f5d3SJohn Marino 			case SDP_DATA_INT64:
356*86d7f5d3SJohn Marino 				alen = sizeof(uint64_t);
357*86d7f5d3SJohn Marino 				break;
358*86d7f5d3SJohn Marino 
359*86d7f5d3SJohn Marino 			case SDP_DATA_UINT128:
360*86d7f5d3SJohn Marino 			case SDP_DATA_INT128:
361*86d7f5d3SJohn Marino 			case SDP_DATA_UUID128:
362*86d7f5d3SJohn Marino 				alen = sizeof(uint128_t);
363*86d7f5d3SJohn Marino 				break;
364*86d7f5d3SJohn Marino 
365*86d7f5d3SJohn Marino 			case SDP_DATA_STR8:
366*86d7f5d3SJohn Marino 			case SDP_DATA_URL8:
367*86d7f5d3SJohn Marino 			case SDP_DATA_SEQ8:
368*86d7f5d3SJohn Marino 			case SDP_DATA_ALT8:
369*86d7f5d3SJohn Marino 				alen = rsp_tmp[1] + sizeof(uint8_t);
370*86d7f5d3SJohn Marino 				break;
371*86d7f5d3SJohn Marino 
372*86d7f5d3SJohn Marino 			case SDP_DATA_STR16:
373*86d7f5d3SJohn Marino 			case SDP_DATA_URL16:
374*86d7f5d3SJohn Marino 			case SDP_DATA_SEQ16:
375*86d7f5d3SJohn Marino 			case SDP_DATA_ALT16:
376*86d7f5d3SJohn Marino 				alen =	  ((uint16_t)rsp_tmp[1] << 8)
377*86d7f5d3SJohn Marino 					| ((uint16_t)rsp_tmp[2]);
378*86d7f5d3SJohn Marino 				alen += sizeof(uint16_t);
379*86d7f5d3SJohn Marino 				break;
380*86d7f5d3SJohn Marino 
381*86d7f5d3SJohn Marino 			case SDP_DATA_STR32:
382*86d7f5d3SJohn Marino 			case SDP_DATA_URL32:
383*86d7f5d3SJohn Marino 			case SDP_DATA_SEQ32:
384*86d7f5d3SJohn Marino 			case SDP_DATA_ALT32:
385*86d7f5d3SJohn Marino 				alen =    ((uint32_t)rsp_tmp[1] << 24)
386*86d7f5d3SJohn Marino 					| ((uint32_t)rsp_tmp[2] << 16)
387*86d7f5d3SJohn Marino 					| ((uint32_t)rsp_tmp[3] <<  8)
388*86d7f5d3SJohn Marino 					| ((uint32_t)rsp_tmp[4]);
389*86d7f5d3SJohn Marino 				alen += sizeof(uint32_t);
390*86d7f5d3SJohn Marino 				break;
391*86d7f5d3SJohn Marino 
392*86d7f5d3SJohn Marino 			default:
393*86d7f5d3SJohn Marino 				ss->error = ENOATTR;
394*86d7f5d3SJohn Marino 				return (-1);
395*86d7f5d3SJohn Marino 				/* NOT REACHED */
396*86d7f5d3SJohn Marino 			}
397*86d7f5d3SJohn Marino 
398*86d7f5d3SJohn Marino 			alen += sizeof(uint8_t);
399*86d7f5d3SJohn Marino 
400*86d7f5d3SJohn Marino 			if (vp->value != NULL) {
401*86d7f5d3SJohn Marino 				if (alen <= vp->vlen) {
402*86d7f5d3SJohn Marino 					vp->flags = SDP_ATTR_OK;
403*86d7f5d3SJohn Marino 					vp->vlen = alen;
404*86d7f5d3SJohn Marino 				} else
405*86d7f5d3SJohn Marino 					vp->flags = SDP_ATTR_TRUNCATED;
406*86d7f5d3SJohn Marino 
407*86d7f5d3SJohn Marino 				memcpy(vp->value, rsp_tmp, vp->vlen);
408*86d7f5d3SJohn Marino 			} else
409*86d7f5d3SJohn Marino 				vp->flags = SDP_ATTR_INVALID;
410*86d7f5d3SJohn Marino 
411*86d7f5d3SJohn Marino 			len -=	(
412*86d7f5d3SJohn Marino 				sizeof(uint8_t) + sizeof(uint16_t) +
413*86d7f5d3SJohn Marino 				alen
414*86d7f5d3SJohn Marino 				);
415*86d7f5d3SJohn Marino 
416*86d7f5d3SJohn Marino 			rsp_tmp += alen;
417*86d7f5d3SJohn Marino 		}
418*86d7f5d3SJohn Marino 	}
419*86d7f5d3SJohn Marino done:
420*86d7f5d3SJohn Marino 	ss->error = 0;
421*86d7f5d3SJohn Marino 
422*86d7f5d3SJohn Marino 	return (0);
423*86d7f5d3SJohn Marino }
424