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