NetBSD/usr.sbin/btdevctl/btdevctl.c

/*	$NetBSD: btdevctl.c,v 1.6 2007/11/19 19:49:58 plunky Exp $	*/

/*-
 * Copyright (c) 2006 Itronix Inc.
 * All rights reserved.
 *
 * Written by Iain Hibbert for Itronix Inc.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The name of Itronix Inc. may not be used to endorse
 *    or promote products derived from this software without specific
 *    prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__COPYRIGHT("@(#) Copyright (c) 2006 Itronix, Inc.\n"
	    "All rights reserved.\n");
__RCSID("$NetBSD: btdevctl.c,v 1.6 2007/11/19 19:49:58 plunky Exp $");

#include <prop/proplib.h>
#include <sys/ioctl.h>

#include <bluetooth.h>
#include <ctype.h>
#include <err.h>
#include <fcntl.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include <dev/bluetooth/btdev.h>

#include "btdevctl.h"

#define BTHUB_PATH		"/dev/bthub"

int main(int, char *[]);
void usage(void);
char *uppercase(const char *);
int bthub_pioctl(unsigned long, prop_dictionary_t);

int
main(int argc, char *argv[])
{
	prop_dictionary_t dev;
	prop_object_t obj;
	bdaddr_t laddr, raddr;
	const char *service, *mode;
	int ch, query, verbose, attach, detach, set, none;

	bdaddr_copy(&laddr, BDADDR_ANY);
	bdaddr_copy(&raddr, BDADDR_ANY);
	service = NULL;
	mode = NULL;
	query = false;
	verbose = false;
	attach = false;
	detach = false;
	set = false;
	none = false;

	while ((ch = getopt(argc, argv, "Aa:Dd:hm:qs:v")) != -1) {
		switch (ch) {
		case 'A': /* Attach device */
			attach = true;
			break;

		case 'a': /* remote address */
			if (!bt_aton(optarg, &raddr)) {
				struct hostent  *he = NULL;

				if ((he = bt_gethostbyname(optarg)) == NULL)
					errx(EXIT_FAILURE, "%s: %s",
						optarg, hstrerror(h_errno));

				bdaddr_copy(&raddr, (bdaddr_t *)he->h_addr);
			}
			break;

		case 'D': /* Detach device */
			detach = true;
			break;

		case 'd': /* local device address */
			if (!bt_devaddr(optarg, &laddr))
				err(EXIT_FAILURE, "%s", optarg);

			break;

		case 'm': /* link mode */
			if (strcasecmp(optarg, "none") == 0)
				none = true;
			else if (strcasecmp(optarg, BTDEVauth) == 0)
				mode = BTDEVauth;
			else if (strcasecmp(optarg, BTDEVencrypt) == 0)
				mode = BTDEVencrypt;
			else if (strcasecmp(optarg, BTDEVsecure) == 0)
				mode = BTDEVsecure;
			else
				errx(EXIT_FAILURE, "%s: unknown mode", optarg);

			break;

		case 'q':
			query = true;
			break;

		case 's': /* service */
			service = uppercase(optarg);
			break;

		case 'v': /* verbose */
			verbose = true;
			break;

		case 'h':
		default:
			usage();
		}
	}

	argc -= optind;
	argv += optind;

	if (argc > 0
	    || (attach == true && detach == true)
	    || bdaddr_any(&laddr)
	    || bdaddr_any(&raddr)
	    || service == NULL)
		usage();

	if (attach == false && detach == false)
		verbose = true;

	dev = db_get(&laddr, &raddr, service);
	if (dev == NULL || query == true) {
		if (verbose == true)
			printf("Performing SDP query for service '%s'..\n", service);

		dev = cfg_query(&laddr, &raddr, service);
		if (dev == NULL)
			errx(EXIT_FAILURE, "%s/%s not found", bt_ntoa(&raddr, NULL), service);

		set = true;
	}

	if (mode != NULL) {
		obj = prop_string_create_cstring_nocopy(mode);
		if (obj == NULL || !prop_dictionary_set(dev, BTDEVmode, obj))
			errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVmode);

		prop_object_release(obj);
		set = true;
	}

	if (none == true) {
		prop_dictionary_remove(dev, BTDEVmode);
		set = true;
	}

	if (set == true && !db_set(dev, &laddr, &raddr, service))
		errx(EXIT_FAILURE, "service store failed");

	/* add binary local-bdaddr */
	obj = prop_data_create_data(&laddr, sizeof(laddr));
	if (obj == NULL || !prop_dictionary_set(dev, BTDEVladdr, obj))
		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVladdr);

	prop_object_release(obj);

	/* add binary remote-bdaddr */
	obj = prop_data_create_data(&raddr, sizeof(raddr));
	if (obj == NULL || !prop_dictionary_set(dev, BTDEVraddr, obj))
		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVraddr);

	prop_object_release(obj);

	/* add service name */
	obj = prop_string_create_cstring(service);
	if (obj == NULL || !prop_dictionary_set(dev, BTDEVservice, obj))
		errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVservice);

	prop_object_release(obj);

	if (verbose == true)
		cfg_print(dev);

	if (attach == true)
		bthub_pioctl(BTDEV_ATTACH, dev);

	if (detach == true)
		bthub_pioctl(BTDEV_DETACH, dev);

	exit(EXIT_SUCCESS);
}

void
usage(void)
{

	fprintf(stderr,
		"usage: %s [-A | -D] [-qv] [-m mode] -a address -d device -s service\n"
		"Where:\n"
		"\t-A           attach device\n"
		"\t-a address   remote device address\n"
		"\t-D           detach device\n"
		"\t-d device    local device address\n"
		"\t-m mode      link mode\n"
		"\t-q           force SDP query\n"
		"\t-s service   remote service\n"
		"\t-v           verbose\n"
		"", getprogname());

	exit(EXIT_FAILURE);
}

char *
uppercase(const char *arg)
{
	char *str, *ptr;

	str = strdup(arg);
	if (str == NULL)
		err(EXIT_FAILURE, "strdup");

	for (ptr = str ; *ptr ; ptr++)
		*ptr = (char)toupper((int)*ptr);

	return str;
}

int
bthub_pioctl(unsigned long cmd, prop_dictionary_t dict)
{
	int fd;

	fd = open(BTHUB_PATH, O_WRONLY, 0);
	if (fd < 0)
		err(EXIT_FAILURE, "%s", BTHUB_PATH);

	if (prop_dictionary_send_ioctl(dict, fd, cmd))
		err(EXIT_FAILURE, "%s", BTHUB_PATH);

	close(fd);
	return EXIT_SUCCESS;
}