ieee80211_sta.c revision 191444
1178354Ssam/*- 2178354Ssam * Copyright (c) 2007-2008 Sam Leffler, Errno Consulting 3178354Ssam * All rights reserved. 4178354Ssam * 5178354Ssam * Redistribution and use in source and binary forms, with or without 6178354Ssam * modification, are permitted provided that the following conditions 7178354Ssam * are met: 8178354Ssam * 1. Redistributions of source code must retain the above copyright 9178354Ssam * notice, this list of conditions and the following disclaimer. 10178354Ssam * 2. Redistributions in binary form must reproduce the above copyright 11178354Ssam * notice, this list of conditions and the following disclaimer in the 12178354Ssam * documentation and/or other materials provided with the distribution. 13178354Ssam * 14178354Ssam * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15178354Ssam * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16178354Ssam * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17178354Ssam * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18178354Ssam * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 19178354Ssam * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 20178354Ssam * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 21178354Ssam * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 22178354Ssam * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 23178354Ssam * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24178354Ssam */ 25178354Ssam 26178354Ssam#include <sys/cdefs.h> 27178354Ssam#ifdef __FreeBSD__ 28178354Ssam__FBSDID("$FreeBSD: head/sys/net80211/ieee80211_sta.c 191444 2009-04-23 22:08:44Z rpaulo $"); 29178354Ssam#endif 30178354Ssam 31178354Ssam/* 32178354Ssam * IEEE 802.11 Station mode support. 33178354Ssam */ 34178354Ssam#include "opt_inet.h" 35178354Ssam#include "opt_wlan.h" 36178354Ssam 37178354Ssam#include <sys/param.h> 38178354Ssam#include <sys/systm.h> 39178354Ssam#include <sys/mbuf.h> 40178354Ssam#include <sys/malloc.h> 41178354Ssam#include <sys/kernel.h> 42178354Ssam 43178354Ssam#include <sys/socket.h> 44178354Ssam#include <sys/sockio.h> 45178354Ssam#include <sys/endian.h> 46178354Ssam#include <sys/errno.h> 47178354Ssam#include <sys/proc.h> 48178354Ssam#include <sys/sysctl.h> 49178354Ssam 50178354Ssam#include <net/if.h> 51178354Ssam#include <net/if_media.h> 52178354Ssam#include <net/if_llc.h> 53178354Ssam#include <net/ethernet.h> 54178354Ssam 55178354Ssam#include <net/bpf.h> 56178354Ssam 57178354Ssam#include <net80211/ieee80211_var.h> 58178354Ssam#include <net80211/ieee80211_sta.h> 59178354Ssam#include <net80211/ieee80211_input.h> 60190391Ssam#ifdef IEEE80211_SUPPORT_SUPERG 61190391Ssam#include <net80211/ieee80211_superg.h> 62190391Ssam#endif 63178354Ssam 64178354Ssam#define IEEE80211_RATE2MBS(r) (((r) & IEEE80211_RATE_VAL) / 2) 65178354Ssam 66178354Ssamstatic void sta_vattach(struct ieee80211vap *); 67178354Ssamstatic void sta_beacon_miss(struct ieee80211vap *); 68178354Ssamstatic int sta_newstate(struct ieee80211vap *, enum ieee80211_state, int); 69178354Ssamstatic int sta_input(struct ieee80211_node *, struct mbuf *, 70178354Ssam int rssi, int noise, uint32_t rstamp); 71178354Ssamstatic void sta_recv_mgmt(struct ieee80211_node *, struct mbuf *, 72178354Ssam int subtype, int rssi, int noise, uint32_t rstamp); 73178354Ssam 74178354Ssamvoid 75178354Ssamieee80211_sta_attach(struct ieee80211com *ic) 76178354Ssam{ 77178354Ssam ic->ic_vattach[IEEE80211_M_STA] = sta_vattach; 78178354Ssam} 79178354Ssam 80178354Ssamvoid 81178354Ssamieee80211_sta_detach(struct ieee80211com *ic) 82178354Ssam{ 83178354Ssam} 84178354Ssam 85178354Ssamstatic void 86178354Ssamsta_vdetach(struct ieee80211vap *vap) 87178354Ssam{ 88178354Ssam} 89178354Ssam 90178354Ssamstatic void 91178354Ssamsta_vattach(struct ieee80211vap *vap) 92178354Ssam{ 93178354Ssam vap->iv_newstate = sta_newstate; 94178354Ssam vap->iv_input = sta_input; 95178354Ssam vap->iv_recv_mgmt = sta_recv_mgmt; 96178354Ssam vap->iv_opdetach = sta_vdetach; 97178354Ssam vap->iv_bmiss = sta_beacon_miss; 98178354Ssam} 99178354Ssam 100178354Ssam/* 101178354Ssam * Handle a beacon miss event. The common code filters out 102178354Ssam * spurious events that can happen when scanning and/or before 103178354Ssam * reaching RUN state. 104178354Ssam */ 105178354Ssamstatic void 106178354Ssamsta_beacon_miss(struct ieee80211vap *vap) 107178354Ssam{ 108190402Ssam KASSERT((vap->iv_ic->ic_flags & IEEE80211_F_SCAN) == 0, ("scanning")); 109178354Ssam KASSERT(vap->iv_state == IEEE80211_S_RUN, 110178354Ssam ("wrong state %d", vap->iv_state)); 111178354Ssam 112178354Ssam IEEE80211_DPRINTF(vap, 113178354Ssam IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG, 114178354Ssam "beacon miss, mode %u state %s\n", 115178354Ssam vap->iv_opmode, ieee80211_state_name[vap->iv_state]); 116178354Ssam 117178354Ssam if (++vap->iv_bmiss_count < vap->iv_bmiss_max) { 118178354Ssam /* 119178354Ssam * Send a directed probe req before falling back to a 120178354Ssam * scan; if we receive a response ic_bmiss_count will 121178354Ssam * be reset. Some cards mistakenly report beacon miss 122178354Ssam * so this avoids the expensive scan if the ap is 123178354Ssam * still there. 124178354Ssam */ 125178354Ssam ieee80211_send_probereq(vap->iv_bss, vap->iv_myaddr, 126178354Ssam vap->iv_bss->ni_bssid, vap->iv_bss->ni_bssid, 127178354Ssam vap->iv_bss->ni_essid, vap->iv_bss->ni_esslen); 128178354Ssam return; 129178354Ssam } 130178354Ssam vap->iv_bmiss_count = 0; 131178354Ssam vap->iv_stats.is_beacon_miss++; 132178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) { 133190391Ssam#ifdef IEEE80211_SUPPORT_SUPERG 134190402Ssam struct ieee80211com *ic = vap->iv_ic; 135190402Ssam 136178354Ssam /* 137178354Ssam * If we receive a beacon miss interrupt when using 138178354Ssam * dynamic turbo, attempt to switch modes before 139178354Ssam * reassociating. 140178354Ssam */ 141178354Ssam if (IEEE80211_ATH_CAP(vap, vap->iv_bss, IEEE80211_NODE_TURBOP)) 142178354Ssam ieee80211_dturbo_switch(vap, 143178354Ssam ic->ic_bsschan->ic_flags ^ IEEE80211_CHAN_TURBO); 144190391Ssam#endif 145178354Ssam /* 146178354Ssam * Try to reassociate before scanning for a new ap. 147178354Ssam */ 148178354Ssam ieee80211_new_state(vap, IEEE80211_S_ASSOC, 1); 149178354Ssam } else { 150178354Ssam /* 151178354Ssam * Somebody else is controlling state changes (e.g. 152178354Ssam * a user-mode app) don't do anything that would 153178354Ssam * confuse them; just drop into scan mode so they'll 154178354Ssam * notified of the state change and given control. 155178354Ssam */ 156178354Ssam ieee80211_new_state(vap, IEEE80211_S_SCAN, 0); 157178354Ssam } 158178354Ssam} 159178354Ssam 160178354Ssam/* 161178354Ssam * Handle deauth with reason. We retry only for 162178354Ssam * the cases where we might succeed. Otherwise 163178354Ssam * we downgrade the ap and scan. 164178354Ssam */ 165178354Ssamstatic void 166178354Ssamsta_authretry(struct ieee80211vap *vap, struct ieee80211_node *ni, int reason) 167178354Ssam{ 168178354Ssam switch (reason) { 169178354Ssam case IEEE80211_STATUS_SUCCESS: /* NB: MLME assoc */ 170178354Ssam case IEEE80211_STATUS_TIMEOUT: 171178354Ssam case IEEE80211_REASON_ASSOC_EXPIRE: 172178354Ssam case IEEE80211_REASON_NOT_AUTHED: 173178354Ssam case IEEE80211_REASON_NOT_ASSOCED: 174178354Ssam case IEEE80211_REASON_ASSOC_LEAVE: 175178354Ssam case IEEE80211_REASON_ASSOC_NOT_AUTHED: 176178354Ssam IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_AUTH, 1); 177178354Ssam break; 178178354Ssam default: 179178354Ssam ieee80211_scan_assoc_fail(vap, vap->iv_bss->ni_macaddr, reason); 180178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) 181178354Ssam ieee80211_check_scan_current(vap); 182178354Ssam break; 183178354Ssam } 184178354Ssam} 185178354Ssam 186178354Ssam/* 187178354Ssam * IEEE80211_M_STA vap state machine handler. 188178354Ssam * This routine handles the main states in the 802.11 protocol. 189178354Ssam */ 190178354Ssamstatic int 191178354Ssamsta_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 192178354Ssam{ 193178354Ssam struct ieee80211com *ic = vap->iv_ic; 194178354Ssam struct ieee80211_node *ni; 195178354Ssam enum ieee80211_state ostate; 196178354Ssam 197178354Ssam IEEE80211_LOCK_ASSERT(ic); 198178354Ssam 199178354Ssam ostate = vap->iv_state; 200178354Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE, "%s: %s -> %s (%d)\n", 201178354Ssam __func__, ieee80211_state_name[ostate], 202178354Ssam ieee80211_state_name[nstate], arg); 203178354Ssam vap->iv_state = nstate; /* state transition */ 204178354Ssam callout_stop(&vap->iv_mgtsend); /* XXX callout_drain */ 205178354Ssam if (ostate != IEEE80211_S_SCAN) 206178354Ssam ieee80211_cancel_scan(vap); /* background scan */ 207178354Ssam ni = vap->iv_bss; /* NB: no reference held */ 208178354Ssam if (vap->iv_flags_ext & IEEE80211_FEXT_SWBMISS) 209178354Ssam callout_stop(&vap->iv_swbmiss); 210178354Ssam switch (nstate) { 211178354Ssam case IEEE80211_S_INIT: 212178354Ssam switch (ostate) { 213178354Ssam case IEEE80211_S_SLEEP: 214178354Ssam /* XXX wakeup */ 215178354Ssam case IEEE80211_S_RUN: 216178354Ssam IEEE80211_SEND_MGMT(ni, 217178354Ssam IEEE80211_FC0_SUBTYPE_DISASSOC, 218178354Ssam IEEE80211_REASON_ASSOC_LEAVE); 219178354Ssam ieee80211_sta_leave(ni); 220178354Ssam break; 221178354Ssam case IEEE80211_S_ASSOC: 222178354Ssam IEEE80211_SEND_MGMT(ni, 223178354Ssam IEEE80211_FC0_SUBTYPE_DEAUTH, 224178354Ssam IEEE80211_REASON_AUTH_LEAVE); 225178354Ssam break; 226178354Ssam case IEEE80211_S_SCAN: 227178354Ssam ieee80211_cancel_scan(vap); 228178354Ssam break; 229178354Ssam default: 230178354Ssam goto invalid; 231178354Ssam } 232178354Ssam if (ostate != IEEE80211_S_INIT) { 233178354Ssam /* NB: optimize INIT -> INIT case */ 234178354Ssam ieee80211_reset_bss(vap); 235178354Ssam } 236178354Ssam if (vap->iv_auth->ia_detach != NULL) 237178354Ssam vap->iv_auth->ia_detach(vap); 238178354Ssam break; 239178354Ssam case IEEE80211_S_SCAN: 240178354Ssam switch (ostate) { 241178354Ssam case IEEE80211_S_INIT: 242178354Ssam /* 243178354Ssam * Initiate a scan. We can come here as a result 244178354Ssam * of an IEEE80211_IOC_SCAN_REQ too in which case 245178354Ssam * the vap will be marked with IEEE80211_FEXT_SCANREQ 246178354Ssam * and the scan request parameters will be present 247178354Ssam * in iv_scanreq. Otherwise we do the default. 248178354Ssam */ 249178354Ssam if (vap->iv_flags_ext & IEEE80211_FEXT_SCANREQ) { 250178354Ssam ieee80211_check_scan(vap, 251178354Ssam vap->iv_scanreq_flags, 252178354Ssam vap->iv_scanreq_duration, 253178354Ssam vap->iv_scanreq_mindwell, 254178354Ssam vap->iv_scanreq_maxdwell, 255178354Ssam vap->iv_scanreq_nssid, vap->iv_scanreq_ssid); 256178354Ssam vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANREQ; 257178354Ssam } else 258178354Ssam ieee80211_check_scan_current(vap); 259178354Ssam break; 260178354Ssam case IEEE80211_S_SCAN: 261178354Ssam case IEEE80211_S_AUTH: 262178354Ssam case IEEE80211_S_ASSOC: 263178354Ssam /* 264178354Ssam * These can happen either because of a timeout 265178354Ssam * on an assoc/auth response or because of a 266178354Ssam * change in state that requires a reset. For 267178354Ssam * the former we're called with a non-zero arg 268178354Ssam * that is the cause for the failure; pass this 269178354Ssam * to the scan code so it can update state. 270178354Ssam * Otherwise trigger a new scan unless we're in 271178354Ssam * manual roaming mode in which case an application 272178354Ssam * must issue an explicit scan request. 273178354Ssam */ 274178354Ssam if (arg != 0) 275178354Ssam ieee80211_scan_assoc_fail(vap, 276178354Ssam vap->iv_bss->ni_macaddr, arg); 277178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) 278178354Ssam ieee80211_check_scan_current(vap); 279178354Ssam break; 280178354Ssam case IEEE80211_S_RUN: /* beacon miss */ 281178354Ssam /* 282178354Ssam * Beacon miss. Notify user space and if not 283178354Ssam * under control of a user application (roaming 284178354Ssam * manual) kick off a scan to re-connect. 285178354Ssam */ 286178354Ssam ieee80211_sta_leave(ni); 287178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) 288178354Ssam ieee80211_check_scan_current(vap); 289178354Ssam break; 290178354Ssam default: 291178354Ssam goto invalid; 292178354Ssam } 293178354Ssam break; 294178354Ssam case IEEE80211_S_AUTH: 295178354Ssam switch (ostate) { 296178354Ssam case IEEE80211_S_INIT: 297178354Ssam case IEEE80211_S_SCAN: 298178354Ssam IEEE80211_SEND_MGMT(ni, 299178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, 1); 300178354Ssam break; 301178354Ssam case IEEE80211_S_AUTH: 302178354Ssam case IEEE80211_S_ASSOC: 303178354Ssam switch (arg & 0xff) { 304178354Ssam case IEEE80211_FC0_SUBTYPE_AUTH: 305178354Ssam /* ??? */ 306178354Ssam IEEE80211_SEND_MGMT(ni, 307178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, 2); 308178354Ssam break; 309178354Ssam case IEEE80211_FC0_SUBTYPE_DEAUTH: 310178354Ssam sta_authretry(vap, ni, arg>>8); 311178354Ssam break; 312178354Ssam } 313178354Ssam break; 314178354Ssam case IEEE80211_S_RUN: 315178354Ssam switch (arg & 0xff) { 316178354Ssam case IEEE80211_FC0_SUBTYPE_AUTH: 317178354Ssam IEEE80211_SEND_MGMT(ni, 318178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, 2); 319178354Ssam vap->iv_state = ostate; /* stay RUN */ 320178354Ssam break; 321178354Ssam case IEEE80211_FC0_SUBTYPE_DEAUTH: 322178354Ssam ieee80211_sta_leave(ni); 323178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) { 324178354Ssam /* try to reauth */ 325178354Ssam IEEE80211_SEND_MGMT(ni, 326178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, 1); 327178354Ssam } 328178354Ssam break; 329178354Ssam } 330178354Ssam break; 331178354Ssam default: 332178354Ssam goto invalid; 333178354Ssam } 334178354Ssam break; 335178354Ssam case IEEE80211_S_ASSOC: 336178354Ssam switch (ostate) { 337178354Ssam case IEEE80211_S_AUTH: 338178354Ssam case IEEE80211_S_ASSOC: 339178354Ssam IEEE80211_SEND_MGMT(ni, 340178354Ssam IEEE80211_FC0_SUBTYPE_ASSOC_REQ, 0); 341178354Ssam break; 342178354Ssam case IEEE80211_S_SLEEP: /* cannot happen */ 343178354Ssam case IEEE80211_S_RUN: 344178354Ssam ieee80211_sta_leave(ni); 345178354Ssam if (vap->iv_roaming == IEEE80211_ROAMING_AUTO) { 346178354Ssam IEEE80211_SEND_MGMT(ni, arg ? 347178354Ssam IEEE80211_FC0_SUBTYPE_REASSOC_REQ : 348178354Ssam IEEE80211_FC0_SUBTYPE_ASSOC_REQ, 0); 349178354Ssam } 350178354Ssam break; 351178354Ssam default: 352178354Ssam goto invalid; 353178354Ssam } 354178354Ssam break; 355178354Ssam case IEEE80211_S_RUN: 356178354Ssam if (vap->iv_flags & IEEE80211_F_WPA) { 357178354Ssam /* XXX validate prerequisites */ 358178354Ssam } 359178354Ssam switch (ostate) { 360178354Ssam case IEEE80211_S_RUN: 361178354Ssam break; 362178354Ssam case IEEE80211_S_AUTH: /* when join is done in fw */ 363178354Ssam case IEEE80211_S_ASSOC: 364178354Ssam#ifdef IEEE80211_DEBUG 365178354Ssam if (ieee80211_msg_debug(vap)) { 366178354Ssam ieee80211_note(vap, "%s with %s ssid ", 367178354Ssam (vap->iv_opmode == IEEE80211_M_STA ? 368178354Ssam "associated" : "synchronized"), 369178354Ssam ether_sprintf(ni->ni_bssid)); 370178354Ssam ieee80211_print_essid(vap->iv_bss->ni_essid, 371178354Ssam ni->ni_esslen); 372178354Ssam /* XXX MCS/HT */ 373178354Ssam printf(" channel %d start %uMb\n", 374178354Ssam ieee80211_chan2ieee(ic, ic->ic_curchan), 375178354Ssam IEEE80211_RATE2MBS(ni->ni_txrate)); 376178354Ssam } 377178354Ssam#endif 378178354Ssam ieee80211_scan_assoc_success(vap, ni->ni_macaddr); 379178354Ssam ieee80211_notify_node_join(ni, 380178354Ssam arg == IEEE80211_FC0_SUBTYPE_ASSOC_RESP); 381178354Ssam break; 382178354Ssam case IEEE80211_S_SLEEP: 383178354Ssam ieee80211_sta_pwrsave(vap, 0); 384178354Ssam break; 385178354Ssam default: 386178354Ssam goto invalid; 387178354Ssam } 388178354Ssam ieee80211_sync_curchan(ic); 389178354Ssam if (ostate != IEEE80211_S_RUN && 390178354Ssam (vap->iv_flags_ext & IEEE80211_FEXT_SWBMISS)) { 391178354Ssam /* 392178354Ssam * Start s/w beacon miss timer for devices w/o 393178354Ssam * hardware support. We fudge a bit here since 394178354Ssam * we're doing this in software. 395178354Ssam */ 396178354Ssam vap->iv_swbmiss_period = IEEE80211_TU_TO_TICKS( 397178354Ssam 2 * vap->iv_bmissthreshold * ni->ni_intval); 398178354Ssam vap->iv_swbmiss_count = 0; 399178354Ssam callout_reset(&vap->iv_swbmiss, vap->iv_swbmiss_period, 400178354Ssam ieee80211_swbmiss, vap); 401178354Ssam } 402178354Ssam /* 403178354Ssam * When 802.1x is not in use mark the port authorized 404178354Ssam * at this point so traffic can flow. 405178354Ssam */ 406178354Ssam if (ni->ni_authmode != IEEE80211_AUTH_8021X) 407178354Ssam ieee80211_node_authorize(ni); 408184345Ssam /* 409184345Ssam * Fake association when joining an existing bss. 410184345Ssam */ 411184345Ssam if (ic->ic_newassoc != NULL) 412184345Ssam ic->ic_newassoc(vap->iv_bss, ostate != IEEE80211_S_RUN); 413178354Ssam break; 414178354Ssam case IEEE80211_S_SLEEP: 415178354Ssam ieee80211_sta_pwrsave(vap, 0); 416178354Ssam break; 417178354Ssam default: 418178354Ssam invalid: 419184268Ssam IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE, 420184268Ssam "%s: unexpected state transition %s -> %s\n", __func__, 421178354Ssam ieee80211_state_name[ostate], ieee80211_state_name[nstate]); 422178354Ssam break; 423178354Ssam } 424178354Ssam return 0; 425178354Ssam} 426178354Ssam 427178354Ssam/* 428178354Ssam * Return non-zero if the frame is an echo of a multicast 429178354Ssam * frame sent by ourself. The dir is known to be DSTODS. 430178354Ssam */ 431178354Ssamstatic __inline int 432178354Ssamisdstods_mcastecho(struct ieee80211vap *vap, const struct ieee80211_frame *wh) 433178354Ssam{ 434178354Ssam#define QWH4(wh) ((const struct ieee80211_qosframe_addr4 *)wh) 435178354Ssam#define WH4(wh) ((const struct ieee80211_frame_addr4 *)wh) 436178354Ssam const uint8_t *sa; 437178354Ssam 438178354Ssam KASSERT(vap->iv_opmode == IEEE80211_M_STA, ("wrong mode")); 439178354Ssam 440178354Ssam if (!IEEE80211_IS_MULTICAST(wh->i_addr3)) 441178354Ssam return 0; 442178354Ssam sa = IEEE80211_QOS_HAS_SEQ(wh) ? QWH4(wh)->i_addr4 : WH4(wh)->i_addr4; 443178354Ssam return IEEE80211_ADDR_EQ(sa, vap->iv_myaddr); 444178354Ssam#undef WH4 445178354Ssam#undef QWH4 446178354Ssam} 447178354Ssam 448178354Ssam/* 449178354Ssam * Return non-zero if the frame is an echo of a multicast 450178354Ssam * frame sent by ourself. The dir is known to be FROMDS. 451178354Ssam */ 452178354Ssamstatic __inline int 453178354Ssamisfromds_mcastecho(struct ieee80211vap *vap, const struct ieee80211_frame *wh) 454178354Ssam{ 455178354Ssam KASSERT(vap->iv_opmode == IEEE80211_M_STA, ("wrong mode")); 456178354Ssam 457178354Ssam if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) 458178354Ssam return 0; 459178354Ssam return IEEE80211_ADDR_EQ(wh->i_addr3, vap->iv_myaddr); 460178354Ssam} 461178354Ssam 462178354Ssam/* 463178354Ssam * Decide if a received management frame should be 464178354Ssam * printed when debugging is enabled. This filters some 465178354Ssam * of the less interesting frames that come frequently 466178354Ssam * (e.g. beacons). 467178354Ssam */ 468178354Ssamstatic __inline int 469178354Ssamdoprint(struct ieee80211vap *vap, int subtype) 470178354Ssam{ 471178354Ssam switch (subtype) { 472178354Ssam case IEEE80211_FC0_SUBTYPE_BEACON: 473178354Ssam return (vap->iv_ic->ic_flags & IEEE80211_F_SCAN); 474178354Ssam case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 475178354Ssam return 0; 476178354Ssam } 477178354Ssam return 1; 478178354Ssam} 479178354Ssam 480178354Ssam/* 481178354Ssam * Process a received frame. The node associated with the sender 482178354Ssam * should be supplied. If nothing was found in the node table then 483178354Ssam * the caller is assumed to supply a reference to iv_bss instead. 484178354Ssam * The RSSI and a timestamp are also supplied. The RSSI data is used 485178354Ssam * during AP scanning to select a AP to associate with; it can have 486178354Ssam * any units so long as values have consistent units and higher values 487178354Ssam * mean ``better signal''. The receive timestamp is currently not used 488178354Ssam * by the 802.11 layer. 489178354Ssam */ 490178354Ssamstatic int 491178354Ssamsta_input(struct ieee80211_node *ni, struct mbuf *m, 492178354Ssam int rssi, int noise, uint32_t rstamp) 493178354Ssam{ 494178354Ssam#define SEQ_LEQ(a,b) ((int)((a)-(b)) <= 0) 495178354Ssam#define HAS_SEQ(type) ((type & 0x4) == 0) 496178354Ssam struct ieee80211vap *vap = ni->ni_vap; 497178354Ssam struct ieee80211com *ic = ni->ni_ic; 498178354Ssam struct ifnet *ifp = vap->iv_ifp; 499178354Ssam struct ieee80211_frame *wh; 500178354Ssam struct ieee80211_key *key; 501178354Ssam struct ether_header *eh; 502178354Ssam int hdrspace, need_tap; 503178354Ssam uint8_t dir, type, subtype, qos; 504178354Ssam uint8_t *bssid; 505178354Ssam uint16_t rxseq; 506178354Ssam 507183247Ssam if (m->m_flags & M_AMPDU_MPDU) { 508178354Ssam /* 509178354Ssam * Fastpath for A-MPDU reorder q resubmission. Frames 510183247Ssam * w/ M_AMPDU_MPDU marked have already passed through 511183247Ssam * here but were received out of order and been held on 512183247Ssam * the reorder queue. When resubmitted they are marked 513183247Ssam * with the M_AMPDU_MPDU flag and we can bypass most of 514183247Ssam * the normal processing. 515178354Ssam */ 516178354Ssam wh = mtod(m, struct ieee80211_frame *); 517178354Ssam type = IEEE80211_FC0_TYPE_DATA; 518178354Ssam dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 519178354Ssam subtype = IEEE80211_FC0_SUBTYPE_QOS; 520178354Ssam hdrspace = ieee80211_hdrspace(ic, wh); /* XXX optimize? */ 521178354Ssam goto resubmit_ampdu; 522178354Ssam } 523178354Ssam 524178354Ssam KASSERT(ni != NULL, ("null node")); 525178354Ssam ni->ni_inact = ni->ni_inact_reload; 526178354Ssam 527178354Ssam need_tap = 1; /* mbuf need to be tapped. */ 528178354Ssam type = -1; /* undefined */ 529178354Ssam 530178354Ssam if (m->m_pkthdr.len < sizeof(struct ieee80211_frame_min)) { 531178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 532178354Ssam ni->ni_macaddr, NULL, 533178354Ssam "too short (1): len %u", m->m_pkthdr.len); 534178354Ssam vap->iv_stats.is_rx_tooshort++; 535178354Ssam goto out; 536178354Ssam } 537178354Ssam /* 538178354Ssam * Bit of a cheat here, we use a pointer for a 3-address 539178354Ssam * frame format but don't reference fields past outside 540178354Ssam * ieee80211_frame_min w/o first validating the data is 541178354Ssam * present. 542178354Ssam */ 543178354Ssam wh = mtod(m, struct ieee80211_frame *); 544178354Ssam 545178354Ssam if ((wh->i_fc[0] & IEEE80211_FC0_VERSION_MASK) != 546178354Ssam IEEE80211_FC0_VERSION_0) { 547178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 548178354Ssam ni->ni_macaddr, NULL, "wrong version %x", wh->i_fc[0]); 549178354Ssam vap->iv_stats.is_rx_badversion++; 550178354Ssam goto err; 551178354Ssam } 552178354Ssam 553178354Ssam dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 554178354Ssam type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 555178354Ssam subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 556178354Ssam if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) { 557178354Ssam bssid = wh->i_addr2; 558178354Ssam if (!IEEE80211_ADDR_EQ(bssid, ni->ni_bssid)) { 559178354Ssam /* not interested in */ 560178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 561178354Ssam bssid, NULL, "%s", "not to bss"); 562178354Ssam vap->iv_stats.is_rx_wrongbss++; 563178354Ssam goto out; 564178354Ssam } 565178354Ssam IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 566178354Ssam ni->ni_noise = noise; 567178354Ssam ni->ni_rstamp = rstamp; 568178354Ssam if (HAS_SEQ(type)) { 569178354Ssam uint8_t tid = ieee80211_gettid(wh); 570178354Ssam if (IEEE80211_QOS_HAS_SEQ(wh) && 571178354Ssam TID_TO_WME_AC(tid) >= WME_AC_VI) 572178354Ssam ic->ic_wme.wme_hipri_traffic++; 573178354Ssam rxseq = le16toh(*(uint16_t *)wh->i_seq); 574178354Ssam if ((ni->ni_flags & IEEE80211_NODE_HT) == 0 && 575178354Ssam (wh->i_fc[1] & IEEE80211_FC1_RETRY) && 576178354Ssam SEQ_LEQ(rxseq, ni->ni_rxseqs[tid])) { 577178354Ssam /* duplicate, discard */ 578178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 579178354Ssam bssid, "duplicate", 580178354Ssam "seqno <%u,%u> fragno <%u,%u> tid %u", 581178354Ssam rxseq >> IEEE80211_SEQ_SEQ_SHIFT, 582178354Ssam ni->ni_rxseqs[tid] >> 583178354Ssam IEEE80211_SEQ_SEQ_SHIFT, 584178354Ssam rxseq & IEEE80211_SEQ_FRAG_MASK, 585178354Ssam ni->ni_rxseqs[tid] & 586178354Ssam IEEE80211_SEQ_FRAG_MASK, 587178354Ssam tid); 588178354Ssam vap->iv_stats.is_rx_dup++; 589178354Ssam IEEE80211_NODE_STAT(ni, rx_dup); 590178354Ssam goto out; 591178354Ssam } 592178354Ssam ni->ni_rxseqs[tid] = rxseq; 593178354Ssam } 594178354Ssam } 595178354Ssam 596178354Ssam switch (type) { 597178354Ssam case IEEE80211_FC0_TYPE_DATA: 598178354Ssam hdrspace = ieee80211_hdrspace(ic, wh); 599178354Ssam if (m->m_len < hdrspace && 600178354Ssam (m = m_pullup(m, hdrspace)) == NULL) { 601178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 602178354Ssam ni->ni_macaddr, NULL, 603178354Ssam "data too short: expecting %u", hdrspace); 604178354Ssam vap->iv_stats.is_rx_tooshort++; 605178354Ssam goto out; /* XXX */ 606178354Ssam } 607178354Ssam /* 608183247Ssam * Handle A-MPDU re-ordering. If the frame is to be 609183247Ssam * processed directly then ieee80211_ampdu_reorder 610178354Ssam * will return 0; otherwise it has consumed the mbuf 611178354Ssam * and we should do nothing more with it. 612178354Ssam */ 613183247Ssam if ((m->m_flags & M_AMPDU) && 614178354Ssam (dir == IEEE80211_FC1_DIR_FROMDS || 615178354Ssam dir == IEEE80211_FC1_DIR_DSTODS) && 616178354Ssam ieee80211_ampdu_reorder(ni, m) != 0) { 617178354Ssam m = NULL; 618178354Ssam goto out; 619178354Ssam } 620178354Ssam resubmit_ampdu: 621178354Ssam if (dir == IEEE80211_FC1_DIR_FROMDS) { 622178354Ssam if ((ifp->if_flags & IFF_SIMPLEX) && 623178354Ssam isfromds_mcastecho(vap, wh)) { 624178354Ssam /* 625178354Ssam * In IEEE802.11 network, multicast 626178354Ssam * packets sent from "me" are broadcast 627178354Ssam * from the AP; silently discard for 628178354Ssam * SIMPLEX interface. 629178354Ssam */ 630178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 631178354Ssam wh, "data", "%s", "multicast echo"); 632178354Ssam vap->iv_stats.is_rx_mcastecho++; 633178354Ssam goto out; 634178354Ssam } 635178354Ssam if ((vap->iv_flags & IEEE80211_F_DWDS) && 636178354Ssam IEEE80211_IS_MULTICAST(wh->i_addr1)) { 637178354Ssam /* 638178354Ssam * DWDS sta's must drop 3-address mcast frames 639178354Ssam * as they will be sent separately as a 4-addr 640178354Ssam * frame. Accepting the 3-addr frame will 641178354Ssam * confuse the bridge into thinking the sending 642178354Ssam * sta is located at the end of WDS link. 643178354Ssam */ 644178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, wh, 645178354Ssam "3-address data", "%s", "DWDS enabled"); 646178354Ssam vap->iv_stats.is_rx_mcastecho++; 647178354Ssam goto out; 648178354Ssam } 649178354Ssam } else if (dir == IEEE80211_FC1_DIR_DSTODS) { 650178354Ssam if ((vap->iv_flags & IEEE80211_F_DWDS) == 0) { 651178354Ssam IEEE80211_DISCARD(vap, 652178354Ssam IEEE80211_MSG_INPUT, wh, "4-address data", 653178354Ssam "%s", "DWDS not enabled"); 654178354Ssam vap->iv_stats.is_rx_wrongdir++; 655178354Ssam goto out; 656178354Ssam } 657178354Ssam if ((ifp->if_flags & IFF_SIMPLEX) && 658178354Ssam isdstods_mcastecho(vap, wh)) { 659178354Ssam /* 660178354Ssam * In IEEE802.11 network, multicast 661178354Ssam * packets sent from "me" are broadcast 662178354Ssam * from the AP; silently discard for 663178354Ssam * SIMPLEX interface. 664178354Ssam */ 665178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, wh, 666178354Ssam "4-address data", "%s", "multicast echo"); 667178354Ssam vap->iv_stats.is_rx_mcastecho++; 668178354Ssam goto out; 669178354Ssam } 670178354Ssam } else { 671178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, wh, 672178354Ssam "data", "incorrect dir 0x%x", dir); 673178354Ssam vap->iv_stats.is_rx_wrongdir++; 674178354Ssam goto out; 675178354Ssam } 676178354Ssam 677178354Ssam /* 678178354Ssam * Handle privacy requirements. Note that we 679178354Ssam * must not be preempted from here until after 680178354Ssam * we (potentially) call ieee80211_crypto_demic; 681178354Ssam * otherwise we may violate assumptions in the 682178354Ssam * crypto cipher modules used to do delayed update 683178354Ssam * of replay sequence numbers. 684178354Ssam */ 685178354Ssam if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 686178354Ssam if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 687178354Ssam /* 688178354Ssam * Discard encrypted frames when privacy is off. 689178354Ssam */ 690178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 691178354Ssam wh, "WEP", "%s", "PRIVACY off"); 692178354Ssam vap->iv_stats.is_rx_noprivacy++; 693178354Ssam IEEE80211_NODE_STAT(ni, rx_noprivacy); 694178354Ssam goto out; 695178354Ssam } 696178354Ssam key = ieee80211_crypto_decap(ni, m, hdrspace); 697178354Ssam if (key == NULL) { 698178354Ssam /* NB: stats+msgs handled in crypto_decap */ 699178354Ssam IEEE80211_NODE_STAT(ni, rx_wepfail); 700178354Ssam goto out; 701178354Ssam } 702178354Ssam wh = mtod(m, struct ieee80211_frame *); 703178354Ssam wh->i_fc[1] &= ~IEEE80211_FC1_WEP; 704178354Ssam } else { 705178354Ssam /* XXX M_WEP and IEEE80211_F_PRIVACY */ 706178354Ssam key = NULL; 707178354Ssam } 708178354Ssam 709178354Ssam /* 710178354Ssam * Save QoS bits for use below--before we strip the header. 711178354Ssam */ 712178354Ssam if (subtype == IEEE80211_FC0_SUBTYPE_QOS) { 713178354Ssam qos = (dir == IEEE80211_FC1_DIR_DSTODS) ? 714178354Ssam ((struct ieee80211_qosframe_addr4 *)wh)->i_qos[0] : 715178354Ssam ((struct ieee80211_qosframe *)wh)->i_qos[0]; 716178354Ssam } else 717178354Ssam qos = 0; 718178354Ssam 719178354Ssam /* 720178354Ssam * Next up, any fragmentation. 721178354Ssam */ 722178354Ssam if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 723178354Ssam m = ieee80211_defrag(ni, m, hdrspace); 724178354Ssam if (m == NULL) { 725178354Ssam /* Fragment dropped or frame not complete yet */ 726178354Ssam goto out; 727178354Ssam } 728178354Ssam } 729178354Ssam wh = NULL; /* no longer valid, catch any uses */ 730178354Ssam 731178354Ssam /* 732178354Ssam * Next strip any MSDU crypto bits. 733178354Ssam */ 734178354Ssam if (key != NULL && !ieee80211_crypto_demic(vap, key, m, 0)) { 735178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 736178354Ssam ni->ni_macaddr, "data", "%s", "demic error"); 737178354Ssam vap->iv_stats.is_rx_demicfail++; 738178354Ssam IEEE80211_NODE_STAT(ni, rx_demicfail); 739178354Ssam goto out; 740178354Ssam } 741178354Ssam 742178354Ssam /* copy to listener after decrypt */ 743178354Ssam if (bpf_peers_present(vap->iv_rawbpf)) 744178354Ssam bpf_mtap(vap->iv_rawbpf, m); 745178354Ssam need_tap = 0; 746178354Ssam 747178354Ssam /* 748178354Ssam * Finally, strip the 802.11 header. 749178354Ssam */ 750178354Ssam m = ieee80211_decap(vap, m, hdrspace); 751178354Ssam if (m == NULL) { 752178354Ssam /* XXX mask bit to check for both */ 753178354Ssam /* don't count Null data frames as errors */ 754178354Ssam if (subtype == IEEE80211_FC0_SUBTYPE_NODATA || 755178354Ssam subtype == IEEE80211_FC0_SUBTYPE_QOS_NULL) 756178354Ssam goto out; 757178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 758178354Ssam ni->ni_macaddr, "data", "%s", "decap error"); 759178354Ssam vap->iv_stats.is_rx_decap++; 760178354Ssam IEEE80211_NODE_STAT(ni, rx_decap); 761178354Ssam goto err; 762178354Ssam } 763178354Ssam eh = mtod(m, struct ether_header *); 764178354Ssam if (!ieee80211_node_is_authorized(ni)) { 765178354Ssam /* 766178354Ssam * Deny any non-PAE frames received prior to 767178354Ssam * authorization. For open/shared-key 768178354Ssam * authentication the port is mark authorized 769178354Ssam * after authentication completes. For 802.1x 770178354Ssam * the port is not marked authorized by the 771178354Ssam * authenticator until the handshake has completed. 772178354Ssam */ 773178354Ssam if (eh->ether_type != htons(ETHERTYPE_PAE)) { 774178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 775178354Ssam eh->ether_shost, "data", 776178354Ssam "unauthorized port: ether type 0x%x len %u", 777178354Ssam eh->ether_type, m->m_pkthdr.len); 778178354Ssam vap->iv_stats.is_rx_unauth++; 779178354Ssam IEEE80211_NODE_STAT(ni, rx_unauth); 780178354Ssam goto err; 781178354Ssam } 782178354Ssam } else { 783178354Ssam /* 784178354Ssam * When denying unencrypted frames, discard 785178354Ssam * any non-PAE frames received without encryption. 786178354Ssam */ 787178354Ssam if ((vap->iv_flags & IEEE80211_F_DROPUNENC) && 788178354Ssam (key == NULL && (m->m_flags & M_WEP) == 0) && 789178354Ssam eh->ether_type != htons(ETHERTYPE_PAE)) { 790178354Ssam /* 791178354Ssam * Drop unencrypted frames. 792178354Ssam */ 793178354Ssam vap->iv_stats.is_rx_unencrypted++; 794178354Ssam IEEE80211_NODE_STAT(ni, rx_unencrypted); 795178354Ssam goto out; 796178354Ssam } 797178354Ssam } 798178354Ssam /* XXX require HT? */ 799178354Ssam if (qos & IEEE80211_QOS_AMSDU) { 800178354Ssam m = ieee80211_decap_amsdu(ni, m); 801178354Ssam if (m == NULL) 802178354Ssam return IEEE80211_FC0_TYPE_DATA; 803190391Ssam } else { 804190391Ssam#ifdef IEEE80211_SUPPORT_SUPERG 805190391Ssam m = ieee80211_decap_fastframe(vap, ni, m); 806190391Ssam if (m == NULL) 807178354Ssam return IEEE80211_FC0_TYPE_DATA; 808190391Ssam#endif 809178354Ssam } 810178354Ssam ieee80211_deliver_data(vap, ni, m); 811178354Ssam return IEEE80211_FC0_TYPE_DATA; 812178354Ssam 813178354Ssam case IEEE80211_FC0_TYPE_MGT: 814178354Ssam vap->iv_stats.is_rx_mgmt++; 815178354Ssam IEEE80211_NODE_STAT(ni, rx_mgmt); 816178354Ssam if (dir != IEEE80211_FC1_DIR_NODS) { 817178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 818178354Ssam wh, "data", "incorrect dir 0x%x", dir); 819178354Ssam vap->iv_stats.is_rx_wrongdir++; 820178354Ssam goto err; 821178354Ssam } 822178354Ssam if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) { 823178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 824178354Ssam ni->ni_macaddr, "mgt", "too short: len %u", 825178354Ssam m->m_pkthdr.len); 826178354Ssam vap->iv_stats.is_rx_tooshort++; 827178354Ssam goto out; 828178354Ssam } 829178354Ssam#ifdef IEEE80211_DEBUG 830178354Ssam if ((ieee80211_msg_debug(vap) && doprint(vap, subtype)) || 831178354Ssam ieee80211_msg_dumppkts(vap)) { 832178354Ssam if_printf(ifp, "received %s from %s rssi %d\n", 833178354Ssam ieee80211_mgt_subtype_name[subtype >> 834178354Ssam IEEE80211_FC0_SUBTYPE_SHIFT], 835178354Ssam ether_sprintf(wh->i_addr2), rssi); 836178354Ssam } 837178354Ssam#endif 838178354Ssam if (wh->i_fc[1] & IEEE80211_FC1_WEP) { 839178354Ssam if (subtype != IEEE80211_FC0_SUBTYPE_AUTH) { 840178354Ssam /* 841178354Ssam * Only shared key auth frames with a challenge 842178354Ssam * should be encrypted, discard all others. 843178354Ssam */ 844178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 845178354Ssam wh, ieee80211_mgt_subtype_name[subtype >> 846178354Ssam IEEE80211_FC0_SUBTYPE_SHIFT], 847178354Ssam "%s", "WEP set but not permitted"); 848178354Ssam vap->iv_stats.is_rx_mgtdiscard++; /* XXX */ 849178354Ssam goto out; 850178354Ssam } 851178354Ssam if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 852178354Ssam /* 853178354Ssam * Discard encrypted frames when privacy is off. 854178354Ssam */ 855178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 856178354Ssam wh, "mgt", "%s", "WEP set but PRIVACY off"); 857178354Ssam vap->iv_stats.is_rx_noprivacy++; 858178354Ssam goto out; 859178354Ssam } 860178354Ssam hdrspace = ieee80211_hdrspace(ic, wh); 861178354Ssam key = ieee80211_crypto_decap(ni, m, hdrspace); 862178354Ssam if (key == NULL) { 863178354Ssam /* NB: stats+msgs handled in crypto_decap */ 864178354Ssam goto out; 865178354Ssam } 866178354Ssam wh = mtod(m, struct ieee80211_frame *); 867178354Ssam wh->i_fc[1] &= ~IEEE80211_FC1_WEP; 868178354Ssam } 869178354Ssam if (bpf_peers_present(vap->iv_rawbpf)) 870178354Ssam bpf_mtap(vap->iv_rawbpf, m); 871178354Ssam vap->iv_recv_mgmt(ni, m, subtype, rssi, noise, rstamp); 872178354Ssam m_freem(m); 873178354Ssam return IEEE80211_FC0_TYPE_MGT; 874178354Ssam 875178354Ssam case IEEE80211_FC0_TYPE_CTL: 876178354Ssam vap->iv_stats.is_rx_ctl++; 877178354Ssam IEEE80211_NODE_STAT(ni, rx_ctrl); 878178354Ssam goto out; 879178354Ssam default: 880178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 881178354Ssam wh, NULL, "bad frame type 0x%x", type); 882178354Ssam /* should not come here */ 883178354Ssam break; 884178354Ssam } 885178354Ssamerr: 886178354Ssam ifp->if_ierrors++; 887178354Ssamout: 888178354Ssam if (m != NULL) { 889178354Ssam if (bpf_peers_present(vap->iv_rawbpf) && need_tap) 890178354Ssam bpf_mtap(vap->iv_rawbpf, m); 891178354Ssam m_freem(m); 892178354Ssam } 893178354Ssam return type; 894178354Ssam#undef SEQ_LEQ 895178354Ssam} 896178354Ssam 897178354Ssamstatic void 898178354Ssamsta_auth_open(struct ieee80211_node *ni, struct ieee80211_frame *wh, 899178354Ssam int rssi, int noise, uint32_t rstamp, uint16_t seq, uint16_t status) 900178354Ssam{ 901178354Ssam struct ieee80211vap *vap = ni->ni_vap; 902178354Ssam 903178354Ssam if (ni->ni_authmode == IEEE80211_AUTH_SHARED) { 904178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 905178354Ssam ni->ni_macaddr, "open auth", 906178354Ssam "bad sta auth mode %u", ni->ni_authmode); 907178354Ssam vap->iv_stats.is_rx_bad_auth++; /* XXX */ 908178354Ssam return; 909178354Ssam } 910178354Ssam if (vap->iv_state != IEEE80211_S_AUTH || 911178354Ssam seq != IEEE80211_AUTH_OPEN_RESPONSE) { 912178354Ssam vap->iv_stats.is_rx_bad_auth++; 913178354Ssam return; 914178354Ssam } 915178354Ssam if (status != 0) { 916178354Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, 917178354Ssam ni, "open auth failed (reason %d)", status); 918178354Ssam vap->iv_stats.is_rx_auth_fail++; 919178354Ssam vap->iv_stats.is_rx_authfail_code = status; 920178354Ssam ieee80211_new_state(vap, IEEE80211_S_SCAN, 921178354Ssam IEEE80211_SCAN_FAIL_STATUS); 922178354Ssam } else 923178354Ssam ieee80211_new_state(vap, IEEE80211_S_ASSOC, 0); 924178354Ssam} 925178354Ssam 926178354Ssamstatic void 927178354Ssamsta_auth_shared(struct ieee80211_node *ni, struct ieee80211_frame *wh, 928178354Ssam uint8_t *frm, uint8_t *efrm, int rssi, int noise, uint32_t rstamp, 929178354Ssam uint16_t seq, uint16_t status) 930178354Ssam{ 931178354Ssam struct ieee80211vap *vap = ni->ni_vap; 932178354Ssam uint8_t *challenge; 933178354Ssam int estatus; 934178354Ssam 935178354Ssam /* 936178354Ssam * NB: this can happen as we allow pre-shared key 937178354Ssam * authentication to be enabled w/o wep being turned 938178354Ssam * on so that configuration of these can be done 939178354Ssam * in any order. It may be better to enforce the 940178354Ssam * ordering in which case this check would just be 941178354Ssam * for sanity/consistency. 942178354Ssam */ 943178354Ssam if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 944178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 945178354Ssam ni->ni_macaddr, "shared key auth", 946178354Ssam "%s", " PRIVACY is disabled"); 947178354Ssam estatus = IEEE80211_STATUS_ALG; 948178354Ssam goto bad; 949178354Ssam } 950178354Ssam /* 951178354Ssam * Pre-shared key authentication is evil; accept 952178354Ssam * it only if explicitly configured (it is supported 953178354Ssam * mainly for compatibility with clients like OS X). 954178354Ssam */ 955178354Ssam if (ni->ni_authmode != IEEE80211_AUTH_AUTO && 956178354Ssam ni->ni_authmode != IEEE80211_AUTH_SHARED) { 957178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 958178354Ssam ni->ni_macaddr, "shared key auth", 959178354Ssam "bad sta auth mode %u", ni->ni_authmode); 960178354Ssam vap->iv_stats.is_rx_bad_auth++; /* XXX maybe a unique error? */ 961178354Ssam estatus = IEEE80211_STATUS_ALG; 962178354Ssam goto bad; 963178354Ssam } 964178354Ssam 965178354Ssam challenge = NULL; 966178354Ssam if (frm + 1 < efrm) { 967178354Ssam if ((frm[1] + 2) > (efrm - frm)) { 968178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 969178354Ssam ni->ni_macaddr, "shared key auth", 970178354Ssam "ie %d/%d too long", 971178354Ssam frm[0], (frm[1] + 2) - (efrm - frm)); 972178354Ssam vap->iv_stats.is_rx_bad_auth++; 973178354Ssam estatus = IEEE80211_STATUS_CHALLENGE; 974178354Ssam goto bad; 975178354Ssam } 976178354Ssam if (*frm == IEEE80211_ELEMID_CHALLENGE) 977178354Ssam challenge = frm; 978178354Ssam frm += frm[1] + 2; 979178354Ssam } 980178354Ssam switch (seq) { 981178354Ssam case IEEE80211_AUTH_SHARED_CHALLENGE: 982178354Ssam case IEEE80211_AUTH_SHARED_RESPONSE: 983178354Ssam if (challenge == NULL) { 984178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 985178354Ssam ni->ni_macaddr, "shared key auth", 986178354Ssam "%s", "no challenge"); 987178354Ssam vap->iv_stats.is_rx_bad_auth++; 988178354Ssam estatus = IEEE80211_STATUS_CHALLENGE; 989178354Ssam goto bad; 990178354Ssam } 991178354Ssam if (challenge[1] != IEEE80211_CHALLENGE_LEN) { 992178354Ssam IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 993178354Ssam ni->ni_macaddr, "shared key auth", 994178354Ssam "bad challenge len %d", challenge[1]); 995178354Ssam vap->iv_stats.is_rx_bad_auth++; 996178354Ssam estatus = IEEE80211_STATUS_CHALLENGE; 997178354Ssam goto bad; 998178354Ssam } 999178354Ssam default: 1000178354Ssam break; 1001178354Ssam } 1002178354Ssam if (vap->iv_state != IEEE80211_S_AUTH) 1003178354Ssam return; 1004178354Ssam switch (seq) { 1005178354Ssam case IEEE80211_AUTH_SHARED_PASS: 1006178354Ssam if (ni->ni_challenge != NULL) { 1007186302Ssam free(ni->ni_challenge, M_80211_NODE); 1008178354Ssam ni->ni_challenge = NULL; 1009178354Ssam } 1010178354Ssam if (status != 0) { 1011178354Ssam IEEE80211_NOTE_FRAME(vap, 1012178354Ssam IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, wh, 1013178354Ssam "shared key auth failed (reason %d)", status); 1014178354Ssam vap->iv_stats.is_rx_auth_fail++; 1015178354Ssam vap->iv_stats.is_rx_authfail_code = status; 1016178354Ssam return; 1017178354Ssam } 1018178354Ssam ieee80211_new_state(vap, IEEE80211_S_ASSOC, 0); 1019178354Ssam break; 1020178354Ssam case IEEE80211_AUTH_SHARED_CHALLENGE: 1021178354Ssam if (!ieee80211_alloc_challenge(ni)) 1022178354Ssam return; 1023178354Ssam /* XXX could optimize by passing recvd challenge */ 1024178354Ssam memcpy(ni->ni_challenge, &challenge[2], challenge[1]); 1025178354Ssam IEEE80211_SEND_MGMT(ni, 1026178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 1027178354Ssam break; 1028178354Ssam default: 1029178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_AUTH, 1030178354Ssam wh, "shared key auth", "bad seq %d", seq); 1031178354Ssam vap->iv_stats.is_rx_bad_auth++; 1032178354Ssam return; 1033178354Ssam } 1034178354Ssam return; 1035178354Ssambad: 1036178354Ssam /* 1037178354Ssam * Kick the state machine. This short-circuits 1038178354Ssam * using the mgt frame timeout to trigger the 1039178354Ssam * state transition. 1040178354Ssam */ 1041178354Ssam if (vap->iv_state == IEEE80211_S_AUTH) 1042178354Ssam ieee80211_new_state(vap, IEEE80211_S_SCAN, 1043178354Ssam IEEE80211_SCAN_FAIL_STATUS); 1044178354Ssam} 1045178354Ssam 1046178354Ssamstatic int 1047178354Ssamieee80211_parse_wmeparams(struct ieee80211vap *vap, uint8_t *frm, 1048178354Ssam const struct ieee80211_frame *wh) 1049178354Ssam{ 1050178354Ssam#define MS(_v, _f) (((_v) & _f) >> _f##_S) 1051178354Ssam struct ieee80211_wme_state *wme = &vap->iv_ic->ic_wme; 1052178354Ssam u_int len = frm[1], qosinfo; 1053178354Ssam int i; 1054178354Ssam 1055178354Ssam if (len < sizeof(struct ieee80211_wme_param)-2) { 1056178354Ssam IEEE80211_DISCARD_IE(vap, 1057178354Ssam IEEE80211_MSG_ELEMID | IEEE80211_MSG_WME, 1058178354Ssam wh, "WME", "too short, len %u", len); 1059178354Ssam return -1; 1060178354Ssam } 1061178354Ssam qosinfo = frm[__offsetof(struct ieee80211_wme_param, param_qosInfo)]; 1062178354Ssam qosinfo &= WME_QOSINFO_COUNT; 1063178354Ssam /* XXX do proper check for wraparound */ 1064178354Ssam if (qosinfo == wme->wme_wmeChanParams.cap_info) 1065178354Ssam return 0; 1066178354Ssam frm += __offsetof(struct ieee80211_wme_param, params_acParams); 1067178354Ssam for (i = 0; i < WME_NUM_AC; i++) { 1068178354Ssam struct wmeParams *wmep = 1069178354Ssam &wme->wme_wmeChanParams.cap_wmeParams[i]; 1070178354Ssam /* NB: ACI not used */ 1071178354Ssam wmep->wmep_acm = MS(frm[0], WME_PARAM_ACM); 1072178354Ssam wmep->wmep_aifsn = MS(frm[0], WME_PARAM_AIFSN); 1073178354Ssam wmep->wmep_logcwmin = MS(frm[1], WME_PARAM_LOGCWMIN); 1074178354Ssam wmep->wmep_logcwmax = MS(frm[1], WME_PARAM_LOGCWMAX); 1075178354Ssam wmep->wmep_txopLimit = LE_READ_2(frm+2); 1076178354Ssam frm += 4; 1077178354Ssam } 1078178354Ssam wme->wme_wmeChanParams.cap_info = qosinfo; 1079178354Ssam return 1; 1080178354Ssam#undef MS 1081178354Ssam} 1082178354Ssam 1083178354Ssam/* 1084178354Ssam * Return non-zero if a background scan may be continued: 1085178354Ssam * o bg scan is active 1086178354Ssam * o no channel switch is pending 1087178354Ssam * o there has not been any traffic recently 1088178354Ssam * 1089178354Ssam * Note we do not check if there is an administrative enable; 1090178354Ssam * this is only done to start the scan. We assume that any 1091178354Ssam * change in state will be accompanied by a request to cancel 1092178354Ssam * active scans which will otherwise cause this test to fail. 1093178354Ssam */ 1094178354Ssamstatic __inline int 1095178354Ssamcontbgscan(struct ieee80211vap *vap) 1096178354Ssam{ 1097178354Ssam struct ieee80211com *ic = vap->iv_ic; 1098178354Ssam 1099178354Ssam return ((ic->ic_flags_ext & IEEE80211_FEXT_BGSCAN) && 1100178354Ssam (ic->ic_flags & IEEE80211_F_CSAPENDING) == 0 && 1101178354Ssam vap->iv_state == IEEE80211_S_RUN && /* XXX? */ 1102178354Ssam time_after(ticks, ic->ic_lastdata + vap->iv_bgscanidle)); 1103178354Ssam} 1104178354Ssam 1105178354Ssam/* 1106178354Ssam * Return non-zero if a backgrond scan may be started: 1107178354Ssam * o bg scanning is administratively enabled 1108178354Ssam * o no channel switch is pending 1109178354Ssam * o we are not boosted on a dynamic turbo channel 1110178354Ssam * o there has not been a scan recently 1111178354Ssam * o there has not been any traffic recently 1112178354Ssam */ 1113178354Ssamstatic __inline int 1114178354Ssamstartbgscan(struct ieee80211vap *vap) 1115178354Ssam{ 1116178354Ssam struct ieee80211com *ic = vap->iv_ic; 1117178354Ssam 1118178354Ssam return ((vap->iv_flags & IEEE80211_F_BGSCAN) && 1119178354Ssam (ic->ic_flags & IEEE80211_F_CSAPENDING) == 0 && 1120190391Ssam#ifdef IEEE80211_SUPPORT_SUPERG 1121178354Ssam !IEEE80211_IS_CHAN_DTURBO(ic->ic_curchan) && 1122190391Ssam#endif 1123178354Ssam time_after(ticks, ic->ic_lastscan + vap->iv_bgscanintvl) && 1124178354Ssam time_after(ticks, ic->ic_lastdata + vap->iv_bgscanidle)); 1125178354Ssam} 1126178354Ssam 1127178354Ssamstatic void 1128178354Ssamsta_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m0, 1129178354Ssam int subtype, int rssi, int noise, uint32_t rstamp) 1130178354Ssam{ 1131178354Ssam#define ISPROBE(_st) ((_st) == IEEE80211_FC0_SUBTYPE_PROBE_RESP) 1132178354Ssam#define ISREASSOC(_st) ((_st) == IEEE80211_FC0_SUBTYPE_REASSOC_RESP) 1133178354Ssam struct ieee80211vap *vap = ni->ni_vap; 1134178354Ssam struct ieee80211com *ic = ni->ni_ic; 1135178354Ssam struct ieee80211_frame *wh; 1136178354Ssam uint8_t *frm, *efrm; 1137178354Ssam uint8_t *rates, *xrates, *wme, *htcap, *htinfo; 1138178354Ssam uint8_t rate; 1139178354Ssam 1140178354Ssam wh = mtod(m0, struct ieee80211_frame *); 1141178354Ssam frm = (uint8_t *)&wh[1]; 1142178354Ssam efrm = mtod(m0, uint8_t *) + m0->m_len; 1143178354Ssam switch (subtype) { 1144178354Ssam case IEEE80211_FC0_SUBTYPE_PROBE_RESP: 1145178354Ssam case IEEE80211_FC0_SUBTYPE_BEACON: { 1146178354Ssam struct ieee80211_scanparams scan; 1147178354Ssam /* 1148178354Ssam * We process beacon/probe response frames: 1149178354Ssam * o when scanning, or 1150178354Ssam * o station mode when associated (to collect state 1151191444Srpaulo * updates such as 802.11g slot time) 1152178354Ssam * Frames otherwise received are discarded. 1153178354Ssam */ 1154178354Ssam if (!((ic->ic_flags & IEEE80211_F_SCAN) || ni->ni_associd)) { 1155178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1156178354Ssam return; 1157178354Ssam } 1158178354Ssam /* XXX probe response in sta mode when !scanning? */ 1159178354Ssam if (ieee80211_parse_beacon(ni, m0, &scan) != 0) 1160178354Ssam return; 1161178354Ssam /* 1162178354Ssam * Count frame now that we know it's to be processed. 1163178354Ssam */ 1164178354Ssam if (subtype == IEEE80211_FC0_SUBTYPE_BEACON) { 1165178354Ssam vap->iv_stats.is_rx_beacon++; /* XXX remove */ 1166178354Ssam IEEE80211_NODE_STAT(ni, rx_beacons); 1167178354Ssam } else 1168178354Ssam IEEE80211_NODE_STAT(ni, rx_proberesp); 1169178354Ssam /* 1170178354Ssam * When operating in station mode, check for state updates. 1171178354Ssam * Be careful to ignore beacons received while doing a 1172178354Ssam * background scan. We consider only 11g/WMM stuff right now. 1173178354Ssam */ 1174178354Ssam if (ni->ni_associd != 0 && 1175178354Ssam ((ic->ic_flags & IEEE80211_F_SCAN) == 0 || 1176178354Ssam IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid))) { 1177178354Ssam /* record tsf of last beacon */ 1178178354Ssam memcpy(ni->ni_tstamp.data, scan.tstamp, 1179178354Ssam sizeof(ni->ni_tstamp)); 1180178354Ssam /* count beacon frame for s/w bmiss handling */ 1181178354Ssam vap->iv_swbmiss_count++; 1182178354Ssam vap->iv_bmiss_count = 0; 1183178354Ssam if (ni->ni_erp != scan.erp) { 1184178354Ssam IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ASSOC, 1185178354Ssam wh->i_addr2, 1186178354Ssam "erp change: was 0x%x, now 0x%x", 1187178354Ssam ni->ni_erp, scan.erp); 1188178354Ssam if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan) && 1189178354Ssam (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION)) 1190178354Ssam ic->ic_flags |= IEEE80211_F_USEPROT; 1191178354Ssam else 1192178354Ssam ic->ic_flags &= ~IEEE80211_F_USEPROT; 1193178354Ssam ni->ni_erp = scan.erp; 1194178354Ssam /* XXX statistic */ 1195178354Ssam /* XXX driver notification */ 1196178354Ssam } 1197178354Ssam if ((ni->ni_capinfo ^ scan.capinfo) & IEEE80211_CAPINFO_SHORT_SLOTTIME) { 1198178354Ssam IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ASSOC, 1199178354Ssam wh->i_addr2, 1200178354Ssam "capabilities change: was 0x%x, now 0x%x", 1201178354Ssam ni->ni_capinfo, scan.capinfo); 1202178354Ssam /* 1203178354Ssam * NB: we assume short preamble doesn't 1204178354Ssam * change dynamically 1205178354Ssam */ 1206178354Ssam ieee80211_set_shortslottime(ic, 1207178354Ssam IEEE80211_IS_CHAN_A(ic->ic_bsschan) || 1208178354Ssam (scan.capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME)); 1209178354Ssam ni->ni_capinfo = (ni->ni_capinfo &~ IEEE80211_CAPINFO_SHORT_SLOTTIME) 1210178354Ssam | (scan.capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME); 1211178354Ssam /* XXX statistic */ 1212178354Ssam } 1213178354Ssam if (scan.wme != NULL && 1214178354Ssam (ni->ni_flags & IEEE80211_NODE_QOS) && 1215178354Ssam ieee80211_parse_wmeparams(vap, scan.wme, wh) > 0) 1216178354Ssam ieee80211_wme_updateparams(vap); 1217190391Ssam#ifdef IEEE80211_SUPPORT_SUPERG 1218178354Ssam if (scan.ath != NULL) 1219178354Ssam ieee80211_parse_athparams(ni, scan.ath, wh); 1220190391Ssam#endif 1221183254Ssam if (scan.htcap != NULL && scan.htinfo != NULL && 1222183254Ssam (vap->iv_flags_ext & IEEE80211_FEXT_HT)) { 1223183254Ssam ieee80211_ht_updateparams(ni, 1224183254Ssam scan.htcap, scan.htinfo); 1225178354Ssam /* XXX state changes? */ 1226178354Ssam } 1227178354Ssam if (scan.tim != NULL) { 1228178354Ssam struct ieee80211_tim_ie *tim = 1229178354Ssam (struct ieee80211_tim_ie *) scan.tim; 1230178354Ssam#if 0 1231178354Ssam int aid = IEEE80211_AID(ni->ni_associd); 1232178354Ssam int ix = aid / NBBY; 1233178354Ssam int min = tim->tim_bitctl &~ 1; 1234178354Ssam int max = tim->tim_len + min - 4; 1235178354Ssam if ((tim->tim_bitctl&1) || 1236178354Ssam (min <= ix && ix <= max && 1237178354Ssam isset(tim->tim_bitmap - min, aid))) { 1238178354Ssam /* 1239178354Ssam * XXX Do not let bg scan kick off 1240178354Ssam * we are expecting data. 1241178354Ssam */ 1242178354Ssam ic->ic_lastdata = ticks; 1243178354Ssam ieee80211_sta_pwrsave(vap, 0); 1244178354Ssam } 1245178354Ssam#endif 1246178354Ssam ni->ni_dtim_count = tim->tim_count; 1247178354Ssam ni->ni_dtim_period = tim->tim_period; 1248178354Ssam } 1249178354Ssam /* 1250178354Ssam * If scanning, pass the info to the scan module. 1251178354Ssam * Otherwise, check if it's the right time to do 1252178354Ssam * a background scan. Background scanning must 1253178354Ssam * be enabled and we must not be operating in the 1254178354Ssam * turbo phase of dynamic turbo mode. Then, 1255178354Ssam * it's been a while since the last background 1256178354Ssam * scan and if no data frames have come through 1257178354Ssam * recently, kick off a scan. Note that this 1258178354Ssam * is the mechanism by which a background scan 1259178354Ssam * is started _and_ continued each time we 1260178354Ssam * return on-channel to receive a beacon from 1261178354Ssam * our ap. 1262178354Ssam */ 1263178354Ssam if (ic->ic_flags & IEEE80211_F_SCAN) { 1264178354Ssam ieee80211_add_scan(vap, &scan, wh, 1265178354Ssam subtype, rssi, noise, rstamp); 1266178354Ssam } else if (contbgscan(vap)) { 1267178354Ssam ieee80211_bg_scan(vap, 0); 1268178354Ssam } else if (startbgscan(vap)) { 1269178354Ssam vap->iv_stats.is_scan_bg++; 1270178354Ssam#if 0 1271178354Ssam /* wakeup if we are sleeing */ 1272178354Ssam ieee80211_set_pwrsave(vap, 0); 1273178354Ssam#endif 1274178354Ssam ieee80211_bg_scan(vap, 0); 1275178354Ssam } 1276178354Ssam return; 1277178354Ssam } 1278178354Ssam /* 1279178354Ssam * If scanning, just pass information to the scan module. 1280178354Ssam */ 1281178354Ssam if (ic->ic_flags & IEEE80211_F_SCAN) { 1282178354Ssam if (ic->ic_flags_ext & IEEE80211_FEXT_PROBECHAN) { 1283178354Ssam /* 1284178354Ssam * Actively scanning a channel marked passive; 1285178354Ssam * send a probe request now that we know there 1286178354Ssam * is 802.11 traffic present. 1287178354Ssam * 1288178354Ssam * XXX check if the beacon we recv'd gives 1289178354Ssam * us what we need and suppress the probe req 1290178354Ssam */ 1291178354Ssam ieee80211_probe_curchan(vap, 1); 1292178354Ssam ic->ic_flags_ext &= ~IEEE80211_FEXT_PROBECHAN; 1293178354Ssam } 1294178354Ssam ieee80211_add_scan(vap, &scan, wh, 1295178354Ssam subtype, rssi, noise, rstamp); 1296178354Ssam return; 1297178354Ssam } 1298178354Ssam break; 1299178354Ssam } 1300178354Ssam 1301178354Ssam case IEEE80211_FC0_SUBTYPE_AUTH: { 1302178354Ssam uint16_t algo, seq, status; 1303178354Ssam /* 1304178354Ssam * auth frame format 1305178354Ssam * [2] algorithm 1306178354Ssam * [2] sequence 1307178354Ssam * [2] status 1308178354Ssam * [tlv*] challenge 1309178354Ssam */ 1310178354Ssam IEEE80211_VERIFY_LENGTH(efrm - frm, 6, return); 1311178354Ssam algo = le16toh(*(uint16_t *)frm); 1312178354Ssam seq = le16toh(*(uint16_t *)(frm + 2)); 1313178354Ssam status = le16toh(*(uint16_t *)(frm + 4)); 1314178354Ssam IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_AUTH, wh->i_addr2, 1315178354Ssam "recv auth frame with algorithm %d seq %d", algo, seq); 1316178354Ssam 1317178354Ssam if (vap->iv_flags & IEEE80211_F_COUNTERM) { 1318178354Ssam IEEE80211_DISCARD(vap, 1319178354Ssam IEEE80211_MSG_AUTH | IEEE80211_MSG_CRYPTO, 1320178354Ssam wh, "auth", "%s", "TKIP countermeasures enabled"); 1321178354Ssam vap->iv_stats.is_rx_auth_countermeasures++; 1322178354Ssam if (vap->iv_opmode == IEEE80211_M_HOSTAP) { 1323178354Ssam ieee80211_send_error(ni, wh->i_addr2, 1324178354Ssam IEEE80211_FC0_SUBTYPE_AUTH, 1325178354Ssam IEEE80211_REASON_MIC_FAILURE); 1326178354Ssam } 1327178354Ssam return; 1328178354Ssam } 1329178354Ssam if (algo == IEEE80211_AUTH_ALG_SHARED) 1330178354Ssam sta_auth_shared(ni, wh, frm + 6, efrm, rssi, 1331178354Ssam noise, rstamp, seq, status); 1332178354Ssam else if (algo == IEEE80211_AUTH_ALG_OPEN) 1333178354Ssam sta_auth_open(ni, wh, rssi, noise, rstamp, 1334178354Ssam seq, status); 1335178354Ssam else { 1336178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1337178354Ssam wh, "auth", "unsupported alg %d", algo); 1338178354Ssam vap->iv_stats.is_rx_auth_unsupported++; 1339178354Ssam return; 1340178354Ssam } 1341178354Ssam break; 1342178354Ssam } 1343178354Ssam 1344178354Ssam case IEEE80211_FC0_SUBTYPE_ASSOC_RESP: 1345178354Ssam case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: { 1346178354Ssam uint16_t capinfo, associd; 1347178354Ssam uint16_t status; 1348178354Ssam 1349178354Ssam if (vap->iv_state != IEEE80211_S_ASSOC) { 1350178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1351178354Ssam return; 1352178354Ssam } 1353178354Ssam 1354178354Ssam /* 1355178354Ssam * asresp frame format 1356178354Ssam * [2] capability information 1357178354Ssam * [2] status 1358178354Ssam * [2] association ID 1359178354Ssam * [tlv] supported rates 1360178354Ssam * [tlv] extended supported rates 1361178354Ssam * [tlv] WME 1362178354Ssam * [tlv] HT capabilities 1363178354Ssam * [tlv] HT info 1364178354Ssam */ 1365178354Ssam IEEE80211_VERIFY_LENGTH(efrm - frm, 6, return); 1366178354Ssam ni = vap->iv_bss; 1367178354Ssam capinfo = le16toh(*(uint16_t *)frm); 1368178354Ssam frm += 2; 1369178354Ssam status = le16toh(*(uint16_t *)frm); 1370178354Ssam frm += 2; 1371178354Ssam if (status != 0) { 1372178354Ssam IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ASSOC, 1373178354Ssam wh->i_addr2, "%sassoc failed (reason %d)", 1374178354Ssam ISREASSOC(subtype) ? "re" : "", status); 1375178354Ssam vap->iv_stats.is_rx_auth_fail++; /* XXX */ 1376178354Ssam return; 1377178354Ssam } 1378178354Ssam associd = le16toh(*(uint16_t *)frm); 1379178354Ssam frm += 2; 1380178354Ssam 1381178354Ssam rates = xrates = wme = htcap = htinfo = NULL; 1382178354Ssam while (efrm - frm > 1) { 1383178354Ssam IEEE80211_VERIFY_LENGTH(efrm - frm, frm[1] + 2, return); 1384178354Ssam switch (*frm) { 1385178354Ssam case IEEE80211_ELEMID_RATES: 1386178354Ssam rates = frm; 1387178354Ssam break; 1388178354Ssam case IEEE80211_ELEMID_XRATES: 1389178354Ssam xrates = frm; 1390178354Ssam break; 1391178354Ssam case IEEE80211_ELEMID_HTCAP: 1392178354Ssam htcap = frm; 1393178354Ssam break; 1394178354Ssam case IEEE80211_ELEMID_HTINFO: 1395178354Ssam htinfo = frm; 1396178354Ssam break; 1397178354Ssam case IEEE80211_ELEMID_VENDOR: 1398178354Ssam if (iswmeoui(frm)) 1399178354Ssam wme = frm; 1400178354Ssam else if (vap->iv_flags_ext & IEEE80211_FEXT_HTCOMPAT) { 1401178354Ssam /* 1402178354Ssam * Accept pre-draft HT ie's if the 1403178354Ssam * standard ones have not been seen. 1404178354Ssam */ 1405178354Ssam if (ishtcapoui(frm)) { 1406178354Ssam if (htcap == NULL) 1407178354Ssam htcap = frm; 1408178354Ssam } else if (ishtinfooui(frm)) { 1409178354Ssam if (htinfo == NULL) 1410178354Ssam htcap = frm; 1411178354Ssam } 1412178354Ssam } 1413178354Ssam /* XXX Atheros OUI support */ 1414178354Ssam break; 1415178354Ssam } 1416178354Ssam frm += frm[1] + 2; 1417178354Ssam } 1418178354Ssam 1419178354Ssam IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE, return); 1420178354Ssam if (xrates != NULL) 1421178354Ssam IEEE80211_VERIFY_ELEMENT(xrates, 1422178354Ssam IEEE80211_RATE_MAXSIZE - rates[1], return); 1423178354Ssam rate = ieee80211_setup_rates(ni, rates, xrates, 1424178354Ssam IEEE80211_F_JOIN | 1425178354Ssam IEEE80211_F_DOSORT | IEEE80211_F_DOFRATE | 1426178354Ssam IEEE80211_F_DONEGO | IEEE80211_F_DODEL); 1427178354Ssam if (rate & IEEE80211_RATE_BASIC) { 1428178354Ssam IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ASSOC, 1429178354Ssam wh->i_addr2, 1430178354Ssam "%sassoc failed (rate set mismatch)", 1431178354Ssam ISREASSOC(subtype) ? "re" : ""); 1432178354Ssam vap->iv_stats.is_rx_assoc_norate++; 1433178354Ssam ieee80211_new_state(vap, IEEE80211_S_SCAN, 1434178354Ssam IEEE80211_SCAN_FAIL_STATUS); 1435178354Ssam return; 1436178354Ssam } 1437178354Ssam 1438178354Ssam ni->ni_capinfo = capinfo; 1439178354Ssam ni->ni_associd = associd; 1440178354Ssam if (ni->ni_jointime == 0) 1441178354Ssam ni->ni_jointime = time_uptime; 1442178354Ssam if (wme != NULL && 1443178354Ssam ieee80211_parse_wmeparams(vap, wme, wh) >= 0) { 1444178354Ssam ni->ni_flags |= IEEE80211_NODE_QOS; 1445178354Ssam ieee80211_wme_updateparams(vap); 1446178354Ssam } else 1447178354Ssam ni->ni_flags &= ~IEEE80211_NODE_QOS; 1448178354Ssam /* 1449178354Ssam * Setup HT state according to the negotiation. 1450178354Ssam * 1451178354Ssam * NB: shouldn't need to check if HT use is enabled but some 1452178354Ssam * ap's send back HT ie's even when we don't indicate we 1453178354Ssam * are HT capable in our AssocReq. 1454178354Ssam */ 1455178354Ssam if (htcap != NULL && htinfo != NULL && 1456178354Ssam (vap->iv_flags_ext & IEEE80211_FEXT_HT)) { 1457183254Ssam ieee80211_ht_node_init(ni); 1458183254Ssam ieee80211_ht_updateparams(ni, htcap, htinfo); 1459178354Ssam ieee80211_setup_htrates(ni, htcap, 1460178354Ssam IEEE80211_F_JOIN | IEEE80211_F_DOBRS); 1461178354Ssam ieee80211_setup_basic_htrates(ni, htinfo); 1462190579Ssam } else { 1463190579Ssam#ifdef IEEE80211_SUPPORT_SUPERG 1464190579Ssam if (IEEE80211_ATH_CAP(vap, ni, IEEE80211_NODE_ATH)) 1465190579Ssam ieee80211_ff_node_init(ni); 1466190579Ssam#endif 1467178354Ssam } 1468178354Ssam /* 1469178354Ssam * Configure state now that we are associated. 1470178354Ssam * 1471178354Ssam * XXX may need different/additional driver callbacks? 1472178354Ssam */ 1473178354Ssam if (IEEE80211_IS_CHAN_A(ic->ic_curchan) || 1474178354Ssam (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)) { 1475178354Ssam ic->ic_flags |= IEEE80211_F_SHPREAMBLE; 1476178354Ssam ic->ic_flags &= ~IEEE80211_F_USEBARKER; 1477178354Ssam } else { 1478178354Ssam ic->ic_flags &= ~IEEE80211_F_SHPREAMBLE; 1479178354Ssam ic->ic_flags |= IEEE80211_F_USEBARKER; 1480178354Ssam } 1481178354Ssam ieee80211_set_shortslottime(ic, 1482178354Ssam IEEE80211_IS_CHAN_A(ic->ic_curchan) || 1483178354Ssam (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME)); 1484178354Ssam /* 1485178354Ssam * Honor ERP protection. 1486178354Ssam * 1487178354Ssam * NB: ni_erp should zero for non-11g operation. 1488178354Ssam */ 1489178354Ssam if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan) && 1490178354Ssam (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION)) 1491178354Ssam ic->ic_flags |= IEEE80211_F_USEPROT; 1492178354Ssam else 1493178354Ssam ic->ic_flags &= ~IEEE80211_F_USEPROT; 1494178354Ssam IEEE80211_NOTE_MAC(vap, 1495178354Ssam IEEE80211_MSG_ASSOC | IEEE80211_MSG_DEBUG, wh->i_addr2, 1496183256Ssam "%sassoc success at aid %d: %s preamble, %s slot time%s%s%s%s%s%s%s%s", 1497178354Ssam ISREASSOC(subtype) ? "re" : "", 1498178354Ssam IEEE80211_NODE_AID(ni), 1499178354Ssam ic->ic_flags&IEEE80211_F_SHPREAMBLE ? "short" : "long", 1500178354Ssam ic->ic_flags&IEEE80211_F_SHSLOT ? "short" : "long", 1501178354Ssam ic->ic_flags&IEEE80211_F_USEPROT ? ", protection" : "", 1502178354Ssam ni->ni_flags & IEEE80211_NODE_QOS ? ", QoS" : "", 1503178354Ssam ni->ni_flags & IEEE80211_NODE_HT ? 1504182834Ssam (ni->ni_chw == 40 ? ", HT40" : ", HT20") : "", 1505178354Ssam ni->ni_flags & IEEE80211_NODE_AMPDU ? " (+AMPDU)" : "", 1506183255Ssam ni->ni_flags & IEEE80211_NODE_MIMO_RTS ? " (+SMPS-DYN)" : 1507183255Ssam ni->ni_flags & IEEE80211_NODE_MIMO_PS ? " (+SMPS)" : "", 1508183256Ssam ni->ni_flags & IEEE80211_NODE_RIFS ? " (+RIFS)" : "", 1509178354Ssam IEEE80211_ATH_CAP(vap, ni, IEEE80211_NODE_FF) ? 1510178354Ssam ", fast-frames" : "", 1511178354Ssam IEEE80211_ATH_CAP(vap, ni, IEEE80211_NODE_TURBOP) ? 1512178354Ssam ", turbo" : "" 1513178354Ssam ); 1514178354Ssam ieee80211_new_state(vap, IEEE80211_S_RUN, subtype); 1515178354Ssam break; 1516178354Ssam } 1517178354Ssam 1518178354Ssam case IEEE80211_FC0_SUBTYPE_DEAUTH: { 1519178354Ssam uint16_t reason; 1520178354Ssam 1521178354Ssam if (vap->iv_state == IEEE80211_S_SCAN) { 1522178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1523178354Ssam return; 1524178354Ssam } 1525178354Ssam if (!IEEE80211_ADDR_EQ(wh->i_addr1, vap->iv_myaddr)) { 1526178354Ssam /* NB: can happen when in promiscuous mode */ 1527178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1528178354Ssam break; 1529178354Ssam } 1530178354Ssam 1531178354Ssam /* 1532178354Ssam * deauth frame format 1533178354Ssam * [2] reason 1534178354Ssam */ 1535178354Ssam IEEE80211_VERIFY_LENGTH(efrm - frm, 2, return); 1536178354Ssam reason = le16toh(*(uint16_t *)frm); 1537178354Ssam 1538178354Ssam vap->iv_stats.is_rx_deauth++; 1539178354Ssam vap->iv_stats.is_rx_deauth_code = reason; 1540178354Ssam IEEE80211_NODE_STAT(ni, rx_deauth); 1541178354Ssam 1542178354Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_AUTH, ni, 1543178354Ssam "recv deauthenticate (reason %d)", reason); 1544178354Ssam ieee80211_new_state(vap, IEEE80211_S_AUTH, 1545178354Ssam (reason << 8) | IEEE80211_FC0_SUBTYPE_DEAUTH); 1546178354Ssam break; 1547178354Ssam } 1548178354Ssam 1549178354Ssam case IEEE80211_FC0_SUBTYPE_DISASSOC: { 1550178354Ssam uint16_t reason; 1551178354Ssam 1552178354Ssam if (vap->iv_state != IEEE80211_S_RUN && 1553178354Ssam vap->iv_state != IEEE80211_S_ASSOC && 1554178354Ssam vap->iv_state != IEEE80211_S_AUTH) { 1555178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1556178354Ssam return; 1557178354Ssam } 1558178354Ssam if (!IEEE80211_ADDR_EQ(wh->i_addr1, vap->iv_myaddr)) { 1559178354Ssam /* NB: can happen when in promiscuous mode */ 1560178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1561178354Ssam break; 1562178354Ssam } 1563178354Ssam 1564178354Ssam /* 1565178354Ssam * disassoc frame format 1566178354Ssam * [2] reason 1567178354Ssam */ 1568178354Ssam IEEE80211_VERIFY_LENGTH(efrm - frm, 2, return); 1569178354Ssam reason = le16toh(*(uint16_t *)frm); 1570178354Ssam 1571178354Ssam vap->iv_stats.is_rx_disassoc++; 1572178354Ssam vap->iv_stats.is_rx_disassoc_code = reason; 1573178354Ssam IEEE80211_NODE_STAT(ni, rx_disassoc); 1574178354Ssam 1575178354Ssam IEEE80211_NOTE(vap, IEEE80211_MSG_ASSOC, ni, 1576178354Ssam "recv disassociate (reason %d)", reason); 1577178354Ssam ieee80211_new_state(vap, IEEE80211_S_ASSOC, 0); 1578178354Ssam break; 1579178354Ssam } 1580178354Ssam 1581178354Ssam case IEEE80211_FC0_SUBTYPE_ACTION: 1582178354Ssam if (vap->iv_state == IEEE80211_S_RUN) { 1583178354Ssam if (ieee80211_parse_action(ni, m0) == 0) 1584178354Ssam ic->ic_recv_action(ni, frm, efrm); 1585178354Ssam } else 1586178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1587178354Ssam break; 1588178354Ssam 1589178354Ssam case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 1590178354Ssam case IEEE80211_FC0_SUBTYPE_ASSOC_REQ: 1591178354Ssam case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: 1592178354Ssam vap->iv_stats.is_rx_mgtdiscard++; 1593178354Ssam return; 1594178354Ssam default: 1595178354Ssam IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1596178354Ssam wh, "mgt", "subtype 0x%x not handled", subtype); 1597178354Ssam vap->iv_stats.is_rx_badsubtype++; 1598178354Ssam break; 1599178354Ssam } 1600178354Ssam#undef ISREASSOC 1601178354Ssam#undef ISPROBE 1602178354Ssam} 1603