rfcomm_sppd.c revision 1.12 1 1.12 plunky /* $NetBSD: rfcomm_sppd.c,v 1.12 2009/09/24 18:30:37 plunky Exp $ */
2 1.1 gdamore
3 1.1 gdamore /*-
4 1.1 gdamore * Copyright (c) 2006 Itronix Inc.
5 1.1 gdamore * All rights reserved.
6 1.1 gdamore *
7 1.1 gdamore * Redistribution and use in source and binary forms, with or without
8 1.1 gdamore * modification, are permitted provided that the following conditions
9 1.1 gdamore * are met:
10 1.1 gdamore * 1. Redistributions of source code must retain the above copyright
11 1.1 gdamore * notice, this list of conditions and the following disclaimer.
12 1.1 gdamore * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 gdamore * notice, this list of conditions and the following disclaimer in the
14 1.1 gdamore * documentation and/or other materials provided with the distribution.
15 1.1 gdamore * 3. The name of Itronix Inc. may not be used to endorse
16 1.1 gdamore * or promote products derived from this software without specific
17 1.1 gdamore * prior written permission.
18 1.1 gdamore *
19 1.1 gdamore * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
20 1.1 gdamore * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 gdamore * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 gdamore * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
23 1.1 gdamore * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
24 1.1 gdamore * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
25 1.1 gdamore * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
26 1.1 gdamore * ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 gdamore * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 gdamore * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 gdamore * POSSIBILITY OF SUCH DAMAGE.
30 1.1 gdamore */
31 1.1 gdamore /*
32 1.10 plunky * Copyright (c) 2009 The NetBSD Foundation, Inc.
33 1.2 plunky * Copyright (c) 2007 Iain Hibbert
34 1.1 gdamore * Copyright (c) 2003 Maksim Yevmenkin <m_evmenkin (at) yahoo.com>
35 1.1 gdamore * All rights reserved.
36 1.1 gdamore *
37 1.1 gdamore * Redistribution and use in source and binary forms, with or without
38 1.1 gdamore * modification, are permitted provided that the following conditions
39 1.1 gdamore * are met:
40 1.1 gdamore * 1. Redistributions of source code must retain the above copyright
41 1.1 gdamore * notice, this list of conditions and the following disclaimer.
42 1.1 gdamore * 2. Redistributions in binary form must reproduce the above copyright
43 1.1 gdamore * notice, this list of conditions and the following disclaimer in the
44 1.1 gdamore * documentation and/or other materials provided with the distribution.
45 1.1 gdamore *
46 1.1 gdamore * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
47 1.1 gdamore * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
48 1.1 gdamore * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
49 1.1 gdamore * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
50 1.1 gdamore * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
51 1.1 gdamore * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
52 1.1 gdamore * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
53 1.1 gdamore * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
54 1.1 gdamore * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
55 1.1 gdamore * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
56 1.1 gdamore * SUCH DAMAGE.
57 1.1 gdamore */
58 1.1 gdamore
59 1.1 gdamore #include <sys/cdefs.h>
60 1.10 plunky __COPYRIGHT("@(#) Copyright (c) 2009 The NetBSD Foundation, Inc.\
61 1.10 plunky Copyright (c) 2007 Iain Hibbert.\
62 1.9 lukem Copyright (c) 2006 Itronix, Inc.\
63 1.9 lukem Copyright (c) 2003 Maksim Yevmenkin m_evmenkin (at) yahoo.com.\
64 1.9 lukem All rights reserved.");
65 1.12 plunky __RCSID("$NetBSD: rfcomm_sppd.c,v 1.12 2009/09/24 18:30:37 plunky Exp $");
66 1.11 plunky
67 1.11 plunky #include <sys/param.h>
68 1.1 gdamore
69 1.1 gdamore #include <bluetooth.h>
70 1.1 gdamore #include <ctype.h>
71 1.1 gdamore #include <err.h>
72 1.1 gdamore #include <errno.h>
73 1.1 gdamore #include <fcntl.h>
74 1.1 gdamore #include <grp.h>
75 1.1 gdamore #include <limits.h>
76 1.1 gdamore #include <paths.h>
77 1.1 gdamore #include <sdp.h>
78 1.1 gdamore #include <signal.h>
79 1.1 gdamore #include <stdarg.h>
80 1.1 gdamore #include <stdio.h>
81 1.1 gdamore #include <stdlib.h>
82 1.1 gdamore #include <string.h>
83 1.1 gdamore #include <syslog.h>
84 1.1 gdamore #include <termios.h>
85 1.1 gdamore #include <unistd.h>
86 1.1 gdamore
87 1.7 plunky #include <netbt/rfcomm.h>
88 1.7 plunky
89 1.2 plunky int open_tty(const char *);
90 1.12 plunky int open_client(bdaddr_t *, bdaddr_t *, int, uintmax_t, const char *);
91 1.12 plunky int open_server(bdaddr_t *, uint16_t, uint8_t, int, const char *);
92 1.2 plunky void copy_data(int, int);
93 1.12 plunky int service_search(const bdaddr_t *, const bdaddr_t *, uint16_t, uintmax_t *, uintmax_t *);
94 1.2 plunky void sighandler(int);
95 1.2 plunky void usage(void);
96 1.2 plunky void reset_tio(void);
97 1.2 plunky
98 1.2 plunky int done; /* got a signal */
99 1.2 plunky struct termios tio; /* stored termios for reset on exit */
100 1.2 plunky
101 1.2 plunky struct service {
102 1.10 plunky const char * name;
103 1.10 plunky const char * description;
104 1.2 plunky uint16_t class;
105 1.2 plunky } services[] = {
106 1.2 plunky { "DUN", "Dialup Networking",
107 1.10 plunky SDP_SERVICE_CLASS_DIALUP_NETWORKING },
108 1.10 plunky { "LAN", "LAN access using PPP",
109 1.10 plunky SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP },
110 1.2 plunky { "SP", "Serial Port",
111 1.10 plunky SDP_SERVICE_CLASS_SERIAL_PORT },
112 1.10 plunky { NULL, NULL, 0 }
113 1.2 plunky };
114 1.1 gdamore
115 1.1 gdamore int
116 1.1 gdamore main(int argc, char *argv[])
117 1.1 gdamore {
118 1.2 plunky struct termios t;
119 1.2 plunky bdaddr_t laddr, raddr;
120 1.2 plunky fd_set rdset;
121 1.6 plunky const char *service;
122 1.6 plunky char *ep, *tty;
123 1.7 plunky int lm, n, rfcomm, tty_in, tty_out;
124 1.12 plunky uint16_t psm;
125 1.2 plunky uint8_t channel;
126 1.1 gdamore
127 1.1 gdamore bdaddr_copy(&laddr, BDADDR_ANY);
128 1.1 gdamore bdaddr_copy(&raddr, BDADDR_ANY);
129 1.3 plunky service = "SP";
130 1.3 plunky tty = NULL;
131 1.2 plunky channel = 0;
132 1.12 plunky psm = L2CAP_PSM_RFCOMM;
133 1.7 plunky lm = 0;
134 1.1 gdamore
135 1.1 gdamore /* Parse command line options */
136 1.12 plunky while ((n = getopt(argc, argv, "a:c:d:hm:p:s:t:")) != -1) {
137 1.1 gdamore switch (n) {
138 1.2 plunky case 'a': /* remote device address */
139 1.1 gdamore if (!bt_aton(optarg, &raddr)) {
140 1.1 gdamore struct hostent *he = NULL;
141 1.1 gdamore
142 1.1 gdamore if ((he = bt_gethostbyname(optarg)) == NULL)
143 1.2 plunky errx(EXIT_FAILURE, "%s: %s", optarg,
144 1.2 plunky hstrerror(h_errno));
145 1.1 gdamore
146 1.1 gdamore bdaddr_copy(&raddr, (bdaddr_t *)he->h_addr);
147 1.1 gdamore }
148 1.1 gdamore break;
149 1.1 gdamore
150 1.1 gdamore case 'c': /* RFCOMM channel */
151 1.1 gdamore channel = strtoul(optarg, &ep, 10);
152 1.3 plunky if (*ep != '\0' || channel < 1 || channel > 30)
153 1.3 plunky errx(EXIT_FAILURE, "Invalid channel: %s", optarg);
154 1.3 plunky
155 1.1 gdamore break;
156 1.1 gdamore
157 1.2 plunky case 'd': /* local device address */
158 1.2 plunky if (!bt_devaddr(optarg, &laddr))
159 1.2 plunky err(EXIT_FAILURE, "%s", optarg);
160 1.2 plunky
161 1.1 gdamore break;
162 1.1 gdamore
163 1.7 plunky case 'm': /* Link Mode */
164 1.7 plunky if (strcasecmp(optarg, "auth") == 0)
165 1.7 plunky lm = RFCOMM_LM_AUTH;
166 1.7 plunky else if (strcasecmp(optarg, "encrypt") == 0)
167 1.7 plunky lm = RFCOMM_LM_ENCRYPT;
168 1.7 plunky else if (strcasecmp(optarg, "secure") == 0)
169 1.7 plunky lm = RFCOMM_LM_SECURE;
170 1.7 plunky else
171 1.7 plunky errx(EXIT_FAILURE, "%s: unknown mode", optarg);
172 1.7 plunky
173 1.7 plunky break;
174 1.7 plunky
175 1.12 plunky case 'p': /* PSM */
176 1.12 plunky psm = strtoul(optarg, &ep, 0);
177 1.12 plunky if (*ep != '\0' || L2CAP_PSM_INVALID(psm))
178 1.12 plunky errx(EXIT_FAILURE, "Invalid PSM: %s", optarg);
179 1.12 plunky
180 1.12 plunky break;
181 1.12 plunky
182 1.3 plunky case 's': /* service class */
183 1.2 plunky service = optarg;
184 1.1 gdamore break;
185 1.1 gdamore
186 1.1 gdamore case 't': /* Slave TTY name */
187 1.1 gdamore if (optarg[0] != '/')
188 1.1 gdamore asprintf(&tty, "%s%s", _PATH_DEV, optarg);
189 1.1 gdamore else
190 1.1 gdamore tty = optarg;
191 1.2 plunky
192 1.1 gdamore break;
193 1.1 gdamore
194 1.1 gdamore case 'h':
195 1.1 gdamore default:
196 1.1 gdamore usage();
197 1.1 gdamore /* NOT REACHED */
198 1.1 gdamore }
199 1.1 gdamore }
200 1.1 gdamore
201 1.2 plunky /*
202 1.2 plunky * validate options:
203 1.3 plunky * must have channel or remote address but not both
204 1.2 plunky */
205 1.3 plunky if ((channel == 0 && bdaddr_any(&raddr))
206 1.3 plunky || (channel != 0 && !bdaddr_any(&raddr)))
207 1.1 gdamore usage();
208 1.1 gdamore
209 1.2 plunky /*
210 1.2 plunky * grab ttys before we start the bluetooth
211 1.2 plunky */
212 1.1 gdamore if (tty == NULL) {
213 1.2 plunky tty_in = STDIN_FILENO;
214 1.2 plunky tty_out = STDOUT_FILENO;
215 1.2 plunky } else {
216 1.2 plunky tty_in = open_tty(tty);
217 1.2 plunky tty_out = tty_in;
218 1.2 plunky }
219 1.1 gdamore
220 1.2 plunky /* open RFCOMM */
221 1.3 plunky if (channel == 0)
222 1.12 plunky rfcomm = open_client(&laddr, &raddr, lm, psm, service);
223 1.2 plunky else
224 1.12 plunky rfcomm = open_server(&laddr, psm, channel, lm, service);
225 1.1 gdamore
226 1.2 plunky /*
227 1.4 plunky * now we are ready to go, so either detach or maybe turn
228 1.2 plunky * off some input processing, so that rfcomm_sppd can
229 1.2 plunky * be used directly with stdio
230 1.2 plunky */
231 1.2 plunky if (tty == NULL) {
232 1.2 plunky if (tcgetattr(tty_in, &t) < 0)
233 1.2 plunky err(EXIT_FAILURE, "tcgetattr");
234 1.1 gdamore
235 1.2 plunky memcpy(&tio, &t, sizeof(tio));
236 1.2 plunky t.c_lflag &= ~(ECHO | ICANON);
237 1.2 plunky t.c_iflag &= ~(ICRNL);
238 1.1 gdamore
239 1.4 plunky if (memcmp(&tio, &t, sizeof(tio))) {
240 1.4 plunky if (tcsetattr(tty_in, TCSANOW, &t) < 0)
241 1.4 plunky err(EXIT_FAILURE, "tcsetattr");
242 1.1 gdamore
243 1.4 plunky atexit(reset_tio);
244 1.4 plunky }
245 1.2 plunky } else {
246 1.2 plunky if (daemon(0, 0) < 0)
247 1.2 plunky err(EXIT_FAILURE, "daemon() failed");
248 1.1 gdamore }
249 1.1 gdamore
250 1.2 plunky /* catch signals */
251 1.2 plunky done = 0;
252 1.2 plunky (void)signal(SIGHUP, sighandler);
253 1.2 plunky (void)signal(SIGINT, sighandler);
254 1.2 plunky (void)signal(SIGPIPE, sighandler);
255 1.2 plunky (void)signal(SIGTERM, sighandler);
256 1.2 plunky
257 1.2 plunky openlog(getprogname(), LOG_PERROR | LOG_PID, LOG_DAEMON);
258 1.2 plunky syslog(LOG_INFO, "Starting on %s...", (tty ? tty : "stdio"));
259 1.2 plunky
260 1.11 plunky n = MAX(tty_in, rfcomm) + 1;
261 1.2 plunky while (!done) {
262 1.2 plunky FD_ZERO(&rdset);
263 1.2 plunky FD_SET(tty_in, &rdset);
264 1.2 plunky FD_SET(rfcomm, &rdset);
265 1.1 gdamore
266 1.2 plunky if (select(n, &rdset, NULL, NULL, NULL) < 0) {
267 1.1 gdamore if (errno == EINTR)
268 1.1 gdamore continue;
269 1.1 gdamore
270 1.2 plunky syslog(LOG_ERR, "select error: %m");
271 1.1 gdamore exit(EXIT_FAILURE);
272 1.1 gdamore }
273 1.1 gdamore
274 1.2 plunky if (FD_ISSET(tty_in, &rdset))
275 1.2 plunky copy_data(tty_in, rfcomm);
276 1.1 gdamore
277 1.2 plunky if (FD_ISSET(rfcomm, &rdset))
278 1.2 plunky copy_data(rfcomm, tty_out);
279 1.2 plunky }
280 1.1 gdamore
281 1.2 plunky syslog(LOG_INFO, "Completed on %s", (tty ? tty : "stdio"));
282 1.2 plunky exit(EXIT_SUCCESS);
283 1.2 plunky }
284 1.1 gdamore
285 1.2 plunky int
286 1.2 plunky open_tty(const char *tty)
287 1.1 gdamore {
288 1.1 gdamore char pty[PATH_MAX], *slash;
289 1.1 gdamore struct group *gr = NULL;
290 1.1 gdamore gid_t ttygid;
291 1.2 plunky int master;
292 1.1 gdamore
293 1.1 gdamore /*
294 1.1 gdamore * Construct master PTY name. The slave tty name must be less then
295 1.1 gdamore * PATH_MAX characters in length, must contain '/' character and
296 1.1 gdamore * must not end with '/'.
297 1.1 gdamore */
298 1.2 plunky if (strlen(tty) >= sizeof(pty))
299 1.2 plunky errx(EXIT_FAILURE, ": tty name too long");
300 1.1 gdamore
301 1.1 gdamore strlcpy(pty, tty, sizeof(pty));
302 1.1 gdamore slash = strrchr(pty, '/');
303 1.2 plunky if (slash == NULL || slash[1] == '\0')
304 1.2 plunky errx(EXIT_FAILURE, "%s: invalid tty", tty);
305 1.1 gdamore
306 1.1 gdamore slash[1] = 'p';
307 1.2 plunky if (strcmp(pty, tty) == 0)
308 1.2 plunky errx(EXIT_FAILURE, "Master and slave tty are the same (%s)", tty);
309 1.1 gdamore
310 1.2 plunky if ((master = open(pty, O_RDWR, 0)) < 0)
311 1.2 plunky err(EXIT_FAILURE, "%s", pty);
312 1.1 gdamore
313 1.1 gdamore /*
314 1.1 gdamore * Slave TTY
315 1.1 gdamore */
316 1.1 gdamore
317 1.1 gdamore if ((gr = getgrnam("tty")) != NULL)
318 1.1 gdamore ttygid = gr->gr_gid;
319 1.1 gdamore else
320 1.1 gdamore ttygid = (gid_t)-1;
321 1.1 gdamore
322 1.2 plunky (void)chown(tty, getuid(), ttygid);
323 1.2 plunky (void)chmod(tty, S_IRUSR | S_IWUSR | S_IWGRP);
324 1.2 plunky (void)revoke(tty);
325 1.2 plunky
326 1.2 plunky return master;
327 1.2 plunky }
328 1.1 gdamore
329 1.2 plunky int
330 1.12 plunky open_client(bdaddr_t *laddr, bdaddr_t *raddr, int lm, uintmax_t psm, const char *service)
331 1.2 plunky {
332 1.2 plunky struct sockaddr_bt sa;
333 1.3 plunky struct service *s;
334 1.2 plunky struct linger l;
335 1.3 plunky char *ep;
336 1.10 plunky int fd, error;
337 1.10 plunky uintmax_t channel;
338 1.3 plunky
339 1.3 plunky for (s = services ; ; s++) {
340 1.3 plunky if (s->name == NULL) {
341 1.5 plunky channel = strtoul(service, &ep, 10);
342 1.10 plunky if (*ep != '\0')
343 1.10 plunky errx(EXIT_FAILURE, "Unknown service: %s", service);
344 1.3 plunky
345 1.3 plunky break;
346 1.3 plunky }
347 1.3 plunky
348 1.3 plunky if (strcasecmp(s->name, service) == 0) {
349 1.12 plunky error = service_search(laddr, raddr, s->class, &psm, &channel);
350 1.10 plunky if (error != 0)
351 1.10 plunky errx(EXIT_FAILURE, "%s: %s", s->name, strerror(error));
352 1.3 plunky
353 1.3 plunky break;
354 1.3 plunky }
355 1.3 plunky }
356 1.1 gdamore
357 1.10 plunky if (channel < RFCOMM_CHANNEL_MIN || channel > RFCOMM_CHANNEL_MAX)
358 1.10 plunky errx(EXIT_FAILURE, "Invalid channel %"PRIuMAX, channel);
359 1.10 plunky
360 1.12 plunky if (L2CAP_PSM_INVALID(psm))
361 1.12 plunky errx(EXIT_FAILURE, "Invalid PSM 0x%04"PRIxMAX, psm);
362 1.12 plunky
363 1.2 plunky memset(&sa, 0, sizeof(sa));
364 1.2 plunky sa.bt_len = sizeof(sa);
365 1.2 plunky sa.bt_family = AF_BLUETOOTH;
366 1.2 plunky bdaddr_copy(&sa.bt_bdaddr, laddr);
367 1.2 plunky
368 1.2 plunky fd = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
369 1.2 plunky if (fd < 0)
370 1.2 plunky err(EXIT_FAILURE, "socket()");
371 1.2 plunky
372 1.2 plunky if (bind(fd, (struct sockaddr *)&sa, sizeof(sa)) < 0)
373 1.2 plunky err(EXIT_FAILURE, "bind(%s)", bt_ntoa(laddr, NULL));
374 1.2 plunky
375 1.2 plunky memset(&l, 0, sizeof(l));
376 1.2 plunky l.l_onoff = 1;
377 1.2 plunky l.l_linger = 5;
378 1.2 plunky if (setsockopt(fd, SOL_SOCKET, SO_LINGER, &l, sizeof(l)) < 0)
379 1.2 plunky err(EXIT_FAILURE, "linger()");
380 1.2 plunky
381 1.7 plunky if (setsockopt(fd, BTPROTO_RFCOMM, SO_RFCOMM_LM, &lm, sizeof(lm)) < 0)
382 1.7 plunky err(EXIT_FAILURE, "link mode");
383 1.7 plunky
384 1.12 plunky sa.bt_psm = psm;
385 1.2 plunky sa.bt_channel = channel;
386 1.2 plunky bdaddr_copy(&sa.bt_bdaddr, raddr);
387 1.2 plunky
388 1.2 plunky if (connect(fd, (struct sockaddr *)&sa, sizeof(sa)) < 0)
389 1.12 plunky err(EXIT_FAILURE, "connect(%s, 0x%04"PRIxMAX", %"PRIuMAX")",
390 1.12 plunky bt_ntoa(raddr, NULL), psm, channel);
391 1.1 gdamore
392 1.2 plunky return fd;
393 1.2 plunky }
394 1.1 gdamore
395 1.2 plunky int
396 1.12 plunky open_server(bdaddr_t *laddr, uint16_t psm, uint8_t channel, int lm, const char *service)
397 1.1 gdamore {
398 1.10 plunky uint8_t buffer[256];
399 1.2 plunky struct sockaddr_bt sa;
400 1.10 plunky struct service *s;
401 1.2 plunky struct linger l;
402 1.2 plunky socklen_t len;
403 1.10 plunky sdp_session_t ss;
404 1.10 plunky sdp_data_t rec;
405 1.10 plunky int sv, fd;
406 1.10 plunky
407 1.10 plunky for (s = services; ; s++) {
408 1.10 plunky if (s->name == NULL)
409 1.10 plunky usage();
410 1.1 gdamore
411 1.10 plunky if (strcasecmp(s->name, service) == 0)
412 1.10 plunky break;
413 1.10 plunky }
414 1.2 plunky
415 1.10 plunky /* Open server socket */
416 1.2 plunky sv = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
417 1.2 plunky if (sv < 0)
418 1.2 plunky err(EXIT_FAILURE, "socket()");
419 1.2 plunky
420 1.10 plunky memset(&sa, 0, sizeof(sa));
421 1.10 plunky sa.bt_len = sizeof(sa);
422 1.10 plunky sa.bt_family = AF_BLUETOOTH;
423 1.12 plunky sa.bt_psm = psm;
424 1.10 plunky sa.bt_channel = channel;
425 1.10 plunky bdaddr_copy(&sa.bt_bdaddr, laddr);
426 1.2 plunky if (bind(sv, (struct sockaddr *)&sa, sizeof(sa)) < 0)
427 1.12 plunky err(EXIT_FAILURE, "bind(%s, 0x%04x, %d)",
428 1.12 plunky bt_ntoa(laddr, NULL), psm, channel);
429 1.2 plunky
430 1.7 plunky if (setsockopt(sv, BTPROTO_RFCOMM, SO_RFCOMM_LM, &lm, sizeof(lm)) < 0)
431 1.7 plunky err(EXIT_FAILURE, "link mode");
432 1.7 plunky
433 1.2 plunky if (listen(sv, 1) < 0)
434 1.2 plunky err(EXIT_FAILURE, "listen()");
435 1.2 plunky
436 1.10 plunky /* Build SDP record */
437 1.10 plunky rec.next = buffer;
438 1.10 plunky rec.end = buffer + sizeof(buffer);
439 1.10 plunky
440 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_SERVICE_RECORD_HANDLE);
441 1.10 plunky sdp_put_uint32(&rec, 0x00000000);
442 1.10 plunky
443 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_SERVICE_CLASS_ID_LIST);
444 1.10 plunky sdp_put_seq(&rec, 3);
445 1.10 plunky sdp_put_uuid16(&rec, s->class);
446 1.10 plunky
447 1.12 plunky len = (psm == L2CAP_PSM_RFCOMM ? 0 : 3);
448 1.12 plunky
449 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST);
450 1.12 plunky sdp_put_seq(&rec, 12 + len);
451 1.12 plunky sdp_put_seq(&rec, 3 + len);
452 1.10 plunky sdp_put_uuid16(&rec, SDP_UUID_PROTOCOL_L2CAP);
453 1.12 plunky if (len > 0)
454 1.12 plunky sdp_put_uint16(&rec, psm);
455 1.10 plunky sdp_put_seq(&rec, 5);
456 1.10 plunky sdp_put_uuid16(&rec, SDP_UUID_PROTOCOL_RFCOMM);
457 1.10 plunky sdp_put_uint8(&rec, channel);
458 1.10 plunky
459 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_BROWSE_GROUP_LIST);
460 1.10 plunky sdp_put_seq(&rec, 3);
461 1.10 plunky sdp_put_uuid16(&rec, SDP_SERVICE_CLASS_PUBLIC_BROWSE_GROUP);
462 1.10 plunky
463 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_LANGUAGE_BASE_ATTRIBUTE_ID_LIST);
464 1.10 plunky sdp_put_seq(&rec, 9);
465 1.10 plunky sdp_put_uint16(&rec, 0x656e); /* "en" */
466 1.10 plunky sdp_put_uint16(&rec, 106); /* UTF-8 */
467 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID);
468 1.10 plunky
469 1.10 plunky if (s->class == SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP) {
470 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_SERVICE_AVAILABILITY);
471 1.10 plunky sdp_put_uint8(&rec, 0x00);
472 1.10 plunky }
473 1.10 plunky
474 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_BLUETOOTH_PROFILE_DESCRIPTOR_LIST);
475 1.10 plunky sdp_put_seq(&rec, 8);
476 1.10 plunky sdp_put_seq(&rec, 6);
477 1.10 plunky sdp_put_uuid16(&rec, s->class);
478 1.10 plunky sdp_put_uint16(&rec, 0x0100); /* v1.0 */
479 1.10 plunky
480 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_PRIMARY_LANGUAGE_BASE_ID
481 1.10 plunky + SDP_ATTR_SERVICE_NAME_OFFSET);
482 1.10 plunky sdp_put_str(&rec, s->description, -1);
483 1.10 plunky
484 1.10 plunky if (s->class == SDP_SERVICE_CLASS_DIALUP_NETWORKING) {
485 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_AUDIO_FEEDBACK_SUPPORT);
486 1.10 plunky sdp_put_bool(&rec, false);
487 1.10 plunky }
488 1.1 gdamore
489 1.10 plunky #if 0
490 1.10 plunky if (s->class == SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP) {
491 1.10 plunky sdp_put_uint16(&rec, SDP_ATTR_IP_SUBNET); /* TODO */
492 1.10 plunky sdp_put_str(&rec, "0.0.0.0/0", -1);
493 1.1 gdamore }
494 1.10 plunky #endif
495 1.1 gdamore
496 1.10 plunky rec.end = rec.next;
497 1.10 plunky rec.next = buffer;
498 1.2 plunky
499 1.10 plunky /* Register service with SDP server */
500 1.2 plunky ss = sdp_open_local(NULL);
501 1.10 plunky if (ss == NULL)
502 1.2 plunky err(EXIT_FAILURE, "sdp_open_local");
503 1.2 plunky
504 1.10 plunky if (!sdp_record_insert(ss, laddr, NULL, &rec))
505 1.10 plunky err(EXIT_FAILURE, "sdp_record_insert");
506 1.2 plunky
507 1.10 plunky /* Accept client connection */
508 1.2 plunky len = sizeof(sa);
509 1.2 plunky fd = accept(sv, (struct sockaddr *)&sa, &len);
510 1.2 plunky if (fd < 0)
511 1.2 plunky err(EXIT_FAILURE, "accept");
512 1.2 plunky
513 1.2 plunky memset(&l, 0, sizeof(l));
514 1.2 plunky l.l_onoff = 1;
515 1.2 plunky l.l_linger = 5;
516 1.2 plunky if (setsockopt(fd, SOL_SOCKET, SO_LINGER, &l, sizeof(l)) < 0)
517 1.2 plunky err(EXIT_FAILURE, "linger()");
518 1.2 plunky
519 1.2 plunky close(sv);
520 1.2 plunky return fd;
521 1.2 plunky }
522 1.1 gdamore
523 1.2 plunky void
524 1.2 plunky copy_data(int src, int dst)
525 1.1 gdamore {
526 1.2 plunky static char buf[BUFSIZ];
527 1.2 plunky ssize_t nr, nw, off;
528 1.1 gdamore
529 1.2 plunky while ((nr = read(src, buf, sizeof(buf))) == -1) {
530 1.2 plunky if (errno != EINTR) {
531 1.2 plunky syslog(LOG_ERR, "read failed: %m");
532 1.2 plunky exit(EXIT_FAILURE);
533 1.2 plunky }
534 1.2 plunky }
535 1.1 gdamore
536 1.3 plunky if (nr == 0) /* reached EOF */
537 1.3 plunky done++;
538 1.3 plunky
539 1.2 plunky for (off = 0 ; nr ; nr -= nw, off += nw) {
540 1.2 plunky if ((nw = write(dst, buf + off, (size_t)nr)) == -1) {
541 1.2 plunky syslog(LOG_ERR, "write failed: %m");
542 1.2 plunky exit(EXIT_FAILURE);
543 1.1 gdamore }
544 1.1 gdamore }
545 1.2 plunky }
546 1.1 gdamore
547 1.10 plunky int
548 1.12 plunky service_search(bdaddr_t const *laddr, bdaddr_t const *raddr,
549 1.12 plunky uint16_t class, uintmax_t *psm, uintmax_t *channel)
550 1.10 plunky {
551 1.10 plunky uint8_t buffer[6]; /* SSP (3 bytes) + AIL (3 bytes) */
552 1.10 plunky sdp_session_t ss;
553 1.10 plunky sdp_data_t ail, ssp, rsp, rec, value, pdl, seq;
554 1.10 plunky uint16_t attr;
555 1.10 plunky bool rv;
556 1.10 plunky
557 1.10 plunky seq.next = buffer;
558 1.10 plunky seq.end = buffer + sizeof(buffer);
559 1.10 plunky
560 1.10 plunky /*
561 1.10 plunky * build ServiceSearchPattern (3 bytes)
562 1.10 plunky */
563 1.10 plunky ssp.next = seq.next;
564 1.10 plunky sdp_put_uuid16(&seq, class);
565 1.10 plunky ssp.end = seq.next;
566 1.10 plunky
567 1.10 plunky /*
568 1.10 plunky * build AttributeIDList (3 bytes)
569 1.10 plunky */
570 1.10 plunky ail.next = seq.next;
571 1.10 plunky sdp_put_uint16(&seq, SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST);
572 1.10 plunky ail.end = seq.next;
573 1.10 plunky
574 1.10 plunky ss = sdp_open(laddr, raddr);
575 1.10 plunky if (ss == NULL)
576 1.10 plunky return errno;
577 1.10 plunky
578 1.10 plunky rv = sdp_service_search_attribute(ss, &ssp, &ail, &rsp);
579 1.10 plunky if (!rv) {
580 1.10 plunky sdp_close(ss);
581 1.10 plunky return errno;
582 1.10 plunky }
583 1.10 plunky
584 1.10 plunky /*
585 1.10 plunky * The response will be a list of records that matched our
586 1.10 plunky * ServiceSearchPattern, where each record is a sequence
587 1.10 plunky * containing a single ProtocolDescriptorList attribute and
588 1.10 plunky * value
589 1.10 plunky *
590 1.10 plunky * seq
591 1.10 plunky * uint16 ProtocolDescriptorList
592 1.10 plunky * value
593 1.10 plunky * seq
594 1.10 plunky * uint16 ProtocolDescriptorList
595 1.10 plunky * value
596 1.10 plunky *
597 1.10 plunky * If the ProtocolDescriptorList describes a single stack,
598 1.10 plunky * the attribute value takes the form of a single Data Element
599 1.10 plunky * Sequence where each member is a protocol descriptor.
600 1.10 plunky *
601 1.10 plunky * seq
602 1.10 plunky * list
603 1.10 plunky *
604 1.10 plunky * If it is possible for more than one kind of protocol
605 1.10 plunky * stack to be used to gain access to the service, the
606 1.10 plunky * ProtocolDescriptorList takes the form of a Data Element
607 1.10 plunky * Alternative where each member is a Data Element Sequence
608 1.10 plunky * describing an alternative protocol stack.
609 1.10 plunky *
610 1.10 plunky * alt
611 1.10 plunky * seq
612 1.10 plunky * list
613 1.10 plunky * seq
614 1.10 plunky * list
615 1.10 plunky *
616 1.10 plunky * Each protocol stack description contains a sequence for each
617 1.10 plunky * protocol, where each sequence contains the protocol UUID as
618 1.10 plunky * the first element, and any ProtocolSpecificParameters. We are
619 1.12 plunky * interested in the L2CAP psm if provided, and the RFCOMM channel
620 1.12 plunky * number, stored as parameter#1 in each case.
621 1.10 plunky *
622 1.10 plunky * seq
623 1.10 plunky * uuid L2CAP
624 1.10 plunky * uint16 psm
625 1.10 plunky * seq
626 1.10 plunky * uuid RFCOMM
627 1.10 plunky * uint8 channel
628 1.10 plunky */
629 1.10 plunky
630 1.10 plunky rv = false;
631 1.10 plunky while (!rv && sdp_get_seq(&rsp, &rec)) {
632 1.10 plunky if (!sdp_get_attr(&rec, &attr, &value)
633 1.10 plunky || attr != SDP_ATTR_PROTOCOL_DESCRIPTOR_LIST)
634 1.10 plunky continue;
635 1.10 plunky
636 1.10 plunky sdp_get_alt(&value, &value); /* strip any alt container */
637 1.10 plunky while (!rv && sdp_get_seq(&value, &pdl)) {
638 1.12 plunky *psm = L2CAP_PSM_RFCOMM;
639 1.10 plunky if (sdp_get_seq(&pdl, &seq)
640 1.10 plunky && sdp_match_uuid16(&seq, SDP_UUID_PROTOCOL_L2CAP)
641 1.12 plunky && (sdp_get_uint(&seq, psm) || true)
642 1.10 plunky && sdp_get_seq(&pdl, &seq)
643 1.10 plunky && sdp_match_uuid16(&seq, SDP_UUID_PROTOCOL_RFCOMM)
644 1.10 plunky && sdp_get_uint(&seq, channel))
645 1.10 plunky rv = true;
646 1.10 plunky }
647 1.10 plunky }
648 1.10 plunky
649 1.10 plunky sdp_close(ss);
650 1.10 plunky return (rv) ? 0 : ENOATTR;
651 1.10 plunky }
652 1.10 plunky
653 1.2 plunky void
654 1.2 plunky sighandler(int s)
655 1.2 plunky {
656 1.1 gdamore
657 1.2 plunky done++;
658 1.2 plunky }
659 1.2 plunky
660 1.2 plunky void
661 1.2 plunky reset_tio(void)
662 1.1 gdamore {
663 1.1 gdamore
664 1.2 plunky tcsetattr(STDIN_FILENO, TCSAFLUSH, &tio);
665 1.2 plunky }
666 1.2 plunky
667 1.2 plunky void
668 1.1 gdamore usage(void)
669 1.1 gdamore {
670 1.7 plunky const char *cmd = getprogname();
671 1.2 plunky struct service *s;
672 1.2 plunky
673 1.12 plunky fprintf(stderr, "Usage: %s [-d device] [-m mode] [-p psm] [-s service] [-t tty]\n"
674 1.7 plunky " %*s {-a bdaddr | -c channel}\n"
675 1.2 plunky "\n"
676 1.2 plunky "Where:\n"
677 1.2 plunky "\t-a bdaddr remote device address\n"
678 1.3 plunky "\t-c channel local RFCOMM channel\n"
679 1.2 plunky "\t-d device local device address\n"
680 1.7 plunky "\t-m mode link mode\n"
681 1.12 plunky "\t-p psm protocol/service multiplexer\n"
682 1.3 plunky "\t-s service service class\n"
683 1.2 plunky "\t-t tty run in background using pty\n"
684 1.8 dsl "\n", cmd, (int)strlen(cmd), "");
685 1.2 plunky
686 1.3 plunky fprintf(stderr, "Known service classes:\n");
687 1.2 plunky for (s = services ; s->name != NULL ; s++)
688 1.3 plunky fprintf(stderr, "\t%-13s%s\n", s->name, s->description);
689 1.1 gdamore
690 1.1 gdamore exit(EXIT_FAILURE);
691 1.2 plunky }
692