Home | History | Annotate | Line # | Download | only in rfcomm_sppd
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