1/*
2 * rfcomm_sppd.c
3 */
4
5/*-
6 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
7 *
8 * Copyright (c) 2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
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
62int		rfcomm_channel_lookup	(bdaddr_t const *local,
63					 bdaddr_t const *remote,
64					 int service, int *channel, int *error);
65
66static int	sppd_ttys_open	(char **tty, int *amaster, int *aslave);
67static int	sppd_read	(int fd, char *buffer, int size);
68static int	sppd_write	(int fd, char *buffer, int size);
69static void	sppd_sighandler	(int s);
70static void	usage		(void);
71
72static int	done;	/* are we done? */
73
74/* Main */
75int
76main(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 */
369static int
370sppd_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 */
393static int
394sppd_read(int fd, char *buffer, int size)
395{
396	int	n;
397
398again:
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 */
411static int
412sppd_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 */
440static void
441sppd_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 */
448static void
449usage(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