Update Bluetooth code.

Reviewed by: M. Warner Losh <imp@bsdimp.com>; John Hay <jhay@freebsd.org>
Approved by: M. Warner Losh <imp@bsdimp.com> (mentor)

1 files changed, 369 insertions, 0 deletions

diff --git a/lib/libbluetooth/bluetooth.c b/lib/libbluetooth/bluetooth.c
new file mode 100644
index 000000000000..4678509541fb
--- /dev/null
+++ b/lib/libbluetooth/bluetooth.c
@@ -0,0 +1,369 @@
+/*
+ * bluetooth.c
+ *
+ * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
+ * All rights reserved.
+ *
+ * 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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 THE AUTHOR OR CONTRIBUTORS 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.
+ *
+ * $Id: bluetooth.c,v 1.3 2003/05/20 23:04:30 max Exp $
+ * $FreeBSD$
+ */
+
+#include <bluetooth.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+
+#define _PATH_BT_HOSTS		"/etc/bluetooth/hosts"
+#define _PATH_BT_PROTOCOLS	"/etc/bluetooth/protocols"
+#define MAXALIASES		 35
+
+static FILE		*hostf = NULL;
+static int		 host_stayopen = 0;
+static struct hostent	 host;
+static bdaddr_t		 host_addr;
+static char		*host_addr_ptrs[2];
+static char		*host_aliases[MAXALIASES];
+
+static FILE		*protof = NULL;
+static int		 proto_stayopen = 0;
+static struct protoent	 proto;
+static char		*proto_aliases[MAXALIASES];
+
+static char		 buf[BUFSIZ + 1];
+
+static int bt_hex_byte   (char const *str);
+static int bt_hex_nibble (char nibble);
+
+struct hostent *
+bt_gethostbyname(char const *name)
+{
+	struct hostent	*p;
+	char		**cp;
+
+	bt_sethostent(host_stayopen);
+	while ((p = bt_gethostent()) != NULL) {
+		if (strcasecmp(p->h_name, name) == 0)
+			break;
+		for (cp = p->h_aliases; *cp != 0; cp++)
+			if (strcasecmp(*cp, name) == 0)
+				goto found;
+	}
+found:
+	bt_endhostent();
+
+	return (p);
+}
+
+struct hostent *
+bt_gethostbyaddr(char const *addr, int len, int type)
+{
+	struct hostent	*p;
+
+	if (type != AF_BLUETOOTH || len != sizeof(bdaddr_t)) {
+		h_errno = NO_RECOVERY;
+		return (NULL);
+	}
+
+	bt_sethostent(host_stayopen);
+	while ((p = bt_gethostent()) != NULL)
+		if (p->h_addrtype == type && bcmp(p->h_addr, addr, len) == 0)
+			break;
+	bt_endhostent();
+
+	return (p);
+}
+
+struct hostent *
+bt_gethostent(void)
+{
+	char	*p, *cp, **q;
+
+	if (hostf == NULL)
+		hostf = fopen(_PATH_BT_HOSTS, "r");
+
+	if (hostf == NULL) {
+		h_errno = NETDB_INTERNAL;
+		return (NULL);
+	}
+again:
+	if ((p = fgets(buf, sizeof(buf), hostf)) == NULL) {
+		h_errno = HOST_NOT_FOUND;
+		return (NULL);
+	}
+	if (*p == '#')
+		goto again;
+	if ((cp = strpbrk(p, "#\n")) == NULL)
+		goto again;
+	*cp = 0;
+	if ((cp = strpbrk(p, " \t")) == NULL)
+		goto again;
+	*cp++ = 0;
+	if (bt_aton(p, &host_addr) == 0) 
+		goto again;
+	host_addr_ptrs[0] = (char *) &host_addr;
+	host_addr_ptrs[1] = NULL;
+	host.h_addr_list = host_addr_ptrs;
+	host.h_length = sizeof(host_addr);
+	host.h_addrtype = AF_BLUETOOTH;
+	while (*cp == ' ' || *cp == '\t')
+		cp++;
+	host.h_name = cp;
+	q = host.h_aliases = host_aliases;
+	if ((cp = strpbrk(cp, " \t")) != NULL)
+		*cp++ = 0;
+	while (cp != NULL && *cp != 0) {
+		if (*cp == ' ' || *cp == '\t') {
+			cp++;
+			continue;
+		}
+		if (q < &host_aliases[MAXALIASES - 1])
+			*q++ = cp;
+		if ((cp = strpbrk(cp, " \t")) != NULL)
+			*cp++ = 0;
+	}
+	*q = NULL;
+	h_errno = NETDB_SUCCESS;
+
+	return (&host);
+}
+
+void
+bt_sethostent(int stayopen)
+{
+	if (hostf == NULL)
+		hostf = fopen(_PATH_BT_HOSTS, "r");
+	else
+		rewind(hostf);
+
+	host_stayopen = stayopen;
+}
+
+void
+bt_endhostent(void)
+{
+	if (hostf != NULL && host_stayopen == 0) {
+		(void) fclose(hostf);
+		hostf = NULL;
+	}
+}
+
+struct protoent *
+bt_getprotobyname(char const *name)
+{
+	struct protoent	 *p;
+	char		**cp;
+
+	bt_setprotoent(proto_stayopen);
+	while ((p = bt_getprotoent()) != NULL) {
+		if (strcmp(p->p_name, name) == 0)
+			break;
+		for (cp = p->p_aliases; *cp != 0; cp++)
+			if (strcmp(*cp, name) == 0)
+				goto found;
+	}
+found:
+	bt_endprotoent();
+
+	return (p);
+}
+
+struct protoent *
+bt_getprotobynumber(int proto)
+{
+	struct protoent	*p;
+
+	bt_setprotoent(proto_stayopen);
+	while ((p = bt_getprotoent()) != NULL)
+		if (p->p_proto == proto)
+			break;
+	bt_endprotoent();
+
+	return (p);
+}
+
+struct protoent *
+bt_getprotoent(void)
+{
+	char	*p, *cp, **q;
+
+	if (protof == NULL)
+		protof = fopen(_PATH_BT_PROTOCOLS, "r");
+
+	if (protof == NULL)
+		return (NULL);
+again:
+	if ((p = fgets(buf, sizeof(buf), protof)) == NULL)
+		return (NULL);
+	if (*p == '#')
+		goto again;
+	if ((cp = strpbrk(p, "#\n")) == NULL)
+		goto again;
+	*cp = '\0';
+	proto.p_name = p;
+	if ((cp = strpbrk(p, " \t")) == NULL)
+		goto again;
+	*cp++ = '\0';
+	while (*cp == ' ' || *cp == '\t')
+		cp++;
+	if ((p = strpbrk(cp, " \t")) != NULL)
+		*p++ = '\0';
+	proto.p_proto = atoi(cp);
+	q = proto.p_aliases = proto_aliases;
+	if (p != NULL) {
+		cp = p;
+		while (cp != NULL && *cp != 0) {
+			if (*cp == ' ' || *cp == '\t') {
+				cp++;
+				continue;
+			}
+			if (q < &proto_aliases[MAXALIASES - 1])
+				*q++ = cp;
+			if ((cp = strpbrk(cp, " \t")) != NULL)
+				*cp++ = '\0';
+		}
+	}
+	*q = NULL;
+
+	return (&proto);
+}
+
+void
+bt_setprotoent(int stayopen)
+{
+	if (protof == NULL)
+		protof = fopen(_PATH_BT_PROTOCOLS, "r");
+	else
+		rewind(protof);
+
+	proto_stayopen = stayopen;
+}
+
+void
+bt_endprotoent(void)
+{
+	if (protof != NULL) {
+		(void) fclose(protof);
+		protof = NULL;
+	}
+}
+
+char const *
+bt_ntoa(bdaddr_t const *ba, char *str)
+{
+	static char	buffer[24];
+
+	if (str == NULL)
+		str = buffer;
+
+	sprintf(str, "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x",
+		ba->b[5], ba->b[4], ba->b[3], ba->b[2], ba->b[1], ba->b[0]);
+
+	return (str);
+}
+
+int
+bt_aton(char const *str, bdaddr_t *ba)
+{
+	int	 i, b;
+	char	*end = NULL;
+
+	memset(ba, 0, sizeof(*ba));
+
+	for (i = 5, end = strchr(str, ':');
+	     i > 0 && *str != NULL && end != NULL;
+	     i --, str = end + 1, end = strchr(str, ':')) {
+		switch (end - str) {
+		case 1:
+			b = bt_hex_nibble(str[0]);
+			break;
+
+		case 2:
+			b = bt_hex_byte(str);
+			break;
+
+		default:
+			b = -1;
+			break;
+		}
+		
+		if (b < 0)
+			return (0);
+
+		ba->b[i] = b;
+	}
+
+	if (i != 0 || end != NULL || *str == 0)
+		return (0);
+
+	switch (strlen(str)) {
+	case 1:
+		b = bt_hex_nibble(str[0]);
+		break;
+
+	case 2:
+		b = bt_hex_byte(str);
+		break;
+
+	default:
+		b = -1;
+		break;
+	}
+
+	if (b < 0)
+		return (0);
+
+	ba->b[i] = b;
+
+	return (1);
+}
+
+static int
+bt_hex_byte(char const *str)
+{
+	int	n1, n2;
+
+	if ((n1 = bt_hex_nibble(str[0])) < 0)
+		return (-1);
+
+	if ((n2 = bt_hex_nibble(str[1])) < 0)
+		return (-1);
+
+	return ((((n1 & 0x0f) << 4) | (n2 & 0x0f)) & 0xff);
+}
+
+static int
+bt_hex_nibble(char nibble)
+{
+	if ('0' <= nibble && nibble <= '9')
+		return (nibble - '0');
+
+	if ('a' <= nibble && nibble <= 'f')
+		return (nibble - 'a' + 0xa);
+
+	if ('A' <= nibble && nibble <= 'F')
+		return (nibble - 'A' + 0xa);
+
+	return (-1);
+}
+