1 /* $NetBSD: service.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $ */
2 /* $DragonFly: src/lib/libsdp/service.c,v 1.1 2008/01/03 11:47:53 hasso Exp $ */
3
4 /*-
5 * Copyright (c) 2006 Itronix Inc.
6 * All rights reserved.
7 *
8 * Written by Iain Hibbert for Itronix Inc.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. The name of Itronix Inc. may not be used to endorse
19 * or promote products derived from this software without specific
20 * prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
24 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
25 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
26 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
27 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
29 * ON ANY THEORY OF LIABILITY, WHETHER IN
30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 * POSSIBILITY OF SUCH DAMAGE.
33 */
34 /*
35 * service.c
36 *
37 * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
38 * All rights reserved.
39 *
40 * Redistribution and use in source and binary forms, with or without
41 * modification, are permitted provided that the following conditions
42 * are met:
43 * 1. Redistributions of source code must retain the above copyright
44 * notice, this list of conditions and the following disclaimer.
45 * 2. Redistributions in binary form must reproduce the above copyright
46 * notice, this list of conditions and the following disclaimer in the
47 * documentation and/or other materials provided with the distribution.
48 *
49 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
50 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
51 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
52 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
53 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
54 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
55 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
56 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
57 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
58 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
59 * SUCH DAMAGE.
60 *
61 * $Id: service.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $
62 * $FreeBSD: src/lib/libsdp/service.c,v 1.1 2004/01/20 20:48:25 emax Exp $
63 */
64
65 #include <sys/uio.h>
66 #include <netinet/in.h>
67 #include <arpa/inet.h>
68 #include <bluetooth.h>
69 #include <errno.h>
70 #include <string.h>
71 #include <unistd.h>
72
73 #include <sdp-int.h>
74 #include <sdp.h>
75
76 static int32_t sdp_receive_error_pdu(sdp_session_p ss);
77
78 int32_t
sdp_register_service(void * xss,uint16_t uuid,bdaddr_t * bdaddr,uint8_t * data,uint32_t datalen,uint32_t * handle)79 sdp_register_service(void *xss, uint16_t uuid, bdaddr_t *bdaddr,
80 uint8_t *data, uint32_t datalen, uint32_t *handle)
81 {
82 sdp_session_p ss = (sdp_session_p) xss;
83 struct iovec iov[4];
84 sdp_pdu_t pdu;
85 int32_t len;
86
87 if (ss == NULL)
88 return (-1);
89 if (bdaddr == NULL || data == NULL ||
90 datalen == 0 || !(ss->flags & SDP_SESSION_LOCAL)) {
91 ss->error = EINVAL;
92 return (-1);
93 }
94 if (sizeof(pdu)+sizeof(uuid)+sizeof(*bdaddr)+datalen > SDP_LOCAL_MTU) {
95 ss->error = EMSGSIZE;
96 return (-1);
97 }
98
99 pdu.pid = SDP_PDU_SERVICE_REGISTER_REQUEST;
100 pdu.tid = htons(++ss->tid);
101 pdu.len = htons(sizeof(uuid) + sizeof(*bdaddr) + datalen);
102
103 uuid = htons(uuid);
104
105 iov[0].iov_base = (void *) &pdu;
106 iov[0].iov_len = sizeof(pdu);
107
108 iov[1].iov_base = (void *) &uuid;
109 iov[1].iov_len = sizeof(uuid);
110
111 iov[2].iov_base = (void *) bdaddr;
112 iov[2].iov_len = sizeof(*bdaddr);
113
114 iov[3].iov_base = (void *) data;
115 iov[3].iov_len = datalen;
116
117 do {
118 len = writev(ss->s, iov, sizeof(iov)/sizeof(iov[0]));
119 } while (len < 0 && errno == EINTR);
120
121 if (len < 0) {
122 ss->error = errno;
123 return (-1);
124 }
125
126 len = sdp_receive_error_pdu(ss);
127 if (len < 0)
128 return (-1);
129 if (len != sizeof(pdu) + sizeof(uint16_t) + sizeof(uint32_t)) {
130 ss->error = EIO;
131 return (-1);
132 }
133
134 if (handle != NULL) {
135 *handle = (uint32_t) ss->rsp[--len];
136 *handle |= (uint32_t) ss->rsp[--len] << 8;
137 *handle |= (uint32_t) ss->rsp[--len] << 16;
138 *handle |= (uint32_t) ss->rsp[--len] << 24;
139 }
140
141 return (0);
142 }
143
144 int32_t
sdp_unregister_service(void * xss,uint32_t handle)145 sdp_unregister_service(void *xss, uint32_t handle)
146 {
147 sdp_session_p ss = (sdp_session_p) xss;
148 struct iovec iov[2];
149 sdp_pdu_t pdu;
150 int32_t len;
151
152 if (ss == NULL)
153 return (-1);
154 if (!(ss->flags & SDP_SESSION_LOCAL)) {
155 ss->error = EINVAL;
156 return (-1);
157 }
158 #if 0
159 if (sizeof(pdu) + sizeof(handle) > SDP_LOCAL_MTU) {
160 ss->error = EMSGSIZE;
161 return (-1);
162 }
163 #endif
164
165 pdu.pid = SDP_PDU_SERVICE_UNREGISTER_REQUEST;
166 pdu.tid = htons(++ss->tid);
167 pdu.len = htons(sizeof(handle));
168
169 handle = htonl(handle);
170
171 iov[0].iov_base = (void *) &pdu;
172 iov[0].iov_len = sizeof(pdu);
173
174 iov[1].iov_base = (void *) &handle;
175 iov[1].iov_len = sizeof(handle);
176
177 do {
178 len = writev(ss->s, iov, sizeof(iov)/sizeof(iov[0]));
179 } while (len < 0 && errno == EINTR);
180
181 if (len < 0) {
182 ss->error = errno;
183 return (-1);
184 }
185
186 return ((sdp_receive_error_pdu(ss) < 0)? -1 : 0);
187 }
188
189 int32_t
sdp_change_service(void * xss,uint32_t handle,uint8_t * data,uint32_t datalen)190 sdp_change_service(void *xss, uint32_t handle,
191 uint8_t *data, uint32_t datalen)
192 {
193 sdp_session_p ss = (sdp_session_p) xss;
194 struct iovec iov[3];
195 sdp_pdu_t pdu;
196 int32_t len;
197
198 if (ss == NULL)
199 return (-1);
200 if (data == NULL || datalen == 0 || !(ss->flags & SDP_SESSION_LOCAL)) {
201 ss->error = EINVAL;
202 return (-1);
203 }
204 if (sizeof(pdu) + sizeof(handle) + datalen > SDP_LOCAL_MTU) {
205 ss->error = EMSGSIZE;
206 return (-1);
207 }
208
209 pdu.pid = SDP_PDU_SERVICE_CHANGE_REQUEST;
210 pdu.tid = htons(++ss->tid);
211 pdu.len = htons(sizeof(handle) + datalen);
212
213 handle = htons(handle);
214
215 iov[0].iov_base = (void *) &pdu;
216 iov[0].iov_len = sizeof(pdu);
217
218 iov[1].iov_base = (void *) &handle;
219 iov[1].iov_len = sizeof(handle);
220
221 iov[2].iov_base = (void *) data;
222 iov[2].iov_len = datalen;
223
224 do {
225 len = writev(ss->s, iov, sizeof(iov)/sizeof(iov[0]));
226 } while (len < 0 && errno == EINTR);
227
228 if (len < 0) {
229 ss->error = errno;
230 return (-1);
231 }
232
233 return ((sdp_receive_error_pdu(ss) < 0)? -1 : 0);
234 }
235
236 static int32_t
sdp_receive_error_pdu(sdp_session_p ss)237 sdp_receive_error_pdu(sdp_session_p ss)
238 {
239 sdp_pdu_t pdu;
240 int32_t len;
241 uint16_t error;
242
243 do {
244 len = read(ss->s, ss->rsp, (size_t)(ss->rsp_e - ss->rsp));
245 } while (len < 0 && errno == EINTR);
246
247 if (len < 0) {
248 ss->error = errno;
249 return (-1);
250 }
251
252 memcpy(&pdu, ss->rsp, sizeof(pdu));
253 pdu.tid = ntohs(pdu.tid);
254 pdu.len = ntohs(pdu.len);
255 memcpy(ss->rsp, &pdu, sizeof(pdu));
256
257 if (pdu.pid != SDP_PDU_ERROR_RESPONSE || pdu.tid != ss->tid ||
258 pdu.len < 2 || pdu.len != len - sizeof(pdu)) {
259 ss->error = EIO;
260 return (-1);
261 }
262
263 error = (uint16_t) ss->rsp[sizeof(pdu)] << 8;
264 error |= (uint16_t) ss->rsp[sizeof(pdu) + 1];
265
266 if (error != 0) {
267 ss->error = EIO;
268 return (-1);
269 }
270
271 return (len);
272 }
273