1 /* $NetBSD: sdp_record.c,v 1.1 2009/05/12 10:05:06 plunky Exp $ */
2
3 /*-
4 * Copyright (c) 2009 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Iain Hibbert.
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 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33 __RCSID("$NetBSD: sdp_record.c,v 1.1 2009/05/12 10:05:06 plunky Exp $");
34
35 #include <errno.h>
36 #include <sdp.h>
37 #include <stdlib.h>
38 #include <string.h>
39 #include <unistd.h>
40
41 #include "sdp-int.h"
42
43 /*
44 * This is the interface to sdpd(8); These PDU IDs are NOT part
45 * of the Bluetooth specification.
46 */
47
48 bool
sdp_record_insert(struct sdp_session * ss,bdaddr_t * bdaddr,uint32_t * handle,const sdp_data_t * rec)49 sdp_record_insert(struct sdp_session *ss, bdaddr_t *bdaddr,
50 uint32_t *handle, const sdp_data_t *rec)
51 {
52 struct iovec req[4];
53 sdp_data_t hdr;
54 uint8_t data[5];
55 ssize_t len;
56 bdaddr_t ba;
57 uint16_t ec;
58
59 /*
60 * setup BluetoothDeviceAddress
61 */
62 bdaddr_copy(&ba, (bdaddr == NULL) ? BDADDR_ANY : bdaddr);
63 req[1].iov_base = &ba;
64 req[1].iov_len = sizeof(bdaddr_t);
65
66 /*
67 * setup ServiceRecord
68 */
69 len = rec->end - rec->next;
70 if (len < 0 || len > UINT16_MAX) {
71 errno = EINVAL;
72 return false;
73 }
74
75 hdr.next = data;
76 hdr.end = data + sizeof(data) + len;
77 sdp_put_seq(&hdr, len);
78 req[2].iov_base = data;
79 req[2].iov_len = hdr.next - data;
80
81 req[3].iov_base = rec->next;
82 req[3].iov_len = len;
83
84 /*
85 * InsertRecord Transaction
86 */
87 if (!_sdp_send_pdu(ss, SDP_PDU_RECORD_INSERT_REQUEST,
88 req, __arraycount(req)))
89 return false;
90
91 len = _sdp_recv_pdu(ss, SDP_PDU_ERROR_RESPONSE);
92 if (len == -1)
93 return false;
94
95 if (len != sizeof(uint16_t) + sizeof(uint32_t)) {
96 errno = EIO;
97 return false;
98 }
99
100 /*
101 * extract and check ErrorCode (success == 0)
102 */
103 ec = be16dec(ss->ibuf);
104 if (ec != 0) {
105 errno = _sdp_errno(ec);
106 return false;
107 }
108
109 /*
110 * extract ServiceRecordHandle if required
111 */
112 if (handle != NULL)
113 *handle = be32dec(ss->ibuf + sizeof(uint16_t));
114
115 return true;
116 }
117
118 bool
sdp_record_update(struct sdp_session * ss,uint32_t handle,const sdp_data_t * rec)119 sdp_record_update(struct sdp_session *ss, uint32_t handle,
120 const sdp_data_t *rec)
121 {
122 struct iovec req[4];
123 sdp_data_t hdr;
124 uint8_t data[5];
125 ssize_t len;
126 uint16_t ec;
127
128 /*
129 * setup ServiceRecordHandle
130 */
131 handle = htobe32(handle);
132 req[1].iov_base = &handle;
133 req[1].iov_len = sizeof(handle);
134
135 /*
136 * setup ServiceRecord
137 */
138 len = rec->end - rec->next;
139 if (len < 0 || len > UINT16_MAX) {
140 errno = EINVAL;
141 return false;
142 }
143
144 hdr.next = data;
145 hdr.end = data + sizeof(data) + len;
146 sdp_put_seq(&hdr, len);
147 req[2].iov_base = data;
148 req[2].iov_len = hdr.next - data;
149
150 req[3].iov_base = rec->next;
151 req[3].iov_len = len;
152
153 /*
154 * UpdateRecord Transaction
155 */
156 if (!_sdp_send_pdu(ss, SDP_PDU_RECORD_UPDATE_REQUEST,
157 req, __arraycount(req)))
158 return false;
159
160 len = _sdp_recv_pdu(ss, SDP_PDU_ERROR_RESPONSE);
161 if (len == -1)
162 return false;
163
164 if (len != sizeof(uint16_t)) {
165 errno = EIO;
166 return false;
167 }
168
169 /*
170 * extract and check ErrorCode (success == 0)
171 */
172 if ((ec = be16dec(ss->ibuf)) != 0) {
173 errno = _sdp_errno(ec);
174 return false;
175 }
176
177 return true;
178 }
179
180 bool
sdp_record_remove(struct sdp_session * ss,uint32_t handle)181 sdp_record_remove(struct sdp_session *ss, uint32_t handle)
182 {
183 struct iovec req[2];
184 ssize_t len;
185 uint16_t ec;
186
187 /*
188 * setup ServiceRecordHandle
189 */
190 handle = htobe32(handle);
191 req[1].iov_base = &handle;
192 req[1].iov_len = sizeof(handle);
193
194 /*
195 * RemoveRecord Transaction
196 */
197 if (!_sdp_send_pdu(ss, SDP_PDU_RECORD_REMOVE_REQUEST,
198 req, __arraycount(req)))
199 return false;
200
201 len = _sdp_recv_pdu(ss, SDP_PDU_ERROR_RESPONSE);
202 if (len == -1)
203 return false;
204
205 if (len != sizeof(uint16_t)) {
206 errno = EIO;
207 return false;
208 }
209
210 /*
211 * extract and check ErrorCode (success == 0)
212 */
213 ec = be16dec(ss->ibuf);
214 if (ec != 0) {
215 errno = _sdp_errno(ec);
216 return false;
217 }
218
219 return true;
220 }
221