1 /* $OpenBSD: ieee80211_proto.c,v 1.68 2016/07/20 15:40:27 stsp Exp $ */ 2 /* $NetBSD: ieee80211_proto.c,v 1.8 2004/04/30 23:58:20 dyoung Exp $ */ 3 4 /*- 5 * Copyright (c) 2001 Atsushi Onoe 6 * Copyright (c) 2002, 2003 Sam Leffler, Errno Consulting 7 * Copyright (c) 2008, 2009 Damien Bergamini 8 * All rights reserved. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. The name of the author may not be used to endorse or promote products 19 * derived from this software without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 31 */ 32 33 /* 34 * IEEE 802.11 protocol support. 35 */ 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/mbuf.h> 40 #include <sys/kernel.h> 41 #include <sys/socket.h> 42 #include <sys/sockio.h> 43 #include <sys/endian.h> 44 #include <sys/errno.h> 45 #include <sys/sysctl.h> 46 47 #include <net/if.h> 48 #include <net/if_dl.h> 49 #include <net/if_media.h> 50 #include <net/if_llc.h> 51 52 #include <netinet/in.h> 53 #include <netinet/if_ether.h> 54 55 #include <net80211/ieee80211_var.h> 56 #include <net80211/ieee80211_priv.h> 57 58 const char * const ieee80211_mgt_subtype_name[] = { 59 "assoc_req", "assoc_resp", "reassoc_req", "reassoc_resp", 60 "probe_req", "probe_resp", "reserved#6", "reserved#7", 61 "beacon", "atim", "disassoc", "auth", 62 "deauth", "action", "action_noack", "reserved#15" 63 }; 64 const char * const ieee80211_state_name[IEEE80211_S_MAX] = { 65 "INIT", /* IEEE80211_S_INIT */ 66 "SCAN", /* IEEE80211_S_SCAN */ 67 "AUTH", /* IEEE80211_S_AUTH */ 68 "ASSOC", /* IEEE80211_S_ASSOC */ 69 "RUN" /* IEEE80211_S_RUN */ 70 }; 71 const char * const ieee80211_phymode_name[] = { 72 "auto", /* IEEE80211_MODE_AUTO */ 73 "11a", /* IEEE80211_MODE_11A */ 74 "11b", /* IEEE80211_MODE_11B */ 75 "11g", /* IEEE80211_MODE_11G */ 76 "11n", /* IEEE80211_MODE_11N */ 77 }; 78 79 int ieee80211_newstate(struct ieee80211com *, enum ieee80211_state, int); 80 81 void 82 ieee80211_proto_attach(struct ifnet *ifp) 83 { 84 struct ieee80211com *ic = (void *)ifp; 85 86 mq_init(&ic->ic_mgtq, IFQ_MAXLEN, IPL_NET); 87 mq_init(&ic->ic_pwrsaveq, IFQ_MAXLEN, IPL_NET); 88 89 ifp->if_hdrlen = sizeof(struct ieee80211_frame); 90 91 ic->ic_rtsthreshold = IEEE80211_RTS_DEFAULT; 92 ic->ic_fragthreshold = 2346; /* XXX not used yet */ 93 ic->ic_fixed_rate = -1; /* no fixed rate */ 94 ic->ic_fixed_mcs = -1; /* no fixed mcs */ 95 ic->ic_protmode = IEEE80211_PROT_CTSONLY; 96 97 /* protocol state change handler */ 98 ic->ic_newstate = ieee80211_newstate; 99 100 /* initialize management frame handlers */ 101 ic->ic_recv_mgmt = ieee80211_recv_mgmt; 102 ic->ic_send_mgmt = ieee80211_send_mgmt; 103 } 104 105 void 106 ieee80211_proto_detach(struct ifnet *ifp) 107 { 108 struct ieee80211com *ic = (void *)ifp; 109 110 mq_purge(&ic->ic_mgtq); 111 mq_purge(&ic->ic_pwrsaveq); 112 } 113 114 void 115 ieee80211_print_essid(const u_int8_t *essid, int len) 116 { 117 int i; 118 const u_int8_t *p; 119 120 if (len > IEEE80211_NWID_LEN) 121 len = IEEE80211_NWID_LEN; 122 /* determine printable or not */ 123 for (i = 0, p = essid; i < len; i++, p++) { 124 if (*p < ' ' || *p > 0x7e) 125 break; 126 } 127 if (i == len) { 128 printf("\""); 129 for (i = 0, p = essid; i < len; i++, p++) 130 printf("%c", *p); 131 printf("\""); 132 } else { 133 printf("0x"); 134 for (i = 0, p = essid; i < len; i++, p++) 135 printf("%02x", *p); 136 } 137 } 138 139 #ifdef IEEE80211_DEBUG 140 void 141 ieee80211_dump_pkt(const u_int8_t *buf, int len, int rate, int rssi) 142 { 143 struct ieee80211_frame *wh; 144 int i; 145 146 wh = (struct ieee80211_frame *)buf; 147 switch (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) { 148 case IEEE80211_FC1_DIR_NODS: 149 printf("NODS %s", ether_sprintf(wh->i_addr2)); 150 printf("->%s", ether_sprintf(wh->i_addr1)); 151 printf("(%s)", ether_sprintf(wh->i_addr3)); 152 break; 153 case IEEE80211_FC1_DIR_TODS: 154 printf("TODS %s", ether_sprintf(wh->i_addr2)); 155 printf("->%s", ether_sprintf(wh->i_addr3)); 156 printf("(%s)", ether_sprintf(wh->i_addr1)); 157 break; 158 case IEEE80211_FC1_DIR_FROMDS: 159 printf("FRDS %s", ether_sprintf(wh->i_addr3)); 160 printf("->%s", ether_sprintf(wh->i_addr1)); 161 printf("(%s)", ether_sprintf(wh->i_addr2)); 162 break; 163 case IEEE80211_FC1_DIR_DSTODS: 164 printf("DSDS %s", ether_sprintf((u_int8_t *)&wh[1])); 165 printf("->%s", ether_sprintf(wh->i_addr3)); 166 printf("(%s", ether_sprintf(wh->i_addr2)); 167 printf("->%s)", ether_sprintf(wh->i_addr1)); 168 break; 169 } 170 switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) { 171 case IEEE80211_FC0_TYPE_DATA: 172 printf(" data"); 173 break; 174 case IEEE80211_FC0_TYPE_MGT: 175 printf(" %s", ieee80211_mgt_subtype_name[ 176 (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) 177 >> IEEE80211_FC0_SUBTYPE_SHIFT]); 178 break; 179 default: 180 printf(" type#%d", wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK); 181 break; 182 } 183 if (wh->i_fc[1] & IEEE80211_FC1_WEP) 184 printf(" WEP"); 185 if (rate >= 0) 186 printf(" %d%sM", rate / 2, (rate & 1) ? ".5" : ""); 187 if (rssi >= 0) 188 printf(" +%d", rssi); 189 printf("\n"); 190 if (len > 0) { 191 for (i = 0; i < len; i++) { 192 if ((i & 1) == 0) 193 printf(" "); 194 printf("%02x", buf[i]); 195 } 196 printf("\n"); 197 } 198 } 199 #endif 200 201 int 202 ieee80211_fix_rate(struct ieee80211com *ic, struct ieee80211_node *ni, 203 int flags) 204 { 205 #define RV(v) ((v) & IEEE80211_RATE_VAL) 206 int i, j, ignore, error; 207 int okrate, badrate, fixedrate; 208 const struct ieee80211_rateset *srs; 209 struct ieee80211_rateset *nrs; 210 u_int8_t r; 211 212 /* 213 * If the fixed rate check was requested but no fixed rate has been 214 * defined then just remove the check. 215 */ 216 if ((flags & IEEE80211_F_DOFRATE) && ic->ic_fixed_rate == -1) 217 flags &= ~IEEE80211_F_DOFRATE; 218 219 error = 0; 220 okrate = badrate = fixedrate = 0; 221 srs = &ic->ic_sup_rates[ieee80211_chan2mode(ic, ni->ni_chan)]; 222 nrs = &ni->ni_rates; 223 for (i = 0; i < nrs->rs_nrates; ) { 224 ignore = 0; 225 if (flags & IEEE80211_F_DOSORT) { 226 /* 227 * Sort rates. 228 */ 229 for (j = i + 1; j < nrs->rs_nrates; j++) { 230 if (RV(nrs->rs_rates[i]) > 231 RV(nrs->rs_rates[j])) { 232 r = nrs->rs_rates[i]; 233 nrs->rs_rates[i] = nrs->rs_rates[j]; 234 nrs->rs_rates[j] = r; 235 } 236 } 237 } 238 r = nrs->rs_rates[i] & IEEE80211_RATE_VAL; 239 badrate = r; 240 if (flags & IEEE80211_F_DOFRATE) { 241 /* 242 * Check fixed rate is included. 243 */ 244 if (r == RV(srs->rs_rates[ic->ic_fixed_rate])) 245 fixedrate = r; 246 } 247 if (flags & IEEE80211_F_DONEGO) { 248 /* 249 * Check against supported rates. 250 */ 251 for (j = 0; j < srs->rs_nrates; j++) { 252 if (r == RV(srs->rs_rates[j])) { 253 /* 254 * Overwrite with the supported rate 255 * value so any basic rate bit is set. 256 * This insures that response we send 257 * to stations have the necessary basic 258 * rate bit set. 259 */ 260 nrs->rs_rates[i] = srs->rs_rates[j]; 261 break; 262 } 263 } 264 if (j == srs->rs_nrates) { 265 /* 266 * A rate in the node's rate set is not 267 * supported. If this is a basic rate and we 268 * are operating as an AP then this is an error. 269 * Otherwise we just discard/ignore the rate. 270 * Note that this is important for 11b stations 271 * when they want to associate with an 11g AP. 272 */ 273 #ifndef IEEE80211_STA_ONLY 274 if (ic->ic_opmode == IEEE80211_M_HOSTAP && 275 (nrs->rs_rates[i] & IEEE80211_RATE_BASIC)) 276 error++; 277 #endif 278 ignore++; 279 } 280 } 281 if (flags & IEEE80211_F_DODEL) { 282 /* 283 * Delete unacceptable rates. 284 */ 285 if (ignore) { 286 nrs->rs_nrates--; 287 for (j = i; j < nrs->rs_nrates; j++) 288 nrs->rs_rates[j] = nrs->rs_rates[j + 1]; 289 nrs->rs_rates[j] = 0; 290 continue; 291 } 292 } 293 if (!ignore) 294 okrate = nrs->rs_rates[i]; 295 i++; 296 } 297 if (okrate == 0 || error != 0 || 298 ((flags & IEEE80211_F_DOFRATE) && fixedrate == 0)) 299 return badrate | IEEE80211_RATE_BASIC; 300 else 301 return RV(okrate); 302 #undef RV 303 } 304 305 /* 306 * Reset 11g-related state. 307 */ 308 void 309 ieee80211_reset_erp(struct ieee80211com *ic) 310 { 311 ic->ic_flags &= ~IEEE80211_F_USEPROT; 312 ic->ic_nonerpsta = 0; 313 ic->ic_longslotsta = 0; 314 315 /* 316 * Enable short slot time iff: 317 * - we're operating in 802.11a or 318 * - we're operating in 802.11g and we're not in IBSS mode and 319 * the device supports short slot time 320 */ 321 ieee80211_set_shortslottime(ic, 322 ic->ic_curmode == IEEE80211_MODE_11A 323 #ifndef IEEE80211_STA_ONLY 324 || 325 (ic->ic_curmode == IEEE80211_MODE_11G && 326 ic->ic_opmode == IEEE80211_M_HOSTAP && 327 (ic->ic_caps & IEEE80211_C_SHSLOT)) 328 #endif 329 ); 330 331 if (ic->ic_curmode == IEEE80211_MODE_11A || 332 (ic->ic_caps & IEEE80211_C_SHPREAMBLE)) 333 ic->ic_flags |= IEEE80211_F_SHPREAMBLE; 334 else 335 ic->ic_flags &= ~IEEE80211_F_SHPREAMBLE; 336 } 337 338 /* 339 * Set the short slot time state and notify the driver. 340 */ 341 void 342 ieee80211_set_shortslottime(struct ieee80211com *ic, int on) 343 { 344 if (on) 345 ic->ic_flags |= IEEE80211_F_SHSLOT; 346 else 347 ic->ic_flags &= ~IEEE80211_F_SHSLOT; 348 349 /* notify the driver */ 350 if (ic->ic_updateslot != NULL) 351 ic->ic_updateslot(ic); 352 } 353 354 /* 355 * This function is called by the 802.1X PACP machine (via an ioctl) when 356 * the transmit key machine (4-Way Handshake for 802.11) should run. 357 */ 358 int 359 ieee80211_keyrun(struct ieee80211com *ic, u_int8_t *macaddr) 360 { 361 #ifndef IEEE80211_STA_ONLY 362 struct ieee80211_node *ni; 363 struct ieee80211_pmk *pmk; 364 #endif 365 366 /* STA must be associated or AP must be ready */ 367 if (ic->ic_state != IEEE80211_S_RUN || 368 !(ic->ic_flags & IEEE80211_F_RSNON)) 369 return ENETDOWN; 370 371 #ifndef IEEE80211_STA_ONLY 372 if (ic->ic_opmode == IEEE80211_M_STA) 373 #endif 374 return 0; /* supplicant only, do nothing */ 375 376 #ifndef IEEE80211_STA_ONLY 377 /* find the STA with which we must start the key exchange */ 378 if ((ni = ieee80211_find_node(ic, macaddr)) == NULL) { 379 DPRINTF(("no node found for %s\n", ether_sprintf(macaddr))); 380 return EINVAL; 381 } 382 /* check that the STA is in the correct state */ 383 if (ni->ni_state != IEEE80211_STA_ASSOC || 384 ni->ni_rsn_state != RSNA_AUTHENTICATION_2) { 385 DPRINTF(("unexpected in state %d\n", ni->ni_rsn_state)); 386 return EINVAL; 387 } 388 ni->ni_rsn_state = RSNA_INITPMK; 389 390 /* make sure a PMK is available for this STA, otherwise deauth it */ 391 if ((pmk = ieee80211_pmksa_find(ic, ni, NULL)) == NULL) { 392 DPRINTF(("no PMK available for %s\n", ether_sprintf(macaddr))); 393 IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH, 394 IEEE80211_REASON_AUTH_LEAVE); 395 ieee80211_node_leave(ic, ni); 396 return EINVAL; 397 } 398 memcpy(ni->ni_pmk, pmk->pmk_key, IEEE80211_PMK_LEN); 399 memcpy(ni->ni_pmkid, pmk->pmk_pmkid, IEEE80211_PMKID_LEN); 400 ni->ni_flags |= IEEE80211_NODE_PMK; 401 402 /* initiate key exchange (4-Way Handshake) with STA */ 403 return ieee80211_send_4way_msg1(ic, ni); 404 #endif /* IEEE80211_STA_ONLY */ 405 } 406 407 #ifndef IEEE80211_STA_ONLY 408 /* 409 * Initiate a group key handshake with a node. 410 */ 411 static void 412 ieee80211_node_gtk_rekey(void *arg, struct ieee80211_node *ni) 413 { 414 struct ieee80211com *ic = arg; 415 416 if (ni->ni_state != IEEE80211_STA_ASSOC || 417 ni->ni_rsn_gstate != RSNA_IDLE) 418 return; 419 420 /* initiate a group key handshake with STA */ 421 ni->ni_flags |= IEEE80211_NODE_REKEY; 422 if (ieee80211_send_group_msg1(ic, ni) != 0) 423 ni->ni_flags &= ~IEEE80211_NODE_REKEY; 424 else 425 ic->ic_rsn_keydonesta++; 426 } 427 428 /* 429 * This function is called in HostAP mode when the group key needs to be 430 * changed. 431 */ 432 void 433 ieee80211_setkeys(struct ieee80211com *ic) 434 { 435 struct ieee80211_key *k; 436 u_int8_t kid; 437 438 /* Swap(GM, GN) */ 439 kid = (ic->ic_def_txkey == 1) ? 2 : 1; 440 k = &ic->ic_nw_keys[kid]; 441 memset(k, 0, sizeof(*k)); 442 k->k_id = kid; 443 k->k_cipher = ic->ic_bss->ni_rsngroupcipher; 444 k->k_flags = IEEE80211_KEY_GROUP | IEEE80211_KEY_TX; 445 k->k_len = ieee80211_cipher_keylen(k->k_cipher); 446 arc4random_buf(k->k_key, k->k_len); 447 448 if (ic->ic_caps & IEEE80211_C_MFP) { 449 /* Swap(GM_igtk, GN_igtk) */ 450 kid = (ic->ic_igtk_kid == 4) ? 5 : 4; 451 k = &ic->ic_nw_keys[kid]; 452 memset(k, 0, sizeof(*k)); 453 k->k_id = kid; 454 k->k_cipher = ic->ic_bss->ni_rsngroupmgmtcipher; 455 k->k_flags = IEEE80211_KEY_IGTK | IEEE80211_KEY_TX; 456 k->k_len = 16; 457 arc4random_buf(k->k_key, k->k_len); 458 } 459 460 ic->ic_rsn_keydonesta = 0; 461 ieee80211_iterate_nodes(ic, ieee80211_node_gtk_rekey, ic); 462 } 463 464 /* 465 * The group key handshake has been completed with all associated stations. 466 */ 467 void 468 ieee80211_setkeysdone(struct ieee80211com *ic) 469 { 470 u_int8_t kid; 471 472 /* install GTK */ 473 kid = (ic->ic_def_txkey == 1) ? 2 : 1; 474 if ((*ic->ic_set_key)(ic, ic->ic_bss, &ic->ic_nw_keys[kid]) == 0) 475 ic->ic_def_txkey = kid; 476 477 if (ic->ic_caps & IEEE80211_C_MFP) { 478 /* install IGTK */ 479 kid = (ic->ic_igtk_kid == 4) ? 5 : 4; 480 if ((*ic->ic_set_key)(ic, ic->ic_bss, 481 &ic->ic_nw_keys[kid]) == 0) 482 ic->ic_igtk_kid = kid; 483 } 484 } 485 486 /* 487 * Group key lifetime has expired, update it. 488 */ 489 void 490 ieee80211_gtk_rekey_timeout(void *arg) 491 { 492 struct ieee80211com *ic = arg; 493 int s; 494 495 s = splnet(); 496 ieee80211_setkeys(ic); 497 splx(s); 498 499 /* re-schedule a GTK rekeying after 3600s */ 500 timeout_add_sec(&ic->ic_rsn_timeout, 3600); 501 } 502 503 void 504 ieee80211_sa_query_timeout(void *arg) 505 { 506 struct ieee80211_node *ni = arg; 507 struct ieee80211com *ic = ni->ni_ic; 508 int s; 509 510 s = splnet(); 511 if (++ni->ni_sa_query_count >= 3) { 512 ni->ni_flags &= ~IEEE80211_NODE_SA_QUERY; 513 ni->ni_flags |= IEEE80211_NODE_SA_QUERY_FAILED; 514 } else /* retry SA Query Request */ 515 ieee80211_sa_query_request(ic, ni); 516 splx(s); 517 } 518 519 /* 520 * Request that a SA Query Request frame be sent to a specified peer STA 521 * to which the STA is associated. 522 */ 523 void 524 ieee80211_sa_query_request(struct ieee80211com *ic, struct ieee80211_node *ni) 525 { 526 /* MLME-SAQuery.request */ 527 528 if (!(ni->ni_flags & IEEE80211_NODE_SA_QUERY)) { 529 ni->ni_flags |= IEEE80211_NODE_SA_QUERY; 530 ni->ni_flags &= ~IEEE80211_NODE_SA_QUERY_FAILED; 531 ni->ni_sa_query_count = 0; 532 } 533 /* generate new Transaction Identifier */ 534 ni->ni_sa_query_trid++; 535 536 /* send SA Query Request */ 537 IEEE80211_SEND_ACTION(ic, ni, IEEE80211_CATEG_SA_QUERY, 538 IEEE80211_ACTION_SA_QUERY_REQ, 0); 539 timeout_add_msec(&ni->ni_sa_query_to, 10); 540 } 541 #endif /* IEEE80211_STA_ONLY */ 542 543 void 544 ieee80211_ht_negotiate(struct ieee80211com *ic, struct ieee80211_node *ni) 545 { 546 int i; 547 548 ni->ni_flags &= ~IEEE80211_NODE_HT; 549 550 /* Check if we support HT. */ 551 if ((ic->ic_modecaps & (1 << IEEE80211_MODE_11N)) == 0) 552 return; 553 554 /* Check if HT support has been explicitly disabled. */ 555 if ((ic->ic_flags & IEEE80211_F_HTON) == 0) 556 return; 557 558 /* Check if the peer supports HT. MCS 0-7 are mandatory. */ 559 if (ni->ni_rxmcs[0] != 0xff) { 560 ic->ic_stats.is_ht_nego_no_mandatory_mcs++; 561 return; 562 } 563 564 if (ic->ic_opmode == IEEE80211_M_STA) { 565 /* We must support the AP's basic MCS set. */ 566 for (i = 0; i < IEEE80211_HT_NUM_MCS; i++) { 567 if (isset(ni->ni_basic_mcs, i) && 568 !isset(ic->ic_sup_mcs, i)) { 569 ic->ic_stats.is_ht_nego_no_basic_mcs++; 570 return; 571 } 572 } 573 } 574 575 /* 576 * Don't allow group cipher (includes WEP) or TKIP 577 * for pairwise encryption (see 802.11-2012 11.1.6). 578 */ 579 if (ic->ic_flags & IEEE80211_F_WEPON) { 580 ic->ic_stats.is_ht_nego_bad_crypto++; 581 return; 582 } 583 if ((ic->ic_flags & IEEE80211_F_RSNON) && 584 (ni->ni_rsnciphers & IEEE80211_CIPHER_USEGROUP || 585 ni->ni_rsnciphers & IEEE80211_CIPHER_TKIP)) { 586 ic->ic_stats.is_ht_nego_bad_crypto++; 587 return; 588 } 589 590 ni->ni_flags |= IEEE80211_NODE_HT; 591 } 592 593 void 594 ieee80211_tx_ba_timeout(void *arg) 595 { 596 struct ieee80211_tx_ba *ba = arg; 597 struct ieee80211_node *ni = ba->ba_ni; 598 struct ieee80211com *ic = ni->ni_ic; 599 u_int8_t tid; 600 int s; 601 602 ic->ic_stats.is_ht_tx_ba_timeout++; 603 604 s = splnet(); 605 if (ba->ba_state == IEEE80211_BA_REQUESTED) { 606 /* MLME-ADDBA.confirm(TIMEOUT) */ 607 ba->ba_state = IEEE80211_BA_INIT; 608 609 } else if (ba->ba_state == IEEE80211_BA_AGREED) { 610 /* Block Ack inactivity timeout */ 611 tid = ((caddr_t)ba - (caddr_t)ni->ni_tx_ba) / sizeof(*ba); 612 ieee80211_delba_request(ic, ni, IEEE80211_REASON_TIMEOUT, 613 1, tid); 614 } 615 splx(s); 616 } 617 618 void 619 ieee80211_rx_ba_timeout(void *arg) 620 { 621 struct ieee80211_rx_ba *ba = arg; 622 struct ieee80211_node *ni = ba->ba_ni; 623 struct ieee80211com *ic = ni->ni_ic; 624 u_int8_t tid; 625 int s; 626 627 ic->ic_stats.is_ht_rx_ba_timeout++; 628 629 s = splnet(); 630 631 /* Block Ack inactivity timeout */ 632 tid = ((caddr_t)ba - (caddr_t)ni->ni_rx_ba) / sizeof(*ba); 633 ieee80211_delba_request(ic, ni, IEEE80211_REASON_TIMEOUT, 0, tid); 634 635 splx(s); 636 } 637 638 /* 639 * Request initiation of Block Ack with the specified peer. 640 */ 641 int 642 ieee80211_addba_request(struct ieee80211com *ic, struct ieee80211_node *ni, 643 u_int16_t ssn, u_int8_t tid) 644 { 645 struct ieee80211_tx_ba *ba = &ni->ni_tx_ba[tid]; 646 647 /* MLME-ADDBA.request */ 648 649 /* setup Block Ack */ 650 ba->ba_state = IEEE80211_BA_REQUESTED; 651 ba->ba_token = ic->ic_dialog_token++; 652 ba->ba_timeout_val = 0; 653 timeout_set(&ba->ba_to, ieee80211_tx_ba_timeout, ba); 654 ba->ba_winsize = IEEE80211_BA_MAX_WINSZ; 655 ba->ba_winstart = ssn; 656 ba->ba_winend = (ba->ba_winstart + ba->ba_winsize - 1) & 0xfff; 657 ba->ba_params = 658 (ba->ba_winsize << IEEE80211_ADDBA_BUFSZ_SHIFT) | 659 (tid << IEEE80211_ADDBA_TID_SHIFT) | IEEE80211_ADDBA_AMSDU; 660 if ((ic->ic_htcaps & IEEE80211_HTCAP_DELAYEDBA) == 0) 661 /* immediate BA */ 662 ba->ba_params |= IEEE80211_ADDBA_BA_POLICY; 663 664 timeout_add_sec(&ba->ba_to, 1); /* dot11ADDBAResponseTimeout */ 665 IEEE80211_SEND_ACTION(ic, ni, IEEE80211_CATEG_BA, 666 IEEE80211_ACTION_ADDBA_REQ, tid); 667 return 0; 668 } 669 670 /* 671 * Request the deletion of Block Ack with a peer. 672 */ 673 void 674 ieee80211_delba_request(struct ieee80211com *ic, struct ieee80211_node *ni, 675 u_int16_t reason, u_int8_t dir, u_int8_t tid) 676 { 677 /* MLME-DELBA.request */ 678 679 /* transmit a DELBA frame */ 680 IEEE80211_SEND_ACTION(ic, ni, IEEE80211_CATEG_BA, 681 IEEE80211_ACTION_DELBA, reason << 16 | dir << 8 | tid); 682 if (dir) { 683 /* MLME-DELBA.confirm(Originator) */ 684 struct ieee80211_tx_ba *ba = &ni->ni_tx_ba[tid]; 685 686 if (ic->ic_ampdu_tx_stop != NULL) 687 ic->ic_ampdu_tx_stop(ic, ni, tid); 688 689 ba->ba_state = IEEE80211_BA_INIT; 690 /* stop Block Ack inactivity timer */ 691 timeout_del(&ba->ba_to); 692 } else { 693 /* MLME-DELBA.confirm(Recipient) */ 694 struct ieee80211_rx_ba *ba = &ni->ni_rx_ba[tid]; 695 int i; 696 697 if (ic->ic_ampdu_rx_stop != NULL) 698 ic->ic_ampdu_rx_stop(ic, ni, tid); 699 700 ba->ba_state = IEEE80211_BA_INIT; 701 /* stop Block Ack inactivity timer */ 702 timeout_del(&ba->ba_to); 703 timeout_del(&ba->ba_gap_to); 704 705 if (ba->ba_buf != NULL) { 706 /* free all MSDUs stored in reordering buffer */ 707 for (i = 0; i < IEEE80211_BA_MAX_WINSZ; i++) 708 m_freem(ba->ba_buf[i].m); 709 /* free reordering buffer */ 710 free(ba->ba_buf, M_DEVBUF, 0); 711 ba->ba_buf = NULL; 712 } 713 } 714 } 715 716 void 717 ieee80211_auth_open(struct ieee80211com *ic, const struct ieee80211_frame *wh, 718 struct ieee80211_node *ni, struct ieee80211_rxinfo *rxi, u_int16_t seq, 719 u_int16_t status) 720 { 721 struct ifnet *ifp = &ic->ic_if; 722 switch (ic->ic_opmode) { 723 #ifndef IEEE80211_STA_ONLY 724 case IEEE80211_M_IBSS: 725 if (ic->ic_state != IEEE80211_S_RUN || 726 seq != IEEE80211_AUTH_OPEN_REQUEST) { 727 DPRINTF(("discard auth from %s; state %u, seq %u\n", 728 ether_sprintf((u_int8_t *)wh->i_addr2), 729 ic->ic_state, seq)); 730 ic->ic_stats.is_rx_bad_auth++; 731 return; 732 } 733 ieee80211_new_state(ic, IEEE80211_S_AUTH, 734 wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK); 735 break; 736 737 case IEEE80211_M_AHDEMO: 738 /* should not come here */ 739 break; 740 741 case IEEE80211_M_HOSTAP: 742 if (ic->ic_state != IEEE80211_S_RUN || 743 seq != IEEE80211_AUTH_OPEN_REQUEST) { 744 DPRINTF(("discard auth from %s; state %u, seq %u\n", 745 ether_sprintf((u_int8_t *)wh->i_addr2), 746 ic->ic_state, seq)); 747 ic->ic_stats.is_rx_bad_auth++; 748 return; 749 } 750 if (ni == ic->ic_bss) { 751 ni = ieee80211_find_node(ic, wh->i_addr2); 752 if (ni == NULL) 753 ni = ieee80211_alloc_node(ic, wh->i_addr2); 754 if (ni == NULL) { 755 return; 756 } 757 IEEE80211_ADDR_COPY(ni->ni_bssid, ic->ic_bss->ni_bssid); 758 ni->ni_rssi = rxi->rxi_rssi; 759 ni->ni_rstamp = rxi->rxi_tstamp; 760 ni->ni_chan = ic->ic_bss->ni_chan; 761 } 762 IEEE80211_SEND_MGMT(ic, ni, 763 IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 764 if (ifp->if_flags & IFF_DEBUG) 765 printf("%s: station %s %s authenticated (open)\n", 766 ifp->if_xname, 767 ether_sprintf((u_int8_t *)ni->ni_macaddr), 768 ni->ni_state != IEEE80211_STA_CACHE ? 769 "newly" : "already"); 770 ieee80211_node_newstate(ni, IEEE80211_STA_AUTH); 771 break; 772 #endif /* IEEE80211_STA_ONLY */ 773 774 case IEEE80211_M_STA: 775 if (ic->ic_state != IEEE80211_S_AUTH || 776 seq != IEEE80211_AUTH_OPEN_RESPONSE) { 777 ic->ic_stats.is_rx_bad_auth++; 778 DPRINTF(("discard auth from %s; state %u, seq %u\n", 779 ether_sprintf((u_int8_t *)wh->i_addr2), 780 ic->ic_state, seq)); 781 return; 782 } 783 if (ic->ic_flags & IEEE80211_F_RSNON) { 784 /* XXX not here! */ 785 ic->ic_bss->ni_flags &= ~IEEE80211_NODE_TXRXPROT; 786 ic->ic_bss->ni_port_valid = 0; 787 ic->ic_bss->ni_replaycnt_ok = 0; 788 (*ic->ic_delete_key)(ic, ic->ic_bss, 789 &ic->ic_bss->ni_pairwise_key); 790 } 791 if (status != 0) { 792 if (ifp->if_flags & IFF_DEBUG) 793 printf("%s: open authentication failed " 794 "(reason %d) for %s\n", ifp->if_xname, 795 status, 796 ether_sprintf((u_int8_t *)wh->i_addr3)); 797 if (ni != ic->ic_bss) 798 ni->ni_fails++; 799 ic->ic_stats.is_rx_auth_fail++; 800 return; 801 } 802 ieee80211_new_state(ic, IEEE80211_S_ASSOC, 803 wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK); 804 break; 805 default: 806 break; 807 } 808 } 809 810 int 811 ieee80211_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, 812 int mgt) 813 { 814 struct ifnet *ifp = &ic->ic_if; 815 struct ieee80211_node *ni; 816 enum ieee80211_state ostate; 817 u_int rate; 818 #ifndef IEEE80211_STA_ONLY 819 int s; 820 #endif 821 822 ostate = ic->ic_state; 823 DPRINTF(("%s -> %s\n", ieee80211_state_name[ostate], 824 ieee80211_state_name[nstate])); 825 ic->ic_state = nstate; /* state transition */ 826 ni = ic->ic_bss; /* NB: no reference held */ 827 if (ostate == IEEE80211_S_RUN) 828 ieee80211_set_link_state(ic, LINK_STATE_DOWN); 829 switch (nstate) { 830 case IEEE80211_S_INIT: 831 /* 832 * If mgt = -1, driver is already partway down, so do 833 * not send management frames. 834 */ 835 switch (ostate) { 836 case IEEE80211_S_INIT: 837 break; 838 case IEEE80211_S_RUN: 839 if (mgt == -1) 840 goto justcleanup; 841 switch (ic->ic_opmode) { 842 case IEEE80211_M_STA: 843 IEEE80211_SEND_MGMT(ic, ni, 844 IEEE80211_FC0_SUBTYPE_DISASSOC, 845 IEEE80211_REASON_ASSOC_LEAVE); 846 break; 847 #ifndef IEEE80211_STA_ONLY 848 case IEEE80211_M_HOSTAP: 849 s = splnet(); 850 RB_FOREACH(ni, ieee80211_tree, &ic->ic_tree) { 851 if (ni->ni_state != IEEE80211_STA_ASSOC) 852 continue; 853 IEEE80211_SEND_MGMT(ic, ni, 854 IEEE80211_FC0_SUBTYPE_DISASSOC, 855 IEEE80211_REASON_ASSOC_LEAVE); 856 } 857 splx(s); 858 break; 859 #endif 860 default: 861 break; 862 } 863 /* FALLTHROUGH */ 864 case IEEE80211_S_ASSOC: 865 if (mgt == -1) 866 goto justcleanup; 867 switch (ic->ic_opmode) { 868 case IEEE80211_M_STA: 869 IEEE80211_SEND_MGMT(ic, ni, 870 IEEE80211_FC0_SUBTYPE_DEAUTH, 871 IEEE80211_REASON_AUTH_LEAVE); 872 break; 873 #ifndef IEEE80211_STA_ONLY 874 case IEEE80211_M_HOSTAP: 875 s = splnet(); 876 RB_FOREACH(ni, ieee80211_tree, &ic->ic_tree) { 877 IEEE80211_SEND_MGMT(ic, ni, 878 IEEE80211_FC0_SUBTYPE_DEAUTH, 879 IEEE80211_REASON_AUTH_LEAVE); 880 } 881 splx(s); 882 break; 883 #endif 884 default: 885 break; 886 } 887 /* FALLTHROUGH */ 888 case IEEE80211_S_AUTH: 889 case IEEE80211_S_SCAN: 890 justcleanup: 891 #ifndef IEEE80211_STA_ONLY 892 if (ic->ic_opmode == IEEE80211_M_HOSTAP) 893 timeout_del(&ic->ic_rsn_timeout); 894 #endif 895 ic->ic_mgt_timer = 0; 896 mq_purge(&ic->ic_mgtq); 897 mq_purge(&ic->ic_pwrsaveq); 898 ieee80211_free_allnodes(ic); 899 break; 900 } 901 break; 902 case IEEE80211_S_SCAN: 903 ic->ic_flags &= ~IEEE80211_F_SIBSS; 904 /* initialize bss for probe request */ 905 IEEE80211_ADDR_COPY(ni->ni_macaddr, etherbroadcastaddr); 906 IEEE80211_ADDR_COPY(ni->ni_bssid, etherbroadcastaddr); 907 ni->ni_rates = ic->ic_sup_rates[ 908 ieee80211_chan2mode(ic, ni->ni_chan)]; 909 ni->ni_associd = 0; 910 ni->ni_rstamp = 0; 911 switch (ostate) { 912 case IEEE80211_S_INIT: 913 #ifndef IEEE80211_STA_ONLY 914 if (ic->ic_opmode == IEEE80211_M_HOSTAP && 915 ic->ic_des_chan != IEEE80211_CHAN_ANYC) { 916 /* 917 * AP operation and we already have a channel; 918 * bypass the scan and startup immediately. 919 */ 920 ieee80211_create_ibss(ic, ic->ic_des_chan); 921 } else 922 #endif 923 ieee80211_begin_scan(ifp); 924 break; 925 case IEEE80211_S_SCAN: 926 /* scan next */ 927 if (ic->ic_flags & IEEE80211_F_ASCAN) { 928 IEEE80211_SEND_MGMT(ic, ni, 929 IEEE80211_FC0_SUBTYPE_PROBE_REQ, 0); 930 } 931 break; 932 case IEEE80211_S_RUN: 933 /* beacon miss */ 934 if (ifp->if_flags & IFF_DEBUG) { 935 /* XXX bssid clobbered above */ 936 printf("%s: no recent beacons from %s;" 937 " rescanning\n", ifp->if_xname, 938 ether_sprintf(ic->ic_bss->ni_bssid)); 939 } 940 ieee80211_free_allnodes(ic); 941 /* FALLTHROUGH */ 942 case IEEE80211_S_AUTH: 943 case IEEE80211_S_ASSOC: 944 /* timeout restart scan */ 945 ni = ieee80211_find_node(ic, ic->ic_bss->ni_macaddr); 946 if (ni != NULL) 947 ni->ni_fails++; 948 ieee80211_begin_scan(ifp); 949 break; 950 } 951 break; 952 case IEEE80211_S_AUTH: 953 switch (ostate) { 954 case IEEE80211_S_INIT: 955 DPRINTF(("invalid transition\n")); 956 break; 957 case IEEE80211_S_SCAN: 958 IEEE80211_SEND_MGMT(ic, ni, 959 IEEE80211_FC0_SUBTYPE_AUTH, 1); 960 break; 961 case IEEE80211_S_AUTH: 962 case IEEE80211_S_ASSOC: 963 switch (mgt) { 964 case IEEE80211_FC0_SUBTYPE_AUTH: 965 /* ??? */ 966 IEEE80211_SEND_MGMT(ic, ni, 967 IEEE80211_FC0_SUBTYPE_AUTH, 2); 968 break; 969 case IEEE80211_FC0_SUBTYPE_DEAUTH: 970 /* ignore and retry scan on timeout */ 971 break; 972 } 973 break; 974 case IEEE80211_S_RUN: 975 switch (mgt) { 976 case IEEE80211_FC0_SUBTYPE_AUTH: 977 IEEE80211_SEND_MGMT(ic, ni, 978 IEEE80211_FC0_SUBTYPE_AUTH, 2); 979 ic->ic_state = ostate; /* stay RUN */ 980 break; 981 case IEEE80211_FC0_SUBTYPE_DEAUTH: 982 /* try to reauth */ 983 IEEE80211_SEND_MGMT(ic, ni, 984 IEEE80211_FC0_SUBTYPE_AUTH, 1); 985 break; 986 } 987 break; 988 } 989 break; 990 case IEEE80211_S_ASSOC: 991 switch (ostate) { 992 case IEEE80211_S_INIT: 993 case IEEE80211_S_SCAN: 994 case IEEE80211_S_ASSOC: 995 DPRINTF(("invalid transition\n")); 996 break; 997 case IEEE80211_S_AUTH: 998 IEEE80211_SEND_MGMT(ic, ni, 999 IEEE80211_FC0_SUBTYPE_ASSOC_REQ, 0); 1000 break; 1001 case IEEE80211_S_RUN: 1002 IEEE80211_SEND_MGMT(ic, ni, 1003 IEEE80211_FC0_SUBTYPE_ASSOC_REQ, 1); 1004 break; 1005 } 1006 break; 1007 case IEEE80211_S_RUN: 1008 switch (ostate) { 1009 case IEEE80211_S_INIT: 1010 case IEEE80211_S_AUTH: 1011 case IEEE80211_S_RUN: 1012 DPRINTF(("invalid transition\n")); 1013 break; 1014 case IEEE80211_S_SCAN: /* adhoc/hostap mode */ 1015 case IEEE80211_S_ASSOC: /* infra mode */ 1016 if (ni->ni_txrate >= ni->ni_rates.rs_nrates) 1017 panic("%s: bogus xmit rate %u setup", 1018 __func__, ni->ni_txrate); 1019 if (ifp->if_flags & IFF_DEBUG) { 1020 printf("%s: %s with %s ssid ", 1021 ifp->if_xname, 1022 ic->ic_opmode == IEEE80211_M_STA ? 1023 "associated" : "synchronized", 1024 ether_sprintf(ni->ni_bssid)); 1025 ieee80211_print_essid(ic->ic_bss->ni_essid, 1026 ni->ni_esslen); 1027 rate = ni->ni_rates.rs_rates[ni->ni_txrate] & 1028 IEEE80211_RATE_VAL; 1029 printf(" channel %d", 1030 ieee80211_chan2ieee(ic, ni->ni_chan)); 1031 if (ni->ni_flags & IEEE80211_NODE_HT) 1032 printf(" start MCS %u", ni->ni_txmcs); 1033 else 1034 printf(" start %u%sMb", 1035 rate / 2, (rate & 1) ? ".5" : ""); 1036 printf(" %s preamble %s slot time%s%s\n", 1037 (ic->ic_flags & IEEE80211_F_SHPREAMBLE) ? 1038 "short" : "long", 1039 (ic->ic_flags & IEEE80211_F_SHSLOT) ? 1040 "short" : "long", 1041 (ic->ic_flags & IEEE80211_F_USEPROT) ? 1042 " protection enabled" : "", 1043 (ni->ni_flags & IEEE80211_NODE_HT) ? 1044 " HT enabled" : ""); 1045 } 1046 if (!(ic->ic_flags & IEEE80211_F_RSNON)) { 1047 /* 1048 * NB: When RSN is enabled, we defer setting 1049 * the link up until the port is valid. 1050 */ 1051 ieee80211_set_link_state(ic, LINK_STATE_UP); 1052 } 1053 ic->ic_mgt_timer = 0; 1054 if_start(ifp); 1055 break; 1056 } 1057 break; 1058 } 1059 return 0; 1060 } 1061 1062 void 1063 ieee80211_set_link_state(struct ieee80211com *ic, int nstate) 1064 { 1065 struct ifnet *ifp = &ic->ic_if; 1066 1067 switch (ic->ic_opmode) { 1068 #ifndef IEEE80211_STA_ONLY 1069 case IEEE80211_M_IBSS: 1070 case IEEE80211_M_HOSTAP: 1071 nstate = LINK_STATE_UNKNOWN; 1072 break; 1073 #endif 1074 case IEEE80211_M_MONITOR: 1075 nstate = LINK_STATE_DOWN; 1076 break; 1077 default: 1078 break; 1079 } 1080 if (nstate != ifp->if_link_state) { 1081 ifp->if_link_state = nstate; 1082 if_link_state_change(ifp); 1083 } 1084 } 1085