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