1 /*
2 * rfcomm_sppd.c
3 */
4
5 /*-
6 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
7 *
8 * Copyright (c) 2003 Maksim Yevmenkin <[email protected]>
9 * All rights reserved.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in the
18 * documentation and/or other materials provided with the distribution.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 * SUCH DAMAGE.
31 *
32 * $Id: rfcomm_sppd.c,v 1.4 2003/09/07 18:15:55 max Exp $
33 * $FreeBSD$
34 */
35
36 #include <sys/stat.h>
37 #include <sys/types.h>
38 #define L2CAP_SOCKET_CHECKED
39 #include <bluetooth.h>
40 #include <ctype.h>
41 #include <err.h>
42 #include <errno.h>
43 #include <fcntl.h>
44 #include <grp.h>
45 #include <limits.h>
46 #include <paths.h>
47 #include <sdp.h>
48 #include <signal.h>
49 #include <stdarg.h>
50 #include <stdio.h>
51 #include <stdlib.h>
52 #include <string.h>
53 #include <syslog.h>
54 #include <termios.h>
55 #include <unistd.h>
56 #include <libutil.h>
57
58 #define SPPD_IDENT "rfcomm_sppd"
59 #define SPPD_BUFFER_SIZE 1024
60 #define max(a, b) (((a) > (b))? (a) : (b))
61
62 int rfcomm_channel_lookup (bdaddr_t const *local,
63 bdaddr_t const *remote,
64 int service, int *channel, int *error);
65
66 static int sppd_ttys_open (char **tty, int *amaster, int *aslave);
67 static int sppd_read (int fd, char *buffer, int size);
68 static int sppd_write (int fd, char *buffer, int size);
69 static void sppd_sighandler (int s);
70 static void usage (void);
71
72 static int done; /* are we done? */
73
74 /* Main */
75 int
main(int argc,char * argv[])76 main(int argc, char *argv[])
77 {
78 struct sigaction sa;
79 struct sockaddr_rfcomm ra;
80 bdaddr_t addr;
81 int n, background, channel, service,
82 s, amaster, aslave, fd, doserver,
83 dopty;
84 fd_set rfd;
85 char *tty = NULL, *ep = NULL, buf[SPPD_BUFFER_SIZE];
86
87 memcpy(&addr, NG_HCI_BDADDR_ANY, sizeof(addr));
88 background = channel = 0;
89 service = SDP_SERVICE_CLASS_SERIAL_PORT;
90 doserver = 0;
91 dopty = 0;
92
93 /* Parse command line options */
94 while ((n = getopt(argc, argv, "a:bc:thS")) != -1) {
95 switch (n) {
96 case 'a': /* BDADDR */
97 if (!bt_aton(optarg, &addr)) {
98 struct hostent *he = NULL;
99
100 if ((he = bt_gethostbyname(optarg)) == NULL)
101 errx(1, "%s: %s", optarg, hstrerror(h_errno));
102
103 memcpy(&addr, he->h_addr, sizeof(addr));
104 }
105 break;
106
107 case 'c': /* RFCOMM channel */
108 channel = strtoul(optarg, &ep, 10);
109 if (*ep != '\0') {
110 channel = 0;
111 switch (tolower(optarg[0])) {
112 case 'd': /* DialUp Networking */
113 service = SDP_SERVICE_CLASS_DIALUP_NETWORKING;
114 break;
115
116 case 'f': /* Fax */
117 service = SDP_SERVICE_CLASS_FAX;
118 break;
119
120 case 'l': /* LAN */
121 service = SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP;
122 break;
123
124 case 's': /* Serial Port */
125 service = SDP_SERVICE_CLASS_SERIAL_PORT;
126 break;
127
128 default:
129 errx(1, "Unknown service name: %s",
130 optarg);
131 /* NOT REACHED */
132 }
133 }
134 break;
135
136 case 'b': /* Run in background */
137 background = 1;
138 break;
139
140 case 't': /* Open pseudo TTY */
141 dopty = 1;
142 break;
143
144 case 'S':
145 doserver = 1;
146 break;
147
148 case 'h':
149 default:
150 usage();
151 /* NOT REACHED */
152 }
153 }
154
155 /* Check if we have everything we need */
156 if (!doserver && memcmp(&addr, NG_HCI_BDADDR_ANY, sizeof(addr)) == 0)
157 usage();
158 /* NOT REACHED */
159
160 /* Set signal handlers */
161 memset(&sa, 0, sizeof(sa));
162 sa.sa_handler = sppd_sighandler;
163
164 if (sigaction(SIGTERM, &sa, NULL) < 0)
165 err(1, "Could not sigaction(SIGTERM)");
166
167 if (sigaction(SIGHUP, &sa, NULL) < 0)
168 err(1, "Could not sigaction(SIGHUP)");
169
170 if (sigaction(SIGINT, &sa, NULL) < 0)
171 err(1, "Could not sigaction(SIGINT)");
172
173 sa.sa_handler = SIG_IGN;
174 sa.sa_flags = SA_NOCLDWAIT;
175
176 if (sigaction(SIGCHLD, &sa, NULL) < 0)
177 err(1, "Could not sigaction(SIGCHLD)");
178
179 /* Open TTYs */
180 if (dopty) {
181 if (sppd_ttys_open(&tty, &amaster, &aslave) < 0)
182 exit(1);
183
184 fd = amaster;
185 } else {
186 if (background)
187 usage();
188
189 amaster = STDIN_FILENO;
190 fd = STDOUT_FILENO;
191 }
192
193 /* Open RFCOMM connection */
194
195 if (doserver) {
196 struct sockaddr_rfcomm ma;
197 bdaddr_t bt_addr_any;
198 sdp_sp_profile_t sp;
199 void *ss;
200 uint32_t sdp_handle;
201 int acceptsock, aaddrlen;
202
203 acceptsock = socket(PF_BLUETOOTH, SOCK_STREAM,
204 BLUETOOTH_PROTO_RFCOMM);
205 if (acceptsock < 0)
206 err(1, "Could not create socket");
207
208 memcpy(&bt_addr_any, NG_HCI_BDADDR_ANY, sizeof(bt_addr_any));
209
210 memset(&ma, 0, sizeof(ma));
211 ma.rfcomm_len = sizeof(ma);
212 ma.rfcomm_family = AF_BLUETOOTH;
213 memcpy(&ma.rfcomm_bdaddr, &bt_addr_any, sizeof(bt_addr_any));
214 ma.rfcomm_channel = channel;
215
216 if (bind(acceptsock, (struct sockaddr *)&ma, sizeof(ma)) < 0)
217 err(1, "Could not bind socket on channel %d", channel);
218 if (listen(acceptsock, 10) != 0)
219 err(1, "Could not listen on socket");
220
221 aaddrlen = sizeof(ma);
222 if (getsockname(acceptsock, (struct sockaddr *)&ma, &aaddrlen) < 0)
223 err(1, "Could not get socket name");
224 channel = ma.rfcomm_channel;
225
226 ss = sdp_open_local(NULL);
227 if (ss == NULL)
228 errx(1, "Unable to create local SDP session");
229 if (sdp_error(ss) != 0)
230 errx(1, "Unable to open local SDP session. %s (%d)",
231 strerror(sdp_error(ss)), sdp_error(ss));
232 memset(&sp, 0, sizeof(sp));
233 sp.server_channel = channel;
234
235 if (sdp_register_service(ss, SDP_SERVICE_CLASS_SERIAL_PORT,
236 &bt_addr_any, (void *)&sp, sizeof(sp),
237 &sdp_handle) != 0) {
238 errx(1, "Unable to register LAN service with "
239 "local SDP daemon. %s (%d)",
240 strerror(sdp_error(ss)), sdp_error(ss));
241 }
242
243 s = -1;
244 while (s < 0) {
245 aaddrlen = sizeof(ra);
246 s = accept(acceptsock, (struct sockaddr *)&ra,
247 &aaddrlen);
248 if (s < 0)
249 err(1, "Unable to accept()");
250 if (memcmp(&addr, NG_HCI_BDADDR_ANY, sizeof(addr)) &&
251 memcmp(&addr, &ra.rfcomm_bdaddr, sizeof(addr))) {
252 warnx("Connect from wrong client");
253 close(s);
254 s = -1;
255 }
256 }
257 sdp_unregister_service(ss, sdp_handle);
258 sdp_close(ss);
259 close(acceptsock);
260 } else {
261 /* Check channel, if was not set then obtain it via SDP */
262 if (channel == 0 && service != 0)
263 if (rfcomm_channel_lookup(NULL, &addr,
264 service, &channel, &n) != 0)
265 errc(1, n, "Could not obtain RFCOMM channel");
266 if (channel <= 0 || channel > 30)
267 errx(1, "Invalid RFCOMM channel number %d", channel);
268
269 s = socket(PF_BLUETOOTH, SOCK_STREAM, BLUETOOTH_PROTO_RFCOMM);
270 if (s < 0)
271 err(1, "Could not create socket");
272
273 memset(&ra, 0, sizeof(ra));
274 ra.rfcomm_len = sizeof(ra);
275 ra.rfcomm_family = AF_BLUETOOTH;
276
277 if (bind(s, (struct sockaddr *) &ra, sizeof(ra)) < 0)
278 err(1, "Could not bind socket");
279
280 memcpy(&ra.rfcomm_bdaddr, &addr, sizeof(ra.rfcomm_bdaddr));
281 ra.rfcomm_channel = channel;
282
283 if (connect(s, (struct sockaddr *) &ra, sizeof(ra)) < 0)
284 err(1, "Could not connect socket");
285 }
286
287 /* Became daemon if required */
288 if (background && daemon(0, 0) < 0)
289 err(1, "Could not daemon()");
290
291 openlog(SPPD_IDENT, LOG_NDELAY|LOG_PERROR|LOG_PID, LOG_DAEMON);
292 syslog(LOG_INFO, "Starting on %s...", (tty != NULL)? tty : "stdin/stdout");
293
294 /* Print used tty on stdout for wrappers to pick up */
295 if (!background)
296 fprintf(stdout, "%s\n", tty);
297
298 for (done = 0; !done; ) {
299 FD_ZERO(&rfd);
300 FD_SET(amaster, &rfd);
301 FD_SET(s, &rfd);
302
303 n = select(max(amaster, s) + 1, &rfd, NULL, NULL, NULL);
304 if (n < 0) {
305 if (errno == EINTR)
306 continue;
307
308 syslog(LOG_ERR, "Could not select(). %s",
309 strerror(errno));
310 exit(1);
311 }
312
313 if (n == 0)
314 continue;
315
316 if (FD_ISSET(amaster, &rfd)) {
317 n = sppd_read(amaster, buf, sizeof(buf));
318 if (n < 0) {
319 syslog(LOG_ERR, "Could not read master pty, " \
320 "fd=%d. %s", amaster, strerror(errno));
321 exit(1);
322 }
323
324 if (n == 0)
325 break; /* XXX */
326
327 if (sppd_write(s, buf, n) < 0) {
328 syslog(LOG_ERR, "Could not write to socket, " \
329 "fd=%d, size=%d. %s",
330 s, n, strerror(errno));
331 exit(1);
332 }
333 }
334
335 if (FD_ISSET(s, &rfd)) {
336 n = sppd_read(s, buf, sizeof(buf));
337 if (n < 0) {
338 syslog(LOG_ERR, "Could not read socket, " \
339 "fd=%d. %s", s, strerror(errno));
340 exit(1);
341 }
342
343 if (n == 0)
344 break;
345
346 if (sppd_write(fd, buf, n) < 0) {
347 syslog(LOG_ERR, "Could not write to master " \
348 "pty, fd=%d, size=%d. %s",
349 fd, n, strerror(errno));
350 exit(1);
351 }
352 }
353 }
354
355 syslog(LOG_INFO, "Completed on %s", (tty != NULL)? tty : "stdin/stdout");
356 closelog();
357
358 close(s);
359
360 if (tty != NULL) {
361 close(aslave);
362 close(amaster);
363 }
364
365 return (0);
366 }
367
368 /* Open TTYs */
369 static int
sppd_ttys_open(char ** tty,int * amaster,int * aslave)370 sppd_ttys_open(char **tty, int *amaster, int *aslave)
371 {
372 char pty[PATH_MAX];
373 struct termios tio;
374
375 cfmakeraw(&tio);
376
377 if (openpty(amaster, aslave, pty, &tio, NULL) == -1) {
378 syslog(LOG_ERR, "Could not openpty(). %s", strerror(errno));
379 return (-1);
380 }
381
382 if ((*tty = strdup(pty)) == NULL) {
383 syslog(LOG_ERR, "Could not strdup(). %s", strerror(errno));
384 close(*aslave);
385 close(*amaster);
386 return (-1);
387 }
388
389 return (0);
390 } /* sppd_ttys_open */
391
392 /* Read data */
393 static int
sppd_read(int fd,char * buffer,int size)394 sppd_read(int fd, char *buffer, int size)
395 {
396 int n;
397
398 again:
399 n = read(fd, buffer, size);
400 if (n < 0) {
401 if (errno == EINTR)
402 goto again;
403
404 return (-1);
405 }
406
407 return (n);
408 } /* sppd_read */
409
410 /* Write data */
411 static int
sppd_write(int fd,char * buffer,int size)412 sppd_write(int fd, char *buffer, int size)
413 {
414 int n, wrote;
415
416 for (wrote = 0; size > 0; ) {
417 n = write(fd, buffer, size);
418 switch (n) {
419 case -1:
420 if (errno != EINTR)
421 return (-1);
422 break;
423
424 case 0:
425 /* XXX can happen? */
426 break;
427
428 default:
429 wrote += n;
430 buffer += n;
431 size -= n;
432 break;
433 }
434 }
435
436 return (wrote);
437 } /* sppd_write */
438
439 /* Signal handler */
440 static void
sppd_sighandler(int s)441 sppd_sighandler(int s)
442 {
443 syslog(LOG_INFO, "Signal %d received. Total %d signals received\n",
444 s, ++ done);
445 } /* sppd_sighandler */
446
447 /* Display usage and exit */
448 static void
usage(void)449 usage(void)
450 {
451 fprintf(stdout,
452 "Usage: %s options\n" \
453 "Where options are:\n" \
454 "\t-a address Peer address (required in client mode)\n" \
455 "\t-b Run in background\n" \
456 "\t-c channel RFCOMM channel to connect to or listen on\n" \
457 "\t-t use slave pseudo tty (required in background mode)\n" \
458 "\t-S Server mode\n" \
459 "\t-h Display this message\n", SPPD_IDENT);
460 exit(255);
461 } /* usage */
462
463