1 /* $NetBSD: hci_misc.c,v 1.3 2007/09/16 19:59:30 plunky Exp $ */
2
3 /*-
4 * Copyright (c) 2005 Iain Hibbert.
5 * Copyright (c) 2006 Itronix Inc.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. The name of Itronix Inc. may not be used to endorse
17 * or promote products derived from this software without specific
18 * prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
24 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
25 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
27 * ON ANY THEORY OF LIABILITY, WHETHER IN
28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: hci_misc.c,v 1.3 2007/09/16 19:59:30 plunky Exp $");
35
36 #include <sys/param.h>
37 #include <sys/kernel.h>
38 #include <sys/malloc.h>
39 #include <sys/mbuf.h>
40 #include <sys/proc.h>
41 #include <sys/queue.h>
42 #include <sys/systm.h>
43
44 #include <netbt/bluetooth.h>
45 #include <netbt/hci.h>
46
47 /*
48 * cache Inquiry Responses for this number of seconds for routing
49 * purposes [sysctl]
50 */
51 int hci_memo_expiry = 600;
52
53 /*
54 * set 'src' address for routing to 'dest'
55 */
56 int
hci_route_lookup(bdaddr_t * src,bdaddr_t * dest)57 hci_route_lookup(bdaddr_t *src, bdaddr_t *dest)
58 {
59 struct hci_unit *unit;
60 struct hci_link *link;
61 struct hci_memo *memo;
62
63 /*
64 * Walk the ACL connections, if we have a connection
65 * to 'dest' already then thats best..
66 */
67 SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
68 if ((unit->hci_flags & BTF_UP) == 0)
69 continue;
70
71 TAILQ_FOREACH(link, &unit->hci_links, hl_next) {
72 if (link->hl_type != HCI_LINK_ACL)
73 continue;
74
75 if (bdaddr_same(&link->hl_bdaddr, dest))
76 goto found;
77 }
78 }
79
80 /*
81 * Now check all the memos to see if there has been an
82 * inquiry repsonse..
83 */
84 SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
85 if ((unit->hci_flags & BTF_UP) == 0)
86 continue;
87
88 memo = hci_memo_find(unit, dest);
89 if (memo)
90 goto found;
91 }
92
93 /*
94 * Last ditch effort, lets use the first unit we find
95 * thats up and running. (XXX settable default route?)
96 */
97 SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
98 if ((unit->hci_flags & BTF_UP) == 0)
99 continue;
100
101 goto found;
102 }
103
104 return EHOSTUNREACH;
105
106 found:
107 bdaddr_copy(src, &unit->hci_bdaddr);
108 return 0;
109 }
110
111 /*
112 * find unit memo from bdaddr
113 */
114 struct hci_memo *
hci_memo_find(struct hci_unit * unit,bdaddr_t * bdaddr)115 hci_memo_find(struct hci_unit *unit, bdaddr_t *bdaddr)
116 {
117 struct hci_memo *memo, *m0;
118 struct timeval now;
119
120 microtime(&now);
121
122 m0 = LIST_FIRST(&unit->hci_memos);
123 while ((memo = m0) != NULL) {
124 m0 = LIST_NEXT(memo, next);
125
126 if (now.tv_sec > memo->time.tv_sec + hci_memo_expiry) {
127 DPRINTF("memo %p too old (expiring)\n", memo);
128 hci_memo_free(memo);
129 continue;
130 }
131
132 if (bdaddr_same(bdaddr, &memo->bdaddr)) {
133 DPRINTF("memo %p found\n", memo);
134 return memo;
135 }
136 }
137
138 DPRINTF("no memo found\n");
139 return NULL;
140 }
141
142 /*
143 * Make a new memo on unit for bdaddr. If a memo exists, just
144 * update the timestamp.
145 */
146 struct hci_memo *
hci_memo_new(struct hci_unit * unit,bdaddr_t * bdaddr)147 hci_memo_new(struct hci_unit *unit, bdaddr_t *bdaddr)
148 {
149 struct hci_memo *memo;
150
151 memo = hci_memo_find(unit, bdaddr);
152 if (memo == NULL) {
153 memo = malloc(sizeof(struct hci_memo),
154 M_BLUETOOTH, M_NOWAIT | M_ZERO);
155
156 if (memo == NULL) {
157 DPRINTFN(0, "no memory for memo!\n");
158 return NULL;
159 }
160
161 DPRINTF("memo created for %02x:%02x:%02x:%02x:%02x:%02x\n",
162 bdaddr->b[5], bdaddr->b[4], bdaddr->b[3],
163 bdaddr->b[2], bdaddr->b[1], bdaddr->b[0]);
164
165 bdaddr_copy(&memo->bdaddr, bdaddr);
166 LIST_INSERT_HEAD(&unit->hci_memos, memo, next);
167 }
168 else
169 DPRINTF("memo updated for %02x:%02x:%02x:%02x:%02x:%02x\n",
170 bdaddr->b[5], bdaddr->b[4], bdaddr->b[3],
171 bdaddr->b[2], bdaddr->b[1], bdaddr->b[0]);
172
173 microtime(&memo->time);
174 return memo;
175 }
176
177 void
hci_memo_free(struct hci_memo * memo)178 hci_memo_free(struct hci_memo *memo)
179 {
180
181 LIST_REMOVE(memo, next);
182 free(memo, M_BLUETOOTH);
183 }
184