Home | History | Annotate | Line # | Download | only in btdevctl
btdevctl.c revision 1.8
      1  1.8  plunky /*	$NetBSD: btdevctl.c,v 1.8 2009/05/12 18:39:20 plunky Exp $	*/
      2  1.1  plunky 
      3  1.1  plunky /*-
      4  1.1  plunky  * Copyright (c) 2006 Itronix Inc.
      5  1.1  plunky  * All rights reserved.
      6  1.1  plunky  *
      7  1.1  plunky  * Written by Iain Hibbert for Itronix Inc.
      8  1.1  plunky  *
      9  1.1  plunky  * Redistribution and use in source and binary forms, with or without
     10  1.1  plunky  * modification, are permitted provided that the following conditions
     11  1.1  plunky  * are met:
     12  1.1  plunky  * 1. Redistributions of source code must retain the above copyright
     13  1.1  plunky  *    notice, this list of conditions and the following disclaimer.
     14  1.1  plunky  * 2. Redistributions in binary form must reproduce the above copyright
     15  1.1  plunky  *    notice, this list of conditions and the following disclaimer in the
     16  1.1  plunky  *    documentation and/or other materials provided with the distribution.
     17  1.1  plunky  * 3. The name of Itronix Inc. may not be used to endorse
     18  1.1  plunky  *    or promote products derived from this software without specific
     19  1.1  plunky  *    prior written permission.
     20  1.1  plunky  *
     21  1.1  plunky  * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
     22  1.1  plunky  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     23  1.1  plunky  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     24  1.1  plunky  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
     25  1.1  plunky  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     26  1.1  plunky  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     27  1.1  plunky  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
     28  1.1  plunky  * ON ANY THEORY OF LIABILITY, WHETHER IN
     29  1.1  plunky  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     30  1.1  plunky  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     31  1.1  plunky  * POSSIBILITY OF SUCH DAMAGE.
     32  1.1  plunky  */
     33  1.1  plunky 
     34  1.1  plunky #include <sys/cdefs.h>
     35  1.8  plunky __COPYRIGHT("@(#) Copyright (c) 2006 The NetBSD Foundation, Inc.\
     36  1.8  plunky   @(#) Copyright (c) 2006 Itronix, Inc.\
     37  1.8  plunky   All rights reserved.");
     38  1.8  plunky __RCSID("$NetBSD: btdevctl.c,v 1.8 2009/05/12 18:39:20 plunky Exp $");
     39  1.1  plunky 
     40  1.1  plunky #include <prop/proplib.h>
     41  1.2  plunky #include <sys/ioctl.h>
     42  1.1  plunky 
     43  1.2  plunky #include <bluetooth.h>
     44  1.2  plunky #include <ctype.h>
     45  1.1  plunky #include <err.h>
     46  1.1  plunky #include <fcntl.h>
     47  1.1  plunky #include <stdlib.h>
     48  1.1  plunky #include <string.h>
     49  1.1  plunky #include <unistd.h>
     50  1.1  plunky 
     51  1.2  plunky #include <dev/bluetooth/btdev.h>
     52  1.2  plunky 
     53  1.1  plunky #include "btdevctl.h"
     54  1.1  plunky 
     55  1.2  plunky #define BTHUB_PATH		"/dev/bthub"
     56  1.1  plunky 
     57  1.2  plunky int main(int, char *[]);
     58  1.2  plunky void usage(void);
     59  1.2  plunky char *uppercase(const char *);
     60  1.2  plunky int bthub_pioctl(unsigned long, prop_dictionary_t);
     61  1.1  plunky 
     62  1.2  plunky int
     63  1.2  plunky main(int argc, char *argv[])
     64  1.1  plunky {
     65  1.2  plunky 	prop_dictionary_t dev;
     66  1.2  plunky 	prop_object_t obj;
     67  1.2  plunky 	bdaddr_t laddr, raddr;
     68  1.4  plunky 	const char *service, *mode;
     69  1.4  plunky 	int ch, query, verbose, attach, detach, set, none;
     70  1.2  plunky 
     71  1.2  plunky 	bdaddr_copy(&laddr, BDADDR_ANY);
     72  1.2  plunky 	bdaddr_copy(&raddr, BDADDR_ANY);
     73  1.2  plunky 	service = NULL;
     74  1.4  plunky 	mode = NULL;
     75  1.5   pavel 	query = false;
     76  1.5   pavel 	verbose = false;
     77  1.5   pavel 	attach = false;
     78  1.5   pavel 	detach = false;
     79  1.5   pavel 	set = false;
     80  1.5   pavel 	none = false;
     81  1.2  plunky 
     82  1.4  plunky 	while ((ch = getopt(argc, argv, "Aa:Dd:hm:qs:v")) != -1) {
     83  1.2  plunky 		switch (ch) {
     84  1.2  plunky 		case 'A': /* Attach device */
     85  1.5   pavel 			attach = true;
     86  1.2  plunky 			break;
     87  1.2  plunky 
     88  1.2  plunky 		case 'a': /* remote address */
     89  1.2  plunky 			if (!bt_aton(optarg, &raddr)) {
     90  1.2  plunky 				struct hostent  *he = NULL;
     91  1.2  plunky 
     92  1.2  plunky 				if ((he = bt_gethostbyname(optarg)) == NULL)
     93  1.2  plunky 					errx(EXIT_FAILURE, "%s: %s",
     94  1.2  plunky 						optarg, hstrerror(h_errno));
     95  1.2  plunky 
     96  1.2  plunky 				bdaddr_copy(&raddr, (bdaddr_t *)he->h_addr);
     97  1.2  plunky 			}
     98  1.2  plunky 			break;
     99  1.2  plunky 
    100  1.2  plunky 		case 'D': /* Detach device */
    101  1.5   pavel 			detach = true;
    102  1.2  plunky 			break;
    103  1.2  plunky 
    104  1.2  plunky 		case 'd': /* local device address */
    105  1.2  plunky 			if (!bt_devaddr(optarg, &laddr))
    106  1.2  plunky 				err(EXIT_FAILURE, "%s", optarg);
    107  1.2  plunky 
    108  1.2  plunky 			break;
    109  1.2  plunky 
    110  1.4  plunky 		case 'm': /* link mode */
    111  1.4  plunky 			if (strcasecmp(optarg, "none") == 0)
    112  1.5   pavel 				none = true;
    113  1.4  plunky 			else if (strcasecmp(optarg, BTDEVauth) == 0)
    114  1.4  plunky 				mode = BTDEVauth;
    115  1.4  plunky 			else if (strcasecmp(optarg, BTDEVencrypt) == 0)
    116  1.4  plunky 				mode = BTDEVencrypt;
    117  1.4  plunky 			else if (strcasecmp(optarg, BTDEVsecure) == 0)
    118  1.4  plunky 				mode = BTDEVsecure;
    119  1.4  plunky 			else
    120  1.6  plunky 				errx(EXIT_FAILURE, "%s: unknown mode", optarg);
    121  1.4  plunky 
    122  1.4  plunky 			break;
    123  1.4  plunky 
    124  1.2  plunky 		case 'q':
    125  1.5   pavel 			query = true;
    126  1.2  plunky 			break;
    127  1.2  plunky 
    128  1.2  plunky 		case 's': /* service */
    129  1.2  plunky 			service = uppercase(optarg);
    130  1.2  plunky 			break;
    131  1.2  plunky 
    132  1.2  plunky 		case 'v': /* verbose */
    133  1.5   pavel 			verbose = true;
    134  1.2  plunky 			break;
    135  1.2  plunky 
    136  1.2  plunky 		case 'h':
    137  1.2  plunky 		default:
    138  1.2  plunky 			usage();
    139  1.2  plunky 		}
    140  1.2  plunky 	}
    141  1.2  plunky 
    142  1.2  plunky 	argc -= optind;
    143  1.2  plunky 	argv += optind;
    144  1.2  plunky 
    145  1.2  plunky 	if (argc > 0
    146  1.5   pavel 	    || (attach == true && detach == true)
    147  1.2  plunky 	    || bdaddr_any(&laddr)
    148  1.2  plunky 	    || bdaddr_any(&raddr)
    149  1.2  plunky 	    || service == NULL)
    150  1.2  plunky 		usage();
    151  1.2  plunky 
    152  1.5   pavel 	if (attach == false && detach == false)
    153  1.5   pavel 		verbose = true;
    154  1.2  plunky 
    155  1.2  plunky 	dev = db_get(&laddr, &raddr, service);
    156  1.5   pavel 	if (dev == NULL || query == true) {
    157  1.5   pavel 		if (verbose == true)
    158  1.2  plunky 			printf("Performing SDP query for service '%s'..\n", service);
    159  1.2  plunky 
    160  1.2  plunky 		dev = cfg_query(&laddr, &raddr, service);
    161  1.2  plunky 		if (dev == NULL)
    162  1.2  plunky 			errx(EXIT_FAILURE, "%s/%s not found", bt_ntoa(&raddr, NULL), service);
    163  1.1  plunky 
    164  1.5   pavel 		set = true;
    165  1.2  plunky 	}
    166  1.2  plunky 
    167  1.4  plunky 	if (mode != NULL) {
    168  1.4  plunky 		obj = prop_string_create_cstring_nocopy(mode);
    169  1.4  plunky 		if (obj == NULL || !prop_dictionary_set(dev, BTDEVmode, obj))
    170  1.4  plunky 			errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVmode);
    171  1.4  plunky 
    172  1.4  plunky 		prop_object_release(obj);
    173  1.5   pavel 		set = true;
    174  1.4  plunky 	}
    175  1.4  plunky 
    176  1.5   pavel 	if (none == true) {
    177  1.4  plunky 		prop_dictionary_remove(dev, BTDEVmode);
    178  1.5   pavel 		set = true;
    179  1.4  plunky 	}
    180  1.4  plunky 
    181  1.5   pavel 	if (set == true && !db_set(dev, &laddr, &raddr, service))
    182  1.4  plunky 		errx(EXIT_FAILURE, "service store failed");
    183  1.4  plunky 
    184  1.2  plunky 	/* add binary local-bdaddr */
    185  1.2  plunky 	obj = prop_data_create_data(&laddr, sizeof(laddr));
    186  1.2  plunky 	if (obj == NULL || !prop_dictionary_set(dev, BTDEVladdr, obj))
    187  1.2  plunky 		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVladdr);
    188  1.1  plunky 
    189  1.2  plunky 	prop_object_release(obj);
    190  1.1  plunky 
    191  1.2  plunky 	/* add binary remote-bdaddr */
    192  1.2  plunky 	obj = prop_data_create_data(&raddr, sizeof(raddr));
    193  1.2  plunky 	if (obj == NULL || !prop_dictionary_set(dev, BTDEVraddr, obj))
    194  1.2  plunky 		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVraddr);
    195  1.1  plunky 
    196  1.2  plunky 	prop_object_release(obj);
    197  1.1  plunky 
    198  1.3  plunky 	/* add service name */
    199  1.3  plunky 	obj = prop_string_create_cstring(service);
    200  1.3  plunky 	if (obj == NULL || !prop_dictionary_set(dev, BTDEVservice, obj))
    201  1.3  plunky 		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVservice);
    202  1.3  plunky 
    203  1.3  plunky 	prop_object_release(obj);
    204  1.3  plunky 
    205  1.5   pavel 	if (verbose == true)
    206  1.2  plunky 		cfg_print(dev);
    207  1.1  plunky 
    208  1.5   pavel 	if (attach == true)
    209  1.2  plunky 		bthub_pioctl(BTDEV_ATTACH, dev);
    210  1.1  plunky 
    211  1.5   pavel 	if (detach == true)
    212  1.2  plunky 		bthub_pioctl(BTDEV_DETACH, dev);
    213  1.1  plunky 
    214  1.2  plunky 	exit(EXIT_SUCCESS);
    215  1.1  plunky }
    216  1.1  plunky 
    217  1.2  plunky void
    218  1.2  plunky usage(void)
    219  1.1  plunky {
    220  1.1  plunky 
    221  1.2  plunky 	fprintf(stderr,
    222  1.4  plunky 		"usage: %s [-A | -D] [-qv] [-m mode] -a address -d device -s service\n"
    223  1.2  plunky 		"Where:\n"
    224  1.2  plunky 		"\t-A           attach device\n"
    225  1.2  plunky 		"\t-a address   remote device address\n"
    226  1.2  plunky 		"\t-D           detach device\n"
    227  1.2  plunky 		"\t-d device    local device address\n"
    228  1.4  plunky 		"\t-m mode      link mode\n"
    229  1.2  plunky 		"\t-q           force SDP query\n"
    230  1.2  plunky 		"\t-s service   remote service\n"
    231  1.2  plunky 		"\t-v           verbose\n"
    232  1.2  plunky 		"", getprogname());
    233  1.1  plunky 
    234  1.2  plunky 	exit(EXIT_FAILURE);
    235  1.2  plunky }
    236  1.1  plunky 
    237  1.2  plunky char *
    238  1.2  plunky uppercase(const char *arg)
    239  1.2  plunky {
    240  1.2  plunky 	char *str, *ptr;
    241  1.1  plunky 
    242  1.2  plunky 	str = strdup(arg);
    243  1.2  plunky 	if (str == NULL)
    244  1.2  plunky 		err(EXIT_FAILURE, "strdup");
    245  1.1  plunky 
    246  1.2  plunky 	for (ptr = str ; *ptr ; ptr++)
    247  1.2  plunky 		*ptr = (char)toupper((int)*ptr);
    248  1.1  plunky 
    249  1.2  plunky 	return str;
    250  1.1  plunky }
    251  1.1  plunky 
    252  1.1  plunky int
    253  1.2  plunky bthub_pioctl(unsigned long cmd, prop_dictionary_t dict)
    254  1.1  plunky {
    255  1.1  plunky 	int fd;
    256  1.1  plunky 
    257  1.2  plunky 	fd = open(BTHUB_PATH, O_WRONLY, 0);
    258  1.1  plunky 	if (fd < 0)
    259  1.2  plunky 		err(EXIT_FAILURE, "%s", BTHUB_PATH);
    260  1.1  plunky 
    261  1.2  plunky 	if (prop_dictionary_send_ioctl(dict, fd, cmd))
    262  1.2  plunky 		err(EXIT_FAILURE, "%s", BTHUB_PATH);
    263  1.1  plunky 
    264  1.1  plunky 	close(fd);
    265  1.2  plunky 	return EXIT_SUCCESS;
    266  1.1  plunky }
    267