xref: /freebsd/lib/libbluetooth/hci.c (revision b3e76948)
1baeef614SMaksim Yevmenkin /*
2baeef614SMaksim Yevmenkin  * hci.c
3baeef614SMaksim Yevmenkin  */
4baeef614SMaksim Yevmenkin 
5baeef614SMaksim Yevmenkin /*-
64d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
75e53a4f9SPedro F. Giffuni  *
8baeef614SMaksim Yevmenkin  * Copyright (c) 2009 Maksim Yevmenkin <m_evmenkin@yahoo.com>
9baeef614SMaksim Yevmenkin  * All rights reserved.
10baeef614SMaksim Yevmenkin  *
11baeef614SMaksim Yevmenkin  * Redistribution and use in source and binary forms, with or without
12baeef614SMaksim Yevmenkin  * modification, are permitted provided that the following conditions
13baeef614SMaksim Yevmenkin  * are met:
14baeef614SMaksim Yevmenkin  * 1. Redistributions of source code must retain the above copyright
15baeef614SMaksim Yevmenkin  *    notice, this list of conditions and the following disclaimer.
16baeef614SMaksim Yevmenkin  * 2. Redistributions in binary form must reproduce the above copyright
17baeef614SMaksim Yevmenkin  *    notice, this list of conditions and the following disclaimer in the
18baeef614SMaksim Yevmenkin  *    documentation and/or other materials provided with the distribution.
19baeef614SMaksim Yevmenkin  *
20baeef614SMaksim Yevmenkin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21baeef614SMaksim Yevmenkin  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22baeef614SMaksim Yevmenkin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23baeef614SMaksim Yevmenkin  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24baeef614SMaksim Yevmenkin  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25baeef614SMaksim Yevmenkin  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26baeef614SMaksim Yevmenkin  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27baeef614SMaksim Yevmenkin  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28baeef614SMaksim Yevmenkin  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29baeef614SMaksim Yevmenkin  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30baeef614SMaksim Yevmenkin  * SUCH DAMAGE.
31baeef614SMaksim Yevmenkin  */
32baeef614SMaksim Yevmenkin 
333ee5c554SVladimir Kondratyev #include <sys/types.h>
343ee5c554SVladimir Kondratyev #include <sys/sysctl.h>
353ee5c554SVladimir Kondratyev 
3678b96635SMaksim Yevmenkin #include <assert.h>
378d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED
38baeef614SMaksim Yevmenkin #include <bluetooth.h>
3978b96635SMaksim Yevmenkin #include <inttypes.h>
40baeef614SMaksim Yevmenkin #include <stdio.h>
41baeef614SMaksim Yevmenkin #include <stdlib.h>
42baeef614SMaksim Yevmenkin #include <string.h>
433ee5c554SVladimir Kondratyev #include <time.h>
44baeef614SMaksim Yevmenkin #include <unistd.h>
45baeef614SMaksim Yevmenkin 
4678b96635SMaksim Yevmenkin #undef	MIN
4778b96635SMaksim Yevmenkin #define	MIN(a, b)	(((a) < (b))? (a) : (b))
4878b96635SMaksim Yevmenkin 
4978b96635SMaksim Yevmenkin static int    bt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname);
50baeef614SMaksim Yevmenkin static char * bt_dev2node (char const *devname, char *nodename, int nnlen);
513ee5c554SVladimir Kondratyev static time_t bt_get_default_hci_command_timeout(void);
52baeef614SMaksim Yevmenkin 
53baeef614SMaksim Yevmenkin int
bt_devopen(char const * devname)5478b96635SMaksim Yevmenkin bt_devopen(char const *devname)
5578b96635SMaksim Yevmenkin {
5678b96635SMaksim Yevmenkin 	struct sockaddr_hci	ha;
5778b96635SMaksim Yevmenkin 	bdaddr_t		ba;
5878b96635SMaksim Yevmenkin 	int			s;
5978b96635SMaksim Yevmenkin 
6078b96635SMaksim Yevmenkin 	if (devname == NULL) {
6178b96635SMaksim Yevmenkin 		errno = EINVAL;
6278b96635SMaksim Yevmenkin 		return (-1);
6378b96635SMaksim Yevmenkin 	}
6478b96635SMaksim Yevmenkin 
6578b96635SMaksim Yevmenkin 	memset(&ha, 0, sizeof(ha));
6678b96635SMaksim Yevmenkin 	ha.hci_len = sizeof(ha);
6778b96635SMaksim Yevmenkin 	ha.hci_family = AF_BLUETOOTH;
6878b96635SMaksim Yevmenkin 
6978b96635SMaksim Yevmenkin 	if (bt_aton(devname, &ba)) {
7078b96635SMaksim Yevmenkin 		if (!bt_devname(ha.hci_node, &ba))
7178b96635SMaksim Yevmenkin 			return (-1);
7278b96635SMaksim Yevmenkin 	} else if (bt_dev2node(devname, ha.hci_node,
7378b96635SMaksim Yevmenkin 					sizeof(ha.hci_node)) == NULL) {
7478b96635SMaksim Yevmenkin 		errno = ENXIO;
7578b96635SMaksim Yevmenkin 		return (-1);
7678b96635SMaksim Yevmenkin 	}
7778b96635SMaksim Yevmenkin 
7878b96635SMaksim Yevmenkin 	s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI);
7978b96635SMaksim Yevmenkin 	if (s < 0)
8078b96635SMaksim Yevmenkin 		return (-1);
8178b96635SMaksim Yevmenkin 
8278b96635SMaksim Yevmenkin 	if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 ||
8378b96635SMaksim Yevmenkin 	    connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0) {
8478b96635SMaksim Yevmenkin 		close(s);
8578b96635SMaksim Yevmenkin 		return (-1);
8678b96635SMaksim Yevmenkin 	}
8778b96635SMaksim Yevmenkin 
8878b96635SMaksim Yevmenkin 	return (s);
8978b96635SMaksim Yevmenkin }
9078b96635SMaksim Yevmenkin 
9178b96635SMaksim Yevmenkin int
bt_devclose(int s)9278b96635SMaksim Yevmenkin bt_devclose(int s)
9378b96635SMaksim Yevmenkin {
9478b96635SMaksim Yevmenkin 	return (close(s));
9578b96635SMaksim Yevmenkin }
9678b96635SMaksim Yevmenkin 
9778b96635SMaksim Yevmenkin int
bt_devsend(int s,uint16_t opcode,void * param,size_t plen)9878b96635SMaksim Yevmenkin bt_devsend(int s, uint16_t opcode, void *param, size_t plen)
9978b96635SMaksim Yevmenkin {
10078b96635SMaksim Yevmenkin 	ng_hci_cmd_pkt_t	h;
10178b96635SMaksim Yevmenkin 	struct iovec		iv[2];
10278b96635SMaksim Yevmenkin 	int			ivn;
10378b96635SMaksim Yevmenkin 
10478b96635SMaksim Yevmenkin 	if ((plen == 0 && param != NULL) ||
10578b96635SMaksim Yevmenkin 	    (plen > 0 && param == NULL) ||
10678b96635SMaksim Yevmenkin 	    plen > UINT8_MAX) {
10778b96635SMaksim Yevmenkin 		errno = EINVAL;
10878b96635SMaksim Yevmenkin 		return (-1);
10978b96635SMaksim Yevmenkin 	}
11078b96635SMaksim Yevmenkin 
11178b96635SMaksim Yevmenkin 	iv[0].iov_base = &h;
11278b96635SMaksim Yevmenkin 	iv[0].iov_len = sizeof(h);
11378b96635SMaksim Yevmenkin 	ivn = 1;
11478b96635SMaksim Yevmenkin 
11578b96635SMaksim Yevmenkin 	h.type = NG_HCI_CMD_PKT;
11678b96635SMaksim Yevmenkin 	h.opcode = htole16(opcode);
11778b96635SMaksim Yevmenkin 	if (plen > 0) {
11878b96635SMaksim Yevmenkin 		h.length = plen;
11978b96635SMaksim Yevmenkin 
12078b96635SMaksim Yevmenkin 		iv[1].iov_base = param;
12178b96635SMaksim Yevmenkin 		iv[1].iov_len = plen;
12278b96635SMaksim Yevmenkin 		ivn = 2;
12378b96635SMaksim Yevmenkin 	} else
12478b96635SMaksim Yevmenkin 		h.length = 0;
12578b96635SMaksim Yevmenkin 
12678b96635SMaksim Yevmenkin 	while (writev(s, iv, ivn) < 0) {
12778b96635SMaksim Yevmenkin 		if (errno == EAGAIN || errno == EINTR)
12878b96635SMaksim Yevmenkin 			continue;
12978b96635SMaksim Yevmenkin 
13078b96635SMaksim Yevmenkin 		return (-1);
13178b96635SMaksim Yevmenkin 	}
13278b96635SMaksim Yevmenkin 
13378b96635SMaksim Yevmenkin 	return (0);
13478b96635SMaksim Yevmenkin }
13578b96635SMaksim Yevmenkin 
13678b96635SMaksim Yevmenkin ssize_t
bt_devrecv(int s,void * buf,size_t size,time_t to)13778b96635SMaksim Yevmenkin bt_devrecv(int s, void *buf, size_t size, time_t to)
13878b96635SMaksim Yevmenkin {
13978b96635SMaksim Yevmenkin 	ssize_t	n;
14078b96635SMaksim Yevmenkin 
14178b96635SMaksim Yevmenkin 	if (buf == NULL || size == 0) {
14278b96635SMaksim Yevmenkin 		errno = EINVAL;
14378b96635SMaksim Yevmenkin 		return (-1);
14478b96635SMaksim Yevmenkin 	}
14578b96635SMaksim Yevmenkin 
14678b96635SMaksim Yevmenkin 	if (to >= 0) {
14778b96635SMaksim Yevmenkin 		fd_set		rfd;
14878b96635SMaksim Yevmenkin 		struct timeval	tv;
14978b96635SMaksim Yevmenkin 
15078b96635SMaksim Yevmenkin 		FD_ZERO(&rfd);
15178b96635SMaksim Yevmenkin 		FD_SET(s, &rfd);
15278b96635SMaksim Yevmenkin 
15378b96635SMaksim Yevmenkin 		tv.tv_sec = to;
15478b96635SMaksim Yevmenkin 		tv.tv_usec = 0;
15578b96635SMaksim Yevmenkin 
15678b96635SMaksim Yevmenkin 		while ((n = select(s + 1, &rfd, NULL, NULL, &tv)) < 0) {
15778b96635SMaksim Yevmenkin 			if (errno == EAGAIN || errno == EINTR)
15878b96635SMaksim Yevmenkin 				continue;
15978b96635SMaksim Yevmenkin 
16078b96635SMaksim Yevmenkin 			return (-1);
16178b96635SMaksim Yevmenkin 		}
16278b96635SMaksim Yevmenkin 
16378b96635SMaksim Yevmenkin 		if (n == 0) {
16478b96635SMaksim Yevmenkin 			errno = ETIMEDOUT;
16578b96635SMaksim Yevmenkin 			return (-1);
16678b96635SMaksim Yevmenkin 		}
16778b96635SMaksim Yevmenkin 
16878b96635SMaksim Yevmenkin 		assert(FD_ISSET(s, &rfd));
16978b96635SMaksim Yevmenkin 	}
17078b96635SMaksim Yevmenkin 
17178b96635SMaksim Yevmenkin 	while ((n = read(s, buf, size)) < 0) {
17278b96635SMaksim Yevmenkin 		if (errno == EAGAIN || errno == EINTR)
17378b96635SMaksim Yevmenkin 			continue;
17478b96635SMaksim Yevmenkin 
17578b96635SMaksim Yevmenkin 		return (-1);
17678b96635SMaksim Yevmenkin 	}
17778b96635SMaksim Yevmenkin 
17878b96635SMaksim Yevmenkin 	switch (*((uint8_t *) buf)) {
17978b96635SMaksim Yevmenkin 	case NG_HCI_CMD_PKT: {
18078b96635SMaksim Yevmenkin 		ng_hci_cmd_pkt_t	*h = (ng_hci_cmd_pkt_t *) buf;
18178b96635SMaksim Yevmenkin 
18278b96635SMaksim Yevmenkin 		if (n >= sizeof(*h) && n == (sizeof(*h) + h->length))
18378b96635SMaksim Yevmenkin 			return (n);
18478b96635SMaksim Yevmenkin 		} break;
18578b96635SMaksim Yevmenkin 
18678b96635SMaksim Yevmenkin 	case NG_HCI_ACL_DATA_PKT: {
18778b96635SMaksim Yevmenkin 		ng_hci_acldata_pkt_t	*h = (ng_hci_acldata_pkt_t *) buf;
18878b96635SMaksim Yevmenkin 
18978b96635SMaksim Yevmenkin 		if (n >= sizeof(*h) && n == (sizeof(*h) + le16toh(h->length)))
19078b96635SMaksim Yevmenkin 			return (n);
19178b96635SMaksim Yevmenkin 		} break;
19278b96635SMaksim Yevmenkin 
19378b96635SMaksim Yevmenkin 	case NG_HCI_SCO_DATA_PKT: {
19478b96635SMaksim Yevmenkin 		ng_hci_scodata_pkt_t	*h = (ng_hci_scodata_pkt_t *) buf;
19578b96635SMaksim Yevmenkin 
19678b96635SMaksim Yevmenkin 		if (n >= sizeof(*h) && n == (sizeof(*h) + h->length))
19778b96635SMaksim Yevmenkin 			return (n);
19878b96635SMaksim Yevmenkin 		} break;
19978b96635SMaksim Yevmenkin 
20078b96635SMaksim Yevmenkin 	case NG_HCI_EVENT_PKT: {
20178b96635SMaksim Yevmenkin 		ng_hci_event_pkt_t	*h = (ng_hci_event_pkt_t *) buf;
20278b96635SMaksim Yevmenkin 
20378b96635SMaksim Yevmenkin 		if (n >= sizeof(*h) && n == (sizeof(*h) + h->length))
20478b96635SMaksim Yevmenkin 			return (n);
20578b96635SMaksim Yevmenkin 		} break;
20678b96635SMaksim Yevmenkin 	}
20778b96635SMaksim Yevmenkin 
20878b96635SMaksim Yevmenkin 	errno = EIO;
20978b96635SMaksim Yevmenkin 	return (-1);
21078b96635SMaksim Yevmenkin }
21178b96635SMaksim Yevmenkin 
21278b96635SMaksim Yevmenkin int
bt_devreq(int s,struct bt_devreq * r,time_t to)21378b96635SMaksim Yevmenkin bt_devreq(int s, struct bt_devreq *r, time_t to)
21478b96635SMaksim Yevmenkin {
21578b96635SMaksim Yevmenkin 	uint8_t				buf[320]; /* more than enough */
21678b96635SMaksim Yevmenkin 	ng_hci_event_pkt_t		*e = (ng_hci_event_pkt_t *) buf;
21778b96635SMaksim Yevmenkin 	ng_hci_command_compl_ep		*cc = (ng_hci_command_compl_ep *)(e+1);
21878b96635SMaksim Yevmenkin 	ng_hci_command_status_ep	*cs = (ng_hci_command_status_ep*)(e+1);
21978b96635SMaksim Yevmenkin 	struct bt_devfilter		old, new;
22078b96635SMaksim Yevmenkin 	time_t				t_end;
22178b96635SMaksim Yevmenkin 	uint16_t			opcode;
22278b96635SMaksim Yevmenkin 	ssize_t				n;
22378b96635SMaksim Yevmenkin 	int				error;
22478b96635SMaksim Yevmenkin 
22578b96635SMaksim Yevmenkin 	if (s < 0 || r == NULL || to < 0) {
22678b96635SMaksim Yevmenkin 		errno = EINVAL;
22778b96635SMaksim Yevmenkin 		return (-1);
22878b96635SMaksim Yevmenkin 	}
22978b96635SMaksim Yevmenkin 
23078b96635SMaksim Yevmenkin 	if ((r->rlen == 0 && r->rparam != NULL) ||
23178b96635SMaksim Yevmenkin 	    (r->rlen > 0 && r->rparam == NULL)) {
23278b96635SMaksim Yevmenkin 		errno = EINVAL;
23378b96635SMaksim Yevmenkin 		return (-1);
23478b96635SMaksim Yevmenkin 	}
23578b96635SMaksim Yevmenkin 
23678b96635SMaksim Yevmenkin 	memset(&new, 0, sizeof(new));
23778b96635SMaksim Yevmenkin 	bt_devfilter_pkt_set(&new, NG_HCI_EVENT_PKT);
23878b96635SMaksim Yevmenkin 	bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_COMPL);
23978b96635SMaksim Yevmenkin 	bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_STATUS);
24078b96635SMaksim Yevmenkin 	if (r->event != 0)
24178b96635SMaksim Yevmenkin 		bt_devfilter_evt_set(&new, r->event);
24278b96635SMaksim Yevmenkin 
24378b96635SMaksim Yevmenkin 	if (bt_devfilter(s, &new, &old) < 0)
24478b96635SMaksim Yevmenkin 		return (-1);
24578b96635SMaksim Yevmenkin 
24678b96635SMaksim Yevmenkin 	error = 0;
24778b96635SMaksim Yevmenkin 
24878b96635SMaksim Yevmenkin 	n = bt_devsend(s, r->opcode, r->cparam, r->clen);
24978b96635SMaksim Yevmenkin 	if (n < 0) {
25078b96635SMaksim Yevmenkin 		error = errno;
25178b96635SMaksim Yevmenkin 		goto out;
25278b96635SMaksim Yevmenkin 	}
25378b96635SMaksim Yevmenkin 
25478b96635SMaksim Yevmenkin 	opcode = htole16(r->opcode);
25578b96635SMaksim Yevmenkin 	t_end = time(NULL) + to;
25678b96635SMaksim Yevmenkin 
25778b96635SMaksim Yevmenkin 	do {
25878b96635SMaksim Yevmenkin 		to = t_end - time(NULL);
25978b96635SMaksim Yevmenkin 		if (to < 0)
26078b96635SMaksim Yevmenkin 			to = 0;
26178b96635SMaksim Yevmenkin 
26278b96635SMaksim Yevmenkin 		n = bt_devrecv(s, buf, sizeof(buf), to);
26378b96635SMaksim Yevmenkin 		if (n < 0) {
26478b96635SMaksim Yevmenkin 			error = errno;
26578b96635SMaksim Yevmenkin 			goto out;
26678b96635SMaksim Yevmenkin 		}
26778b96635SMaksim Yevmenkin 
26878b96635SMaksim Yevmenkin 		if (e->type != NG_HCI_EVENT_PKT) {
26978b96635SMaksim Yevmenkin 			error = EIO;
27078b96635SMaksim Yevmenkin 			goto out;
27178b96635SMaksim Yevmenkin 		}
27278b96635SMaksim Yevmenkin 
27378b96635SMaksim Yevmenkin 		n -= sizeof(*e);
27478b96635SMaksim Yevmenkin 
27578b96635SMaksim Yevmenkin 		switch (e->event) {
27678b96635SMaksim Yevmenkin 		case NG_HCI_EVENT_COMMAND_COMPL:
27778b96635SMaksim Yevmenkin 			if (cc->opcode == opcode) {
27878b96635SMaksim Yevmenkin 				n -= sizeof(*cc);
27978b96635SMaksim Yevmenkin 
28078b96635SMaksim Yevmenkin 				if (r->rlen >= n) {
28178b96635SMaksim Yevmenkin 					r->rlen = n;
28278b96635SMaksim Yevmenkin 					memcpy(r->rparam, cc + 1, r->rlen);
28378b96635SMaksim Yevmenkin 				}
28478b96635SMaksim Yevmenkin 
28578b96635SMaksim Yevmenkin 				goto out;
28678b96635SMaksim Yevmenkin 			}
28778b96635SMaksim Yevmenkin 			break;
28878b96635SMaksim Yevmenkin 
28978b96635SMaksim Yevmenkin 		case NG_HCI_EVENT_COMMAND_STATUS:
29078b96635SMaksim Yevmenkin 			if (cs->opcode == opcode) {
29178b96635SMaksim Yevmenkin 				if (r->event != NG_HCI_EVENT_COMMAND_STATUS) {
29278b96635SMaksim Yevmenkin 					if (cs->status != 0) {
29378b96635SMaksim Yevmenkin 						error = EIO;
29478b96635SMaksim Yevmenkin 						goto out;
29578b96635SMaksim Yevmenkin 					}
29678b96635SMaksim Yevmenkin 				} else {
29778b96635SMaksim Yevmenkin 					if (r->rlen >= n) {
29878b96635SMaksim Yevmenkin 						r->rlen = n;
29978b96635SMaksim Yevmenkin 						memcpy(r->rparam, cs, r->rlen);
30078b96635SMaksim Yevmenkin 					}
30178b96635SMaksim Yevmenkin 
30278b96635SMaksim Yevmenkin 					goto out;
30378b96635SMaksim Yevmenkin 				}
30478b96635SMaksim Yevmenkin 			}
30578b96635SMaksim Yevmenkin 			break;
30678b96635SMaksim Yevmenkin 
30778b96635SMaksim Yevmenkin 		default:
30878b96635SMaksim Yevmenkin 			if (e->event == r->event) {
30978b96635SMaksim Yevmenkin 				if (r->rlen >= n) {
31078b96635SMaksim Yevmenkin 					r->rlen = n;
31178b96635SMaksim Yevmenkin 					memcpy(r->rparam, e + 1, r->rlen);
31278b96635SMaksim Yevmenkin 				}
31378b96635SMaksim Yevmenkin 
31478b96635SMaksim Yevmenkin 				goto out;
31578b96635SMaksim Yevmenkin 			}
31678b96635SMaksim Yevmenkin 			break;
31778b96635SMaksim Yevmenkin 		}
31878b96635SMaksim Yevmenkin 	} while (to > 0);
31978b96635SMaksim Yevmenkin 
32078b96635SMaksim Yevmenkin 	error = ETIMEDOUT;
32178b96635SMaksim Yevmenkin out:
32278b96635SMaksim Yevmenkin 	bt_devfilter(s, &old, NULL);
32378b96635SMaksim Yevmenkin 
32478b96635SMaksim Yevmenkin 	if (error != 0) {
32578b96635SMaksim Yevmenkin 		errno = error;
32678b96635SMaksim Yevmenkin 		return (-1);
32778b96635SMaksim Yevmenkin 	}
32878b96635SMaksim Yevmenkin 
32978b96635SMaksim Yevmenkin 	return (0);
33078b96635SMaksim Yevmenkin }
33178b96635SMaksim Yevmenkin 
33278b96635SMaksim Yevmenkin int
bt_devfilter(int s,struct bt_devfilter const * new,struct bt_devfilter * old)33378b96635SMaksim Yevmenkin bt_devfilter(int s, struct bt_devfilter const *new, struct bt_devfilter *old)
33478b96635SMaksim Yevmenkin {
33578b96635SMaksim Yevmenkin 	struct ng_btsocket_hci_raw_filter	f;
33678b96635SMaksim Yevmenkin 	socklen_t				len;
33778b96635SMaksim Yevmenkin 
33878b96635SMaksim Yevmenkin 	if (new == NULL && old == NULL) {
33978b96635SMaksim Yevmenkin 		errno = EINVAL;
34078b96635SMaksim Yevmenkin 		return (-1);
34178b96635SMaksim Yevmenkin 	}
34278b96635SMaksim Yevmenkin 
34378b96635SMaksim Yevmenkin 	if (old != NULL) {
34478b96635SMaksim Yevmenkin 		len = sizeof(f);
34578b96635SMaksim Yevmenkin 		if (getsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, &len) < 0)
34678b96635SMaksim Yevmenkin 			return (-1);
34778b96635SMaksim Yevmenkin 
34878b96635SMaksim Yevmenkin 		memset(old, 0, sizeof(*old));
34978b96635SMaksim Yevmenkin 		memcpy(old->packet_mask, &f.packet_mask,
35078b96635SMaksim Yevmenkin 			MIN(sizeof(old->packet_mask), sizeof(f.packet_mask)));
35178b96635SMaksim Yevmenkin 		memcpy(old->event_mask, &f.event_mask,
35278b96635SMaksim Yevmenkin 			MIN(sizeof(old->event_mask), sizeof(f.packet_mask)));
35378b96635SMaksim Yevmenkin 	}
35478b96635SMaksim Yevmenkin 
35578b96635SMaksim Yevmenkin 	if (new != NULL) {
35678b96635SMaksim Yevmenkin 		memset(&f, 0, sizeof(f));
35778b96635SMaksim Yevmenkin 		memcpy(&f.packet_mask, new->packet_mask,
35878b96635SMaksim Yevmenkin 			MIN(sizeof(f.packet_mask), sizeof(new->event_mask)));
35978b96635SMaksim Yevmenkin 		memcpy(&f.event_mask, new->event_mask,
36078b96635SMaksim Yevmenkin 			MIN(sizeof(f.event_mask), sizeof(new->event_mask)));
36178b96635SMaksim Yevmenkin 
36278b96635SMaksim Yevmenkin 		len = sizeof(f);
36378b96635SMaksim Yevmenkin 		if (setsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, len) < 0)
36478b96635SMaksim Yevmenkin 			return (-1);
36578b96635SMaksim Yevmenkin 	}
36678b96635SMaksim Yevmenkin 
36778b96635SMaksim Yevmenkin 	return (0);
36878b96635SMaksim Yevmenkin }
36978b96635SMaksim Yevmenkin 
37078b96635SMaksim Yevmenkin void
bt_devfilter_pkt_set(struct bt_devfilter * filter,uint8_t type)37178b96635SMaksim Yevmenkin bt_devfilter_pkt_set(struct bt_devfilter *filter, uint8_t type)
37278b96635SMaksim Yevmenkin {
37378b96635SMaksim Yevmenkin 	bit_set(filter->packet_mask, type - 1);
37478b96635SMaksim Yevmenkin }
37578b96635SMaksim Yevmenkin 
37678b96635SMaksim Yevmenkin void
bt_devfilter_pkt_clr(struct bt_devfilter * filter,uint8_t type)37778b96635SMaksim Yevmenkin bt_devfilter_pkt_clr(struct bt_devfilter *filter, uint8_t type)
37878b96635SMaksim Yevmenkin {
37978b96635SMaksim Yevmenkin 	bit_clear(filter->packet_mask, type - 1);
38078b96635SMaksim Yevmenkin }
38178b96635SMaksim Yevmenkin 
38278b96635SMaksim Yevmenkin int
bt_devfilter_pkt_tst(struct bt_devfilter const * filter,uint8_t type)38378b96635SMaksim Yevmenkin bt_devfilter_pkt_tst(struct bt_devfilter const *filter, uint8_t type)
38478b96635SMaksim Yevmenkin {
38578b96635SMaksim Yevmenkin 	return (bit_test(filter->packet_mask, type - 1));
38678b96635SMaksim Yevmenkin }
38778b96635SMaksim Yevmenkin 
38878b96635SMaksim Yevmenkin void
bt_devfilter_evt_set(struct bt_devfilter * filter,uint8_t event)38978b96635SMaksim Yevmenkin bt_devfilter_evt_set(struct bt_devfilter *filter, uint8_t event)
39078b96635SMaksim Yevmenkin {
39178b96635SMaksim Yevmenkin 	bit_set(filter->event_mask, event - 1);
39278b96635SMaksim Yevmenkin }
39378b96635SMaksim Yevmenkin 
39478b96635SMaksim Yevmenkin void
bt_devfilter_evt_clr(struct bt_devfilter * filter,uint8_t event)39578b96635SMaksim Yevmenkin bt_devfilter_evt_clr(struct bt_devfilter *filter, uint8_t event)
39678b96635SMaksim Yevmenkin {
39778b96635SMaksim Yevmenkin 	bit_clear(filter->event_mask, event - 1);
39878b96635SMaksim Yevmenkin }
39978b96635SMaksim Yevmenkin 
40078b96635SMaksim Yevmenkin int
bt_devfilter_evt_tst(struct bt_devfilter const * filter,uint8_t event)40178b96635SMaksim Yevmenkin bt_devfilter_evt_tst(struct bt_devfilter const *filter, uint8_t event)
40278b96635SMaksim Yevmenkin {
40378b96635SMaksim Yevmenkin 	return (bit_test(filter->event_mask, event - 1));
40478b96635SMaksim Yevmenkin }
40578b96635SMaksim Yevmenkin 
40678b96635SMaksim Yevmenkin int
bt_devinquiry(char const * devname,time_t length,int num_rsp,struct bt_devinquiry ** ii)40778b96635SMaksim Yevmenkin bt_devinquiry(char const *devname, time_t length, int num_rsp,
40878b96635SMaksim Yevmenkin 		struct bt_devinquiry **ii)
40978b96635SMaksim Yevmenkin {
41078b96635SMaksim Yevmenkin 	uint8_t				buf[320];
41178b96635SMaksim Yevmenkin 	char				_devname[HCI_DEVNAME_SIZE];
41278b96635SMaksim Yevmenkin 	struct bt_devfilter		f;
41378b96635SMaksim Yevmenkin 	ng_hci_inquiry_cp		*cp = (ng_hci_inquiry_cp *) buf;
41478b96635SMaksim Yevmenkin 	ng_hci_event_pkt_t		*e = (ng_hci_event_pkt_t *) buf;
41578b96635SMaksim Yevmenkin 	ng_hci_inquiry_result_ep	*ep = (ng_hci_inquiry_result_ep *)(e+1);
41678b96635SMaksim Yevmenkin 	ng_hci_inquiry_response		*ir;
41778b96635SMaksim Yevmenkin 	struct bt_devinquiry		*i;
41878b96635SMaksim Yevmenkin 	int				s, n;
41978b96635SMaksim Yevmenkin 
42078b96635SMaksim Yevmenkin 	if (ii == NULL) {
42178b96635SMaksim Yevmenkin 		errno = EINVAL;
42278b96635SMaksim Yevmenkin 		return (-1);
42378b96635SMaksim Yevmenkin 	}
42478b96635SMaksim Yevmenkin 
42578b96635SMaksim Yevmenkin 	if (devname == NULL) {
42678b96635SMaksim Yevmenkin 		memset(_devname, 0, sizeof(_devname));
42778b96635SMaksim Yevmenkin 		devname = _devname;
42878b96635SMaksim Yevmenkin 
42978b96635SMaksim Yevmenkin 		n = bt_devenum(bt_devany_cb, _devname);
43078b96635SMaksim Yevmenkin 		if (n <= 0) {
43178b96635SMaksim Yevmenkin 			if (n == 0)
43278b96635SMaksim Yevmenkin 				*ii = NULL;
43378b96635SMaksim Yevmenkin 
43478b96635SMaksim Yevmenkin 			return (n);
43578b96635SMaksim Yevmenkin 		}
43678b96635SMaksim Yevmenkin 	}
43778b96635SMaksim Yevmenkin 
43878b96635SMaksim Yevmenkin 	s = bt_devopen(devname);
43978b96635SMaksim Yevmenkin 	if (s < 0)
44078b96635SMaksim Yevmenkin 		return (-1);
44178b96635SMaksim Yevmenkin 
44278b96635SMaksim Yevmenkin 	if (bt_devfilter(s, NULL, &f) < 0) {
44378b96635SMaksim Yevmenkin 		bt_devclose(s);
44478b96635SMaksim Yevmenkin 		return (-1);
44578b96635SMaksim Yevmenkin 	}
44678b96635SMaksim Yevmenkin 
44778b96635SMaksim Yevmenkin 	bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_COMPL);
44878b96635SMaksim Yevmenkin 	bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_RESULT);
44978b96635SMaksim Yevmenkin 
45078b96635SMaksim Yevmenkin 	if (bt_devfilter(s, &f, NULL) < 0) {
45178b96635SMaksim Yevmenkin 		bt_devclose(s);
45278b96635SMaksim Yevmenkin 		return (-1);
45378b96635SMaksim Yevmenkin 	}
45478b96635SMaksim Yevmenkin 
45578b96635SMaksim Yevmenkin 	/* Always use GIAC LAP */
45678b96635SMaksim Yevmenkin 	cp->lap[0] = 0x33;
45778b96635SMaksim Yevmenkin 	cp->lap[1] = 0x8b;
45878b96635SMaksim Yevmenkin 	cp->lap[2] = 0x9e;
45978b96635SMaksim Yevmenkin 
460b7ced94cSMaksim Yevmenkin 	/*
461b7ced94cSMaksim Yevmenkin 	 * Calculate inquire length in 1.28 second units
462b7ced94cSMaksim Yevmenkin 	 * v2.x specification says that 1.28 -> 61.44 seconds
463b7ced94cSMaksim Yevmenkin 	 * range is acceptable
464b7ced94cSMaksim Yevmenkin 	 */
46578b96635SMaksim Yevmenkin 
466b7ced94cSMaksim Yevmenkin 	if (length <= 0)
467b7ced94cSMaksim Yevmenkin 		length = 5;
468b7ced94cSMaksim Yevmenkin 	else if (length == 1)
469b7ced94cSMaksim Yevmenkin 		length = 2;
470b7ced94cSMaksim Yevmenkin 	else if (length > 62)
471b7ced94cSMaksim Yevmenkin 		length = 62;
472b7ced94cSMaksim Yevmenkin 
473b7ced94cSMaksim Yevmenkin 	cp->inquiry_length = (uint8_t)((length * 100) / 128);
47478b96635SMaksim Yevmenkin 
47578b96635SMaksim Yevmenkin 	if (num_rsp <= 0 || num_rsp > 255)
47678b96635SMaksim Yevmenkin 		num_rsp = 8;
47778b96635SMaksim Yevmenkin 	cp->num_responses = (uint8_t) num_rsp;
47878b96635SMaksim Yevmenkin 
47978b96635SMaksim Yevmenkin 	i = *ii = calloc(num_rsp, sizeof(struct bt_devinquiry));
48078b96635SMaksim Yevmenkin 	if (i == NULL) {
48178b96635SMaksim Yevmenkin 		bt_devclose(s);
48278b96635SMaksim Yevmenkin 		errno = ENOMEM;
48378b96635SMaksim Yevmenkin 		return (-1);
48478b96635SMaksim Yevmenkin 	}
48578b96635SMaksim Yevmenkin 
48678b96635SMaksim Yevmenkin 	if (bt_devsend(s,
48778b96635SMaksim Yevmenkin 		NG_HCI_OPCODE(NG_HCI_OGF_LINK_CONTROL, NG_HCI_OCF_INQUIRY),
48878b96635SMaksim Yevmenkin 			cp, sizeof(*cp)) < 0) {
48978b96635SMaksim Yevmenkin 		free(i);
49078b96635SMaksim Yevmenkin 		bt_devclose(s);
49178b96635SMaksim Yevmenkin 		return (-1);
49278b96635SMaksim Yevmenkin 	}
49378b96635SMaksim Yevmenkin 
49478b96635SMaksim Yevmenkin wait_for_more:
49578b96635SMaksim Yevmenkin 
496b7ced94cSMaksim Yevmenkin 	n = bt_devrecv(s, buf, sizeof(buf), length);
49778b96635SMaksim Yevmenkin 	if (n < 0) {
49878b96635SMaksim Yevmenkin 		free(i);
49978b96635SMaksim Yevmenkin 		bt_devclose(s);
50078b96635SMaksim Yevmenkin 		return (-1);
50178b96635SMaksim Yevmenkin 	}
50278b96635SMaksim Yevmenkin 
50378b96635SMaksim Yevmenkin 	if (n < sizeof(ng_hci_event_pkt_t)) {
50478b96635SMaksim Yevmenkin 		free(i);
50578b96635SMaksim Yevmenkin 		bt_devclose(s);
50678b96635SMaksim Yevmenkin 		errno = EIO;
50778b96635SMaksim Yevmenkin 		return (-1);
50878b96635SMaksim Yevmenkin 	}
50978b96635SMaksim Yevmenkin 
51078b96635SMaksim Yevmenkin 	switch (e->event) {
51178b96635SMaksim Yevmenkin 	case NG_HCI_EVENT_INQUIRY_COMPL:
51278b96635SMaksim Yevmenkin 		break;
51378b96635SMaksim Yevmenkin 
51478b96635SMaksim Yevmenkin 	case NG_HCI_EVENT_INQUIRY_RESULT:
51578b96635SMaksim Yevmenkin 		ir = (ng_hci_inquiry_response *)(ep + 1);
51678b96635SMaksim Yevmenkin 
51778b96635SMaksim Yevmenkin 		for (n = 0; n < MIN(ep->num_responses, num_rsp); n ++) {
51878b96635SMaksim Yevmenkin 			bdaddr_copy(&i->bdaddr, &ir->bdaddr);
51978b96635SMaksim Yevmenkin 			i->pscan_rep_mode = ir->page_scan_rep_mode;
52078b96635SMaksim Yevmenkin 			i->pscan_period_mode = ir->page_scan_period_mode;
52178b96635SMaksim Yevmenkin 			memcpy(i->dev_class, ir->uclass, sizeof(i->dev_class));
52278b96635SMaksim Yevmenkin 			i->clock_offset = le16toh(ir->clock_offset);
52378b96635SMaksim Yevmenkin 
52478b96635SMaksim Yevmenkin 			ir ++;
52578b96635SMaksim Yevmenkin 			i ++;
52678b96635SMaksim Yevmenkin 			num_rsp --;
52778b96635SMaksim Yevmenkin 		}
52878b96635SMaksim Yevmenkin 		/* FALLTHROUGH */
52978b96635SMaksim Yevmenkin 
53078b96635SMaksim Yevmenkin 	default:
53178b96635SMaksim Yevmenkin 		goto wait_for_more;
53278b96635SMaksim Yevmenkin 		/* NOT REACHED */
53378b96635SMaksim Yevmenkin 	}
53478b96635SMaksim Yevmenkin 
53578b96635SMaksim Yevmenkin 	bt_devclose(s);
53678b96635SMaksim Yevmenkin 
53778b96635SMaksim Yevmenkin 	return (i - *ii);
53878b96635SMaksim Yevmenkin }
53978b96635SMaksim Yevmenkin 
5403ee5c554SVladimir Kondratyev char *
bt_devremote_name(char const * devname,const bdaddr_t * remote,time_t to,uint16_t clk_off,uint8_t ps_rep_mode,uint8_t ps_mode)5413ee5c554SVladimir Kondratyev bt_devremote_name(char const *devname, const bdaddr_t *remote, time_t to,
5423ee5c554SVladimir Kondratyev     uint16_t clk_off, uint8_t ps_rep_mode, uint8_t ps_mode)
5433ee5c554SVladimir Kondratyev {
5443ee5c554SVladimir Kondratyev 	char				 _devname[HCI_DEVNAME_SIZE];
5453ee5c554SVladimir Kondratyev 	struct bt_devreq		 r;
5463ee5c554SVladimir Kondratyev 	ng_hci_remote_name_req_cp	 cp;
5473ee5c554SVladimir Kondratyev 	ng_hci_remote_name_req_compl_ep	 ep;
5483ee5c554SVladimir Kondratyev 	int				 s;
5493ee5c554SVladimir Kondratyev 	char				*remote_name = NULL;
5503ee5c554SVladimir Kondratyev 
5513ee5c554SVladimir Kondratyev 	if (remote == NULL || to < 0) {
5523ee5c554SVladimir Kondratyev 		errno = EINVAL;
5533ee5c554SVladimir Kondratyev 		goto out;
5543ee5c554SVladimir Kondratyev 	}
5553ee5c554SVladimir Kondratyev 
5563ee5c554SVladimir Kondratyev 	if (to == 0) {
5573ee5c554SVladimir Kondratyev 		to = bt_get_default_hci_command_timeout();
5583ee5c554SVladimir Kondratyev 		if (to < 0)
5593ee5c554SVladimir Kondratyev 			goto out;
5603ee5c554SVladimir Kondratyev 	}
5613ee5c554SVladimir Kondratyev 	to++;
5623ee5c554SVladimir Kondratyev 
5633ee5c554SVladimir Kondratyev 	if (devname == NULL) {
5643ee5c554SVladimir Kondratyev 		memset(_devname, 0, sizeof(_devname));
5653ee5c554SVladimir Kondratyev 		devname = _devname;
5663ee5c554SVladimir Kondratyev 		if (bt_devenum(bt_devany_cb, _devname) <= 0)
5673ee5c554SVladimir Kondratyev 			goto out;
5683ee5c554SVladimir Kondratyev         }
5693ee5c554SVladimir Kondratyev 
5703ee5c554SVladimir Kondratyev 	memset(&r, 0, sizeof(r));
5713ee5c554SVladimir Kondratyev 	memset(&cp, 0, sizeof(cp));
5723ee5c554SVladimir Kondratyev 	memset(&ep, 0, sizeof(ep));
5733ee5c554SVladimir Kondratyev 	cp.clock_offset = htole16(clk_off);
5743ee5c554SVladimir Kondratyev 	cp.page_scan_rep_mode = ps_rep_mode;
5753ee5c554SVladimir Kondratyev 	cp.page_scan_mode = ps_mode;
5763ee5c554SVladimir Kondratyev 	bdaddr_copy(&cp.bdaddr, remote);
5773ee5c554SVladimir Kondratyev 	r.opcode = NG_HCI_OPCODE(NG_HCI_OGF_LINK_CONTROL,
5783ee5c554SVladimir Kondratyev 				 NG_HCI_OCF_REMOTE_NAME_REQ);
5793ee5c554SVladimir Kondratyev 	r.event = NG_HCI_EVENT_REMOTE_NAME_REQ_COMPL;
5803ee5c554SVladimir Kondratyev 	r.cparam = &cp;
5813ee5c554SVladimir Kondratyev 	r.clen = sizeof(cp);
5823ee5c554SVladimir Kondratyev 	r.rparam = &ep;
5833ee5c554SVladimir Kondratyev 	r.rlen = sizeof(ep);
5843ee5c554SVladimir Kondratyev 
5853ee5c554SVladimir Kondratyev 	s = bt_devopen(devname);
5863ee5c554SVladimir Kondratyev 	if (s < 0)
5873ee5c554SVladimir Kondratyev 		goto out;
5883ee5c554SVladimir Kondratyev 
5893ee5c554SVladimir Kondratyev 	if (bt_devreq(s, &r, to) == 0 || ep.status == 0x00)
5903ee5c554SVladimir Kondratyev 		remote_name = strndup((const char *)&ep.name, sizeof(ep.name));
5913ee5c554SVladimir Kondratyev 
5923ee5c554SVladimir Kondratyev 	bt_devclose(s);
5933ee5c554SVladimir Kondratyev out:
5943ee5c554SVladimir Kondratyev 	return (remote_name);
5953ee5c554SVladimir Kondratyev }
5963ee5c554SVladimir Kondratyev 
59778b96635SMaksim Yevmenkin int
bt_devinfo(struct bt_devinfo * di)598baeef614SMaksim Yevmenkin bt_devinfo(struct bt_devinfo *di)
599baeef614SMaksim Yevmenkin {
600baeef614SMaksim Yevmenkin 	union {
601baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_state		r0;
602baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_bdaddr		r1;
603baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_features	r2;
604baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_buffer		r3;
605baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_stat		r4;
606baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_link_policy_mask r5;
607baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_packet_mask	r6;
608baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_role_switch	r7;
609baeef614SMaksim Yevmenkin 		struct ng_btsocket_hci_raw_node_debug		r8;
610baeef614SMaksim Yevmenkin 	}						rp;
611baeef614SMaksim Yevmenkin 	struct sockaddr_hci				ha;
61278b96635SMaksim Yevmenkin 	socklen_t					halen;
613baeef614SMaksim Yevmenkin 	int						s, rval;
614baeef614SMaksim Yevmenkin 
615baeef614SMaksim Yevmenkin 	if (di == NULL) {
616baeef614SMaksim Yevmenkin 		errno = EINVAL;
617baeef614SMaksim Yevmenkin 		return (-1);
618baeef614SMaksim Yevmenkin 	}
619baeef614SMaksim Yevmenkin 
62078b96635SMaksim Yevmenkin 	s = bt_devopen(di->devname);
621baeef614SMaksim Yevmenkin 	if (s < 0)
622baeef614SMaksim Yevmenkin 		return (-1);
623baeef614SMaksim Yevmenkin 
624baeef614SMaksim Yevmenkin 	rval = -1;
625baeef614SMaksim Yevmenkin 
62678b96635SMaksim Yevmenkin 	halen = sizeof(ha);
62778b96635SMaksim Yevmenkin 	if (getsockname(s, (struct sockaddr *) &ha, &halen) < 0)
628baeef614SMaksim Yevmenkin 		goto bad;
629baeef614SMaksim Yevmenkin 	strlcpy(di->devname, ha.hci_node, sizeof(di->devname));
630baeef614SMaksim Yevmenkin 
631baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STATE, &rp.r0, sizeof(rp.r0)) < 0)
632baeef614SMaksim Yevmenkin 		goto bad;
633baeef614SMaksim Yevmenkin 	di->state = rp.r0.state;
634baeef614SMaksim Yevmenkin 
635baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BDADDR, &rp.r1, sizeof(rp.r1)) < 0)
636baeef614SMaksim Yevmenkin 		goto bad;
637baeef614SMaksim Yevmenkin 	bdaddr_copy(&di->bdaddr, &rp.r1.bdaddr);
638baeef614SMaksim Yevmenkin 
639baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_FEATURES, &rp.r2, sizeof(rp.r2)) < 0)
640baeef614SMaksim Yevmenkin 		goto bad;
641baeef614SMaksim Yevmenkin 	memcpy(di->features, rp.r2.features, sizeof(di->features));
642baeef614SMaksim Yevmenkin 
643baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BUFFER, &rp.r3, sizeof(rp.r3)) < 0)
644baeef614SMaksim Yevmenkin 		goto bad;
645baeef614SMaksim Yevmenkin 	di->cmd_free = rp.r3.buffer.cmd_free;
646baeef614SMaksim Yevmenkin 	di->sco_size = rp.r3.buffer.sco_size;
647baeef614SMaksim Yevmenkin 	di->sco_pkts = rp.r3.buffer.sco_pkts;
648baeef614SMaksim Yevmenkin 	di->sco_free = rp.r3.buffer.sco_free;
649baeef614SMaksim Yevmenkin 	di->acl_size = rp.r3.buffer.acl_size;
650baeef614SMaksim Yevmenkin 	di->acl_pkts = rp.r3.buffer.acl_pkts;
651baeef614SMaksim Yevmenkin 	di->acl_free = rp.r3.buffer.acl_free;
652baeef614SMaksim Yevmenkin 
653baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STAT, &rp.r4, sizeof(rp.r4)) < 0)
654baeef614SMaksim Yevmenkin 		goto bad;
655baeef614SMaksim Yevmenkin 	di->cmd_sent = rp.r4.stat.cmd_sent;
656baeef614SMaksim Yevmenkin 	di->evnt_recv = rp.r4.stat.evnt_recv;
657baeef614SMaksim Yevmenkin 	di->acl_recv = rp.r4.stat.acl_recv;
658baeef614SMaksim Yevmenkin 	di->acl_sent = rp.r4.stat.acl_sent;
659baeef614SMaksim Yevmenkin 	di->sco_recv = rp.r4.stat.sco_recv;
660baeef614SMaksim Yevmenkin 	di->sco_sent = rp.r4.stat.sco_sent;
661baeef614SMaksim Yevmenkin 	di->bytes_recv = rp.r4.stat.bytes_recv;
662baeef614SMaksim Yevmenkin 	di->bytes_sent = rp.r4.stat.bytes_sent;
663baeef614SMaksim Yevmenkin 
664baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_LINK_POLICY_MASK,
665baeef614SMaksim Yevmenkin 			&rp.r5, sizeof(rp.r5)) < 0)
666baeef614SMaksim Yevmenkin 		goto bad;
667baeef614SMaksim Yevmenkin 	di->link_policy_info = rp.r5.policy_mask;
668baeef614SMaksim Yevmenkin 
669baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_PACKET_MASK,
670baeef614SMaksim Yevmenkin 			&rp.r6, sizeof(rp.r6)) < 0)
671baeef614SMaksim Yevmenkin 		goto bad;
672baeef614SMaksim Yevmenkin 	di->packet_type_info = rp.r6.packet_mask;
673baeef614SMaksim Yevmenkin 
674baeef614SMaksim Yevmenkin 	 if (ioctl(s, SIOC_HCI_RAW_NODE_GET_ROLE_SWITCH,
675baeef614SMaksim Yevmenkin 			&rp.r7, sizeof(rp.r7)) < 0)
676baeef614SMaksim Yevmenkin 		goto bad;
677baeef614SMaksim Yevmenkin 	di->role_switch_info = rp.r7.role_switch;
678baeef614SMaksim Yevmenkin 
679baeef614SMaksim Yevmenkin 	if (ioctl(s, SIOC_HCI_RAW_NODE_GET_DEBUG, &rp.r8, sizeof(rp.r8)) < 0)
680baeef614SMaksim Yevmenkin 		goto bad;
681baeef614SMaksim Yevmenkin 	di->debug = rp.r8.debug;
682baeef614SMaksim Yevmenkin 
683baeef614SMaksim Yevmenkin 	rval = 0;
684baeef614SMaksim Yevmenkin bad:
68578b96635SMaksim Yevmenkin 	bt_devclose(s);
686baeef614SMaksim Yevmenkin 
687baeef614SMaksim Yevmenkin 	return (rval);
688baeef614SMaksim Yevmenkin }
689baeef614SMaksim Yevmenkin 
690baeef614SMaksim Yevmenkin int
bt_devenum(bt_devenum_cb_t cb,void * arg)691baeef614SMaksim Yevmenkin bt_devenum(bt_devenum_cb_t cb, void *arg)
692baeef614SMaksim Yevmenkin {
693baeef614SMaksim Yevmenkin 	struct ng_btsocket_hci_raw_node_list_names	rp;
694baeef614SMaksim Yevmenkin 	struct bt_devinfo				di;
695baeef614SMaksim Yevmenkin 	struct sockaddr_hci				ha;
696baeef614SMaksim Yevmenkin 	int						s, i, count;
697baeef614SMaksim Yevmenkin 
698baeef614SMaksim Yevmenkin 	rp.num_names = HCI_DEVMAX;
699baeef614SMaksim Yevmenkin 	rp.names = (struct nodeinfo *) calloc(rp.num_names,
700baeef614SMaksim Yevmenkin 						sizeof(struct nodeinfo));
701baeef614SMaksim Yevmenkin 	if (rp.names == NULL) {
702baeef614SMaksim Yevmenkin 		errno = ENOMEM;
703baeef614SMaksim Yevmenkin 		return (-1);
704baeef614SMaksim Yevmenkin 	}
705baeef614SMaksim Yevmenkin 
706baeef614SMaksim Yevmenkin 	memset(&ha, 0, sizeof(ha));
707baeef614SMaksim Yevmenkin 	ha.hci_len = sizeof(ha);
708baeef614SMaksim Yevmenkin 	ha.hci_family = AF_BLUETOOTH;
709baeef614SMaksim Yevmenkin 	ha.hci_node[0] = 'x';
710baeef614SMaksim Yevmenkin 
711baeef614SMaksim Yevmenkin 	s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI);
712baeef614SMaksim Yevmenkin 	if (s < 0) {
713baeef614SMaksim Yevmenkin 		free(rp.names);
714baeef614SMaksim Yevmenkin 
715baeef614SMaksim Yevmenkin 		return (-1);
716baeef614SMaksim Yevmenkin 	}
717baeef614SMaksim Yevmenkin 
718baeef614SMaksim Yevmenkin 	if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 ||
719baeef614SMaksim Yevmenkin 	    connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 ||
720baeef614SMaksim Yevmenkin 	    ioctl(s, SIOC_HCI_RAW_NODE_LIST_NAMES, &rp, sizeof(rp)) < 0) {
721baeef614SMaksim Yevmenkin 		close(s);
722baeef614SMaksim Yevmenkin 		free(rp.names);
723baeef614SMaksim Yevmenkin 
724baeef614SMaksim Yevmenkin 		return (-1);
725baeef614SMaksim Yevmenkin 	}
726baeef614SMaksim Yevmenkin 
727baeef614SMaksim Yevmenkin 	for (count = 0, i = 0; i < rp.num_names; i ++) {
728baeef614SMaksim Yevmenkin 		strlcpy(di.devname, rp.names[i].name, sizeof(di.devname));
729baeef614SMaksim Yevmenkin 		if (bt_devinfo(&di) < 0)
730baeef614SMaksim Yevmenkin 			continue;
731baeef614SMaksim Yevmenkin 
732baeef614SMaksim Yevmenkin 		count ++;
733baeef614SMaksim Yevmenkin 
734baeef614SMaksim Yevmenkin 		if (cb == NULL)
735baeef614SMaksim Yevmenkin 			continue;
736baeef614SMaksim Yevmenkin 
737baeef614SMaksim Yevmenkin 		strlcpy(ha.hci_node, rp.names[i].name, sizeof(ha.hci_node));
738baeef614SMaksim Yevmenkin 		if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 ||
739baeef614SMaksim Yevmenkin 		    connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0)
740baeef614SMaksim Yevmenkin 			continue;
741baeef614SMaksim Yevmenkin 
742baeef614SMaksim Yevmenkin 		if ((*cb)(s, &di, arg) > 0)
743baeef614SMaksim Yevmenkin 			break;
744baeef614SMaksim Yevmenkin 	}
745baeef614SMaksim Yevmenkin 
746baeef614SMaksim Yevmenkin 	close (s);
747baeef614SMaksim Yevmenkin 	free(rp.names);
748baeef614SMaksim Yevmenkin 
749baeef614SMaksim Yevmenkin 	return (count);
750baeef614SMaksim Yevmenkin }
751baeef614SMaksim Yevmenkin 
75278b96635SMaksim Yevmenkin static int
bt_devany_cb(int s,struct bt_devinfo const * di,void * xdevname)75378b96635SMaksim Yevmenkin bt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname)
75478b96635SMaksim Yevmenkin {
75578b96635SMaksim Yevmenkin 	strlcpy((char *) xdevname, di->devname, HCI_DEVNAME_SIZE);
75678b96635SMaksim Yevmenkin 	return (1);
75778b96635SMaksim Yevmenkin }
75878b96635SMaksim Yevmenkin 
759baeef614SMaksim Yevmenkin static char *
bt_dev2node(char const * devname,char * nodename,int nnlen)760baeef614SMaksim Yevmenkin bt_dev2node(char const *devname, char *nodename, int nnlen)
761baeef614SMaksim Yevmenkin {
762baeef614SMaksim Yevmenkin 	static char const *	 bt_dev_prefix[] = {
763baeef614SMaksim Yevmenkin 		"ubt",		/* Bluetooth USB devices */
764baeef614SMaksim Yevmenkin 		NULL		/* should be last */
765baeef614SMaksim Yevmenkin 	};
766baeef614SMaksim Yevmenkin 
767baeef614SMaksim Yevmenkin 	static char		_nodename[HCI_DEVNAME_SIZE];
768baeef614SMaksim Yevmenkin 	char const		**p;
769baeef614SMaksim Yevmenkin 	char			*ep;
770baeef614SMaksim Yevmenkin 	int			plen, unit;
771baeef614SMaksim Yevmenkin 
772baeef614SMaksim Yevmenkin 	if (nodename == NULL) {
773baeef614SMaksim Yevmenkin 		nodename = _nodename;
774baeef614SMaksim Yevmenkin 		nnlen = HCI_DEVNAME_SIZE;
775baeef614SMaksim Yevmenkin 	}
776baeef614SMaksim Yevmenkin 
777baeef614SMaksim Yevmenkin 	for (p = bt_dev_prefix; *p != NULL; p ++) {
778baeef614SMaksim Yevmenkin 		plen = strlen(*p);
779baeef614SMaksim Yevmenkin 		if (strncmp(devname, *p, plen) != 0)
780baeef614SMaksim Yevmenkin 			continue;
781baeef614SMaksim Yevmenkin 
782baeef614SMaksim Yevmenkin 		unit = strtoul(devname + plen, &ep, 10);
783baeef614SMaksim Yevmenkin 		if (*ep != '\0' &&
784baeef614SMaksim Yevmenkin 		    strcmp(ep, "hci") != 0 &&
785baeef614SMaksim Yevmenkin 		    strcmp(ep, "l2cap") != 0)
786baeef614SMaksim Yevmenkin 			return (NULL);	/* can't make sense of device name */
787baeef614SMaksim Yevmenkin 
788baeef614SMaksim Yevmenkin 		snprintf(nodename, nnlen, "%s%uhci", *p, unit);
789baeef614SMaksim Yevmenkin 
790baeef614SMaksim Yevmenkin 		return (nodename);
791baeef614SMaksim Yevmenkin 	}
792baeef614SMaksim Yevmenkin 
793baeef614SMaksim Yevmenkin 	return (NULL);
794baeef614SMaksim Yevmenkin }
795baeef614SMaksim Yevmenkin 
7963ee5c554SVladimir Kondratyev static time_t
bt_get_default_hci_command_timeout(void)7973ee5c554SVladimir Kondratyev bt_get_default_hci_command_timeout(void)
7983ee5c554SVladimir Kondratyev {
7993ee5c554SVladimir Kondratyev 	int	to;
8003ee5c554SVladimir Kondratyev 	size_t	to_size = sizeof(to);
8013ee5c554SVladimir Kondratyev 
8023ee5c554SVladimir Kondratyev 	if (sysctlbyname("net.bluetooth.hci.command_timeout",
8033ee5c554SVladimir Kondratyev 			 &to, &to_size, NULL, 0) < 0)
8043ee5c554SVladimir Kondratyev 		return (-1);
8053ee5c554SVladimir Kondratyev 
8063ee5c554SVladimir Kondratyev 	/* Should not happen */
8073ee5c554SVladimir Kondratyev 	if (to <= 0) {
8083ee5c554SVladimir Kondratyev 		errno = ERANGE;
8093ee5c554SVladimir Kondratyev 		return (-1);
8103ee5c554SVladimir Kondratyev 	}
8113ee5c554SVladimir Kondratyev 
8123ee5c554SVladimir Kondratyev 	return ((time_t)to);
8133ee5c554SVladimir Kondratyev }
814