btpand.c revision 299826 
1/*	$NetBSD: btpand.c,v 1.1 2008/08/17 13:20:57 plunky Exp $	*/
2
3/*-
4 * Copyright (c) 2008 Iain Hibbert
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 *    notice, this list of conditions and the following disclaimer in the
14 *    documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 */
27
28/* $FreeBSD: stable/10/usr.sbin/bluetooth/btpand/btpand.c 299826 2016-05-15 03:15:36Z pfg $ */
29
30#include <sys/cdefs.h>
31__COPYRIGHT("@(#) Copyright (c) 2008 Iain Hibbert. All rights reserved.");
32__RCSID("$NetBSD: btpand.c,v 1.1 2008/08/17 13:20:57 plunky Exp $");
33
34#include <sys/wait.h>
35
36#include <bluetooth.h>
37#include <err.h>
38#include <fcntl.h>
39#include <paths.h>
40#include <sdp.h>
41#include <stdio.h>
42#include <signal.h>
43#include <stdlib.h>
44#include <string.h>
45#include <unistd.h>
46
47#include "btpand.h"
48
49/* global variables */
50const char *	control_path;		/* -c <path> */
51const char *	interface_name;		/* -i <ifname> */
52const char *	service_name;		/* -s <service> */
53uint16_t	service_class;
54
55bdaddr_t	local_bdaddr;		/* -d <addr> */
56bdaddr_t	remote_bdaddr;		/* -a <addr> */
57uint16_t	l2cap_psm;		/* -p <psm> */
58int		l2cap_mode;		/* -m <mode> */
59
60int		server_limit;		/* -n <limit> */
61
62static const struct {
63	const char *	name;
64	uint16_t	class;
65	const char *	desc;
66} services[] = {
67	{ "PANU", SDP_SERVICE_CLASS_PANU, "Personal Area Networking User" },
68	{ "NAP",  SDP_SERVICE_CLASS_NAP,  "Network Access Point"		  },
69	{ "GN",	  SDP_SERVICE_CLASS_GN,   "Group Network"		  },
70};
71
72static void main_exit(int);
73static void main_detach(void);
74static void usage(void);
75
76int
77main(int argc, char *argv[])
78{
79	unsigned long	ul;
80	char *		ep;
81	int		ch, status;
82
83	while ((ch = getopt(argc, argv, "a:c:d:i:l:m:p:S:s:")) != -1) {
84		switch (ch) {
85		case 'a': /* remote address */
86			if (!bt_aton(optarg, &remote_bdaddr)) {
87				struct hostent  *he;
88
89				if ((he = bt_gethostbyname(optarg)) == NULL)
90					errx(EXIT_FAILURE, "%s: %s",
91					    optarg, hstrerror(h_errno));
92
93				bdaddr_copy(&remote_bdaddr,
94					(bdaddr_t *)he->h_addr);
95			}
96
97			break;
98
99		case 'c': /* control socket path */
100			control_path = optarg;
101			break;
102
103		case 'd': /* local address */
104			if (!bt_devaddr(optarg, &local_bdaddr)) {
105				struct hostent  *he;
106
107				if ((he = bt_gethostbyname(optarg)) == NULL)
108					errx(EXIT_FAILURE, "%s: %s",
109					    optarg, hstrerror(h_errno));
110
111				bdaddr_copy(&local_bdaddr,
112					(bdaddr_t *)he->h_addr);
113			}
114			break;
115
116		case 'i': /* tap interface name */
117			if (strchr(optarg, '/') == NULL) {
118				asprintf(&ep, "/dev/%s", optarg);
119				interface_name = ep;
120			} else
121				interface_name = optarg;
122			break;
123
124		case 'l': /* limit server sessions */
125			ul = strtoul(optarg, &ep, 10);
126			if (*optarg == '\0' || *ep != '\0' || ul == 0)
127				errx(EXIT_FAILURE, "%s: invalid session limit",
128					optarg);
129
130			server_limit = ul;
131			break;
132
133		case 'm': /* link mode */
134			warnx("Setting link mode is not yet supported");
135			break;
136
137		case 'p': /* protocol/service multiplexer */
138			ul = strtoul(optarg, &ep, 0);
139			if (*optarg == '\0' || *ep != '\0'
140			    || ul > 0xffff || L2CAP_PSM_INVALID(ul))
141				errx(EXIT_FAILURE, "%s: invalid PSM", optarg);
142
143			l2cap_psm = ul;
144			break;
145
146		case 's': /* service */
147		case 'S': /* service (no SDP) */
148			for (ul = 0; strcasecmp(optarg, services[ul].name); ul++) {
149				if (ul == __arraycount(services))
150					errx(EXIT_FAILURE, "%s: unknown service", optarg);
151			}
152
153			if (ch == 's')
154				service_name = services[ul].name;
155
156			service_class = services[ul].class;
157			break;
158
159		default:
160			usage();
161			/* NOTREACHED */
162		}
163	}
164
165	argc -= optind;
166	argv += optind;
167
168	/* validate options */
169	if (bdaddr_any(&local_bdaddr) || service_class == 0)
170		usage();
171
172	if (!bdaddr_any(&remote_bdaddr) && (server_limit != 0 ||
173	    control_path != 0 || (service_name != NULL && l2cap_psm != 0)))
174		usage();
175
176	/* default options */
177	if (interface_name == NULL)
178		interface_name = "/dev/tap";
179
180	if (l2cap_psm == 0)
181		l2cap_psm = L2CAP_PSM_BNEP;
182
183	if (bdaddr_any(&remote_bdaddr) && server_limit == 0) {
184		if (service_class == SDP_SERVICE_CLASS_PANU)
185			server_limit = 1;
186		else
187			server_limit = 7;
188	}
189
190#ifdef L2CAP_LM_MASTER
191	if (server_limit > 1 && service_class != SDP_SERVICE_CLASS_PANU)
192		l2cap_mode |= L2CAP_LM_MASTER;
193#endif
194
195	/*
196	 * fork() now so that the setup can be done in the child process
197	 * (as kqueue is not inherited) but block in the parent until the
198	 * setup is finished so we can return an error if necessary.
199	 */
200	switch(fork()) {
201	case -1: /* bad */
202		err(EXIT_FAILURE, "fork() failed");
203
204	case 0:	/* child */
205		signal(SIGPIPE, SIG_IGN);
206
207		openlog(getprogname(), LOG_NDELAY | LOG_PERROR | LOG_PID, LOG_DAEMON);
208
209		channel_init();
210		server_init();
211		event_init();
212		client_init();
213		tap_init();
214
215		main_detach();
216
217		event_dispatch();
218		break;
219
220	default: /* parent */
221		signal(SIGUSR1, main_exit);
222		wait(&status);
223
224		if (WIFEXITED(status))
225			exit(WEXITSTATUS(status));
226
227		break;
228	}
229
230	err(EXIT_FAILURE, "exiting");
231}
232
233static void
234main_exit(int s)
235{
236
237	/* child is all grown up */
238	_exit(EXIT_SUCCESS);
239}
240
241static void
242main_detach(void)
243{
244	int fd;
245
246	if (kill(getppid(), SIGUSR1) == -1)
247		log_err("Could not signal main process: %m");
248
249	if (setsid() == -1)
250		log_err("setsid() failed");
251
252	fd = open(_PATH_DEVNULL, O_RDWR, 0);
253	if (fd == -1) {
254		log_err("Could not open %s", _PATH_DEVNULL);
255	} else {
256		(void)dup2(fd, STDIN_FILENO);
257		(void)dup2(fd, STDOUT_FILENO);
258		(void)dup2(fd, STDERR_FILENO);
259		close(fd);
260	}
261}
262
263static void
264usage(void)
265{
266	const char *p = getprogname();
267	int n = strlen(p);
268
269	fprintf(stderr,
270	    "usage: %s [-i ifname] [-m mode] -a address -d device\n"
271	    "       %*s {-s service | -S service [-p psm]}\n"
272	    "       %s [-c path] [-i ifname] [-l limit] [-m mode] [-p psm] -d device\n"
273	    "       %*s {-s service | -S service}\n"
274	    "\n"
275	    "Where:\n"
276	    "\t-a address  remote bluetooth device\n"
277	    "\t-c path     SDP server socket\n"
278	    "\t-d device   local bluetooth device\n"
279	    "\t-i ifname   tap interface\n"
280	    "\t-l limit    limit server sessions\n"
281	    "\t-m mode     L2CAP link mode (NOT YET SUPPORTED)\n"
282	    "\t-p psm      L2CAP PSM\n"
283	    "\t-S service  service name (no SDP)\n"
284	    "\t-s service  service name\n"
285	    "\n"
286	    "Known services:\n"
287	    "", p, n, "", p, n, "");
288
289	for (n = 0; n < __arraycount(services); n++)
290		fprintf(stderr, "\t%s\t%s\n", services[n].name, services[n].desc);
291
292	exit(EXIT_FAILURE);
293}
294