ieee80211_netbsd.c revision 1.16.4.1 1 1.16 christos /* $NetBSD: ieee80211_netbsd.c,v 1.16.4.1 2008/02/22 16:50:25 skrll Exp $ */
2 1.1 dyoung /*-
3 1.1 dyoung * Copyright (c) 2003-2005 Sam Leffler, Errno Consulting
4 1.1 dyoung * All rights reserved.
5 1.1 dyoung *
6 1.1 dyoung * Redistribution and use in source and binary forms, with or without
7 1.1 dyoung * modification, are permitted provided that the following conditions
8 1.1 dyoung * are met:
9 1.1 dyoung * 1. Redistributions of source code must retain the above copyright
10 1.1 dyoung * notice, this list of conditions and the following disclaimer.
11 1.1 dyoung * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 dyoung * notice, this list of conditions and the following disclaimer in the
13 1.1 dyoung * documentation and/or other materials provided with the distribution.
14 1.1 dyoung * 3. The name of the author may not be used to endorse or promote products
15 1.1 dyoung * derived from this software without specific prior written permission.
16 1.1 dyoung *
17 1.1 dyoung * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 1.1 dyoung * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 1.1 dyoung * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 1.1 dyoung * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 1.1 dyoung * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 1.1 dyoung * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 1.1 dyoung * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 1.1 dyoung * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 1.1 dyoung * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 1.1 dyoung * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 1.1 dyoung */
28 1.1 dyoung
29 1.1 dyoung #include <sys/cdefs.h>
30 1.2 dyoung #ifdef __FreeBSD__
31 1.8 skrll __FBSDID("$FreeBSD: src/sys/net80211/ieee80211_freebsd.c,v 1.8 2005/08/08 18:46:35 sam Exp $");
32 1.2 dyoung #else
33 1.16 christos __KERNEL_RCSID(0, "$NetBSD: ieee80211_netbsd.c,v 1.16.4.1 2008/02/22 16:50:25 skrll Exp $");
34 1.2 dyoung #endif
35 1.1 dyoung
36 1.1 dyoung /*
37 1.10 thorpej * IEEE 802.11 support (NetBSD-specific code)
38 1.1 dyoung */
39 1.1 dyoung #include <sys/param.h>
40 1.1 dyoung #include <sys/kernel.h>
41 1.1 dyoung #include <sys/systm.h>
42 1.1 dyoung #include <sys/mbuf.h>
43 1.1 dyoung #include <sys/proc.h>
44 1.1 dyoung #include <sys/sysctl.h>
45 1.10 thorpej #include <sys/once.h>
46 1.1 dyoung
47 1.2 dyoung #include <machine/stdarg.h>
48 1.2 dyoung
49 1.1 dyoung #include <sys/socket.h>
50 1.1 dyoung
51 1.1 dyoung #include <net/if.h>
52 1.1 dyoung #include <net/if_media.h>
53 1.2 dyoung #include <net/if_ether.h>
54 1.1 dyoung #include <net/route.h>
55 1.1 dyoung
56 1.1 dyoung #include <net80211/ieee80211_var.h>
57 1.2 dyoung #include <net80211/ieee80211_sysctl.h>
58 1.16.4.1 skrll #include <net80211/ieee80211_netbsd.h>
59 1.2 dyoung
60 1.2 dyoung #define LOGICALLY_EQUAL(x, y) (!(x) == !(y))
61 1.1 dyoung
62 1.2 dyoung static void ieee80211_sysctl_fill_node(struct ieee80211_node *,
63 1.16.4.1 skrll struct ieee80211_node_sysctl *, int, const struct ieee80211_channel *);
64 1.2 dyoung static int ieee80211_sysctl_node(SYSCTLFN_ARGS);
65 1.1 dyoung
66 1.1 dyoung #ifdef IEEE80211_DEBUG
67 1.1 dyoung int ieee80211_debug = 0;
68 1.1 dyoung #endif
69 1.1 dyoung
70 1.8 skrll typedef void (*ieee80211_setup_func)(void);
71 1.8 skrll
72 1.8 skrll __link_set_decl(ieee80211_funcs, ieee80211_setup_func);
73 1.8 skrll
74 1.12 yamt static int
75 1.10 thorpej ieee80211_init0(void)
76 1.8 skrll {
77 1.8 skrll ieee80211_setup_func * const *ieee80211_setup, f;
78 1.8 skrll
79 1.8 skrll __link_set_foreach(ieee80211_setup, ieee80211_funcs) {
80 1.8 skrll f = (void*)*ieee80211_setup;
81 1.8 skrll (*f)();
82 1.8 skrll }
83 1.12 yamt
84 1.12 yamt return 0;
85 1.8 skrll }
86 1.8 skrll
87 1.10 thorpej void
88 1.16.4.1 skrll net80211_init(void)
89 1.10 thorpej {
90 1.10 thorpej static ONCE_DECL(ieee80211_init_once);
91 1.10 thorpej
92 1.10 thorpej RUN_ONCE(&ieee80211_init_once, ieee80211_init0);
93 1.10 thorpej }
94 1.10 thorpej
95 1.1 dyoung static int
96 1.2 dyoung ieee80211_sysctl_inact(SYSCTLFN_ARGS)
97 1.1 dyoung {
98 1.2 dyoung int error, t;
99 1.2 dyoung struct sysctlnode node;
100 1.2 dyoung
101 1.2 dyoung node = *rnode;
102 1.2 dyoung /* sysctl_lookup copies the product from t. Then, it
103 1.2 dyoung * copies the new value onto t.
104 1.2 dyoung */
105 1.2 dyoung t = *(int*)rnode->sysctl_data * IEEE80211_INACT_WAIT;
106 1.2 dyoung node.sysctl_data = &t;
107 1.2 dyoung error = sysctl_lookup(SYSCTLFN_CALL(&node));
108 1.2 dyoung if (error || newp == NULL)
109 1.2 dyoung return (error);
110 1.2 dyoung
111 1.2 dyoung /* The new value was in seconds. Convert to inactivity-wait
112 1.2 dyoung * intervals. There are IEEE80211_INACT_WAIT seconds per
113 1.2 dyoung * interval.
114 1.2 dyoung */
115 1.2 dyoung *(int*)rnode->sysctl_data = t / IEEE80211_INACT_WAIT;
116 1.1 dyoung
117 1.2 dyoung return (0);
118 1.1 dyoung }
119 1.1 dyoung
120 1.1 dyoung static int
121 1.2 dyoung ieee80211_sysctl_parent(SYSCTLFN_ARGS)
122 1.1 dyoung {
123 1.2 dyoung struct ieee80211com *ic;
124 1.2 dyoung char pname[IFNAMSIZ];
125 1.2 dyoung struct sysctlnode node;
126 1.2 dyoung
127 1.2 dyoung node = *rnode;
128 1.2 dyoung ic = node.sysctl_data;
129 1.2 dyoung strncpy(pname, ic->ic_ifp->if_xname, IFNAMSIZ);
130 1.2 dyoung node.sysctl_data = pname;
131 1.2 dyoung return sysctl_lookup(SYSCTLFN_CALL(&node));
132 1.2 dyoung }
133 1.2 dyoung
134 1.2 dyoung /*
135 1.2 dyoung * Create or get top of sysctl tree net.link.ieee80211.
136 1.2 dyoung */
137 1.2 dyoung static const struct sysctlnode *
138 1.2 dyoung ieee80211_sysctl_treetop(struct sysctllog **log)
139 1.2 dyoung {
140 1.2 dyoung int rc;
141 1.2 dyoung const struct sysctlnode *rnode;
142 1.1 dyoung
143 1.2 dyoung if ((rc = sysctl_createv(log, 0, NULL, &rnode,
144 1.2 dyoung CTLFLAG_PERMANENT, CTLTYPE_NODE, "net", NULL,
145 1.2 dyoung NULL, 0, NULL, 0, CTL_NET, CTL_EOL)) != 0)
146 1.2 dyoung goto err;
147 1.2 dyoung
148 1.2 dyoung if ((rc = sysctl_createv(log, 0, &rnode, &rnode,
149 1.2 dyoung CTLFLAG_PERMANENT, CTLTYPE_NODE, "link",
150 1.2 dyoung "link-layer statistics and controls",
151 1.2 dyoung NULL, 0, NULL, 0, PF_LINK, CTL_EOL)) != 0)
152 1.2 dyoung goto err;
153 1.2 dyoung
154 1.2 dyoung if ((rc = sysctl_createv(log, 0, &rnode, &rnode,
155 1.2 dyoung CTLFLAG_PERMANENT, CTLTYPE_NODE, "ieee80211",
156 1.2 dyoung "IEEE 802.11 WLAN statistics and controls",
157 1.2 dyoung NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0)
158 1.2 dyoung goto err;
159 1.2 dyoung
160 1.2 dyoung return rnode;
161 1.2 dyoung err:
162 1.2 dyoung printf("%s: sysctl_createv failed, rc = %d\n", __func__, rc);
163 1.2 dyoung return NULL;
164 1.1 dyoung }
165 1.1 dyoung
166 1.1 dyoung void
167 1.1 dyoung ieee80211_sysctl_attach(struct ieee80211com *ic)
168 1.1 dyoung {
169 1.2 dyoung int rc;
170 1.2 dyoung const struct sysctlnode *cnode, *rnode;
171 1.2 dyoung char num[sizeof("vap") + 14]; /* sufficient for 32 bits */
172 1.2 dyoung
173 1.2 dyoung if ((rnode = ieee80211_sysctl_treetop(NULL)) == NULL)
174 1.1 dyoung return;
175 1.2 dyoung
176 1.2 dyoung snprintf(num, sizeof(num), "vap%u", ic->ic_vap);
177 1.2 dyoung
178 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &rnode,
179 1.2 dyoung CTLFLAG_PERMANENT, CTLTYPE_NODE, num, SYSCTL_DESCR("virtual AP"),
180 1.2 dyoung NULL, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0)
181 1.2 dyoung goto err;
182 1.2 dyoung
183 1.2 dyoung /* control debugging printfs */
184 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
185 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READONLY, CTLTYPE_STRING,
186 1.2 dyoung "parent", SYSCTL_DESCR("parent device"),
187 1.2 dyoung ieee80211_sysctl_parent, 0, ic, IFNAMSIZ, CTL_CREATE,
188 1.2 dyoung CTL_EOL)) != 0)
189 1.2 dyoung goto err;
190 1.2 dyoung
191 1.1 dyoung #ifdef IEEE80211_DEBUG
192 1.2 dyoung /* control debugging printfs */
193 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
194 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
195 1.2 dyoung "debug", SYSCTL_DESCR("control debugging printfs"),
196 1.2 dyoung NULL, ieee80211_debug, &ic->ic_debug, 0,
197 1.2 dyoung CTL_CREATE, CTL_EOL)) != 0)
198 1.2 dyoung goto err;
199 1.1 dyoung #endif
200 1.1 dyoung /* XXX inherit from tunables */
201 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
202 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
203 1.2 dyoung "inact_run", SYSCTL_DESCR("station inactivity timeout (sec)"),
204 1.2 dyoung ieee80211_sysctl_inact, 0, &ic->ic_inact_run, 0,
205 1.2 dyoung CTL_CREATE, CTL_EOL)) != 0)
206 1.2 dyoung goto err;
207 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
208 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
209 1.2 dyoung "inact_probe",
210 1.2 dyoung SYSCTL_DESCR("station inactivity probe timeout (sec)"),
211 1.2 dyoung ieee80211_sysctl_inact, 0, &ic->ic_inact_probe, 0,
212 1.2 dyoung CTL_CREATE, CTL_EOL)) != 0)
213 1.2 dyoung goto err;
214 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
215 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
216 1.2 dyoung "inact_auth",
217 1.2 dyoung SYSCTL_DESCR("station authentication timeout (sec)"),
218 1.2 dyoung ieee80211_sysctl_inact, 0, &ic->ic_inact_auth, 0,
219 1.2 dyoung CTL_CREATE, CTL_EOL)) != 0)
220 1.2 dyoung goto err;
221 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
222 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
223 1.2 dyoung "inact_init",
224 1.2 dyoung SYSCTL_DESCR("station initial state timeout (sec)"),
225 1.2 dyoung ieee80211_sysctl_inact, 0, &ic->ic_inact_init, 0,
226 1.2 dyoung CTL_CREATE, CTL_EOL)) != 0)
227 1.2 dyoung goto err;
228 1.2 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
229 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
230 1.2 dyoung "driver_caps", SYSCTL_DESCR("driver capabilities"),
231 1.2 dyoung NULL, 0, &ic->ic_caps, 0, CTL_CREATE, CTL_EOL)) != 0)
232 1.2 dyoung goto err;
233 1.13 dyoung if ((rc = sysctl_createv(&ic->ic_sysctllog, 0, &rnode, &cnode,
234 1.13 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
235 1.13 dyoung "bmiss_max", SYSCTL_DESCR("consecutive beacon misses before scanning"),
236 1.13 dyoung NULL, 0, &ic->ic_bmiss_max, 0, CTL_CREATE, CTL_EOL)) != 0)
237 1.13 dyoung goto err;
238 1.2 dyoung
239 1.2 dyoung return;
240 1.2 dyoung err:
241 1.2 dyoung printf("%s: sysctl_createv failed, rc = %d\n", __func__, rc);
242 1.1 dyoung }
243 1.1 dyoung
244 1.1 dyoung void
245 1.1 dyoung ieee80211_sysctl_detach(struct ieee80211com *ic)
246 1.1 dyoung {
247 1.2 dyoung sysctl_teardown(&ic->ic_sysctllog);
248 1.2 dyoung }
249 1.2 dyoung
250 1.2 dyoung static void
251 1.2 dyoung ieee80211_sysctl_fill_node(struct ieee80211_node *ni,
252 1.2 dyoung struct ieee80211_node_sysctl *ns, int ifindex,
253 1.16.4.1 skrll const struct ieee80211_channel *chan0)
254 1.2 dyoung {
255 1.2 dyoung ns->ns_ifindex = ifindex;
256 1.2 dyoung ns->ns_capinfo = ni->ni_capinfo;
257 1.16.4.1 skrll ns->ns_flags |= IEEE80211_NODE_SYSCTL_F_STA;
258 1.2 dyoung (void)memcpy(ns->ns_macaddr, ni->ni_macaddr, sizeof(ns->ns_macaddr));
259 1.2 dyoung (void)memcpy(ns->ns_bssid, ni->ni_bssid, sizeof(ns->ns_bssid));
260 1.2 dyoung if (ni->ni_chan != IEEE80211_CHAN_ANYC) {
261 1.2 dyoung ns->ns_freq = ni->ni_chan->ic_freq;
262 1.2 dyoung ns->ns_chanflags = ni->ni_chan->ic_flags;
263 1.2 dyoung ns->ns_chanidx = ni->ni_chan - chan0;
264 1.2 dyoung } else {
265 1.2 dyoung ns->ns_freq = ns->ns_chanflags = 0;
266 1.2 dyoung ns->ns_chanidx = 0;
267 1.1 dyoung }
268 1.2 dyoung ns->ns_rssi = ni->ni_rssi;
269 1.2 dyoung ns->ns_esslen = ni->ni_esslen;
270 1.2 dyoung (void)memcpy(ns->ns_essid, ni->ni_essid, sizeof(ns->ns_essid));
271 1.2 dyoung ns->ns_erp = ni->ni_erp;
272 1.2 dyoung ns->ns_associd = ni->ni_associd;
273 1.2 dyoung ns->ns_inact = ni->ni_inact * IEEE80211_INACT_WAIT;
274 1.2 dyoung ns->ns_rstamp = ni->ni_rstamp;
275 1.2 dyoung ns->ns_rates = ni->ni_rates;
276 1.2 dyoung ns->ns_txrate = ni->ni_txrate;
277 1.2 dyoung ns->ns_intval = ni->ni_intval;
278 1.2 dyoung (void)memcpy(ns->ns_tstamp, &ni->ni_tstamp, sizeof(ns->ns_tstamp));
279 1.2 dyoung ns->ns_txseq = ni->ni_txseqs[0];
280 1.2 dyoung ns->ns_rxseq = ni->ni_rxseqs[0];
281 1.2 dyoung ns->ns_fhdwell = ni->ni_fhdwell;
282 1.2 dyoung ns->ns_fhindex = ni->ni_fhindex;
283 1.2 dyoung ns->ns_fails = ni->ni_fails;
284 1.2 dyoung }
285 1.2 dyoung
286 1.16.4.1 skrll static void
287 1.16.4.1 skrll sysctl_read_scan(void *arg, const struct ieee80211_scan_entry *se)
288 1.16.4.1 skrll {
289 1.16.4.1 skrll struct ieee80211_node_sysctl ns;
290 1.16.4.1 skrll struct ieee80211_node_walk *nw = arg;
291 1.16.4.1 skrll struct ieee80211com *ic = nw->nw_ic;
292 1.16.4.1 skrll int error, nr, nxr;
293 1.16.4.1 skrll
294 1.16.4.1 skrll if (nw->nw_error != 0 || nw->nw_nelt <= 0)
295 1.16.4.1 skrll return;
296 1.16.4.1 skrll
297 1.16.4.1 skrll if (nw->nw_len >= nw->nw_eltsize) {
298 1.16.4.1 skrll memset(&ns, 0, sizeof(ns));
299 1.16.4.1 skrll ns.ns_ifindex = ic->ic_ifp->if_index;
300 1.16.4.1 skrll IEEE80211_ADDR_COPY(ns.ns_bssid, se->se_bssid);
301 1.16.4.1 skrll ns.ns_capinfo = se->se_capinfo;
302 1.16.4.1 skrll ns.ns_flags = IEEE80211_NODE_SYSCTL_F_SCAN;
303 1.16.4.1 skrll ns.ns_freq = se->se_chan->ic_freq;
304 1.16.4.1 skrll ns.ns_chanflags = se->se_chan->ic_flags;
305 1.16.4.1 skrll ns.ns_chanidx = &ic->ic_channels[0] - se->se_chan; /* XXXNH */
306 1.16.4.1 skrll ns.ns_rssi = se->se_rssi;
307 1.16.4.1 skrll ns.ns_esslen = se->se_ssid[1];
308 1.16.4.1 skrll (void)memcpy(ns.ns_essid, se->se_ssid+2, ns.ns_esslen);
309 1.16.4.1 skrll ns.ns_erp = se->se_erp;
310 1.16.4.1 skrll ns.ns_rstamp = se->se_rstamp;
311 1.16.4.1 skrll nr = min(se->se_rates[1], IEEE80211_RATE_MAXSIZE);
312 1.16.4.1 skrll memcpy(ns.ns_rates.rs_rates, se->se_rates+2, nr);
313 1.16.4.1 skrll nxr = min(se->se_xrates[1], IEEE80211_RATE_MAXSIZE - nr);
314 1.16.4.1 skrll memcpy(ns.ns_rates.rs_rates+nr, se->se_xrates+2, nxr);
315 1.16.4.1 skrll ns.ns_rates.rs_nrates = nr + nxr;
316 1.16.4.1 skrll ns.ns_intval = se->se_intval;
317 1.16.4.1 skrll (void)memcpy(ns.ns_tstamp, &se->se_tstamp,
318 1.16.4.1 skrll sizeof(ns.ns_tstamp));
319 1.16.4.1 skrll ns.ns_fhdwell = se->se_fhdwell;
320 1.16.4.1 skrll ns.ns_fhindex = se->se_fhindex;
321 1.16.4.1 skrll
322 1.16.4.1 skrll error = copyout(&ns, nw->nw_dp, nw->nw_out_size);
323 1.16.4.1 skrll if (error) {
324 1.16.4.1 skrll nw->nw_error = error;
325 1.16.4.1 skrll return;
326 1.16.4.1 skrll }
327 1.16.4.1 skrll nw->nw_dp += nw->nw_eltsize;
328 1.16.4.1 skrll nw->nw_len -= nw->nw_eltsize;
329 1.16.4.1 skrll }
330 1.16.4.1 skrll
331 1.16.4.1 skrll nw->nw_needed += nw->nw_eltsize;
332 1.16.4.1 skrll if (nw->nw_nelt != INT_MAX)
333 1.16.4.1 skrll nw->nw_nelt--;
334 1.16.4.1 skrll }
335 1.16.4.1 skrll
336 1.16.4.1 skrll static void
337 1.16.4.1 skrll sysctl_read_sta(void *arg, struct ieee80211_node *ni)
338 1.16.4.1 skrll {
339 1.16.4.1 skrll struct ieee80211_node_sysctl ns;
340 1.16.4.1 skrll struct ieee80211_node_walk *nw = arg;
341 1.16.4.1 skrll struct ieee80211com *ic = nw->nw_ic;
342 1.16.4.1 skrll int error;
343 1.16.4.1 skrll
344 1.16.4.1 skrll if (nw->nw_error != 0 || nw->nw_nelt <= 0)
345 1.16.4.1 skrll return;
346 1.16.4.1 skrll
347 1.16.4.1 skrll if (nw->nw_len >= nw->nw_eltsize) {
348 1.16.4.1 skrll ieee80211_sysctl_fill_node(ni, &ns, ic->ic_ifp->if_index,
349 1.16.4.1 skrll &ic->ic_channels[0]);
350 1.16.4.1 skrll error = copyout(&ns, nw->nw_dp, nw->nw_out_size);
351 1.16.4.1 skrll if (error) {
352 1.16.4.1 skrll nw->nw_error = error;
353 1.16.4.1 skrll return;
354 1.16.4.1 skrll }
355 1.16.4.1 skrll nw->nw_dp += nw->nw_eltsize;
356 1.16.4.1 skrll nw->nw_len -= nw->nw_eltsize;
357 1.16.4.1 skrll }
358 1.16.4.1 skrll
359 1.16.4.1 skrll nw->nw_needed += nw->nw_eltsize;
360 1.16.4.1 skrll if (nw->nw_nelt != INT_MAX)
361 1.16.4.1 skrll nw->nw_nelt--;
362 1.16.4.1 skrll }
363 1.16.4.1 skrll
364 1.2 dyoung /* Between two examinations of the sysctl tree, I expect each
365 1.2 dyoung * interface to add no more than 5 nodes.
366 1.2 dyoung */
367 1.2 dyoung #define IEEE80211_SYSCTL_NODE_GROWTH 5
368 1.2 dyoung
369 1.2 dyoung static int
370 1.2 dyoung ieee80211_sysctl_node(SYSCTLFN_ARGS)
371 1.2 dyoung {
372 1.2 dyoung struct ieee80211_node_walk nw;
373 1.16.4.1 skrll u_int op, arg, hdr_type;
374 1.16.4.1 skrll int s, nelt;
375 1.2 dyoung
376 1.2 dyoung if (namelen == 1 && name[0] == CTL_QUERY)
377 1.2 dyoung return (sysctl_query(SYSCTLFN_CALL(rnode)));
378 1.2 dyoung
379 1.2 dyoung if (namelen != IEEE80211_SYSCTL_NODENAMELEN)
380 1.2 dyoung return (EINVAL);
381 1.2 dyoung
382 1.2 dyoung /* ifindex.op.arg.header-type.eltsize.nelt */
383 1.16.4.1 skrll nw.nw_dp = oldp;
384 1.16.4.1 skrll nw.nw_len = (oldp != NULL) ? *oldlenp : 0;
385 1.16.4.1 skrll nw.nw_ifindex = name[IEEE80211_SYSCTL_NODENAME_IF];
386 1.2 dyoung op = name[IEEE80211_SYSCTL_NODENAME_OP];
387 1.2 dyoung arg = name[IEEE80211_SYSCTL_NODENAME_ARG];
388 1.2 dyoung hdr_type = name[IEEE80211_SYSCTL_NODENAME_TYPE];
389 1.16.4.1 skrll nw.nw_eltsize = name[IEEE80211_SYSCTL_NODENAME_ELTSIZE];
390 1.2 dyoung nelt = name[IEEE80211_SYSCTL_NODENAME_ELTCOUNT];
391 1.16.4.1 skrll nw.nw_out_size = MIN(sizeof(struct ieee80211_node_sysctl), nw.nw_eltsize);
392 1.2 dyoung
393 1.2 dyoung if (op != IEEE80211_SYSCTL_OP_ALL || arg != 0 ||
394 1.16.4.1 skrll hdr_type != IEEE80211_SYSCTL_T_NODE || nw.nw_eltsize < 1 ||
395 1.16.4.1 skrll nelt < 0)
396 1.2 dyoung return (EINVAL);
397 1.2 dyoung
398 1.16.4.1 skrll nw.nw_nelt = nelt;
399 1.16.4.1 skrll nw.nw_error = 0;
400 1.16.4.1 skrll nw.nw_needed = 0;
401 1.16.4.1 skrll nw.nw_ifcount = 0;
402 1.2 dyoung
403 1.2 dyoung s = splnet();
404 1.16.4.1 skrll SLIST_FOREACH(nw.nw_ic, &ieee80211_list, ic_next) {
405 1.16.4.1 skrll if (nw.nw_ifindex != nw.nw_ic->ic_ifp->if_index)
406 1.16.4.1 skrll continue;
407 1.2 dyoung
408 1.16.4.1 skrll ieee80211_iterate_nodes(&nw.nw_ic->ic_sta, sysctl_read_sta,
409 1.16.4.1 skrll &nw);
410 1.16.4.1 skrll if (nw.nw_error)
411 1.16.4.1 skrll break;
412 1.2 dyoung
413 1.16.4.1 skrll ieee80211_scan_iterate(nw.nw_ic, sysctl_read_scan,
414 1.16.4.1 skrll &nw);
415 1.16.4.1 skrll if (nw.nw_error)
416 1.16.4.1 skrll break;
417 1.2 dyoung
418 1.16.4.1 skrll /* XXXNH flags */
419 1.16.4.1 skrll if (nw.nw_ic->ic_bss != NULL)
420 1.16.4.1 skrll sysctl_read_sta(&nw, nw.nw_ic->ic_bss);
421 1.16.4.1 skrll if (nw.nw_error)
422 1.16.4.1 skrll break;
423 1.2 dyoung }
424 1.2 dyoung splx(s);
425 1.2 dyoung
426 1.16.4.1 skrll *oldlenp = nw.nw_needed;
427 1.2 dyoung if (oldp == NULL)
428 1.16.4.1 skrll *oldlenp += nw.nw_ifcount * IEEE80211_SYSCTL_NODE_GROWTH * nw.nw_eltsize;
429 1.2 dyoung
430 1.16.4.1 skrll return (nw.nw_error);
431 1.2 dyoung }
432 1.2 dyoung
433 1.2 dyoung /*
434 1.2 dyoung * Setup sysctl(3) MIB, net.ieee80211.*
435 1.2 dyoung *
436 1.2 dyoung * TBD condition CTLFLAG_PERMANENT on being an LKM or not
437 1.2 dyoung */
438 1.2 dyoung SYSCTL_SETUP(sysctl_ieee80211, "sysctl ieee80211 subtree setup")
439 1.2 dyoung {
440 1.2 dyoung int rc;
441 1.2 dyoung const struct sysctlnode *cnode, *rnode;
442 1.2 dyoung
443 1.2 dyoung if ((rnode = ieee80211_sysctl_treetop(clog)) == NULL)
444 1.2 dyoung return;
445 1.2 dyoung
446 1.2 dyoung if ((rc = sysctl_createv(clog, 0, &rnode, NULL,
447 1.2 dyoung CTLFLAG_PERMANENT, CTLTYPE_NODE, "nodes", "client/peer stations",
448 1.2 dyoung ieee80211_sysctl_node, 0, NULL, 0, CTL_CREATE, CTL_EOL)) != 0)
449 1.2 dyoung goto err;
450 1.2 dyoung
451 1.2 dyoung #ifdef IEEE80211_DEBUG
452 1.2 dyoung /* control debugging printfs */
453 1.2 dyoung if ((rc = sysctl_createv(clog, 0, &rnode, &cnode,
454 1.2 dyoung CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
455 1.2 dyoung "debug", SYSCTL_DESCR("control debugging printfs"),
456 1.2 dyoung NULL, 0, &ieee80211_debug, 0, CTL_CREATE, CTL_EOL)) != 0)
457 1.2 dyoung goto err;
458 1.2 dyoung #endif /* IEEE80211_DEBUG */
459 1.2 dyoung
460 1.2 dyoung return;
461 1.2 dyoung err:
462 1.2 dyoung printf("%s: sysctl_createv failed (rc = %d)\n", __func__, rc);
463 1.1 dyoung }
464 1.1 dyoung
465 1.1 dyoung int
466 1.1 dyoung ieee80211_node_dectestref(struct ieee80211_node *ni)
467 1.1 dyoung {
468 1.2 dyoung int rc, s;
469 1.2 dyoung s = splnet();
470 1.2 dyoung if (--ni->ni_refcnt == 0) {
471 1.2 dyoung rc = 1;
472 1.2 dyoung ni->ni_refcnt = 1;
473 1.2 dyoung } else
474 1.2 dyoung rc = 0;
475 1.2 dyoung splx(s);
476 1.2 dyoung return rc;
477 1.2 dyoung }
478 1.2 dyoung
479 1.2 dyoung void
480 1.15 degroote ieee80211_drain_ifq(struct ifqueue *ifq)
481 1.15 degroote {
482 1.15 degroote struct ieee80211_node *ni;
483 1.15 degroote struct mbuf *m;
484 1.15 degroote
485 1.15 degroote for (;;) {
486 1.15 degroote IF_DEQUEUE(ifq, m);
487 1.15 degroote if (m == NULL)
488 1.15 degroote break;
489 1.15 degroote
490 1.15 degroote ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
491 1.15 degroote KASSERT(ni != NULL);
492 1.15 degroote ieee80211_free_node(ni);
493 1.15 degroote m->m_pkthdr.rcvif = NULL;
494 1.15 degroote
495 1.15 degroote m_freem(m);
496 1.15 degroote }
497 1.15 degroote }
498 1.15 degroote
499 1.15 degroote
500 1.15 degroote void
501 1.2 dyoung if_printf(struct ifnet *ifp, const char *fmt, ...)
502 1.2 dyoung {
503 1.2 dyoung va_list ap;
504 1.2 dyoung va_start(ap, fmt);
505 1.2 dyoung
506 1.2 dyoung printf("%s: ", ifp->if_xname);
507 1.2 dyoung vprintf(fmt, ap);
508 1.2 dyoung
509 1.2 dyoung va_end(ap);
510 1.2 dyoung return;
511 1.2 dyoung }
512 1.2 dyoung
513 1.2 dyoung /*
514 1.13 dyoung * Set the m_data pointer of a newly-allocated mbuf
515 1.13 dyoung * to place an object of the specified size at the
516 1.13 dyoung * end of the mbuf, longword aligned.
517 1.13 dyoung */
518 1.13 dyoung void
519 1.13 dyoung m_align(struct mbuf *m, int len)
520 1.13 dyoung {
521 1.13 dyoung int adjust;
522 1.13 dyoung
523 1.13 dyoung if (m->m_flags & M_EXT)
524 1.13 dyoung adjust = m->m_ext.ext_size - len;
525 1.13 dyoung else if (m->m_flags & M_PKTHDR)
526 1.13 dyoung adjust = MHLEN - len;
527 1.13 dyoung else
528 1.13 dyoung adjust = MLEN - len;
529 1.13 dyoung m->m_data += adjust &~ (sizeof(long)-1);
530 1.13 dyoung }
531 1.13 dyoung
532 1.13 dyoung /*
533 1.2 dyoung * Append the specified data to the indicated mbuf chain,
534 1.2 dyoung * Extend the mbuf chain if the new data does not fit in
535 1.2 dyoung * existing space.
536 1.2 dyoung *
537 1.2 dyoung * Return 1 if able to complete the job; otherwise 0.
538 1.2 dyoung */
539 1.2 dyoung int
540 1.14 christos m_append(struct mbuf *m0, int len, const void *cpv)
541 1.2 dyoung {
542 1.2 dyoung struct mbuf *m, *n;
543 1.2 dyoung int remainder, space;
544 1.14 christos const char *cp = cpv;
545 1.2 dyoung
546 1.2 dyoung for (m = m0; m->m_next != NULL; m = m->m_next)
547 1.14 christos continue;
548 1.2 dyoung remainder = len;
549 1.2 dyoung space = M_TRAILINGSPACE(m);
550 1.2 dyoung if (space > 0) {
551 1.2 dyoung /*
552 1.2 dyoung * Copy into available space.
553 1.2 dyoung */
554 1.2 dyoung if (space > remainder)
555 1.2 dyoung space = remainder;
556 1.14 christos memmove(mtod(m, char *) + m->m_len, cp, space);
557 1.2 dyoung m->m_len += space;
558 1.14 christos cp = cp + space, remainder -= space;
559 1.2 dyoung }
560 1.2 dyoung while (remainder > 0) {
561 1.2 dyoung /*
562 1.2 dyoung * Allocate a new mbuf; could check space
563 1.2 dyoung * and allocate a cluster instead.
564 1.2 dyoung */
565 1.2 dyoung n = m_get(M_DONTWAIT, m->m_type);
566 1.2 dyoung if (n == NULL)
567 1.2 dyoung break;
568 1.2 dyoung n->m_len = min(MLEN, remainder);
569 1.14 christos memmove(mtod(n, void *), cp, n->m_len);
570 1.2 dyoung cp += n->m_len, remainder -= n->m_len;
571 1.2 dyoung m->m_next = n;
572 1.2 dyoung m = n;
573 1.2 dyoung }
574 1.2 dyoung if (m0->m_flags & M_PKTHDR)
575 1.2 dyoung m0->m_pkthdr.len += len - remainder;
576 1.2 dyoung return (remainder == 0);
577 1.1 dyoung }
578 1.1 dyoung
579 1.1 dyoung /*
580 1.1 dyoung * Allocate and setup a management frame of the specified
581 1.1 dyoung * size. We return the mbuf and a pointer to the start
582 1.1 dyoung * of the contiguous data area that's been reserved based
583 1.1 dyoung * on the packet length. The data area is forced to 32-bit
584 1.1 dyoung * alignment and the buffer length to a multiple of 4 bytes.
585 1.1 dyoung * This is done mainly so beacon frames (that require this)
586 1.1 dyoung * can use this interface too.
587 1.1 dyoung */
588 1.1 dyoung struct mbuf *
589 1.16.4.1 skrll ieee80211_getmgtframe(u_int8_t **frm, int headroom, u_int pktlen)
590 1.1 dyoung {
591 1.1 dyoung struct mbuf *m;
592 1.1 dyoung u_int len;
593 1.1 dyoung
594 1.1 dyoung /*
595 1.1 dyoung * NB: we know the mbuf routines will align the data area
596 1.1 dyoung * so we don't need to do anything special.
597 1.1 dyoung */
598 1.1 dyoung /* XXX 4-address frame? */
599 1.1 dyoung len = roundup(sizeof(struct ieee80211_frame) + pktlen, 4);
600 1.2 dyoung IASSERT(len <= MCLBYTES, ("802.11 mgt frame too large: %u", len));
601 1.2 dyoung if (len <= MHLEN) {
602 1.1 dyoung m = m_gethdr(M_NOWAIT, MT_HEADER);
603 1.1 dyoung /*
604 1.1 dyoung * Align the data in case additional headers are added.
605 1.1 dyoung * This should only happen when a WEP header is added
606 1.1 dyoung * which only happens for shared key authentication mgt
607 1.1 dyoung * frames which all fit in MHLEN.
608 1.1 dyoung */
609 1.1 dyoung if (m != NULL)
610 1.1 dyoung MH_ALIGN(m, len);
611 1.1 dyoung } else
612 1.1 dyoung m = m_getcl(M_NOWAIT, MT_HEADER, M_PKTHDR);
613 1.1 dyoung if (m != NULL) {
614 1.1 dyoung m->m_data += sizeof(struct ieee80211_frame);
615 1.1 dyoung *frm = m->m_data;
616 1.9 dyoung IASSERT((uintptr_t)*frm % 4 == 0, ("bad beacon boundary"));
617 1.1 dyoung }
618 1.1 dyoung return m;
619 1.1 dyoung }
620 1.1 dyoung
621 1.1 dyoung void
622 1.1 dyoung get_random_bytes(void *p, size_t n)
623 1.1 dyoung {
624 1.1 dyoung u_int8_t *dp = p;
625 1.1 dyoung
626 1.1 dyoung while (n > 0) {
627 1.1 dyoung u_int32_t v = arc4random();
628 1.1 dyoung size_t nb = n > sizeof(u_int32_t) ? sizeof(u_int32_t) : n;
629 1.2 dyoung (void)memcpy(dp, &v, nb);
630 1.1 dyoung dp += sizeof(u_int32_t), n -= nb;
631 1.1 dyoung }
632 1.1 dyoung }
633 1.1 dyoung
634 1.1 dyoung void
635 1.1 dyoung ieee80211_notify_node_join(struct ieee80211com *ic, struct ieee80211_node *ni, int newassoc)
636 1.1 dyoung {
637 1.1 dyoung struct ifnet *ifp = ic->ic_ifp;
638 1.1 dyoung struct ieee80211_join_event iev;
639 1.1 dyoung
640 1.3 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_NODE, "%s: %snode %s join\n",
641 1.3 dyoung ifp->if_xname, (ni == ic->ic_bss) ? "bss " : "",
642 1.3 dyoung ether_sprintf(ni->ni_macaddr));
643 1.3 dyoung
644 1.7 dyoung memset(&iev, 0, sizeof(iev));
645 1.1 dyoung if (ni == ic->ic_bss) {
646 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_addr, ni->ni_bssid);
647 1.1 dyoung rt_ieee80211msg(ifp, newassoc ?
648 1.1 dyoung RTM_IEEE80211_ASSOC : RTM_IEEE80211_REASSOC,
649 1.1 dyoung &iev, sizeof(iev));
650 1.1 dyoung if_link_state_change(ifp, LINK_STATE_UP);
651 1.16 christos } else {
652 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_addr, ni->ni_macaddr);
653 1.16 christos rt_ieee80211msg(ifp, newassoc ?
654 1.16 christos RTM_IEEE80211_JOIN : RTM_IEEE80211_REJOIN,
655 1.16 christos &iev, sizeof(iev));
656 1.1 dyoung }
657 1.1 dyoung }
658 1.1 dyoung
659 1.1 dyoung void
660 1.1 dyoung ieee80211_notify_node_leave(struct ieee80211com *ic, struct ieee80211_node *ni)
661 1.1 dyoung {
662 1.1 dyoung struct ifnet *ifp = ic->ic_ifp;
663 1.1 dyoung struct ieee80211_leave_event iev;
664 1.1 dyoung
665 1.3 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_NODE, "%s: %snode %s leave\n",
666 1.3 dyoung ifp->if_xname, (ni == ic->ic_bss) ? "bss " : "",
667 1.3 dyoung ether_sprintf(ni->ni_macaddr));
668 1.3 dyoung
669 1.1 dyoung if (ni == ic->ic_bss) {
670 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_DISASSOC, NULL, 0);
671 1.1 dyoung if_link_state_change(ifp, LINK_STATE_DOWN);
672 1.1 dyoung } else {
673 1.1 dyoung /* fire off wireless event station leaving */
674 1.1 dyoung memset(&iev, 0, sizeof(iev));
675 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_addr, ni->ni_macaddr);
676 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_LEAVE, &iev, sizeof(iev));
677 1.1 dyoung }
678 1.1 dyoung }
679 1.1 dyoung
680 1.1 dyoung void
681 1.1 dyoung ieee80211_notify_scan_done(struct ieee80211com *ic)
682 1.1 dyoung {
683 1.1 dyoung struct ifnet *ifp = ic->ic_ifp;
684 1.1 dyoung
685 1.1 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_SCAN,
686 1.1 dyoung "%s: notify scan done\n", ic->ic_ifp->if_xname);
687 1.1 dyoung
688 1.1 dyoung /* dispatch wireless event indicating scan completed */
689 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_SCAN, NULL, 0);
690 1.1 dyoung }
691 1.1 dyoung
692 1.1 dyoung void
693 1.1 dyoung ieee80211_notify_replay_failure(struct ieee80211com *ic,
694 1.1 dyoung const struct ieee80211_frame *wh, const struct ieee80211_key *k,
695 1.1 dyoung u_int64_t rsc)
696 1.1 dyoung {
697 1.1 dyoung struct ifnet *ifp = ic->ic_ifp;
698 1.1 dyoung
699 1.1 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_CRYPTO,
700 1.8 skrll "[%s] %s replay detected <rsc %ju, csc %ju, keyix %u rxkeyix %u>\n",
701 1.8 skrll ether_sprintf(wh->i_addr2), k->wk_cipher->ic_name,
702 1.8 skrll (intmax_t) rsc, (intmax_t) k->wk_keyrsc,
703 1.8 skrll k->wk_keyix, k->wk_rxkeyix);
704 1.1 dyoung
705 1.1 dyoung if (ifp != NULL) { /* NB: for cipher test modules */
706 1.1 dyoung struct ieee80211_replay_event iev;
707 1.1 dyoung
708 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_dst, wh->i_addr1);
709 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_src, wh->i_addr2);
710 1.1 dyoung iev.iev_cipher = k->wk_cipher->ic_cipher;
711 1.8 skrll if (k->wk_rxkeyix != IEEE80211_KEYIX_NONE)
712 1.8 skrll iev.iev_keyix = k->wk_rxkeyix;
713 1.8 skrll else
714 1.8 skrll iev.iev_keyix = k->wk_keyix;
715 1.1 dyoung iev.iev_keyrsc = k->wk_keyrsc;
716 1.1 dyoung iev.iev_rsc = rsc;
717 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_REPLAY, &iev, sizeof(iev));
718 1.1 dyoung }
719 1.1 dyoung }
720 1.1 dyoung
721 1.1 dyoung void
722 1.1 dyoung ieee80211_notify_michael_failure(struct ieee80211com *ic,
723 1.1 dyoung const struct ieee80211_frame *wh, u_int keyix)
724 1.1 dyoung {
725 1.1 dyoung struct ifnet *ifp = ic->ic_ifp;
726 1.1 dyoung
727 1.1 dyoung IEEE80211_DPRINTF(ic, IEEE80211_MSG_CRYPTO,
728 1.1 dyoung "[%s] michael MIC verification failed <keyix %u>\n",
729 1.1 dyoung ether_sprintf(wh->i_addr2), keyix);
730 1.1 dyoung ic->ic_stats.is_rx_tkipmic++;
731 1.1 dyoung
732 1.1 dyoung if (ifp != NULL) { /* NB: for cipher test modules */
733 1.1 dyoung struct ieee80211_michael_event iev;
734 1.1 dyoung
735 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_dst, wh->i_addr1);
736 1.1 dyoung IEEE80211_ADDR_COPY(iev.iev_src, wh->i_addr2);
737 1.1 dyoung iev.iev_cipher = IEEE80211_CIPHER_TKIP;
738 1.1 dyoung iev.iev_keyix = keyix;
739 1.1 dyoung rt_ieee80211msg(ifp, RTM_IEEE80211_MICHAEL, &iev, sizeof(iev));
740 1.1 dyoung }
741 1.1 dyoung }
742 1.1 dyoung
743 1.1 dyoung void
744 1.1 dyoung ieee80211_load_module(const char *modname)
745 1.1 dyoung {
746 1.1 dyoung #ifdef notyet
747 1.1 dyoung struct thread *td = curthread;
748 1.1 dyoung
749 1.1 dyoung if (suser(td) == 0 && securelevel_gt(td->td_ucred, 0) == 0) {
750 1.1 dyoung mtx_lock(&Giant);
751 1.1 dyoung (void) linker_load_module(modname, NULL, NULL, NULL, NULL);
752 1.1 dyoung mtx_unlock(&Giant);
753 1.1 dyoung }
754 1.1 dyoung #else
755 1.1 dyoung printf("%s: load the %s module by hand for now.\n", __func__, modname);
756 1.1 dyoung #endif
757 1.1 dyoung }
758