[dragonfly.git] / lib / libbluetooth / bluetooth.c

/* $NetBSD: bluetooth.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $ */
/* $DragonFly: src/lib/libbluetooth/bluetooth.c,v 1.1 2008/01/03 11:47:52 hasso Exp $ */

/*
 * 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.1 2006/06/19 15:44:36 gdamore Exp $
 * $FreeBSD: src/lib/libbluetooth/bluetooth.c,v 1.2 2004/03/05 08:10:17 markm Exp $
 */

#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(void const *addr, socklen_t 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 && memcmp(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 num)
{
	struct protoent	*p;

	bt_setprotoent(proto_stayopen);
	while ((p = bt_getprotoent()) != NULL)
		if (p->p_proto == num)
			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 = (int)strtol(cp, NULL, 0);
	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 != '\0' && 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);
}
Commit	Line	Data
37f60ad1 HT	1	/* $NetBSD: bluetooth.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $ */
	2	/* $DragonFly: src/lib/libbluetooth/bluetooth.c,v 1.1 2008/01/03 11:47:52 hasso Exp $ */
	3
	4	/*
	5	* bluetooth.c
	6	*
	7	* Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
	8	* All rights reserved.
	9	*
	10	* Redistribution and use in source and binary forms, with or without
	11	* modification, are permitted provided that the following conditions
	12	* are met:
	13	* 1. Redistributions of source code must retain the above copyright
	14	* notice, this list of conditions and the following disclaimer.
	15	* 2. Redistributions in binary form must reproduce the above copyright
	16	* notice, this list of conditions and the following disclaimer in the
	17	* documentation and/or other materials provided with the distribution.
	18	*
	19	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
	20	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	21	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	22	* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
	23	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
	24	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
	25	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
	26	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
	27	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
	28	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
	29	* SUCH DAMAGE.
	30	*
	31	* $Id: bluetooth.c,v 1.1 2006/06/19 15:44:36 gdamore Exp $
	32	* $FreeBSD: src/lib/libbluetooth/bluetooth.c,v 1.2 2004/03/05 08:10:17 markm Exp $
	33	*/
	34
	35	#include <bluetooth.h>
	36	#include <stdio.h>
	37	#include <stdlib.h>
	38	#include <string.h>
	39
	40	#define _PATH_BT_HOSTS "/etc/bluetooth/hosts"
	41	#define _PATH_BT_PROTOCOLS "/etc/bluetooth/protocols"
	42	#define MAXALIASES 35
	43
	44	static FILE *hostf = NULL;
	45	static int host_stayopen = 0;
	46	static struct hostent host;
	47	static bdaddr_t host_addr;
	48	static char *host_addr_ptrs[2];
	49	static char *host_aliases[MAXALIASES];
	50
	51	static FILE *protof = NULL;
	52	static int proto_stayopen = 0;
	53	static struct protoent proto;
	54	static char *proto_aliases[MAXALIASES];
	55
	56	static char buf[BUFSIZ + 1];
	57
	58	static int bt_hex_byte (char const *str);
	59	static int bt_hex_nibble (char nibble);
	60
	61	struct hostent *
	62	bt_gethostbyname(char const *name)
	63	{
	64	struct hostent *p;
65	char **cp;
66
67	bt_sethostent(host_stayopen);
68	while ((p = bt_gethostent()) != NULL) {
69	if (strcasecmp(p->h_name, name) == 0)
70	break;
71	for (cp = p->h_aliases; *cp != 0; cp++)
72	if (strcasecmp(*cp, name) == 0)
73	goto found;
74	}
75	found:
76	bt_endhostent();
77
78	return (p);
79	}
80
81	struct hostent *
63bd4a35	82	bt_gethostbyaddr(void const *addr, socklen_t len, int type)
37f60ad1 HT	83	{
	84	struct hostent *p;
	85
	86	if (type != AF_BLUETOOTH \|\| len != sizeof(bdaddr_t)) {
	87	h_errno = NO_RECOVERY;
	88	return (NULL);
	89	}
	90
	91	bt_sethostent(host_stayopen);
	92	while ((p = bt_gethostent()) != NULL)
	93	if (p->h_addrtype == type && memcmp(p->h_addr, addr, len) == 0)
	94	break;
	95	bt_endhostent();
	96
	97	return (p);
	98	}
	99
	100	struct hostent *
	101	bt_gethostent(void)
	102	{
	103	char p, cp, **q;
	104
	105	if (hostf == NULL)
	106	hostf = fopen(_PATH_BT_HOSTS, "r");
	107
	108	if (hostf == NULL) {
	109	h_errno = NETDB_INTERNAL;
	110	return (NULL);
	111	}
	112	again:
	113	if ((p = fgets(buf, sizeof(buf), hostf)) == NULL) {
	114	h_errno = HOST_NOT_FOUND;
	115	return (NULL);
	116	}
	117	if (*p == '#')
	118	goto again;
	119	if ((cp = strpbrk(p, "#\n")) == NULL)
	120	goto again;
	121	*cp = 0;
	122	if ((cp = strpbrk(p, " \t")) == NULL)
	123	goto again;
	124	*cp++ = 0;
	125	if (bt_aton(p, &host_addr) == 0)
	126	goto again;
	127	host_addr_ptrs[0] = (char *) &host_addr;
	128	host_addr_ptrs[1] = NULL;
	129	host.h_addr_list = host_addr_ptrs;
	130	host.h_length = sizeof(host_addr);
	131	host.h_addrtype = AF_BLUETOOTH;
	132	while (cp == ' ' \|\| cp == '\t')
	133	cp++;
	134	host.h_name = cp;
	135	q = host.h_aliases = host_aliases;
	136	if ((cp = strpbrk(cp, " \t")) != NULL)
	137	*cp++ = 0;
	138	while (cp != NULL && *cp != 0) {
	139	if (cp == ' ' \|\| cp == '\t') {
	140	cp++;
	141	continue;
	142	}
	143	if (q < &host_aliases[MAXALIASES - 1])
	144	*q++ = cp;
	145	if ((cp = strpbrk(cp, " \t")) != NULL)
	146	*cp++ = 0;
147	}
148	*q = NULL;
149	h_errno = NETDB_SUCCESS;
150
151	return (&host);
152	}
153
154	void
155	bt_sethostent(int stayopen)
156	{
157	if (hostf == NULL)
158	hostf = fopen(_PATH_BT_HOSTS, "r");
159	else
160	rewind(hostf);
161
162	host_stayopen = stayopen;
163	}
164
165	void
166	bt_endhostent(void)
167	{
168	if (hostf != NULL && host_stayopen == 0) {
169	(void) fclose(hostf);
170	hostf = NULL;
171	}
172	}
173
174	struct protoent *
175	bt_getprotobyname(char const *name)
176	{
177	struct protoent *p;
178	char **cp;
179
180	bt_setprotoent(proto_stayopen);
181	while ((p = bt_getprotoent()) != NULL) {
182	if (strcmp(p->p_name, name) == 0)
183	break;
184	for (cp = p->p_aliases; *cp != 0; cp++)
185	if (strcmp(*cp, name) == 0)
186	goto found;
187	}
188	found:
189	bt_endprotoent();
190
191	return (p);
192	}
193
194	struct protoent *
195	bt_getprotobynumber(int num)
196	{
197	struct protoent *p;
198
199	bt_setprotoent(proto_stayopen);
200	while ((p = bt_getprotoent()) != NULL)
201	if (p->p_proto == num)
202	break;
203	bt_endprotoent();
204
205	return (p);
206	}
207
208	struct protoent *
209	bt_getprotoent(void)
210	{
211	char p, cp, **q;
212
213	if (protof == NULL)
214	protof = fopen(_PATH_BT_PROTOCOLS, "r");
215
216	if (protof == NULL)
217	return (NULL);
218	again:
219	if ((p = fgets(buf, sizeof(buf), protof)) == NULL)
220	return (NULL);
221	if (*p == '#')
222	goto again;
223	if ((cp = strpbrk(p, "#\n")) == NULL)
224	goto again;
225	*cp = '\0';
226	proto.p_name = p;
227	if ((cp = strpbrk(p, " \t")) == NULL)
228	goto again;
229	*cp++ = '\0';
230	while (cp == ' ' \|\| cp == '\t')
231	cp++;
232	if ((p = strpbrk(cp, " \t")) != NULL)
233	*p++ = '\0';
234	proto.p_proto = (int)strtol(cp, NULL, 0);
235	q = proto.p_aliases = proto_aliases;
236	if (p != NULL) {
237	cp = p;
238	while (cp != NULL && *cp != 0) {
239	if (cp == ' ' \|\| cp == '\t') {
240	cp++;
241	continue;
242	}
243	if (q < &proto_aliases[MAXALIASES - 1])
244	*q++ = cp;
245	if ((cp = strpbrk(cp, " \t")) != NULL)
246	*cp++ = '\0';
247	}
248	}
249	*q = NULL;
250
251	return (&proto);
252	}
253
254	void
255	bt_setprotoent(int stayopen)
256	{
257	if (protof == NULL)
258	protof = fopen(_PATH_BT_PROTOCOLS, "r");
259	else
260	rewind(protof);
261
262	proto_stayopen = stayopen;
263	}
264
265	void
266	bt_endprotoent(void)
267	{
268	if (protof != NULL) {
269	(void) fclose(protof);
270	protof = NULL;
271	}
272	}
273
274	char const *
275	bt_ntoa(bdaddr_t const ba, char str)
276	{
277	static char buffer[24];
278
279	if (str == NULL)
280	str = buffer;
281
282	sprintf(str, "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x",
283	ba->b[5], ba->b[4], ba->b[3], ba->b[2], ba->b[1], ba->b[0]);
284
285	return (str);
286	}
287
288	int
289	bt_aton(char const str, bdaddr_t ba)
290	{
291	int i, b;
292	char *end = NULL;
293
294	memset(ba, 0, sizeof(*ba));
295
296	for (i = 5, end = strchr(str, ':');
297	i > 0 && *str != '\0' && end != NULL;
298	i --, str = end + 1, end = strchr(str, ':')) {
299	switch (end - str) {
300	case 1:
301	b = bt_hex_nibble(str[0]);
302	break;
303
304	case 2:
305	b = bt_hex_byte(str);
306	break;
307
308	default:
309	b = -1;
310	break;
311	}
312
313	if (b < 0)
314	return (0);
315
316	ba->b[i] = b;
317	}
318
319	if (i != 0 \|\| end != NULL \|\| *str == 0)
320	return (0);
321
322	switch (strlen(str)) {
323	case 1:
324	b = bt_hex_nibble(str[0]);
325	break;
326
327	case 2:
328	b = bt_hex_byte(str);
329	break;
330
331	default:
332	b = -1;
333	break;
334	}
335
336	if (b < 0)
337	return (0);
338
339	ba->b[i] = b;
340
341	return (1);
342	}
343
344	static int
345	bt_hex_byte(char const *str)
346	{
347	int n1, n2;
348
349	if ((n1 = bt_hex_nibble(str[0])) < 0)
350	return (-1);
351
352	if ((n2 = bt_hex_nibble(str[1])) < 0)
353	return (-1);
354
355	return ((((n1 & 0x0f) << 4) \| (n2 & 0x0f)) & 0xff);
356	}
357
358	static int
359	bt_hex_nibble(char nibble)
360	{
361	if ('0' <= nibble && nibble <= '9')
362	return (nibble - '0');
363
364	if ('a' <= nibble && nibble <= 'f')
365	return (nibble - 'a' + 0xa);
366
367	if ('A' <= nibble && nibble <= 'F')
368	return (nibble - 'A' + 0xa);
369
370	return (-1);
371	}