ieee80211_output.c revision 1.19
1 /* $NetBSD: ieee80211_output.c,v 1.19 2004/12/23 06:08:52 dyoung Exp $ */ 2 /*- 3 * Copyright (c) 2001 Atsushi Onoe 4 * Copyright (c) 2002, 2003 Sam Leffler, Errno Consulting 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 3. The name of the author may not be used to endorse or promote products 16 * derived from this software without specific prior written permission. 17 * 18 * Alternatively, this software may be distributed under the terms of the 19 * GNU General Public License ("GPL") version 2 as published by the Free 20 * Software Foundation. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 25 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 27 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 31 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 32 */ 33 34 #include <sys/cdefs.h> 35 #ifdef __FreeBSD__ 36 __FBSDID("$FreeBSD: src/sys/net80211/ieee80211_output.c,v 1.10 2004/04/02 23:25:39 sam Exp $"); 37 #else 38 __KERNEL_RCSID(0, "$NetBSD: ieee80211_output.c,v 1.19 2004/12/23 06:08:52 dyoung Exp $"); 39 #endif 40 41 #include "opt_inet.h" 42 43 #ifdef __NetBSD__ 44 #include "bpfilter.h" 45 #endif /* __NetBSD__ */ 46 47 #include <sys/param.h> 48 #include <sys/systm.h> 49 #include <sys/mbuf.h> 50 #include <sys/malloc.h> 51 #include <sys/kernel.h> 52 #include <sys/socket.h> 53 #include <sys/sockio.h> 54 #include <sys/endian.h> 55 #include <sys/errno.h> 56 #ifdef __FreeBSD__ 57 #include <sys/bus.h> 58 #endif 59 #include <sys/proc.h> 60 #include <sys/sysctl.h> 61 62 #ifdef __FreeBSD__ 63 #include <machine/atomic.h> 64 #endif 65 66 #include <net/if.h> 67 #include <net/if_dl.h> 68 #include <net/if_media.h> 69 #include <net/if_arp.h> 70 #ifdef __FreeBSD__ 71 #include <net/ethernet.h> 72 #else 73 #include <net/if_ether.h> 74 #endif 75 #include <net/if_llc.h> 76 77 #include <net80211/ieee80211_var.h> 78 #include <net80211/ieee80211_compat.h> 79 80 #if NBPFILTER > 0 81 #include <net/bpf.h> 82 #endif 83 84 #ifdef INET 85 #include <netinet/in.h> 86 #ifdef __FreeBSD__ 87 #include <netinet/if_ether.h> 88 #else 89 #include <net/if_ether.h> 90 #endif 91 #endif 92 93 #ifdef IEEE80211_DEBUG 94 /* 95 * Decide if an outbound management frame should be 96 * printed when debugging is enabled. This filters some 97 * of the less interesting frames that come frequently 98 * (e.g. beacons). 99 */ 100 static __inline int 101 doprint(struct ieee80211com *ic, int subtype) 102 { 103 switch (subtype) { 104 case IEEE80211_FC0_SUBTYPE_PROBE_RESP: 105 return (ic->ic_opmode == IEEE80211_M_IBSS); 106 } 107 return 1; 108 } 109 #endif 110 111 /* 112 * Send a management frame to the specified node. The node pointer 113 * must have a reference as the pointer will be passed to the driver 114 * and potentially held for a long time. If the frame is successfully 115 * dispatched to the driver, then it is responsible for freeing the 116 * reference (and potentially free'ing up any associated storage). 117 */ 118 static int 119 ieee80211_mgmt_output(struct ifnet *ifp, struct ieee80211_node *ni, 120 struct mbuf *m, int type) 121 { 122 struct ieee80211com *ic = (void *)ifp; 123 struct ieee80211_frame *wh; 124 125 IASSERT(ni != NULL, ("null node")); 126 ni->ni_inact = 0; 127 128 /* 129 * Yech, hack alert! We want to pass the node down to the 130 * driver's start routine. If we don't do so then the start 131 * routine must immediately look it up again and that can 132 * cause a lock order reversal if, for example, this frame 133 * is being sent because the station is being timedout and 134 * the frame being sent is a DEAUTH message. We could stick 135 * this in an m_tag and tack that on to the mbuf. However 136 * that's rather expensive to do for every frame so instead 137 * we stuff it in the rcvif field since outbound frames do 138 * not (presently) use this. 139 */ 140 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT); 141 if (m == NULL) 142 return ENOMEM; 143 #ifdef __FreeBSD__ 144 KASSERT(m->m_pkthdr.rcvif == NULL, ("rcvif not null")); 145 #endif 146 m->m_pkthdr.rcvif = (void *)ni; 147 148 wh = mtod(m, struct ieee80211_frame *); 149 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT | type; 150 wh->i_fc[1] = IEEE80211_FC1_DIR_NODS; 151 *(u_int16_t *)&wh->i_dur[0] = 0; 152 *(u_int16_t *)&wh->i_seq[0] = 153 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT); 154 ni->ni_txseq++; 155 IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr); 156 IEEE80211_ADDR_COPY(wh->i_addr2, ic->ic_myaddr); 157 IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid); 158 159 if ((m->m_flags & M_LINK0) != 0 && ni->ni_challenge != NULL) { 160 m->m_flags &= ~M_LINK0; 161 IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH, 162 ("%s: encrypting frame for %s\n", 163 __func__, ether_sprintf(wh->i_addr1))); 164 wh->i_fc[1] |= IEEE80211_FC1_WEP; 165 } 166 #ifdef IEEE80211_DEBUG 167 /* avoid printing too many frames */ 168 if ((ieee80211_msg_debug(ic) && doprint(ic, type)) || 169 ieee80211_msg_dumppkts(ic)) { 170 if_printf(ifp, "sending %s to %s on channel %u\n", 171 ieee80211_mgt_subtype_name[ 172 (type & IEEE80211_FC0_SUBTYPE_MASK) 173 >> IEEE80211_FC0_SUBTYPE_SHIFT], 174 ether_sprintf(ni->ni_macaddr), 175 ieee80211_chan2ieee(ic, ni->ni_chan)); 176 } 177 #endif 178 IF_ENQUEUE(&ic->ic_mgtq, m); 179 ifp->if_timer = 1; 180 (*ifp->if_start)(ifp); 181 return 0; 182 } 183 184 /* 185 * Encapsulate an outbound data frame. The mbuf chain is updated and 186 * a reference to the destination node is returned. If an error is 187 * encountered NULL is returned and the node reference will also be NULL. 188 * 189 * NB: The caller is responsible for free'ing a returned node reference. 190 * The convention is ic_bss is not reference counted; the caller must 191 * maintain that. 192 */ 193 struct mbuf * 194 ieee80211_encap(struct ifnet *ifp, struct mbuf *m, struct ieee80211_node **pni) 195 { 196 struct ieee80211com *ic = (void *)ifp; 197 struct ether_header eh; 198 struct ieee80211_frame *wh; 199 struct ieee80211_node *ni = NULL; 200 struct llc *llc; 201 202 if (m->m_len < sizeof(struct ether_header)) { 203 m = m_pullup(m, sizeof(struct ether_header)); 204 if (m == NULL) { 205 ic->ic_stats.is_tx_nombuf++; 206 goto bad; 207 } 208 } 209 memcpy(&eh, mtod(m, caddr_t), sizeof(struct ether_header)); 210 211 ni = ieee80211_find_txnode(ic, eh.ether_dhost); 212 if (ni == NULL) { 213 IEEE80211_DPRINTF(ic, IEEE80211_MSG_OUTPUT, 214 ("%s: no node for dst %s, discard frame\n", 215 __func__, ether_sprintf(eh.ether_dhost))); 216 ic->ic_stats.is_tx_nonode++; 217 goto bad; 218 } 219 ni->ni_inact = 0; 220 221 m_adj(m, sizeof(struct ether_header) - sizeof(struct llc)); 222 llc = mtod(m, struct llc *); 223 llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP; 224 llc->llc_control = LLC_UI; 225 llc->llc_snap.org_code[0] = 0; 226 llc->llc_snap.org_code[1] = 0; 227 llc->llc_snap.org_code[2] = 0; 228 llc->llc_snap.ether_type = eh.ether_type; 229 M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT); 230 if (m == NULL) { 231 ic->ic_stats.is_tx_nombuf++; 232 goto bad; 233 } 234 wh = mtod(m, struct ieee80211_frame *); 235 wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA; 236 *(u_int16_t *)&wh->i_dur[0] = 0; 237 *(u_int16_t *)&wh->i_seq[0] = 238 htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT); 239 ni->ni_txseq++; 240 switch (ic->ic_opmode) { 241 case IEEE80211_M_STA: 242 wh->i_fc[1] = IEEE80211_FC1_DIR_TODS; 243 IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_bssid); 244 IEEE80211_ADDR_COPY(wh->i_addr2, eh.ether_shost); 245 IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_dhost); 246 break; 247 case IEEE80211_M_IBSS: 248 case IEEE80211_M_AHDEMO: 249 wh->i_fc[1] = IEEE80211_FC1_DIR_NODS; 250 IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost); 251 IEEE80211_ADDR_COPY(wh->i_addr2, eh.ether_shost); 252 IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid); 253 break; 254 case IEEE80211_M_HOSTAP: 255 wh->i_fc[1] = IEEE80211_FC1_DIR_FROMDS; 256 IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost); 257 IEEE80211_ADDR_COPY(wh->i_addr2, ni->ni_bssid); 258 IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_shost); 259 break; 260 case IEEE80211_M_MONITOR: 261 goto bad; 262 } 263 if (ic->ic_flags & IEEE80211_F_PRIVACY) 264 wh->i_fc[1] |= IEEE80211_FC1_WEP; 265 *pni = ni; 266 return m; 267 bad: 268 if (m != NULL) 269 m_freem(m); 270 if (ni != NULL) 271 ieee80211_release_node(ic, ni); 272 *pni = NULL; 273 return NULL; 274 } 275 276 /* 277 * Arguments in: 278 * 279 * paylen: payload length (no FCS, no WEP header) 280 * 281 * hdrlen: header length 282 * 283 * rate: MSDU speed, units 500kb/s 284 * 285 * flags: IEEE80211_F_SHPREAMBLE (use short preamble), 286 * IEEE80211_F_SHSLOT (use short slot length) 287 * 288 * Arguments out: 289 * 290 * d: 802.11 Duration field for data frame, 291 * PLCP Length for data frame, 292 * PLCP Service field for data frame, 293 * 802.11 Duration field for RTS 294 */ 295 static int 296 ieee80211_compute_duration1(int len, uint32_t flags, int rate, 297 struct ieee80211_duration *d) 298 { 299 int ack, bitlen, cts, data_dur, remainder; 300 301 /* RTS reserves medium for SIFS | CTS | SIFS | (DATA) | SIFS | ACK 302 * DATA reserves medium for SIFS | ACK 303 */ 304 305 bitlen = len * 8; 306 307 #if 0 308 /* RTS is always sent at 1 Mb/s. (XXX Really?) */ 309 d->d_rts_plcp_len = sizeof(struct ieee80211_frame_rts) * 8; 310 #endif 311 d->d_plcp_svc = 0; 312 313 switch (rate) { 314 case 2: /* 1 Mb/s */ 315 case 4: /* 2 Mb/s */ 316 data_dur = (bitlen * 2) / rate; 317 318 /* 1 - 2 Mb/s WLAN: send ACK/CTS at 1 Mb/s */ 319 cts = IEEE80211_DUR_DS_SLOW_CTS; 320 ack = IEEE80211_DUR_DS_SLOW_ACK; 321 break; 322 case 44: /* 22 Mb/s */ 323 d->d_plcp_svc = IEEE80211_PLCP_SERVICE_PBCC; 324 /*FALLTHROUGH*/ 325 case 11: /* 5.5 Mb/s */ 326 case 22: /* 11 Mb/s */ 327 remainder = (bitlen * 2) % rate; 328 329 if (remainder != 0) 330 data_dur = (bitlen * 2) / rate + 1; 331 else 332 data_dur = (bitlen * 2) / rate; 333 334 if (rate == 22 && remainder <= 6) 335 d->d_plcp_svc |= IEEE80211_PLCP_SERVICE_LENEXT; 336 337 /* 5.5 - 11 Mb/s WLAN: send ACK/CTS at 2 Mb/s */ 338 cts = IEEE80211_DUR_DS_FAST_CTS; 339 ack = IEEE80211_DUR_DS_FAST_ACK; 340 break; 341 default: 342 /* TBD */ 343 return -1; 344 } 345 346 d->d_plcp_len = data_dur; 347 348 d->d_rts_dur = data_dur + 3 * (IEEE80211_DUR_DS_SIFS + 349 IEEE80211_DUR_DS_SHORT_PREAMBLE + 350 IEEE80211_DUR_DS_FAST_PLCPHDR) + cts + ack; 351 352 /* Note that this is the amount of time reserved *after* 353 * the packet is transmitted: just long enough for a SIFS 354 * and an ACK. 355 */ 356 d->d_data_dur = IEEE80211_DUR_DS_SIFS + 357 IEEE80211_DUR_DS_SHORT_PREAMBLE + IEEE80211_DUR_DS_FAST_PLCPHDR + 358 ack; 359 360 if ((flags & IEEE80211_F_SHPREAMBLE) != 0) 361 return 0; 362 363 d->d_rts_dur += 3 * IEEE80211_DUR_DS_PREAMBLE_DIFFERENCE + 364 3 * IEEE80211_DUR_DS_PLCPHDR_DIFFERENCE; 365 d->d_data_dur += IEEE80211_DUR_DS_PREAMBLE_DIFFERENCE + 366 IEEE80211_DUR_DS_PLCPHDR_DIFFERENCE; 367 return 0; 368 } 369 370 /* 371 * Arguments in: 372 * 373 * wh: 802.11 header 374 * 375 * paylen: payload length (no FCS, no WEP header) 376 * 377 * rate: MSDU speed, units 500kb/s 378 * 379 * fraglen: fragment length, set to maximum (or higher) for no 380 * fragmentation 381 * 382 * flags: IEEE80211_F_PRIVACY (hardware adds WEP), 383 * IEEE80211_F_SHPREAMBLE (use short preamble), 384 * IEEE80211_F_SHSLOT (use short slot length) 385 * 386 * Arguments out: 387 * 388 * d0: 802.11 Duration fields (RTS/Data), PLCP Length, Service fields 389 * of first/only fragment 390 * 391 * dn: 802.11 Duration fields (RTS/Data), PLCP Length, Service fields 392 * of first/only fragment 393 */ 394 int 395 ieee80211_compute_duration(struct ieee80211_frame *wh, int len, 396 uint32_t flags, int fraglen, int rate, struct ieee80211_duration *d0, 397 struct ieee80211_duration *dn, int *npktp, int debug) 398 { 399 int rc; 400 int firstlen, hdrlen, lastlen, lastlen0, npkt, overlen, paylen; 401 402 if ((wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS) 403 hdrlen = sizeof(struct ieee80211_frame_addr4); 404 else 405 hdrlen = sizeof(struct ieee80211_frame); 406 407 paylen = len - hdrlen; 408 409 if ((flags & IEEE80211_F_PRIVACY) != 0) { 410 overlen = IEEE80211_WEP_TOTLEN + IEEE80211_CRC_LEN; 411 #if 0 /* 802.11 lets us extend a fragment's length by the length of 412 * a WEP header, AFTER fragmentation. Might want to disable 413 * this while fancy link adaptations are running. 414 */ 415 fraglen -= IEEE80211_WEP_TOTLEN; 416 #endif 417 #if 0 /* Ditto CRC? */ 418 fraglen -= IEEE80211_CRC_LEN; 419 #endif 420 } else 421 overlen = IEEE80211_CRC_LEN; 422 423 npkt = paylen / fraglen; 424 lastlen0 = paylen % fraglen; 425 426 if (npkt == 0) { 427 /* no fragments */ 428 lastlen = paylen + overlen; 429 } else if (lastlen0 != 0) { 430 /* a short fragment */ 431 lastlen = lastlen0 + overlen; 432 npkt++; 433 } else 434 lastlen = fraglen + overlen; 435 436 if (npktp != NULL) 437 *npktp = npkt; 438 439 if (npkt > 1) 440 firstlen = fraglen + overlen; 441 else 442 firstlen = paylen + overlen; 443 444 if (debug) { 445 printf("%s: npkt %d firstlen %d lastlen0 %d lastlen %d " 446 "fraglen %d overlen %d len %d rate %d flags %08x\n", 447 __func__, npkt, firstlen, lastlen0, lastlen, fraglen, 448 overlen, len, rate, flags); 449 } 450 rc = ieee80211_compute_duration1(firstlen + hdrlen, flags, rate, d0); 451 if (rc == -1) 452 return rc; 453 454 if (npkt <= 1) { 455 *dn = *d0; 456 return 0; 457 } 458 return ieee80211_compute_duration1(lastlen + hdrlen, flags, rate, dn); 459 } 460 461 /* 462 * Add a supported rates element id to a frame. 463 */ 464 u_int8_t * 465 ieee80211_add_rates(u_int8_t *frm, const struct ieee80211_rateset *rs) 466 { 467 int nrates; 468 469 *frm++ = IEEE80211_ELEMID_RATES; 470 nrates = rs->rs_nrates; 471 if (nrates > IEEE80211_RATE_SIZE) 472 nrates = IEEE80211_RATE_SIZE; 473 *frm++ = nrates; 474 memcpy(frm, rs->rs_rates, nrates); 475 return frm + nrates; 476 } 477 478 /* 479 * Add an extended supported rates element id to a frame. 480 */ 481 u_int8_t * 482 ieee80211_add_xrates(u_int8_t *frm, const struct ieee80211_rateset *rs) 483 { 484 /* 485 * Add an extended supported rates element if operating in 11g mode. 486 */ 487 if (rs->rs_nrates > IEEE80211_RATE_SIZE) { 488 int nrates = rs->rs_nrates - IEEE80211_RATE_SIZE; 489 *frm++ = IEEE80211_ELEMID_XRATES; 490 *frm++ = nrates; 491 memcpy(frm, rs->rs_rates + IEEE80211_RATE_SIZE, nrates); 492 frm += nrates; 493 } 494 return frm; 495 } 496 497 /* 498 * Add an ssid elemet to a frame. 499 */ 500 static u_int8_t * 501 ieee80211_add_ssid(u_int8_t *frm, const u_int8_t *ssid, u_int len) 502 { 503 *frm++ = IEEE80211_ELEMID_SSID; 504 *frm++ = len; 505 memcpy(frm, ssid, len); 506 return frm + len; 507 } 508 509 static struct mbuf * 510 ieee80211_getmbuf(int flags, int type, u_int pktlen) 511 { 512 struct mbuf *m; 513 514 IASSERT(pktlen <= MCLBYTES, ("802.11 packet too large: %u", pktlen)); 515 #ifdef __FreeBSD__ 516 if (pktlen <= MHLEN) 517 MGETHDR(m, flags, type); 518 else 519 m = m_getcl(flags, type, M_PKTHDR); 520 #else 521 MGETHDR(m, flags, type); 522 if (m != NULL && pktlen > MHLEN) 523 MCLGET(m, flags); 524 #endif 525 return m; 526 } 527 528 /* 529 * Send a management frame. The node is for the destination (or ic_bss 530 * when in station mode). Nodes other than ic_bss have their reference 531 * count bumped to reflect our use for an indeterminant time. 532 */ 533 int 534 ieee80211_send_mgmt(struct ieee80211com *ic, struct ieee80211_node *ni, 535 int type, int arg) 536 { 537 #define senderr(_x, _v) do { ic->ic_stats._v++; ret = _x; goto bad; } while (0) 538 struct ifnet *ifp = &ic->ic_if; 539 struct mbuf *m; 540 u_int8_t *frm; 541 enum ieee80211_phymode mode; 542 u_int16_t capinfo; 543 int has_challenge, is_shared_key, ret, timer; 544 545 IASSERT(ni != NULL, ("null node")); 546 547 /* 548 * Hold a reference on the node so it doesn't go away until after 549 * the xmit is complete all the way in the driver. On error we 550 * will remove our reference. 551 */ 552 ieee80211_ref_node(ni); 553 timer = 0; 554 switch (type) { 555 case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 556 /* 557 * prreq frame format 558 * [tlv] ssid 559 * [tlv] supported rates 560 * [tlv] extended supported rates 561 */ 562 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA, 563 2 + ic->ic_des_esslen 564 + 2 + IEEE80211_RATE_SIZE 565 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE)); 566 if (m == NULL) 567 senderr(ENOMEM, is_tx_nombuf); 568 m->m_data += sizeof(struct ieee80211_frame); 569 frm = mtod(m, u_int8_t *); 570 frm = ieee80211_add_ssid(frm, ic->ic_des_essid, ic->ic_des_esslen); 571 mode = ieee80211_chan2mode(ic, ni->ni_chan); 572 frm = ieee80211_add_rates(frm, &ic->ic_sup_rates[mode]); 573 frm = ieee80211_add_xrates(frm, &ic->ic_sup_rates[mode]); 574 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *); 575 576 timer = IEEE80211_TRANS_WAIT; 577 break; 578 579 case IEEE80211_FC0_SUBTYPE_PROBE_RESP: 580 /* 581 * probe response frame format 582 * [8] time stamp 583 * [2] beacon interval 584 * [2] cabability information 585 * [tlv] ssid 586 * [tlv] supported rates 587 * [tlv] parameter set (FH/DS) 588 * [tlv] parameter set (IBSS) 589 * [tlv] extended supported rates 590 */ 591 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA, 592 8 + 2 + 2 + 2 593 + 2 + ni->ni_esslen 594 + 2 + IEEE80211_RATE_SIZE 595 + (ic->ic_phytype == IEEE80211_T_FH ? 7 : 3) 596 + 6 597 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE)); 598 if (m == NULL) 599 senderr(ENOMEM, is_tx_nombuf); 600 m->m_data += sizeof(struct ieee80211_frame); 601 frm = mtod(m, u_int8_t *); 602 603 memset(frm, 0, 8); /* timestamp should be filled later */ 604 frm += 8; 605 *(u_int16_t *)frm = htole16(ic->ic_bss->ni_intval); 606 frm += 2; 607 if (ic->ic_opmode == IEEE80211_M_IBSS) 608 capinfo = IEEE80211_CAPINFO_IBSS; 609 else 610 capinfo = IEEE80211_CAPINFO_ESS; 611 if (ic->ic_flags & IEEE80211_F_PRIVACY) 612 capinfo |= IEEE80211_CAPINFO_PRIVACY; 613 if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) && 614 IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) 615 capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE; 616 *(u_int16_t *)frm = htole16(capinfo); 617 frm += 2; 618 619 frm = ieee80211_add_ssid(frm, ic->ic_bss->ni_essid, 620 ic->ic_bss->ni_esslen); 621 frm = ieee80211_add_rates(frm, &ic->ic_bss->ni_rates); 622 623 if (ic->ic_phytype == IEEE80211_T_FH) { 624 *frm++ = IEEE80211_ELEMID_FHPARMS; 625 *frm++ = 5; 626 *frm++ = ni->ni_fhdwell & 0x00ff; 627 *frm++ = (ni->ni_fhdwell >> 8) & 0x00ff; 628 *frm++ = IEEE80211_FH_CHANSET( 629 ieee80211_chan2ieee(ic, ni->ni_chan)); 630 *frm++ = IEEE80211_FH_CHANPAT( 631 ieee80211_chan2ieee(ic, ni->ni_chan)); 632 *frm++ = ni->ni_fhindex; 633 } else { 634 *frm++ = IEEE80211_ELEMID_DSPARMS; 635 *frm++ = 1; 636 *frm++ = ieee80211_chan2ieee(ic, ni->ni_chan); 637 } 638 639 if (ic->ic_opmode == IEEE80211_M_IBSS) { 640 *frm++ = IEEE80211_ELEMID_IBSSPARMS; 641 *frm++ = 2; 642 *frm++ = 0; *frm++ = 0; /* TODO: ATIM window */ 643 } else { /* IEEE80211_M_HOSTAP */ 644 /* TODO: TIM */ 645 *frm++ = IEEE80211_ELEMID_TIM; 646 *frm++ = 4; /* length */ 647 *frm++ = 0; /* DTIM count */ 648 *frm++ = 1; /* DTIM period */ 649 *frm++ = 0; /* bitmap control */ 650 *frm++ = 0; /* Partial Virtual Bitmap (variable length) */ 651 } 652 frm = ieee80211_add_xrates(frm, &ic->ic_bss->ni_rates); 653 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *); 654 break; 655 656 case IEEE80211_FC0_SUBTYPE_AUTH: 657 MGETHDR(m, M_DONTWAIT, MT_DATA); 658 if (m == NULL) 659 senderr(ENOMEM, is_tx_nombuf); 660 661 has_challenge = ((arg == IEEE80211_AUTH_SHARED_CHALLENGE || 662 arg == IEEE80211_AUTH_SHARED_RESPONSE) && 663 ni->ni_challenge != NULL); 664 665 is_shared_key = has_challenge || (ni->ni_challenge != NULL && 666 arg == IEEE80211_AUTH_SHARED_PASS); 667 668 if (has_challenge) { 669 MH_ALIGN(m, 2 * 3 + 2 + IEEE80211_CHALLENGE_LEN); 670 m->m_pkthdr.len = m->m_len = 671 2 * 3 + 2 + IEEE80211_CHALLENGE_LEN; 672 } else { 673 MH_ALIGN(m, 2 * 3); 674 m->m_pkthdr.len = m->m_len = 2 * 3; 675 } 676 frm = mtod(m, u_int8_t *); 677 ((u_int16_t *)frm)[0] = 678 (is_shared_key) ? htole16(IEEE80211_AUTH_ALG_SHARED) 679 : htole16(IEEE80211_AUTH_ALG_OPEN); 680 ((u_int16_t *)frm)[1] = htole16(arg); /* sequence number */ 681 ((u_int16_t *)frm)[2] = 0; /* status */ 682 683 if (has_challenge) { 684 ((u_int16_t *)frm)[3] = 685 htole16((IEEE80211_CHALLENGE_LEN << 8) | 686 IEEE80211_ELEMID_CHALLENGE); 687 memcpy(&((u_int16_t *)frm)[4], ni->ni_challenge, 688 IEEE80211_CHALLENGE_LEN); 689 if (arg == IEEE80211_AUTH_SHARED_RESPONSE) { 690 IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH, 691 ("%s: request encrypt frame\n", __func__)); 692 m->m_flags |= M_LINK0; /* WEP-encrypt, please */ 693 } 694 } 695 if (ic->ic_opmode == IEEE80211_M_STA) 696 timer = IEEE80211_TRANS_WAIT; 697 break; 698 699 case IEEE80211_FC0_SUBTYPE_DEAUTH: 700 IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH, 701 ("send station %s deauthenticate (reason %d)\n", 702 ether_sprintf(ni->ni_macaddr), arg)); 703 MGETHDR(m, M_DONTWAIT, MT_DATA); 704 if (m == NULL) 705 senderr(ENOMEM, is_tx_nombuf); 706 MH_ALIGN(m, 2); 707 m->m_pkthdr.len = m->m_len = 2; 708 *mtod(m, u_int16_t *) = htole16(arg); /* reason */ 709 break; 710 711 case IEEE80211_FC0_SUBTYPE_ASSOC_REQ: 712 case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: 713 /* 714 * asreq frame format 715 * [2] capability information 716 * [2] listen interval 717 * [6*] current AP address (reassoc only) 718 * [tlv] ssid 719 * [tlv] supported rates 720 * [tlv] extended supported rates 721 */ 722 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA, 723 sizeof(capinfo) 724 + sizeof(u_int16_t) 725 + IEEE80211_ADDR_LEN 726 + 2 + ni->ni_esslen 727 + 2 + IEEE80211_RATE_SIZE 728 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE)); 729 if (m == NULL) 730 senderr(ENOMEM, is_tx_nombuf); 731 m->m_data += sizeof(struct ieee80211_frame); 732 frm = mtod(m, u_int8_t *); 733 734 capinfo = 0; 735 if (ic->ic_opmode == IEEE80211_M_IBSS) 736 capinfo |= IEEE80211_CAPINFO_IBSS; 737 else /* IEEE80211_M_STA */ 738 capinfo |= IEEE80211_CAPINFO_ESS; 739 if (ic->ic_flags & IEEE80211_F_PRIVACY) 740 capinfo |= IEEE80211_CAPINFO_PRIVACY; 741 /* 742 * NB: Some 11a AP's reject the request when 743 * short premable is set. 744 */ 745 if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) && 746 IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) 747 capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE; 748 if (ic->ic_flags & IEEE80211_F_SHSLOT) 749 capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME; 750 *(u_int16_t *)frm = htole16(capinfo); 751 frm += 2; 752 753 *(u_int16_t *)frm = htole16(ic->ic_lintval); 754 frm += 2; 755 756 if (type == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) { 757 IEEE80211_ADDR_COPY(frm, ic->ic_bss->ni_bssid); 758 frm += IEEE80211_ADDR_LEN; 759 } 760 761 frm = ieee80211_add_ssid(frm, ni->ni_essid, ni->ni_esslen); 762 frm = ieee80211_add_rates(frm, &ni->ni_rates); 763 frm = ieee80211_add_xrates(frm, &ni->ni_rates); 764 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *); 765 766 timer = IEEE80211_TRANS_WAIT; 767 break; 768 769 case IEEE80211_FC0_SUBTYPE_ASSOC_RESP: 770 case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: 771 /* 772 * asreq frame format 773 * [2] capability information 774 * [2] status 775 * [2] association ID 776 * [tlv] supported rates 777 * [tlv] extended supported rates 778 */ 779 m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA, 780 sizeof(capinfo) 781 + sizeof(u_int16_t) 782 + sizeof(u_int16_t) 783 + 2 + IEEE80211_RATE_SIZE 784 + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE)); 785 if (m == NULL) 786 senderr(ENOMEM, is_tx_nombuf); 787 m->m_data += sizeof(struct ieee80211_frame); 788 frm = mtod(m, u_int8_t *); 789 790 capinfo = IEEE80211_CAPINFO_ESS; 791 if (ic->ic_flags & IEEE80211_F_PRIVACY) 792 capinfo |= IEEE80211_CAPINFO_PRIVACY; 793 if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) && 794 IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) 795 capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE; 796 *(u_int16_t *)frm = htole16(capinfo); 797 frm += 2; 798 799 *(u_int16_t *)frm = htole16(arg); /* status */ 800 frm += 2; 801 802 if (arg == IEEE80211_STATUS_SUCCESS) 803 *(u_int16_t *)frm = htole16(ni->ni_associd); 804 frm += 2; 805 806 frm = ieee80211_add_rates(frm, &ni->ni_rates); 807 frm = ieee80211_add_xrates(frm, &ni->ni_rates); 808 m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *); 809 break; 810 811 case IEEE80211_FC0_SUBTYPE_DISASSOC: 812 IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC, 813 ("send station %s disassociate (reason %d)\n", 814 ether_sprintf(ni->ni_macaddr), arg)); 815 MGETHDR(m, M_DONTWAIT, MT_DATA); 816 if (m == NULL) 817 senderr(ENOMEM, is_tx_nombuf); 818 MH_ALIGN(m, 2); 819 m->m_pkthdr.len = m->m_len = 2; 820 *mtod(m, u_int16_t *) = htole16(arg); /* reason */ 821 break; 822 823 default: 824 IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY, 825 ("%s: invalid mgmt frame type %u\n", __func__, type)); 826 senderr(EINVAL, is_tx_unknownmgt); 827 /* NOTREACHED */ 828 } 829 830 ret = ieee80211_mgmt_output(ifp, ni, m, type); 831 if (ret == 0) { 832 if (timer) 833 ic->ic_mgt_timer = timer; 834 } else { 835 bad: 836 ieee80211_release_node(ic, ni); 837 } 838 return ret; 839 #undef senderr 840 } 841 842 void 843 ieee80211_pwrsave(struct ieee80211com *ic, struct ieee80211_node *ni, 844 struct mbuf *m) 845 { 846 /* Store the new packet on our queue, changing the TIM if necessary */ 847 848 if (IF_IS_EMPTY(&ni->ni_savedq)) { 849 ic->ic_set_tim(ic, ni->ni_associd, 1); 850 } 851 if (ni->ni_savedq.ifq_len >= IEEE80211_PS_MAX_QUEUE) { 852 IF_DROP(&ni->ni_savedq); 853 m_freem(m); 854 if (ic->ic_if.if_flags & IFF_DEBUG) 855 printf("%s: station %s power save queue overflow" 856 " of size %d drops %d\n", 857 ic->ic_if.if_xname, 858 ether_sprintf(ni->ni_macaddr), 859 IEEE80211_PS_MAX_QUEUE, 860 ni->ni_savedq.ifq_drops); 861 } else { 862 /* Similar to ieee80211_mgmt_output, store the node in 863 * the rcvif field. 864 */ 865 IF_ENQUEUE(&ni->ni_savedq, m); 866 m->m_pkthdr.rcvif = (void *)ni; 867 } 868 } 869 870
Indexes created Tue Sep 23 07:09:52 GMT 2025