1b032f27cSSam Leffler /*- 2fe267a55SPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3fe267a55SPedro F. Giffuni * 4b032f27cSSam Leffler * Copyright (c) 2007-2008 Sam Leffler, Errno Consulting 5b032f27cSSam Leffler * All rights reserved. 6b032f27cSSam Leffler * 7b032f27cSSam Leffler * Redistribution and use in source and binary forms, with or without 8b032f27cSSam Leffler * modification, are permitted provided that the following conditions 9b032f27cSSam Leffler * are met: 10b032f27cSSam Leffler * 1. Redistributions of source code must retain the above copyright 11b032f27cSSam Leffler * notice, this list of conditions and the following disclaimer. 12b032f27cSSam Leffler * 2. Redistributions in binary form must reproduce the above copyright 13b032f27cSSam Leffler * notice, this list of conditions and the following disclaimer in the 14b032f27cSSam Leffler * documentation and/or other materials provided with the distribution. 15b032f27cSSam Leffler * 16b032f27cSSam Leffler * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17b032f27cSSam Leffler * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18b032f27cSSam Leffler * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19b032f27cSSam Leffler * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20b032f27cSSam Leffler * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21b032f27cSSam Leffler * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22b032f27cSSam Leffler * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23b032f27cSSam Leffler * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24b032f27cSSam Leffler * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25b032f27cSSam Leffler * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26b032f27cSSam Leffler */ 27b032f27cSSam Leffler 28b032f27cSSam Leffler #include <sys/cdefs.h> 29b032f27cSSam Leffler #ifdef __FreeBSD__ 30b032f27cSSam Leffler __FBSDID("$FreeBSD$"); 31b032f27cSSam Leffler #endif 32b032f27cSSam Leffler 33b032f27cSSam Leffler /* 34b032f27cSSam Leffler * IEEE 802.11 HOSTAP mode support. 35b032f27cSSam Leffler */ 36b032f27cSSam Leffler #include "opt_inet.h" 37b032f27cSSam Leffler #include "opt_wlan.h" 38b032f27cSSam Leffler 39b032f27cSSam Leffler #include <sys/param.h> 40b032f27cSSam Leffler #include <sys/systm.h> 41b032f27cSSam Leffler #include <sys/mbuf.h> 42b032f27cSSam Leffler #include <sys/malloc.h> 43b032f27cSSam Leffler #include <sys/kernel.h> 44b032f27cSSam Leffler 45b032f27cSSam Leffler #include <sys/socket.h> 46b032f27cSSam Leffler #include <sys/sockio.h> 47b032f27cSSam Leffler #include <sys/endian.h> 48b032f27cSSam Leffler #include <sys/errno.h> 49b032f27cSSam Leffler #include <sys/proc.h> 50b032f27cSSam Leffler #include <sys/sysctl.h> 51b032f27cSSam Leffler 52b032f27cSSam Leffler #include <net/if.h> 5376039bc8SGleb Smirnoff #include <net/if_var.h> 54b032f27cSSam Leffler #include <net/if_media.h> 55b032f27cSSam Leffler #include <net/if_llc.h> 56b032f27cSSam Leffler #include <net/ethernet.h> 57b032f27cSSam Leffler 58b032f27cSSam Leffler #include <net/bpf.h> 59b032f27cSSam Leffler 60b032f27cSSam Leffler #include <net80211/ieee80211_var.h> 61b032f27cSSam Leffler #include <net80211/ieee80211_hostap.h> 62b032f27cSSam Leffler #include <net80211/ieee80211_input.h> 63616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 64616190d0SSam Leffler #include <net80211/ieee80211_superg.h> 65616190d0SSam Leffler #endif 66b032f27cSSam Leffler #include <net80211/ieee80211_wds.h> 6751172f62SAdrian Chadd #include <net80211/ieee80211_vht.h> 688379e8dbSAdrian Chadd #include <net80211/ieee80211_sta.h> /* for parse_wmeie */ 69b032f27cSSam Leffler 70b032f27cSSam Leffler #define IEEE80211_RATE2MBS(r) (((r) & IEEE80211_RATE_VAL) / 2) 71b032f27cSSam Leffler 72b032f27cSSam Leffler static void hostap_vattach(struct ieee80211vap *); 73b032f27cSSam Leffler static int hostap_newstate(struct ieee80211vap *, enum ieee80211_state, int); 74b032f27cSSam Leffler static int hostap_input(struct ieee80211_node *ni, struct mbuf *m, 75c79f192cSAdrian Chadd const struct ieee80211_rx_stats *, 765463c4a4SSam Leffler int rssi, int nf); 77b032f27cSSam Leffler static void hostap_deliver_data(struct ieee80211vap *, 78b032f27cSSam Leffler struct ieee80211_node *, struct mbuf *); 79b032f27cSSam Leffler static void hostap_recv_mgmt(struct ieee80211_node *, struct mbuf *, 80c79f192cSAdrian Chadd int subtype, const struct ieee80211_rx_stats *rxs, int rssi, int nf); 8149eae5f7SSam Leffler static void hostap_recv_ctl(struct ieee80211_node *, struct mbuf *, int); 82b032f27cSSam Leffler 83b032f27cSSam Leffler void 84b032f27cSSam Leffler ieee80211_hostap_attach(struct ieee80211com *ic) 85b032f27cSSam Leffler { 86b032f27cSSam Leffler ic->ic_vattach[IEEE80211_M_HOSTAP] = hostap_vattach; 87b032f27cSSam Leffler } 88b032f27cSSam Leffler 89b032f27cSSam Leffler void 90b032f27cSSam Leffler ieee80211_hostap_detach(struct ieee80211com *ic) 91b032f27cSSam Leffler { 92b032f27cSSam Leffler } 93b032f27cSSam Leffler 94b032f27cSSam Leffler static void 95b032f27cSSam Leffler hostap_vdetach(struct ieee80211vap *vap) 96b032f27cSSam Leffler { 97b032f27cSSam Leffler } 98b032f27cSSam Leffler 99b032f27cSSam Leffler static void 100b032f27cSSam Leffler hostap_vattach(struct ieee80211vap *vap) 101b032f27cSSam Leffler { 102b032f27cSSam Leffler vap->iv_newstate = hostap_newstate; 103b032f27cSSam Leffler vap->iv_input = hostap_input; 104b032f27cSSam Leffler vap->iv_recv_mgmt = hostap_recv_mgmt; 10549eae5f7SSam Leffler vap->iv_recv_ctl = hostap_recv_ctl; 106b032f27cSSam Leffler vap->iv_opdetach = hostap_vdetach; 107b032f27cSSam Leffler vap->iv_deliver_data = hostap_deliver_data; 108e7f0d7cfSAdrian Chadd vap->iv_recv_pspoll = ieee80211_recv_pspoll; 109b032f27cSSam Leffler } 110b032f27cSSam Leffler 111b032f27cSSam Leffler static void 112b032f27cSSam Leffler sta_disassoc(void *arg, struct ieee80211_node *ni) 113b032f27cSSam Leffler { 114b032f27cSSam Leffler 1157db788c6SAndriy Voskoboinyk if (ni->ni_associd != 0) { 116b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_DISASSOC, 117b032f27cSSam Leffler IEEE80211_REASON_ASSOC_LEAVE); 118b032f27cSSam Leffler ieee80211_node_leave(ni); 119b032f27cSSam Leffler } 120b032f27cSSam Leffler } 121b032f27cSSam Leffler 1224e150988SSam Leffler static void 1234e150988SSam Leffler sta_csa(void *arg, struct ieee80211_node *ni) 1244e150988SSam Leffler { 1257db788c6SAndriy Voskoboinyk struct ieee80211vap *vap = ni->ni_vap; 1264e150988SSam Leffler 1277db788c6SAndriy Voskoboinyk if (ni->ni_associd != 0) 1284e150988SSam Leffler if (ni->ni_inact > vap->iv_inact_init) { 1294e150988SSam Leffler ni->ni_inact = vap->iv_inact_init; 1304e150988SSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_INACT, ni, 1314e150988SSam Leffler "%s: inact %u", __func__, ni->ni_inact); 1324e150988SSam Leffler } 1334e150988SSam Leffler } 1344e150988SSam Leffler 1357131987dSSam Leffler static void 1367131987dSSam Leffler sta_drop(void *arg, struct ieee80211_node *ni) 1377131987dSSam Leffler { 1387131987dSSam Leffler 1397db788c6SAndriy Voskoboinyk if (ni->ni_associd != 0) 1407131987dSSam Leffler ieee80211_node_leave(ni); 1417131987dSSam Leffler } 1427131987dSSam Leffler 1437131987dSSam Leffler /* 1447131987dSSam Leffler * Does a channel change require associated stations to re-associate 1457131987dSSam Leffler * so protocol state is correct. This is used when doing CSA across 1467131987dSSam Leffler * bands or similar (e.g. HT -> legacy). 1477131987dSSam Leffler */ 1487131987dSSam Leffler static int 1497131987dSSam Leffler isbandchange(struct ieee80211com *ic) 1507131987dSSam Leffler { 1517131987dSSam Leffler return ((ic->ic_bsschan->ic_flags ^ ic->ic_csa_newchan->ic_flags) & 1527131987dSSam Leffler (IEEE80211_CHAN_2GHZ | IEEE80211_CHAN_5GHZ | IEEE80211_CHAN_HALF | 1537131987dSSam Leffler IEEE80211_CHAN_QUARTER | IEEE80211_CHAN_HT)) != 0; 1547131987dSSam Leffler } 1557131987dSSam Leffler 156b032f27cSSam Leffler /* 157b032f27cSSam Leffler * IEEE80211_M_HOSTAP vap state machine handler. 158b032f27cSSam Leffler */ 159b032f27cSSam Leffler static int 160b032f27cSSam Leffler hostap_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 161b032f27cSSam Leffler { 162b032f27cSSam Leffler struct ieee80211com *ic = vap->iv_ic; 163b032f27cSSam Leffler enum ieee80211_state ostate; 164b032f27cSSam Leffler 165b032f27cSSam Leffler IEEE80211_LOCK_ASSERT(ic); 166b032f27cSSam Leffler 167b032f27cSSam Leffler ostate = vap->iv_state; 168b032f27cSSam Leffler IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE, "%s: %s -> %s (%d)\n", 169b032f27cSSam Leffler __func__, ieee80211_state_name[ostate], 170b032f27cSSam Leffler ieee80211_state_name[nstate], arg); 171b032f27cSSam Leffler vap->iv_state = nstate; /* state transition */ 172b032f27cSSam Leffler if (ostate != IEEE80211_S_SCAN) 173b032f27cSSam Leffler ieee80211_cancel_scan(vap); /* background scan */ 174b032f27cSSam Leffler switch (nstate) { 175b032f27cSSam Leffler case IEEE80211_S_INIT: 176b032f27cSSam Leffler switch (ostate) { 177b032f27cSSam Leffler case IEEE80211_S_SCAN: 178b032f27cSSam Leffler ieee80211_cancel_scan(vap); 179b032f27cSSam Leffler break; 180b032f27cSSam Leffler case IEEE80211_S_CAC: 181b032f27cSSam Leffler ieee80211_dfs_cac_stop(vap); 182b032f27cSSam Leffler break; 183b032f27cSSam Leffler case IEEE80211_S_RUN: 1847db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 1857db788c6SAndriy Voskoboinyk sta_disassoc, NULL); 186b032f27cSSam Leffler break; 187b032f27cSSam Leffler default: 188b032f27cSSam Leffler break; 189b032f27cSSam Leffler } 190b032f27cSSam Leffler if (ostate != IEEE80211_S_INIT) { 191b032f27cSSam Leffler /* NB: optimize INIT -> INIT case */ 192b032f27cSSam Leffler ieee80211_reset_bss(vap); 193b032f27cSSam Leffler } 194b032f27cSSam Leffler if (vap->iv_auth->ia_detach != NULL) 195b032f27cSSam Leffler vap->iv_auth->ia_detach(vap); 196b032f27cSSam Leffler break; 197b032f27cSSam Leffler case IEEE80211_S_SCAN: 198b032f27cSSam Leffler switch (ostate) { 199b032f27cSSam Leffler case IEEE80211_S_CSA: 200b032f27cSSam Leffler case IEEE80211_S_RUN: 2017db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 2027db788c6SAndriy Voskoboinyk sta_disassoc, NULL); 203b032f27cSSam Leffler /* 204b032f27cSSam Leffler * Clear overlapping BSS state; the beacon frame 205b032f27cSSam Leffler * will be reconstructed on transition to the RUN 206b032f27cSSam Leffler * state and the timeout routines check if the flag 207b032f27cSSam Leffler * is set before doing anything so this is sufficient. 208b032f27cSSam Leffler */ 209f1481c8dSAdrian Chadd vap->iv_flags_ext &= ~IEEE80211_FEXT_NONERP_PR; 210f1481c8dSAdrian Chadd vap->iv_flags_ht &= ~IEEE80211_FHT_NONHT_PR; 211f1481c8dSAdrian Chadd /* XXX TODO: schedule deferred update? */ 212b032f27cSSam Leffler /* fall thru... */ 213b032f27cSSam Leffler case IEEE80211_S_CAC: 214b032f27cSSam Leffler /* 215b032f27cSSam Leffler * NB: We may get here because of a manual channel 216b032f27cSSam Leffler * change in which case we need to stop CAC 217b032f27cSSam Leffler * XXX no need to stop if ostate RUN but it's ok 218b032f27cSSam Leffler */ 219b032f27cSSam Leffler ieee80211_dfs_cac_stop(vap); 220b032f27cSSam Leffler /* fall thru... */ 221b032f27cSSam Leffler case IEEE80211_S_INIT: 222b032f27cSSam Leffler if (vap->iv_des_chan != IEEE80211_CHAN_ANYC && 223b032f27cSSam Leffler !IEEE80211_IS_CHAN_RADAR(vap->iv_des_chan)) { 224b032f27cSSam Leffler /* 225b032f27cSSam Leffler * Already have a channel; bypass the 226b032f27cSSam Leffler * scan and startup immediately. 227b032f27cSSam Leffler * ieee80211_create_ibss will call back to 228b032f27cSSam Leffler * move us to RUN state. 229b032f27cSSam Leffler */ 230b032f27cSSam Leffler ieee80211_create_ibss(vap, vap->iv_des_chan); 231b032f27cSSam Leffler break; 232b032f27cSSam Leffler } 233b032f27cSSam Leffler /* 234b032f27cSSam Leffler * Initiate a scan. We can come here as a result 235b032f27cSSam Leffler * of an IEEE80211_IOC_SCAN_REQ too in which case 236b032f27cSSam Leffler * the vap will be marked with IEEE80211_FEXT_SCANREQ 237b032f27cSSam Leffler * and the scan request parameters will be present 238b032f27cSSam Leffler * in iv_scanreq. Otherwise we do the default. 239b032f27cSSam Leffler */ 240b032f27cSSam Leffler if (vap->iv_flags_ext & IEEE80211_FEXT_SCANREQ) { 241b032f27cSSam Leffler ieee80211_check_scan(vap, 242b032f27cSSam Leffler vap->iv_scanreq_flags, 243b032f27cSSam Leffler vap->iv_scanreq_duration, 244b032f27cSSam Leffler vap->iv_scanreq_mindwell, 245b032f27cSSam Leffler vap->iv_scanreq_maxdwell, 246b032f27cSSam Leffler vap->iv_scanreq_nssid, vap->iv_scanreq_ssid); 247b032f27cSSam Leffler vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANREQ; 248b032f27cSSam Leffler } else 249b032f27cSSam Leffler ieee80211_check_scan_current(vap); 250b032f27cSSam Leffler break; 251b032f27cSSam Leffler case IEEE80211_S_SCAN: 252b032f27cSSam Leffler /* 253b032f27cSSam Leffler * A state change requires a reset; scan. 254b032f27cSSam Leffler */ 255b032f27cSSam Leffler ieee80211_check_scan_current(vap); 256b032f27cSSam Leffler break; 257b032f27cSSam Leffler default: 258b032f27cSSam Leffler break; 259b032f27cSSam Leffler } 260b032f27cSSam Leffler break; 261b032f27cSSam Leffler case IEEE80211_S_CAC: 262b032f27cSSam Leffler /* 263b032f27cSSam Leffler * Start CAC on a DFS channel. We come here when starting 264b032f27cSSam Leffler * a bss on a DFS channel (see ieee80211_create_ibss). 265b032f27cSSam Leffler */ 266b032f27cSSam Leffler ieee80211_dfs_cac_start(vap); 267b032f27cSSam Leffler break; 268b032f27cSSam Leffler case IEEE80211_S_RUN: 269b032f27cSSam Leffler if (vap->iv_flags & IEEE80211_F_WPA) { 270b032f27cSSam Leffler /* XXX validate prerequisites */ 271b032f27cSSam Leffler } 272b032f27cSSam Leffler switch (ostate) { 273b032f27cSSam Leffler case IEEE80211_S_INIT: 274b032f27cSSam Leffler /* 275b032f27cSSam Leffler * Already have a channel; bypass the 276b032f27cSSam Leffler * scan and startup immediately. 277b032f27cSSam Leffler * Note that ieee80211_create_ibss will call 278b032f27cSSam Leffler * back to do a RUN->RUN state change. 279b032f27cSSam Leffler */ 280b032f27cSSam Leffler ieee80211_create_ibss(vap, 281b032f27cSSam Leffler ieee80211_ht_adjust_channel(ic, 2822bfc8a91SSam Leffler ic->ic_curchan, vap->iv_flags_ht)); 283b032f27cSSam Leffler /* NB: iv_bss is changed on return */ 284b032f27cSSam Leffler break; 285b032f27cSSam Leffler case IEEE80211_S_CAC: 286b032f27cSSam Leffler /* 287b032f27cSSam Leffler * NB: This is the normal state change when CAC 288b032f27cSSam Leffler * expires and no radar was detected; no need to 289b032f27cSSam Leffler * clear the CAC timer as it's already expired. 290b032f27cSSam Leffler */ 291b032f27cSSam Leffler /* fall thru... */ 292b032f27cSSam Leffler case IEEE80211_S_CSA: 293b032f27cSSam Leffler /* 2944e150988SSam Leffler * Shorten inactivity timer of associated stations 2954e150988SSam Leffler * to weed out sta's that don't follow a CSA. 2964e150988SSam Leffler */ 2977db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 2987db788c6SAndriy Voskoboinyk sta_csa, NULL); 2994e150988SSam Leffler /* 300b032f27cSSam Leffler * Update bss node channel to reflect where 301b032f27cSSam Leffler * we landed after CSA. 302b032f27cSSam Leffler */ 303b032f27cSSam Leffler ieee80211_node_set_chan(vap->iv_bss, 304b032f27cSSam Leffler ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 305b032f27cSSam Leffler ieee80211_htchanflags(vap->iv_bss->ni_chan))); 306b032f27cSSam Leffler /* XXX bypass debug msgs */ 307b032f27cSSam Leffler break; 308b032f27cSSam Leffler case IEEE80211_S_SCAN: 309b032f27cSSam Leffler case IEEE80211_S_RUN: 310b032f27cSSam Leffler #ifdef IEEE80211_DEBUG 311b032f27cSSam Leffler if (ieee80211_msg_debug(vap)) { 312b032f27cSSam Leffler struct ieee80211_node *ni = vap->iv_bss; 313b032f27cSSam Leffler ieee80211_note(vap, 314b032f27cSSam Leffler "synchronized with %s ssid ", 315b032f27cSSam Leffler ether_sprintf(ni->ni_bssid)); 316b032f27cSSam Leffler ieee80211_print_essid(ni->ni_essid, 317b032f27cSSam Leffler ni->ni_esslen); 318b032f27cSSam Leffler /* XXX MCS/HT */ 319b032f27cSSam Leffler printf(" channel %d start %uMb\n", 320b032f27cSSam Leffler ieee80211_chan2ieee(ic, ic->ic_curchan), 321b032f27cSSam Leffler IEEE80211_RATE2MBS(ni->ni_txrate)); 322b032f27cSSam Leffler } 323b032f27cSSam Leffler #endif 324b032f27cSSam Leffler break; 325b032f27cSSam Leffler default: 326b032f27cSSam Leffler break; 327b032f27cSSam Leffler } 328b032f27cSSam Leffler /* 329b032f27cSSam Leffler * Start/stop the authenticator. We delay until here 330b032f27cSSam Leffler * to allow configuration to happen out of order. 331b032f27cSSam Leffler */ 332b032f27cSSam Leffler if (vap->iv_auth->ia_attach != NULL) { 333b032f27cSSam Leffler /* XXX check failure */ 334b032f27cSSam Leffler vap->iv_auth->ia_attach(vap); 335b032f27cSSam Leffler } else if (vap->iv_auth->ia_detach != NULL) { 336b032f27cSSam Leffler vap->iv_auth->ia_detach(vap); 337b032f27cSSam Leffler } 338b032f27cSSam Leffler ieee80211_node_authorize(vap->iv_bss); 339b032f27cSSam Leffler break; 3407131987dSSam Leffler case IEEE80211_S_CSA: 3417131987dSSam Leffler if (ostate == IEEE80211_S_RUN && isbandchange(ic)) { 3427131987dSSam Leffler /* 3437131987dSSam Leffler * On a ``band change'' silently drop associated 3447131987dSSam Leffler * stations as they must re-associate before they 3457131987dSSam Leffler * can pass traffic (as otherwise protocol state 3467131987dSSam Leffler * such as capabilities and the negotiated rate 3477131987dSSam Leffler * set may/will be wrong). 3487131987dSSam Leffler */ 3497db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 3507db788c6SAndriy Voskoboinyk sta_drop, NULL); 3517131987dSSam Leffler } 3527131987dSSam Leffler break; 353b032f27cSSam Leffler default: 354b032f27cSSam Leffler break; 355b032f27cSSam Leffler } 356b032f27cSSam Leffler return 0; 357b032f27cSSam Leffler } 358b032f27cSSam Leffler 359b032f27cSSam Leffler static void 360b032f27cSSam Leffler hostap_deliver_data(struct ieee80211vap *vap, 361b032f27cSSam Leffler struct ieee80211_node *ni, struct mbuf *m) 362b032f27cSSam Leffler { 363b032f27cSSam Leffler struct ether_header *eh = mtod(m, struct ether_header *); 364b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 365b032f27cSSam Leffler 366e1cfcbcbSSam Leffler /* clear driver/net80211 flags before passing up */ 36786bd0491SAndre Oppermann m->m_flags &= ~(M_MCAST | M_BCAST); 36886bd0491SAndre Oppermann m_clrprotoflags(m); 369e1cfcbcbSSam Leffler 370b032f27cSSam Leffler KASSERT(vap->iv_opmode == IEEE80211_M_HOSTAP, 371b032f27cSSam Leffler ("gack, opmode %d", vap->iv_opmode)); 372b032f27cSSam Leffler /* 373b032f27cSSam Leffler * Do accounting. 374b032f27cSSam Leffler */ 375dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 376b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_data); 377b032f27cSSam Leffler IEEE80211_NODE_STAT_ADD(ni, rx_bytes, m->m_pkthdr.len); 378b032f27cSSam Leffler if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 379b032f27cSSam Leffler m->m_flags |= M_MCAST; /* XXX M_BCAST? */ 380b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_mcast); 381b032f27cSSam Leffler } else 382b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_ucast); 383b032f27cSSam Leffler 384b032f27cSSam Leffler /* perform as a bridge within the AP */ 385b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_NOBRIDGE) == 0) { 386b032f27cSSam Leffler struct mbuf *mcopy = NULL; 387b032f27cSSam Leffler 388b032f27cSSam Leffler if (m->m_flags & M_MCAST) { 389eb1b1807SGleb Smirnoff mcopy = m_dup(m, M_NOWAIT); 390b032f27cSSam Leffler if (mcopy == NULL) 391dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 392b032f27cSSam Leffler else 393b032f27cSSam Leffler mcopy->m_flags |= M_MCAST; 394b032f27cSSam Leffler } else { 395b032f27cSSam Leffler /* 396b032f27cSSam Leffler * Check if the destination is associated with the 397b032f27cSSam Leffler * same vap and authorized to receive traffic. 398b032f27cSSam Leffler * Beware of traffic destined for the vap itself; 399b032f27cSSam Leffler * sending it will not work; just let it be delivered 400b032f27cSSam Leffler * normally. 401b032f27cSSam Leffler */ 402b032f27cSSam Leffler struct ieee80211_node *sta = ieee80211_find_vap_node( 403b032f27cSSam Leffler &vap->iv_ic->ic_sta, vap, eh->ether_dhost); 404b032f27cSSam Leffler if (sta != NULL) { 405b032f27cSSam Leffler if (ieee80211_node_is_authorized(sta)) { 406b032f27cSSam Leffler /* 407b032f27cSSam Leffler * Beware of sending to ourself; this 408b032f27cSSam Leffler * needs to happen via the normal 409b032f27cSSam Leffler * input path. 410b032f27cSSam Leffler */ 411b032f27cSSam Leffler if (sta != vap->iv_bss) { 412b032f27cSSam Leffler mcopy = m; 413b032f27cSSam Leffler m = NULL; 414b032f27cSSam Leffler } 415b032f27cSSam Leffler } else { 416b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 417b032f27cSSam Leffler IEEE80211_NODE_STAT(sta, rx_unauth); 418b032f27cSSam Leffler } 419b032f27cSSam Leffler ieee80211_free_node(sta); 420b032f27cSSam Leffler } 421b032f27cSSam Leffler } 4224d4d5e25SAndriy Voskoboinyk if (mcopy != NULL) 4234d4d5e25SAndriy Voskoboinyk (void) ieee80211_vap_xmitpkt(vap, mcopy); 424b032f27cSSam Leffler } 425b032f27cSSam Leffler if (m != NULL) { 426b032f27cSSam Leffler /* 427b032f27cSSam Leffler * Mark frame as coming from vap's interface. 428b032f27cSSam Leffler */ 429b032f27cSSam Leffler m->m_pkthdr.rcvif = ifp; 430b032f27cSSam Leffler if (m->m_flags & M_MCAST) { 431b032f27cSSam Leffler /* 432b032f27cSSam Leffler * Spam DWDS vap's w/ multicast traffic. 433b032f27cSSam Leffler */ 434b032f27cSSam Leffler /* XXX only if dwds in use? */ 435b032f27cSSam Leffler ieee80211_dwds_mcast(vap, m); 436b032f27cSSam Leffler } 437b032f27cSSam Leffler if (ni->ni_vlan != 0) { 438b032f27cSSam Leffler /* attach vlan tag */ 439b032f27cSSam Leffler m->m_pkthdr.ether_vtag = ni->ni_vlan; 440b032f27cSSam Leffler m->m_flags |= M_VLANTAG; 441b032f27cSSam Leffler } 442b032f27cSSam Leffler ifp->if_input(ifp, m); 443b032f27cSSam Leffler } 444b032f27cSSam Leffler } 445b032f27cSSam Leffler 446b032f27cSSam Leffler /* 447b032f27cSSam Leffler * Decide if a received management frame should be 448b032f27cSSam Leffler * printed when debugging is enabled. This filters some 449b032f27cSSam Leffler * of the less interesting frames that come frequently 450b032f27cSSam Leffler * (e.g. beacons). 451b032f27cSSam Leffler */ 452b032f27cSSam Leffler static __inline int 453b032f27cSSam Leffler doprint(struct ieee80211vap *vap, int subtype) 454b032f27cSSam Leffler { 455b032f27cSSam Leffler switch (subtype) { 456b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_BEACON: 457b032f27cSSam Leffler return (vap->iv_ic->ic_flags & IEEE80211_F_SCAN); 458b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 459b032f27cSSam Leffler return 0; 460b032f27cSSam Leffler } 461b032f27cSSam Leffler return 1; 462b032f27cSSam Leffler } 463b032f27cSSam Leffler 464b032f27cSSam Leffler /* 465b032f27cSSam Leffler * Process a received frame. The node associated with the sender 466b032f27cSSam Leffler * should be supplied. If nothing was found in the node table then 467b032f27cSSam Leffler * the caller is assumed to supply a reference to iv_bss instead. 468b032f27cSSam Leffler * The RSSI and a timestamp are also supplied. The RSSI data is used 469b032f27cSSam Leffler * during AP scanning to select a AP to associate with; it can have 470b032f27cSSam Leffler * any units so long as values have consistent units and higher values 471b032f27cSSam Leffler * mean ``better signal''. The receive timestamp is currently not used 472b032f27cSSam Leffler * by the 802.11 layer. 473b032f27cSSam Leffler */ 474b032f27cSSam Leffler static int 475c79f192cSAdrian Chadd hostap_input(struct ieee80211_node *ni, struct mbuf *m, 476c79f192cSAdrian Chadd const struct ieee80211_rx_stats *rxs, int rssi, int nf) 477b032f27cSSam Leffler { 478b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 479b032f27cSSam Leffler struct ieee80211com *ic = ni->ni_ic; 480b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 481b032f27cSSam Leffler struct ieee80211_frame *wh; 482b032f27cSSam Leffler struct ieee80211_key *key; 483b032f27cSSam Leffler struct ether_header *eh; 4842b80a340SRui Paulo int hdrspace, need_tap = 1; /* mbuf need to be tapped. */ 485b032f27cSSam Leffler uint8_t dir, type, subtype, qos; 486b032f27cSSam Leffler uint8_t *bssid; 487fe75b452SAdrian Chadd int is_hw_decrypted = 0; 488fe75b452SAdrian Chadd int has_decrypted = 0; 489fe75b452SAdrian Chadd 490fe75b452SAdrian Chadd /* 491fe75b452SAdrian Chadd * Some devices do hardware decryption all the way through 492fe75b452SAdrian Chadd * to pretending the frame wasn't encrypted in the first place. 493fe75b452SAdrian Chadd * So, tag it appropriately so it isn't discarded inappropriately. 494fe75b452SAdrian Chadd */ 495fe75b452SAdrian Chadd if ((rxs != NULL) && (rxs->c_pktflags & IEEE80211_RX_F_DECRYPTED)) 496fe75b452SAdrian Chadd is_hw_decrypted = 1; 497b032f27cSSam Leffler 49845f856e3SSam Leffler if (m->m_flags & M_AMPDU_MPDU) { 499b032f27cSSam Leffler /* 500b032f27cSSam Leffler * Fastpath for A-MPDU reorder q resubmission. Frames 50145f856e3SSam Leffler * w/ M_AMPDU_MPDU marked have already passed through 50245f856e3SSam Leffler * here but were received out of order and been held on 50345f856e3SSam Leffler * the reorder queue. When resubmitted they are marked 50445f856e3SSam Leffler * with the M_AMPDU_MPDU flag and we can bypass most of 50545f856e3SSam Leffler * the normal processing. 506b032f27cSSam Leffler */ 507b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 508b032f27cSSam Leffler type = IEEE80211_FC0_TYPE_DATA; 509b032f27cSSam Leffler dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 510b032f27cSSam Leffler subtype = IEEE80211_FC0_SUBTYPE_QOS; 511b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); /* XXX optimize? */ 512b032f27cSSam Leffler goto resubmit_ampdu; 513b032f27cSSam Leffler } 514b032f27cSSam Leffler 515b032f27cSSam Leffler KASSERT(ni != NULL, ("null node")); 516b032f27cSSam Leffler ni->ni_inact = ni->ni_inact_reload; 517b032f27cSSam Leffler 518b032f27cSSam Leffler type = -1; /* undefined */ 519b032f27cSSam Leffler 520b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame_min)) { 521b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 522b032f27cSSam Leffler ni->ni_macaddr, NULL, 523b032f27cSSam Leffler "too short (1): len %u", m->m_pkthdr.len); 524b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 525b032f27cSSam Leffler goto out; 526b032f27cSSam Leffler } 527b032f27cSSam Leffler /* 528b032f27cSSam Leffler * Bit of a cheat here, we use a pointer for a 3-address 529b032f27cSSam Leffler * frame format but don't reference fields past outside 530b032f27cSSam Leffler * ieee80211_frame_min w/o first validating the data is 531b032f27cSSam Leffler * present. 532b032f27cSSam Leffler */ 533b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 534b032f27cSSam Leffler 535b032f27cSSam Leffler if ((wh->i_fc[0] & IEEE80211_FC0_VERSION_MASK) != 536b032f27cSSam Leffler IEEE80211_FC0_VERSION_0) { 537b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 538dc7bf546SSam Leffler ni->ni_macaddr, NULL, "wrong version, fc %02x:%02x", 539dc7bf546SSam Leffler wh->i_fc[0], wh->i_fc[1]); 540b032f27cSSam Leffler vap->iv_stats.is_rx_badversion++; 541b032f27cSSam Leffler goto err; 542b032f27cSSam Leffler } 543b032f27cSSam Leffler 544b032f27cSSam Leffler dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 545b032f27cSSam Leffler type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 546b032f27cSSam Leffler subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 547b032f27cSSam Leffler if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) { 548b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_NODS) 549b032f27cSSam Leffler bssid = wh->i_addr1; 550b032f27cSSam Leffler else if (type == IEEE80211_FC0_TYPE_CTL) 551b032f27cSSam Leffler bssid = wh->i_addr1; 552b032f27cSSam Leffler else { 553b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) { 554b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, 555b032f27cSSam Leffler IEEE80211_MSG_ANY, ni->ni_macaddr, 556b032f27cSSam Leffler NULL, "too short (2): len %u", 557b032f27cSSam Leffler m->m_pkthdr.len); 558b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 559b032f27cSSam Leffler goto out; 560b032f27cSSam Leffler } 561b032f27cSSam Leffler bssid = wh->i_addr3; 562b032f27cSSam Leffler } 563b032f27cSSam Leffler /* 564b032f27cSSam Leffler * Validate the bssid. 565b032f27cSSam Leffler */ 566b032f27cSSam Leffler if (!(type == IEEE80211_FC0_TYPE_MGT && 567b032f27cSSam Leffler subtype == IEEE80211_FC0_SUBTYPE_BEACON) && 568b032f27cSSam Leffler !IEEE80211_ADDR_EQ(bssid, vap->iv_bss->ni_bssid) && 569b032f27cSSam Leffler !IEEE80211_ADDR_EQ(bssid, ifp->if_broadcastaddr)) { 570b032f27cSSam Leffler /* not interested in */ 571b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 572b032f27cSSam Leffler bssid, NULL, "%s", "not to bss"); 573b032f27cSSam Leffler vap->iv_stats.is_rx_wrongbss++; 574b032f27cSSam Leffler goto out; 575b032f27cSSam Leffler } 576b032f27cSSam Leffler 577b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 5785463c4a4SSam Leffler ni->ni_noise = nf; 579c3ebe019SAdrian Chadd if (IEEE80211_HAS_SEQ(type, subtype)) { 580b032f27cSSam Leffler uint8_t tid = ieee80211_gettid(wh); 581b032f27cSSam Leffler if (IEEE80211_QOS_HAS_SEQ(wh) && 582b032f27cSSam Leffler TID_TO_WME_AC(tid) >= WME_AC_VI) 583b032f27cSSam Leffler ic->ic_wme.wme_hipri_traffic++; 58485c4e670SAdrian Chadd if (! ieee80211_check_rxseq(ni, wh, bssid, rxs)) 585b032f27cSSam Leffler goto out; 586b032f27cSSam Leffler } 587b032f27cSSam Leffler } 588b032f27cSSam Leffler 589b032f27cSSam Leffler switch (type) { 590b032f27cSSam Leffler case IEEE80211_FC0_TYPE_DATA: 591b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); 592b032f27cSSam Leffler if (m->m_len < hdrspace && 593b032f27cSSam Leffler (m = m_pullup(m, hdrspace)) == NULL) { 594b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 595b032f27cSSam Leffler ni->ni_macaddr, NULL, 596b032f27cSSam Leffler "data too short: expecting %u", hdrspace); 597b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 598b032f27cSSam Leffler goto out; /* XXX */ 599b032f27cSSam Leffler } 600b032f27cSSam Leffler if (!(dir == IEEE80211_FC1_DIR_TODS || 601b032f27cSSam Leffler (dir == IEEE80211_FC1_DIR_DSTODS && 602b032f27cSSam Leffler (vap->iv_flags & IEEE80211_F_DWDS)))) { 603b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_DSTODS) { 604b032f27cSSam Leffler IEEE80211_DISCARD(vap, 605b032f27cSSam Leffler IEEE80211_MSG_INPUT, wh, "data", 606b032f27cSSam Leffler "incorrect dir 0x%x", dir); 607b032f27cSSam Leffler } else { 608b032f27cSSam Leffler IEEE80211_DISCARD(vap, 609b032f27cSSam Leffler IEEE80211_MSG_INPUT | 610b032f27cSSam Leffler IEEE80211_MSG_WDS, wh, 611b032f27cSSam Leffler "4-address data", 612b032f27cSSam Leffler "%s", "DWDS not enabled"); 613b032f27cSSam Leffler } 614b032f27cSSam Leffler vap->iv_stats.is_rx_wrongdir++; 615b032f27cSSam Leffler goto out; 616b032f27cSSam Leffler } 617b032f27cSSam Leffler /* check if source STA is associated */ 618b032f27cSSam Leffler if (ni == vap->iv_bss) { 619b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 620b032f27cSSam Leffler wh, "data", "%s", "unknown src"); 621b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 622b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DEAUTH, 623b032f27cSSam Leffler IEEE80211_REASON_NOT_AUTHED); 624b032f27cSSam Leffler vap->iv_stats.is_rx_notassoc++; 625b032f27cSSam Leffler goto err; 626b032f27cSSam Leffler } 627b032f27cSSam Leffler if (ni->ni_associd == 0) { 628b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 629b032f27cSSam Leffler wh, "data", "%s", "unassoc src"); 630b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, 631b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DISASSOC, 632b032f27cSSam Leffler IEEE80211_REASON_NOT_ASSOCED); 633b032f27cSSam Leffler vap->iv_stats.is_rx_notassoc++; 634b032f27cSSam Leffler goto err; 635b032f27cSSam Leffler } 636b032f27cSSam Leffler 637b032f27cSSam Leffler /* 638b032f27cSSam Leffler * Check for power save state change. 639b032f27cSSam Leffler * XXX out-of-order A-MPDU frames? 640b032f27cSSam Leffler */ 641b032f27cSSam Leffler if (((wh->i_fc[1] & IEEE80211_FC1_PWR_MGT) ^ 642b032f27cSSam Leffler (ni->ni_flags & IEEE80211_NODE_PWR_MGT))) 643e7f0d7cfSAdrian Chadd vap->iv_node_ps(ni, 644b032f27cSSam Leffler wh->i_fc[1] & IEEE80211_FC1_PWR_MGT); 645b032f27cSSam Leffler /* 646b032f27cSSam Leffler * For 4-address packets handle WDS discovery 647b032f27cSSam Leffler * notifications. Once a WDS link is setup frames 648b032f27cSSam Leffler * are just delivered to the WDS vap (see below). 649b032f27cSSam Leffler */ 650b032f27cSSam Leffler if (dir == IEEE80211_FC1_DIR_DSTODS && ni->ni_wdsvap == NULL) { 651b032f27cSSam Leffler if (!ieee80211_node_is_authorized(ni)) { 652b032f27cSSam Leffler IEEE80211_DISCARD(vap, 653b032f27cSSam Leffler IEEE80211_MSG_INPUT | 654b032f27cSSam Leffler IEEE80211_MSG_WDS, wh, 655b032f27cSSam Leffler "4-address data", 656b032f27cSSam Leffler "%s", "unauthorized port"); 657b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 658b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unauth); 659b032f27cSSam Leffler goto err; 660b032f27cSSam Leffler } 661b032f27cSSam Leffler ieee80211_dwds_discover(ni, m); 662b032f27cSSam Leffler return type; 663b032f27cSSam Leffler } 664b032f27cSSam Leffler 665b032f27cSSam Leffler /* 66645f856e3SSam Leffler * Handle A-MPDU re-ordering. If the frame is to be 66745f856e3SSam Leffler * processed directly then ieee80211_ampdu_reorder 668b032f27cSSam Leffler * will return 0; otherwise it has consumed the mbuf 669b032f27cSSam Leffler * and we should do nothing more with it. 670b032f27cSSam Leffler */ 67145f856e3SSam Leffler if ((m->m_flags & M_AMPDU) && 67285c4e670SAdrian Chadd ieee80211_ampdu_reorder(ni, m, rxs) != 0) { 673b032f27cSSam Leffler m = NULL; 674b032f27cSSam Leffler goto out; 675b032f27cSSam Leffler } 676b032f27cSSam Leffler resubmit_ampdu: 677b032f27cSSam Leffler 678b032f27cSSam Leffler /* 679b032f27cSSam Leffler * Handle privacy requirements. Note that we 680b032f27cSSam Leffler * must not be preempted from here until after 681b032f27cSSam Leffler * we (potentially) call ieee80211_crypto_demic; 682b032f27cSSam Leffler * otherwise we may violate assumptions in the 683b032f27cSSam Leffler * crypto cipher modules used to do delayed update 684b032f27cSSam Leffler * of replay sequence numbers. 685b032f27cSSam Leffler */ 686fe75b452SAdrian Chadd if (is_hw_decrypted || wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 687b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 688b032f27cSSam Leffler /* 689b032f27cSSam Leffler * Discard encrypted frames when privacy is off. 690b032f27cSSam Leffler */ 691b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 692b032f27cSSam Leffler wh, "WEP", "%s", "PRIVACY off"); 693b032f27cSSam Leffler vap->iv_stats.is_rx_noprivacy++; 694b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_noprivacy); 695b032f27cSSam Leffler goto out; 696b032f27cSSam Leffler } 697fe75b452SAdrian Chadd if (ieee80211_crypto_decap(ni, m, hdrspace, &key) == 0) { 698b032f27cSSam Leffler /* NB: stats+msgs handled in crypto_decap */ 699b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_wepfail); 700b032f27cSSam Leffler goto out; 701b032f27cSSam Leffler } 702b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 7035945b5f5SKevin Lo wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED; 704fe75b452SAdrian Chadd has_decrypted = 1; 705b032f27cSSam Leffler } else { 706b032f27cSSam Leffler /* XXX M_WEP and IEEE80211_F_PRIVACY */ 707b032f27cSSam Leffler key = NULL; 708b032f27cSSam Leffler } 709b032f27cSSam Leffler 710b032f27cSSam Leffler /* 711b032f27cSSam Leffler * Save QoS bits for use below--before we strip the header. 712b032f27cSSam Leffler */ 713f3f08e16SAndriy Voskoboinyk if (subtype == IEEE80211_FC0_SUBTYPE_QOS) 714f3f08e16SAndriy Voskoboinyk qos = ieee80211_getqos(wh)[0]; 715f3f08e16SAndriy Voskoboinyk else 716b032f27cSSam Leffler qos = 0; 717b032f27cSSam Leffler 718b032f27cSSam Leffler /* 719b032f27cSSam Leffler * Next up, any fragmentation. 720b032f27cSSam Leffler */ 721b032f27cSSam Leffler if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 722b032f27cSSam Leffler m = ieee80211_defrag(ni, m, hdrspace); 723b032f27cSSam Leffler if (m == NULL) { 724b032f27cSSam Leffler /* Fragment dropped or frame not complete yet */ 725b032f27cSSam Leffler goto out; 726b032f27cSSam Leffler } 727b032f27cSSam Leffler } 728b032f27cSSam Leffler wh = NULL; /* no longer valid, catch any uses */ 729b032f27cSSam Leffler 730b032f27cSSam Leffler /* 731b032f27cSSam Leffler * Next strip any MSDU crypto bits. 732b032f27cSSam Leffler */ 733b032f27cSSam Leffler if (key != NULL && !ieee80211_crypto_demic(vap, key, m, 0)) { 734b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 735b032f27cSSam Leffler ni->ni_macaddr, "data", "%s", "demic error"); 736b032f27cSSam Leffler vap->iv_stats.is_rx_demicfail++; 737b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_demicfail); 738b032f27cSSam Leffler goto out; 739b032f27cSSam Leffler } 740b032f27cSSam Leffler /* copy to listener after decrypt */ 7415463c4a4SSam Leffler if (ieee80211_radiotap_active_vap(vap)) 7425463c4a4SSam Leffler ieee80211_radiotap_rx(vap, m); 743b032f27cSSam Leffler need_tap = 0; 744b032f27cSSam Leffler /* 745b032f27cSSam Leffler * Finally, strip the 802.11 header. 746b032f27cSSam Leffler */ 747b032f27cSSam Leffler m = ieee80211_decap(vap, m, hdrspace); 748b032f27cSSam Leffler if (m == NULL) { 749b032f27cSSam Leffler /* XXX mask bit to check for both */ 750b032f27cSSam Leffler /* don't count Null data frames as errors */ 751b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_NODATA || 752b032f27cSSam Leffler subtype == IEEE80211_FC0_SUBTYPE_QOS_NULL) 753b032f27cSSam Leffler goto out; 754b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 755b032f27cSSam Leffler ni->ni_macaddr, "data", "%s", "decap error"); 756b032f27cSSam Leffler vap->iv_stats.is_rx_decap++; 757b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_decap); 758b032f27cSSam Leffler goto err; 759b032f27cSSam Leffler } 760b032f27cSSam Leffler eh = mtod(m, struct ether_header *); 761b032f27cSSam Leffler if (!ieee80211_node_is_authorized(ni)) { 762b032f27cSSam Leffler /* 763b032f27cSSam Leffler * Deny any non-PAE frames received prior to 764b032f27cSSam Leffler * authorization. For open/shared-key 765b032f27cSSam Leffler * authentication the port is mark authorized 766b032f27cSSam Leffler * after authentication completes. For 802.1x 767b032f27cSSam Leffler * the port is not marked authorized by the 768b032f27cSSam Leffler * authenticator until the handshake has completed. 769b032f27cSSam Leffler */ 770b032f27cSSam Leffler if (eh->ether_type != htons(ETHERTYPE_PAE)) { 771b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 772b032f27cSSam Leffler eh->ether_shost, "data", 773b032f27cSSam Leffler "unauthorized port: ether type 0x%x len %u", 774b032f27cSSam Leffler eh->ether_type, m->m_pkthdr.len); 775b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 776b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unauth); 777b032f27cSSam Leffler goto err; 778b032f27cSSam Leffler } 779b032f27cSSam Leffler } else { 780b032f27cSSam Leffler /* 781b032f27cSSam Leffler * When denying unencrypted frames, discard 782b032f27cSSam Leffler * any non-PAE frames received without encryption. 783b032f27cSSam Leffler */ 784b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_DROPUNENC) && 785fe75b452SAdrian Chadd ((has_decrypted == 0) && (m->m_flags & M_WEP) == 0) && 786fe75b452SAdrian Chadd (is_hw_decrypted == 0) && 787b032f27cSSam Leffler eh->ether_type != htons(ETHERTYPE_PAE)) { 788b032f27cSSam Leffler /* 789b032f27cSSam Leffler * Drop unencrypted frames. 790b032f27cSSam Leffler */ 791b032f27cSSam Leffler vap->iv_stats.is_rx_unencrypted++; 792b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unencrypted); 793b032f27cSSam Leffler goto out; 794b032f27cSSam Leffler } 795b032f27cSSam Leffler } 796b032f27cSSam Leffler /* XXX require HT? */ 797b032f27cSSam Leffler if (qos & IEEE80211_QOS_AMSDU) { 798b032f27cSSam Leffler m = ieee80211_decap_amsdu(ni, m); 799b032f27cSSam Leffler if (m == NULL) 800b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 801616190d0SSam Leffler } else { 802616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 803616190d0SSam Leffler m = ieee80211_decap_fastframe(vap, ni, m); 804b032f27cSSam Leffler if (m == NULL) 805b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 806616190d0SSam Leffler #endif 807b032f27cSSam Leffler } 808b032f27cSSam Leffler if (dir == IEEE80211_FC1_DIR_DSTODS && ni->ni_wdsvap != NULL) 809b032f27cSSam Leffler ieee80211_deliver_data(ni->ni_wdsvap, ni, m); 810b032f27cSSam Leffler else 811b032f27cSSam Leffler hostap_deliver_data(vap, ni, m); 812b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 813b032f27cSSam Leffler 814b032f27cSSam Leffler case IEEE80211_FC0_TYPE_MGT: 815b032f27cSSam Leffler vap->iv_stats.is_rx_mgmt++; 816b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_mgmt); 817b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_NODS) { 818b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 819b032f27cSSam Leffler wh, "mgt", "incorrect dir 0x%x", dir); 820b032f27cSSam Leffler vap->iv_stats.is_rx_wrongdir++; 821b032f27cSSam Leffler goto err; 822b032f27cSSam Leffler } 823b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) { 824b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 825b032f27cSSam Leffler ni->ni_macaddr, "mgt", "too short: len %u", 826b032f27cSSam Leffler m->m_pkthdr.len); 827b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 828b032f27cSSam Leffler goto out; 829b032f27cSSam Leffler } 830b032f27cSSam Leffler if (IEEE80211_IS_MULTICAST(wh->i_addr2)) { 831b032f27cSSam Leffler /* ensure return frames are unicast */ 832b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 833b032f27cSSam Leffler wh, NULL, "source is multicast: %s", 834b032f27cSSam Leffler ether_sprintf(wh->i_addr2)); 835b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; /* XXX stat */ 836b032f27cSSam Leffler goto out; 837b032f27cSSam Leffler } 838b032f27cSSam Leffler #ifdef IEEE80211_DEBUG 839b032f27cSSam Leffler if ((ieee80211_msg_debug(vap) && doprint(vap, subtype)) || 840b032f27cSSam Leffler ieee80211_msg_dumppkts(vap)) { 841b032f27cSSam Leffler if_printf(ifp, "received %s from %s rssi %d\n", 8424357a5d1SAndriy Voskoboinyk ieee80211_mgt_subtype_name(subtype), 843b032f27cSSam Leffler ether_sprintf(wh->i_addr2), rssi); 844b032f27cSSam Leffler } 845b032f27cSSam Leffler #endif 8465945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 847b032f27cSSam Leffler if (subtype != IEEE80211_FC0_SUBTYPE_AUTH) { 848b032f27cSSam Leffler /* 849b032f27cSSam Leffler * Only shared key auth frames with a challenge 850b032f27cSSam Leffler * should be encrypted, discard all others. 851b032f27cSSam Leffler */ 852b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 853b032f27cSSam Leffler wh, NULL, 854b032f27cSSam Leffler "%s", "WEP set but not permitted"); 855b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; /* XXX */ 856b032f27cSSam Leffler goto out; 857b032f27cSSam Leffler } 858b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 859b032f27cSSam Leffler /* 860b032f27cSSam Leffler * Discard encrypted frames when privacy is off. 861b032f27cSSam Leffler */ 862b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 863b032f27cSSam Leffler wh, NULL, "%s", "WEP set but PRIVACY off"); 864b032f27cSSam Leffler vap->iv_stats.is_rx_noprivacy++; 865b032f27cSSam Leffler goto out; 866b032f27cSSam Leffler } 867b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); 868fe75b452SAdrian Chadd if (ieee80211_crypto_decap(ni, m, hdrspace, &key) == 0) { 869b032f27cSSam Leffler /* NB: stats+msgs handled in crypto_decap */ 870b032f27cSSam Leffler goto out; 871b032f27cSSam Leffler } 872b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 8735945b5f5SKevin Lo wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED; 874fe75b452SAdrian Chadd has_decrypted = 1; 875b032f27cSSam Leffler } 8764e87d54aSRui Paulo /* 8774e87d54aSRui Paulo * Pass the packet to radiotap before calling iv_recv_mgmt(). 8784e87d54aSRui Paulo * Otherwise iv_recv_mgmt() might pass another packet to 8794e87d54aSRui Paulo * radiotap, resulting in out of order packet captures. 8804e87d54aSRui Paulo */ 881323f12abSRui Paulo if (ieee80211_radiotap_active_vap(vap)) 882323f12abSRui Paulo ieee80211_radiotap_rx(vap, m); 883323f12abSRui Paulo need_tap = 0; 884c79f192cSAdrian Chadd vap->iv_recv_mgmt(ni, m, subtype, rxs, rssi, nf); 8858bbd3e41SSam Leffler goto out; 886b032f27cSSam Leffler 887b032f27cSSam Leffler case IEEE80211_FC0_TYPE_CTL: 888b032f27cSSam Leffler vap->iv_stats.is_rx_ctl++; 889b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_ctrl); 89049eae5f7SSam Leffler vap->iv_recv_ctl(ni, m, subtype); 891b032f27cSSam Leffler goto out; 892b032f27cSSam Leffler default: 893b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 894b032f27cSSam Leffler wh, "bad", "frame type 0x%x", type); 895b032f27cSSam Leffler /* should not come here */ 896b032f27cSSam Leffler break; 897b032f27cSSam Leffler } 898b032f27cSSam Leffler err: 899dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 900b032f27cSSam Leffler out: 901b032f27cSSam Leffler if (m != NULL) { 902a6c3cf3eSSam Leffler if (need_tap && ieee80211_radiotap_active_vap(vap)) 9035463c4a4SSam Leffler ieee80211_radiotap_rx(vap, m); 904b032f27cSSam Leffler m_freem(m); 905b032f27cSSam Leffler } 906b032f27cSSam Leffler return type; 907b032f27cSSam Leffler } 908b032f27cSSam Leffler 909b032f27cSSam Leffler static void 910b032f27cSSam Leffler hostap_auth_open(struct ieee80211_node *ni, struct ieee80211_frame *wh, 9115463c4a4SSam Leffler int rssi, int nf, uint16_t seq, uint16_t status) 912b032f27cSSam Leffler { 913b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 914b032f27cSSam Leffler 915b032f27cSSam Leffler KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 916b032f27cSSam Leffler 917b032f27cSSam Leffler if (ni->ni_authmode == IEEE80211_AUTH_SHARED) { 918b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 919b032f27cSSam Leffler ni->ni_macaddr, "open auth", 920b032f27cSSam Leffler "bad sta auth mode %u", ni->ni_authmode); 921b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; /* XXX */ 922b032f27cSSam Leffler /* 923b032f27cSSam Leffler * Clear any challenge text that may be there if 924b032f27cSSam Leffler * a previous shared key auth failed and then an 925b032f27cSSam Leffler * open auth is attempted. 926b032f27cSSam Leffler */ 927b032f27cSSam Leffler if (ni->ni_challenge != NULL) { 928b9b53389SAdrian Chadd IEEE80211_FREE(ni->ni_challenge, M_80211_NODE); 929b032f27cSSam Leffler ni->ni_challenge = NULL; 930b032f27cSSam Leffler } 931b032f27cSSam Leffler /* XXX hack to workaround calling convention */ 932b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 933b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 934b032f27cSSam Leffler (seq + 1) | (IEEE80211_STATUS_ALG<<16)); 935b032f27cSSam Leffler return; 936b032f27cSSam Leffler } 937b032f27cSSam Leffler if (seq != IEEE80211_AUTH_OPEN_REQUEST) { 938b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 939b032f27cSSam Leffler return; 940b032f27cSSam Leffler } 941b032f27cSSam Leffler /* always accept open authentication requests */ 942b032f27cSSam Leffler if (ni == vap->iv_bss) { 943b032f27cSSam Leffler ni = ieee80211_dup_bss(vap, wh->i_addr2); 944b032f27cSSam Leffler if (ni == NULL) 945b032f27cSSam Leffler return; 946b032f27cSSam Leffler } else if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0) 947b032f27cSSam Leffler (void) ieee80211_ref_node(ni); 948b032f27cSSam Leffler /* 949b032f27cSSam Leffler * Mark the node as referenced to reflect that it's 950b032f27cSSam Leffler * reference count has been bumped to insure it remains 951b032f27cSSam Leffler * after the transaction completes. 952b032f27cSSam Leffler */ 953b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_AREF; 9541b999d64SSam Leffler /* 95512c290feSSam Leffler * Mark the node as requiring a valid association id 9561b999d64SSam Leffler * before outbound traffic is permitted. 9571b999d64SSam Leffler */ 9581b999d64SSam Leffler ni->ni_flags |= IEEE80211_NODE_ASSOCID; 959b032f27cSSam Leffler 960b032f27cSSam Leffler if (vap->iv_acl != NULL && 961b032f27cSSam Leffler vap->iv_acl->iac_getpolicy(vap) == IEEE80211_MACCMD_POLICY_RADIUS) { 962b032f27cSSam Leffler /* 963b032f27cSSam Leffler * When the ACL policy is set to RADIUS we defer the 964b032f27cSSam Leffler * authorization to a user agent. Dispatch an event, 965b032f27cSSam Leffler * a subsequent MLME call will decide the fate of the 966b032f27cSSam Leffler * station. If the user agent is not present then the 967b032f27cSSam Leffler * node will be reclaimed due to inactivity. 968b032f27cSSam Leffler */ 969b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 970b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_ACL, ni->ni_macaddr, 971b032f27cSSam Leffler "%s", "station authentication defered (radius acl)"); 972b032f27cSSam Leffler ieee80211_notify_node_auth(ni); 973b032f27cSSam Leffler } else { 974b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 975b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 976b032f27cSSam Leffler IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, ni->ni_macaddr, 977b032f27cSSam Leffler "%s", "station authenticated (open)"); 978b032f27cSSam Leffler /* 979b032f27cSSam Leffler * When 802.1x is not in use mark the port 980b032f27cSSam Leffler * authorized at this point so traffic can flow. 981b032f27cSSam Leffler */ 982b032f27cSSam Leffler if (ni->ni_authmode != IEEE80211_AUTH_8021X) 983b032f27cSSam Leffler ieee80211_node_authorize(ni); 984b032f27cSSam Leffler } 985b032f27cSSam Leffler } 986b032f27cSSam Leffler 987b032f27cSSam Leffler static void 988b032f27cSSam Leffler hostap_auth_shared(struct ieee80211_node *ni, struct ieee80211_frame *wh, 9895463c4a4SSam Leffler uint8_t *frm, uint8_t *efrm, int rssi, int nf, 990b032f27cSSam Leffler uint16_t seq, uint16_t status) 991b032f27cSSam Leffler { 992b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 993b032f27cSSam Leffler uint8_t *challenge; 994b032f27cSSam Leffler int allocbs, estatus; 995b032f27cSSam Leffler 996b032f27cSSam Leffler KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 997b032f27cSSam Leffler 998b032f27cSSam Leffler /* 999b032f27cSSam Leffler * NB: this can happen as we allow pre-shared key 1000b032f27cSSam Leffler * authentication to be enabled w/o wep being turned 1001b032f27cSSam Leffler * on so that configuration of these can be done 1002b032f27cSSam Leffler * in any order. It may be better to enforce the 1003b032f27cSSam Leffler * ordering in which case this check would just be 1004b032f27cSSam Leffler * for sanity/consistency. 1005b032f27cSSam Leffler */ 1006b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 1007b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1008b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1009b032f27cSSam Leffler "%s", " PRIVACY is disabled"); 1010b032f27cSSam Leffler estatus = IEEE80211_STATUS_ALG; 1011b032f27cSSam Leffler goto bad; 1012b032f27cSSam Leffler } 1013b032f27cSSam Leffler /* 1014b032f27cSSam Leffler * Pre-shared key authentication is evil; accept 1015b032f27cSSam Leffler * it only if explicitly configured (it is supported 1016b032f27cSSam Leffler * mainly for compatibility with clients like Mac OS X). 1017b032f27cSSam Leffler */ 1018b032f27cSSam Leffler if (ni->ni_authmode != IEEE80211_AUTH_AUTO && 1019b032f27cSSam Leffler ni->ni_authmode != IEEE80211_AUTH_SHARED) { 1020b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1021b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1022b032f27cSSam Leffler "bad sta auth mode %u", ni->ni_authmode); 1023b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; /* XXX maybe a unique error? */ 1024b032f27cSSam Leffler estatus = IEEE80211_STATUS_ALG; 1025b032f27cSSam Leffler goto bad; 1026b032f27cSSam Leffler } 1027b032f27cSSam Leffler 1028b032f27cSSam Leffler challenge = NULL; 1029b032f27cSSam Leffler if (frm + 1 < efrm) { 1030b032f27cSSam Leffler if ((frm[1] + 2) > (efrm - frm)) { 1031b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1032b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1033b032f27cSSam Leffler "ie %d/%d too long", 1034b032f27cSSam Leffler frm[0], (frm[1] + 2) - (efrm - frm)); 1035b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1036b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1037b032f27cSSam Leffler goto bad; 1038b032f27cSSam Leffler } 1039b032f27cSSam Leffler if (*frm == IEEE80211_ELEMID_CHALLENGE) 1040b032f27cSSam Leffler challenge = frm; 1041b032f27cSSam Leffler frm += frm[1] + 2; 1042b032f27cSSam Leffler } 1043b032f27cSSam Leffler switch (seq) { 1044b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_CHALLENGE: 1045b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_RESPONSE: 1046b032f27cSSam Leffler if (challenge == NULL) { 1047b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1048b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1049b032f27cSSam Leffler "%s", "no challenge"); 1050b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1051b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1052b032f27cSSam Leffler goto bad; 1053b032f27cSSam Leffler } 1054b032f27cSSam Leffler if (challenge[1] != IEEE80211_CHALLENGE_LEN) { 1055b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1056b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1057b032f27cSSam Leffler "bad challenge len %d", challenge[1]); 1058b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1059b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1060b032f27cSSam Leffler goto bad; 1061b032f27cSSam Leffler } 1062b032f27cSSam Leffler default: 1063b032f27cSSam Leffler break; 1064b032f27cSSam Leffler } 1065b032f27cSSam Leffler switch (seq) { 1066b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_REQUEST: 1067b032f27cSSam Leffler if (ni == vap->iv_bss) { 1068b032f27cSSam Leffler ni = ieee80211_dup_bss(vap, wh->i_addr2); 1069b032f27cSSam Leffler if (ni == NULL) { 1070b032f27cSSam Leffler /* NB: no way to return an error */ 1071b032f27cSSam Leffler return; 1072b032f27cSSam Leffler } 1073b032f27cSSam Leffler allocbs = 1; 1074b032f27cSSam Leffler } else { 1075b032f27cSSam Leffler if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0) 1076b032f27cSSam Leffler (void) ieee80211_ref_node(ni); 1077b032f27cSSam Leffler allocbs = 0; 1078b032f27cSSam Leffler } 1079b032f27cSSam Leffler /* 1080b032f27cSSam Leffler * Mark the node as referenced to reflect that it's 1081b032f27cSSam Leffler * reference count has been bumped to insure it remains 1082b032f27cSSam Leffler * after the transaction completes. 1083b032f27cSSam Leffler */ 1084b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_AREF; 10851b999d64SSam Leffler /* 10866dbbec93SAndriy Voskoboinyk * Mark the node as requiring a valid association id 10871b999d64SSam Leffler * before outbound traffic is permitted. 10881b999d64SSam Leffler */ 10891b999d64SSam Leffler ni->ni_flags |= IEEE80211_NODE_ASSOCID; 1090b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 10915463c4a4SSam Leffler ni->ni_noise = nf; 1092b032f27cSSam Leffler if (!ieee80211_alloc_challenge(ni)) { 1093b032f27cSSam Leffler /* NB: don't return error so they rexmit */ 1094b032f27cSSam Leffler return; 1095b032f27cSSam Leffler } 1096*af7d9f8eSBjoern A. Zeeb net80211_get_random_bytes(ni->ni_challenge, 1097b032f27cSSam Leffler IEEE80211_CHALLENGE_LEN); 1098b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, 1099b032f27cSSam Leffler ni, "shared key %sauth request", allocbs ? "" : "re"); 1100b032f27cSSam Leffler /* 1101b032f27cSSam Leffler * When the ACL policy is set to RADIUS we defer the 1102b032f27cSSam Leffler * authorization to a user agent. Dispatch an event, 1103b032f27cSSam Leffler * a subsequent MLME call will decide the fate of the 1104b032f27cSSam Leffler * station. If the user agent is not present then the 1105b032f27cSSam Leffler * node will be reclaimed due to inactivity. 1106b032f27cSSam Leffler */ 1107b032f27cSSam Leffler if (vap->iv_acl != NULL && 1108b032f27cSSam Leffler vap->iv_acl->iac_getpolicy(vap) == IEEE80211_MACCMD_POLICY_RADIUS) { 1109b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 1110b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_ACL, 1111b032f27cSSam Leffler ni->ni_macaddr, 1112b032f27cSSam Leffler "%s", "station authentication defered (radius acl)"); 1113b032f27cSSam Leffler ieee80211_notify_node_auth(ni); 1114b032f27cSSam Leffler return; 1115b032f27cSSam Leffler } 1116b032f27cSSam Leffler break; 1117b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_RESPONSE: 1118b032f27cSSam Leffler if (ni == vap->iv_bss) { 1119b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1120b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1121b032f27cSSam Leffler "%s", "unknown station"); 1122b032f27cSSam Leffler /* NB: don't send a response */ 1123b032f27cSSam Leffler return; 1124b032f27cSSam Leffler } 1125b032f27cSSam Leffler if (ni->ni_challenge == NULL) { 1126b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1127b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1128b032f27cSSam Leffler "%s", "no challenge recorded"); 1129b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1130b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1131b032f27cSSam Leffler goto bad; 1132b032f27cSSam Leffler } 1133b032f27cSSam Leffler if (memcmp(ni->ni_challenge, &challenge[2], 1134b032f27cSSam Leffler challenge[1]) != 0) { 1135b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1136b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1137b032f27cSSam Leffler "%s", "challenge mismatch"); 1138b032f27cSSam Leffler vap->iv_stats.is_rx_auth_fail++; 1139b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1140b032f27cSSam Leffler goto bad; 1141b032f27cSSam Leffler } 1142b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, 1143b032f27cSSam Leffler ni, "%s", "station authenticated (shared key)"); 1144b032f27cSSam Leffler ieee80211_node_authorize(ni); 1145b032f27cSSam Leffler break; 1146b032f27cSSam Leffler default: 1147b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1148b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1149b032f27cSSam Leffler "bad seq %d", seq); 1150b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1151b032f27cSSam Leffler estatus = IEEE80211_STATUS_SEQUENCE; 1152b032f27cSSam Leffler goto bad; 1153b032f27cSSam Leffler } 1154b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 1155b032f27cSSam Leffler return; 1156b032f27cSSam Leffler bad: 1157b032f27cSSam Leffler /* 1158b032f27cSSam Leffler * Send an error response; but only when operating as an AP. 1159b032f27cSSam Leffler */ 1160b032f27cSSam Leffler /* XXX hack to workaround calling convention */ 1161b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1162b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1163b032f27cSSam Leffler (seq + 1) | (estatus<<16)); 1164b032f27cSSam Leffler } 1165b032f27cSSam Leffler 1166b032f27cSSam Leffler /* 1167b032f27cSSam Leffler * Convert a WPA cipher selector OUI to an internal 1168b032f27cSSam Leffler * cipher algorithm. Where appropriate we also 1169b032f27cSSam Leffler * record any key length. 1170b032f27cSSam Leffler */ 1171b032f27cSSam Leffler static int 117295d9a127SAndriy Voskoboinyk wpa_cipher(const uint8_t *sel, uint8_t *keylen, uint8_t *cipher) 1173b032f27cSSam Leffler { 1174b032f27cSSam Leffler #define WPA_SEL(x) (((x)<<24)|WPA_OUI) 117531021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1176b032f27cSSam Leffler 1177b032f27cSSam Leffler switch (w) { 1178b032f27cSSam Leffler case WPA_SEL(WPA_CSE_NULL): 117995d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_NONE; 118095d9a127SAndriy Voskoboinyk break; 1181b032f27cSSam Leffler case WPA_SEL(WPA_CSE_WEP40): 1182b032f27cSSam Leffler if (keylen) 1183b032f27cSSam Leffler *keylen = 40 / NBBY; 118495d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 118595d9a127SAndriy Voskoboinyk break; 1186b032f27cSSam Leffler case WPA_SEL(WPA_CSE_WEP104): 1187b032f27cSSam Leffler if (keylen) 1188b032f27cSSam Leffler *keylen = 104 / NBBY; 118995d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 119095d9a127SAndriy Voskoboinyk break; 1191b032f27cSSam Leffler case WPA_SEL(WPA_CSE_TKIP): 119295d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_TKIP; 119395d9a127SAndriy Voskoboinyk break; 1194b032f27cSSam Leffler case WPA_SEL(WPA_CSE_CCMP): 119595d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_CCM; 119695d9a127SAndriy Voskoboinyk break; 119795d9a127SAndriy Voskoboinyk default: 119895d9a127SAndriy Voskoboinyk return (EINVAL); 1199b032f27cSSam Leffler } 120095d9a127SAndriy Voskoboinyk 120195d9a127SAndriy Voskoboinyk return (0); 1202b032f27cSSam Leffler #undef WPA_SEL 1203b032f27cSSam Leffler } 1204b032f27cSSam Leffler 1205b032f27cSSam Leffler /* 1206b032f27cSSam Leffler * Convert a WPA key management/authentication algorithm 1207b032f27cSSam Leffler * to an internal code. 1208b032f27cSSam Leffler */ 1209b032f27cSSam Leffler static int 1210b032f27cSSam Leffler wpa_keymgmt(const uint8_t *sel) 1211b032f27cSSam Leffler { 1212b032f27cSSam Leffler #define WPA_SEL(x) (((x)<<24)|WPA_OUI) 121331021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1214b032f27cSSam Leffler 1215b032f27cSSam Leffler switch (w) { 1216b032f27cSSam Leffler case WPA_SEL(WPA_ASE_8021X_UNSPEC): 1217b032f27cSSam Leffler return WPA_ASE_8021X_UNSPEC; 1218b032f27cSSam Leffler case WPA_SEL(WPA_ASE_8021X_PSK): 1219b032f27cSSam Leffler return WPA_ASE_8021X_PSK; 1220b032f27cSSam Leffler case WPA_SEL(WPA_ASE_NONE): 1221b032f27cSSam Leffler return WPA_ASE_NONE; 1222b032f27cSSam Leffler } 1223b032f27cSSam Leffler return 0; /* NB: so is discarded */ 1224b032f27cSSam Leffler #undef WPA_SEL 1225b032f27cSSam Leffler } 1226b032f27cSSam Leffler 1227b032f27cSSam Leffler /* 1228b032f27cSSam Leffler * Parse a WPA information element to collect parameters. 1229b032f27cSSam Leffler * Note that we do not validate security parameters; that 1230b032f27cSSam Leffler * is handled by the authenticator; the parsing done here 1231b032f27cSSam Leffler * is just for internal use in making operational decisions. 1232b032f27cSSam Leffler */ 1233b032f27cSSam Leffler static int 1234b032f27cSSam Leffler ieee80211_parse_wpa(struct ieee80211vap *vap, const uint8_t *frm, 1235b032f27cSSam Leffler struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh) 1236b032f27cSSam Leffler { 1237b032f27cSSam Leffler uint8_t len = frm[1]; 1238b032f27cSSam Leffler uint32_t w; 123995d9a127SAndriy Voskoboinyk int error, n; 1240b032f27cSSam Leffler 1241b032f27cSSam Leffler /* 1242b032f27cSSam Leffler * Check the length once for fixed parts: OUI, type, 1243b032f27cSSam Leffler * version, mcast cipher, and 2 selector counts. 1244b032f27cSSam Leffler * Other, variable-length data, must be checked separately. 1245b032f27cSSam Leffler */ 1246b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA1) == 0) { 1247b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1248b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1249b032f27cSSam Leffler wh, "WPA", "not WPA, flags 0x%x", vap->iv_flags); 1250b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1251b032f27cSSam Leffler } 1252b032f27cSSam Leffler if (len < 14) { 1253b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1254b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1255b032f27cSSam Leffler wh, "WPA", "too short, len %u", len); 1256b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1257b032f27cSSam Leffler } 1258b032f27cSSam Leffler frm += 6, len -= 4; /* NB: len is payload only */ 1259f59310a1SRui Paulo /* NB: iswpaoui already validated the OUI and type */ 126031021a2bSAndriy Voskoboinyk w = le16dec(frm); 1261b032f27cSSam Leffler if (w != WPA_VERSION) { 1262b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1263b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1264b032f27cSSam Leffler wh, "WPA", "bad version %u", w); 1265b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1266b032f27cSSam Leffler } 1267b032f27cSSam Leffler frm += 2, len -= 2; 1268b032f27cSSam Leffler 1269b032f27cSSam Leffler memset(rsn, 0, sizeof(*rsn)); 1270b032f27cSSam Leffler 1271b032f27cSSam Leffler /* multicast/group cipher */ 127295d9a127SAndriy Voskoboinyk error = wpa_cipher(frm, &rsn->rsn_mcastkeylen, &rsn->rsn_mcastcipher); 127395d9a127SAndriy Voskoboinyk if (error != 0) { 127495d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 127595d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 127695d9a127SAndriy Voskoboinyk wh, "WPA", "unknown mcast cipher suite %08X", 127795d9a127SAndriy Voskoboinyk le32dec(frm)); 127895d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 127995d9a127SAndriy Voskoboinyk } 1280b032f27cSSam Leffler frm += 4, len -= 4; 1281b032f27cSSam Leffler 1282b032f27cSSam Leffler /* unicast ciphers */ 128331021a2bSAndriy Voskoboinyk n = le16dec(frm); 1284b032f27cSSam Leffler frm += 2, len -= 2; 1285b032f27cSSam Leffler if (len < n*4+2) { 1286b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1287b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1288b032f27cSSam Leffler wh, "WPA", "ucast cipher data too short; len %u, n %u", 1289b032f27cSSam Leffler len, n); 1290b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1291b032f27cSSam Leffler } 1292b032f27cSSam Leffler w = 0; 1293b032f27cSSam Leffler for (; n > 0; n--) { 129495d9a127SAndriy Voskoboinyk uint8_t cipher; 129595d9a127SAndriy Voskoboinyk 129695d9a127SAndriy Voskoboinyk error = wpa_cipher(frm, &rsn->rsn_ucastkeylen, &cipher); 129795d9a127SAndriy Voskoboinyk if (error == 0) 129895d9a127SAndriy Voskoboinyk w |= 1 << cipher; 129995d9a127SAndriy Voskoboinyk 1300b032f27cSSam Leffler frm += 4, len -= 4; 1301b032f27cSSam Leffler } 130295d9a127SAndriy Voskoboinyk if (w == 0) { 130395d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 130495d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 130595d9a127SAndriy Voskoboinyk wh, "WPA", "no usable pairwise cipher suite found (w=%d)", 130695d9a127SAndriy Voskoboinyk w); 130795d9a127SAndriy Voskoboinyk return IEEE80211_REASON_PAIRWISE_CIPHER_INVALID; 130895d9a127SAndriy Voskoboinyk } 130995d9a127SAndriy Voskoboinyk /* XXX other? */ 131095d9a127SAndriy Voskoboinyk if (w & (1 << IEEE80211_CIPHER_AES_CCM)) 1311b032f27cSSam Leffler rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM; 131295d9a127SAndriy Voskoboinyk else 131395d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP; 1314b032f27cSSam Leffler 1315b032f27cSSam Leffler /* key management algorithms */ 131631021a2bSAndriy Voskoboinyk n = le16dec(frm); 1317b032f27cSSam Leffler frm += 2, len -= 2; 1318b032f27cSSam Leffler if (len < n*4) { 1319b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1320b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1321b032f27cSSam Leffler wh, "WPA", "key mgmt alg data too short; len %u, n %u", 1322b032f27cSSam Leffler len, n); 1323b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1324b032f27cSSam Leffler } 1325b032f27cSSam Leffler w = 0; 1326b032f27cSSam Leffler for (; n > 0; n--) { 1327b032f27cSSam Leffler w |= wpa_keymgmt(frm); 1328b032f27cSSam Leffler frm += 4, len -= 4; 1329b032f27cSSam Leffler } 1330b032f27cSSam Leffler if (w & WPA_ASE_8021X_UNSPEC) 1331b032f27cSSam Leffler rsn->rsn_keymgmt = WPA_ASE_8021X_UNSPEC; 1332b032f27cSSam Leffler else 1333b032f27cSSam Leffler rsn->rsn_keymgmt = WPA_ASE_8021X_PSK; 1334b032f27cSSam Leffler 1335b032f27cSSam Leffler if (len > 2) /* optional capabilities */ 133631021a2bSAndriy Voskoboinyk rsn->rsn_caps = le16dec(frm); 1337b032f27cSSam Leffler 1338b032f27cSSam Leffler return 0; 1339b032f27cSSam Leffler } 1340b032f27cSSam Leffler 1341b032f27cSSam Leffler /* 1342b032f27cSSam Leffler * Convert an RSN cipher selector OUI to an internal 1343b032f27cSSam Leffler * cipher algorithm. Where appropriate we also 1344b032f27cSSam Leffler * record any key length. 1345b032f27cSSam Leffler */ 1346b032f27cSSam Leffler static int 134795d9a127SAndriy Voskoboinyk rsn_cipher(const uint8_t *sel, uint8_t *keylen, uint8_t *cipher) 1348b032f27cSSam Leffler { 1349b032f27cSSam Leffler #define RSN_SEL(x) (((x)<<24)|RSN_OUI) 135031021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1351b032f27cSSam Leffler 1352b032f27cSSam Leffler switch (w) { 1353b032f27cSSam Leffler case RSN_SEL(RSN_CSE_NULL): 135495d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_NONE; 135595d9a127SAndriy Voskoboinyk break; 1356b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WEP40): 1357b032f27cSSam Leffler if (keylen) 1358b032f27cSSam Leffler *keylen = 40 / NBBY; 135995d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 136095d9a127SAndriy Voskoboinyk break; 1361b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WEP104): 1362b032f27cSSam Leffler if (keylen) 1363b032f27cSSam Leffler *keylen = 104 / NBBY; 136495d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 136595d9a127SAndriy Voskoboinyk break; 1366b032f27cSSam Leffler case RSN_SEL(RSN_CSE_TKIP): 136795d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_TKIP; 136895d9a127SAndriy Voskoboinyk break; 1369b032f27cSSam Leffler case RSN_SEL(RSN_CSE_CCMP): 137095d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_CCM; 137195d9a127SAndriy Voskoboinyk break; 1372b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WRAP): 137395d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_OCB; 137495d9a127SAndriy Voskoboinyk break; 137595d9a127SAndriy Voskoboinyk default: 137695d9a127SAndriy Voskoboinyk return (EINVAL); 1377b032f27cSSam Leffler } 137895d9a127SAndriy Voskoboinyk 137995d9a127SAndriy Voskoboinyk return (0); 1380b032f27cSSam Leffler #undef WPA_SEL 1381b032f27cSSam Leffler } 1382b032f27cSSam Leffler 1383b032f27cSSam Leffler /* 1384b032f27cSSam Leffler * Convert an RSN key management/authentication algorithm 1385b032f27cSSam Leffler * to an internal code. 1386b032f27cSSam Leffler */ 1387b032f27cSSam Leffler static int 1388b032f27cSSam Leffler rsn_keymgmt(const uint8_t *sel) 1389b032f27cSSam Leffler { 1390b032f27cSSam Leffler #define RSN_SEL(x) (((x)<<24)|RSN_OUI) 139131021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1392b032f27cSSam Leffler 1393b032f27cSSam Leffler switch (w) { 1394b032f27cSSam Leffler case RSN_SEL(RSN_ASE_8021X_UNSPEC): 1395b032f27cSSam Leffler return RSN_ASE_8021X_UNSPEC; 1396b032f27cSSam Leffler case RSN_SEL(RSN_ASE_8021X_PSK): 1397b032f27cSSam Leffler return RSN_ASE_8021X_PSK; 1398b032f27cSSam Leffler case RSN_SEL(RSN_ASE_NONE): 1399b032f27cSSam Leffler return RSN_ASE_NONE; 1400b032f27cSSam Leffler } 1401b032f27cSSam Leffler return 0; /* NB: so is discarded */ 1402b032f27cSSam Leffler #undef RSN_SEL 1403b032f27cSSam Leffler } 1404b032f27cSSam Leffler 1405b032f27cSSam Leffler /* 1406b032f27cSSam Leffler * Parse a WPA/RSN information element to collect parameters 1407b032f27cSSam Leffler * and validate the parameters against what has been 1408b032f27cSSam Leffler * configured for the system. 1409b032f27cSSam Leffler */ 1410b032f27cSSam Leffler static int 1411b032f27cSSam Leffler ieee80211_parse_rsn(struct ieee80211vap *vap, const uint8_t *frm, 1412b032f27cSSam Leffler struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh) 1413b032f27cSSam Leffler { 1414b032f27cSSam Leffler uint8_t len = frm[1]; 1415b032f27cSSam Leffler uint32_t w; 141695d9a127SAndriy Voskoboinyk int error, n; 1417b032f27cSSam Leffler 1418b032f27cSSam Leffler /* 1419b032f27cSSam Leffler * Check the length once for fixed parts: 1420b032f27cSSam Leffler * version, mcast cipher, and 2 selector counts. 1421b032f27cSSam Leffler * Other, variable-length data, must be checked separately. 1422b032f27cSSam Leffler */ 1423b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA2) == 0) { 1424b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1425b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1426b032f27cSSam Leffler wh, "WPA", "not RSN, flags 0x%x", vap->iv_flags); 1427b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1428b032f27cSSam Leffler } 142995d9a127SAndriy Voskoboinyk /* XXX may be shorter */ 1430b032f27cSSam Leffler if (len < 10) { 1431b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1432b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1433b032f27cSSam Leffler wh, "RSN", "too short, len %u", len); 1434b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1435b032f27cSSam Leffler } 1436b032f27cSSam Leffler frm += 2; 143731021a2bSAndriy Voskoboinyk w = le16dec(frm); 1438b032f27cSSam Leffler if (w != RSN_VERSION) { 1439b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1440b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1441b032f27cSSam Leffler wh, "RSN", "bad version %u", w); 144295d9a127SAndriy Voskoboinyk return IEEE80211_REASON_UNSUPP_RSN_IE_VERSION; 1443b032f27cSSam Leffler } 1444b032f27cSSam Leffler frm += 2, len -= 2; 1445b032f27cSSam Leffler 1446b032f27cSSam Leffler memset(rsn, 0, sizeof(*rsn)); 1447b032f27cSSam Leffler 1448b032f27cSSam Leffler /* multicast/group cipher */ 144995d9a127SAndriy Voskoboinyk error = rsn_cipher(frm, &rsn->rsn_mcastkeylen, &rsn->rsn_mcastcipher); 145095d9a127SAndriy Voskoboinyk if (error != 0) { 145195d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 145295d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 145395d9a127SAndriy Voskoboinyk wh, "RSN", "unknown mcast cipher suite %08X", 145495d9a127SAndriy Voskoboinyk le32dec(frm)); 145595d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 145695d9a127SAndriy Voskoboinyk } 145795d9a127SAndriy Voskoboinyk if (rsn->rsn_mcastcipher == IEEE80211_CIPHER_NONE) { 145895d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 145995d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 146095d9a127SAndriy Voskoboinyk wh, "RSN", "invalid mcast cipher suite %d", 146195d9a127SAndriy Voskoboinyk rsn->rsn_mcastcipher); 146295d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 146395d9a127SAndriy Voskoboinyk } 1464b032f27cSSam Leffler frm += 4, len -= 4; 1465b032f27cSSam Leffler 1466b032f27cSSam Leffler /* unicast ciphers */ 146731021a2bSAndriy Voskoboinyk n = le16dec(frm); 1468b032f27cSSam Leffler frm += 2, len -= 2; 1469b032f27cSSam Leffler if (len < n*4+2) { 1470b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1471b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1472b032f27cSSam Leffler wh, "RSN", "ucast cipher data too short; len %u, n %u", 1473b032f27cSSam Leffler len, n); 1474b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1475b032f27cSSam Leffler } 1476b032f27cSSam Leffler w = 0; 147795d9a127SAndriy Voskoboinyk 1478b032f27cSSam Leffler for (; n > 0; n--) { 147995d9a127SAndriy Voskoboinyk uint8_t cipher; 148095d9a127SAndriy Voskoboinyk 148195d9a127SAndriy Voskoboinyk error = rsn_cipher(frm, &rsn->rsn_ucastkeylen, &cipher); 148295d9a127SAndriy Voskoboinyk if (error == 0) 148395d9a127SAndriy Voskoboinyk w |= 1 << cipher; 148495d9a127SAndriy Voskoboinyk 1485b032f27cSSam Leffler frm += 4, len -= 4; 1486b032f27cSSam Leffler } 148795d9a127SAndriy Voskoboinyk if (w & (1 << IEEE80211_CIPHER_AES_CCM)) 1488b032f27cSSam Leffler rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM; 148995d9a127SAndriy Voskoboinyk else if (w & (1 << IEEE80211_CIPHER_AES_OCB)) 149095d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_OCB; 149195d9a127SAndriy Voskoboinyk else if (w & (1 << IEEE80211_CIPHER_TKIP)) 149295d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP; 149395d9a127SAndriy Voskoboinyk else if ((w & (1 << IEEE80211_CIPHER_NONE)) && 149495d9a127SAndriy Voskoboinyk (rsn->rsn_mcastcipher == IEEE80211_CIPHER_WEP || 149595d9a127SAndriy Voskoboinyk rsn->rsn_mcastcipher == IEEE80211_CIPHER_TKIP)) 149695d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_NONE; 149795d9a127SAndriy Voskoboinyk else { 149895d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 149995d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 150095d9a127SAndriy Voskoboinyk wh, "RSN", "no usable pairwise cipher suite found (w=%d)", 150195d9a127SAndriy Voskoboinyk w); 150295d9a127SAndriy Voskoboinyk return IEEE80211_REASON_PAIRWISE_CIPHER_INVALID; 150395d9a127SAndriy Voskoboinyk } 1504b032f27cSSam Leffler 1505b032f27cSSam Leffler /* key management algorithms */ 150631021a2bSAndriy Voskoboinyk n = le16dec(frm); 1507b032f27cSSam Leffler frm += 2, len -= 2; 1508b032f27cSSam Leffler if (len < n*4) { 1509b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1510b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1511b032f27cSSam Leffler wh, "RSN", "key mgmt alg data too short; len %u, n %u", 1512b032f27cSSam Leffler len, n); 1513b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1514b032f27cSSam Leffler } 1515b032f27cSSam Leffler w = 0; 1516b032f27cSSam Leffler for (; n > 0; n--) { 1517b032f27cSSam Leffler w |= rsn_keymgmt(frm); 1518b032f27cSSam Leffler frm += 4, len -= 4; 1519b032f27cSSam Leffler } 1520b032f27cSSam Leffler if (w & RSN_ASE_8021X_UNSPEC) 1521b032f27cSSam Leffler rsn->rsn_keymgmt = RSN_ASE_8021X_UNSPEC; 1522b032f27cSSam Leffler else 1523b032f27cSSam Leffler rsn->rsn_keymgmt = RSN_ASE_8021X_PSK; 1524b032f27cSSam Leffler 1525b032f27cSSam Leffler /* optional RSN capabilities */ 1526b032f27cSSam Leffler if (len > 2) 152731021a2bSAndriy Voskoboinyk rsn->rsn_caps = le16dec(frm); 1528b032f27cSSam Leffler /* XXXPMKID */ 1529b032f27cSSam Leffler 1530b032f27cSSam Leffler return 0; 1531b032f27cSSam Leffler } 1532b032f27cSSam Leffler 1533b032f27cSSam Leffler /* 1534a4641f4eSPedro F. Giffuni * WPA/802.11i association request processing. 1535b032f27cSSam Leffler */ 1536b032f27cSSam Leffler static int 1537b032f27cSSam Leffler wpa_assocreq(struct ieee80211_node *ni, struct ieee80211_rsnparms *rsnparms, 1538b032f27cSSam Leffler const struct ieee80211_frame *wh, const uint8_t *wpa, 1539b032f27cSSam Leffler const uint8_t *rsn, uint16_t capinfo) 1540b032f27cSSam Leffler { 1541b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1542b032f27cSSam Leffler uint8_t reason; 1543b032f27cSSam Leffler int badwparsn; 1544b032f27cSSam Leffler 1545b032f27cSSam Leffler ni->ni_flags &= ~(IEEE80211_NODE_WPS|IEEE80211_NODE_TSN); 1546b032f27cSSam Leffler if (wpa == NULL && rsn == NULL) { 1547b032f27cSSam Leffler if (vap->iv_flags_ext & IEEE80211_FEXT_WPS) { 1548b032f27cSSam Leffler /* 1549b032f27cSSam Leffler * W-Fi Protected Setup (WPS) permits 1550b032f27cSSam Leffler * clients to associate and pass EAPOL frames 1551b032f27cSSam Leffler * to establish initial credentials. 1552b032f27cSSam Leffler */ 1553b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_WPS; 1554b032f27cSSam Leffler return 1; 1555b032f27cSSam Leffler } 1556b032f27cSSam Leffler if ((vap->iv_flags_ext & IEEE80211_FEXT_TSN) && 1557b032f27cSSam Leffler (capinfo & IEEE80211_CAPINFO_PRIVACY)) { 1558b032f27cSSam Leffler /* 1559b032f27cSSam Leffler * Transitional Security Network. Permits clients 1560b032f27cSSam Leffler * to associate and use WEP while WPA is configured. 1561b032f27cSSam Leffler */ 1562b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_TSN; 1563b032f27cSSam Leffler return 1; 1564b032f27cSSam Leffler } 1565b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, 1566b032f27cSSam Leffler wh, NULL, "%s", "no WPA/RSN IE in association request"); 1567b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1568b032f27cSSam Leffler reason = IEEE80211_REASON_IE_INVALID; 1569b032f27cSSam Leffler goto bad; 1570b032f27cSSam Leffler } 1571b032f27cSSam Leffler /* assert right association security credentials */ 1572b032f27cSSam Leffler badwparsn = 0; /* NB: to silence compiler */ 1573b032f27cSSam Leffler switch (vap->iv_flags & IEEE80211_F_WPA) { 1574b032f27cSSam Leffler case IEEE80211_F_WPA1: 1575b032f27cSSam Leffler badwparsn = (wpa == NULL); 1576b032f27cSSam Leffler break; 1577b032f27cSSam Leffler case IEEE80211_F_WPA2: 1578b032f27cSSam Leffler badwparsn = (rsn == NULL); 1579b032f27cSSam Leffler break; 1580b032f27cSSam Leffler case IEEE80211_F_WPA1|IEEE80211_F_WPA2: 1581b032f27cSSam Leffler badwparsn = (wpa == NULL && rsn == NULL); 1582b032f27cSSam Leffler break; 1583b032f27cSSam Leffler } 1584b032f27cSSam Leffler if (badwparsn) { 1585b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, 1586b032f27cSSam Leffler wh, NULL, 1587b032f27cSSam Leffler "%s", "missing WPA/RSN IE in association request"); 1588b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1589b032f27cSSam Leffler reason = IEEE80211_REASON_IE_INVALID; 1590b032f27cSSam Leffler goto bad; 1591b032f27cSSam Leffler } 1592b032f27cSSam Leffler /* 1593b032f27cSSam Leffler * Parse WPA/RSN information element. 1594b032f27cSSam Leffler */ 1595b032f27cSSam Leffler if (wpa != NULL) 1596b032f27cSSam Leffler reason = ieee80211_parse_wpa(vap, wpa, rsnparms, wh); 1597b032f27cSSam Leffler else 1598b032f27cSSam Leffler reason = ieee80211_parse_rsn(vap, rsn, rsnparms, wh); 1599b032f27cSSam Leffler if (reason != 0) { 160095d9a127SAndriy Voskoboinyk /* XXX wpa->rsn fallback? */ 1601b032f27cSSam Leffler /* XXX distinguish WPA/RSN? */ 1602b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1603b032f27cSSam Leffler goto bad; 1604b032f27cSSam Leffler } 1605b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, ni, 1606b032f27cSSam Leffler "%s ie: mc %u/%u uc %u/%u key %u caps 0x%x", 1607b032f27cSSam Leffler wpa != NULL ? "WPA" : "RSN", 1608b032f27cSSam Leffler rsnparms->rsn_mcastcipher, rsnparms->rsn_mcastkeylen, 1609b032f27cSSam Leffler rsnparms->rsn_ucastcipher, rsnparms->rsn_ucastkeylen, 1610b032f27cSSam Leffler rsnparms->rsn_keymgmt, rsnparms->rsn_caps); 1611b032f27cSSam Leffler 1612b032f27cSSam Leffler return 1; 1613b032f27cSSam Leffler bad: 1614b032f27cSSam Leffler ieee80211_node_deauth(ni, reason); 1615b032f27cSSam Leffler return 0; 1616b032f27cSSam Leffler } 1617b032f27cSSam Leffler 1618b032f27cSSam Leffler /* XXX find a better place for definition */ 1619b032f27cSSam Leffler struct l2_update_frame { 1620b032f27cSSam Leffler struct ether_header eh; 1621b032f27cSSam Leffler uint8_t dsap; 1622b032f27cSSam Leffler uint8_t ssap; 1623b032f27cSSam Leffler uint8_t control; 1624b032f27cSSam Leffler uint8_t xid[3]; 1625b032f27cSSam Leffler } __packed; 1626b032f27cSSam Leffler 1627b032f27cSSam Leffler /* 1628b032f27cSSam Leffler * Deliver a TGf L2UF frame on behalf of a station. 1629b032f27cSSam Leffler * This primes any bridge when the station is roaming 1630b032f27cSSam Leffler * between ap's on the same wired network. 1631b032f27cSSam Leffler */ 1632b032f27cSSam Leffler static void 1633b032f27cSSam Leffler ieee80211_deliver_l2uf(struct ieee80211_node *ni) 1634b032f27cSSam Leffler { 1635b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1636b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 1637b032f27cSSam Leffler struct mbuf *m; 1638b032f27cSSam Leffler struct l2_update_frame *l2uf; 1639b032f27cSSam Leffler struct ether_header *eh; 1640b032f27cSSam Leffler 1641b032f27cSSam Leffler m = m_gethdr(M_NOWAIT, MT_DATA); 1642b032f27cSSam Leffler if (m == NULL) { 1643b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_ASSOC, ni, 1644b032f27cSSam Leffler "%s", "no mbuf for l2uf frame"); 1645b032f27cSSam Leffler vap->iv_stats.is_rx_nobuf++; /* XXX not right */ 1646b032f27cSSam Leffler return; 1647b032f27cSSam Leffler } 1648b032f27cSSam Leffler l2uf = mtod(m, struct l2_update_frame *); 1649b032f27cSSam Leffler eh = &l2uf->eh; 1650b032f27cSSam Leffler /* dst: Broadcast address */ 1651b032f27cSSam Leffler IEEE80211_ADDR_COPY(eh->ether_dhost, ifp->if_broadcastaddr); 1652b032f27cSSam Leffler /* src: associated STA */ 1653b032f27cSSam Leffler IEEE80211_ADDR_COPY(eh->ether_shost, ni->ni_macaddr); 1654b032f27cSSam Leffler eh->ether_type = htons(sizeof(*l2uf) - sizeof(*eh)); 1655b032f27cSSam Leffler 1656b032f27cSSam Leffler l2uf->dsap = 0; 1657b032f27cSSam Leffler l2uf->ssap = 0; 1658b032f27cSSam Leffler l2uf->control = 0xf5; 1659b032f27cSSam Leffler l2uf->xid[0] = 0x81; 1660b032f27cSSam Leffler l2uf->xid[1] = 0x80; 1661b032f27cSSam Leffler l2uf->xid[2] = 0x00; 1662b032f27cSSam Leffler 1663b032f27cSSam Leffler m->m_pkthdr.len = m->m_len = sizeof(*l2uf); 1664b032f27cSSam Leffler hostap_deliver_data(vap, ni, m); 1665b032f27cSSam Leffler } 1666b032f27cSSam Leffler 1667b032f27cSSam Leffler static void 1668b032f27cSSam Leffler ratesetmismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1669b032f27cSSam Leffler int reassoc, int resp, const char *tag, int rate) 1670b032f27cSSam Leffler { 1671b032f27cSSam Leffler IEEE80211_NOTE_MAC(ni->ni_vap, IEEE80211_MSG_ANY, wh->i_addr2, 1672b032f27cSSam Leffler "deny %s request, %s rate set mismatch, rate/MCS %d", 1673b032f27cSSam Leffler reassoc ? "reassoc" : "assoc", tag, rate & IEEE80211_RATE_VAL); 1674b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_BASIC_RATE); 1675b032f27cSSam Leffler ieee80211_node_leave(ni); 1676b032f27cSSam Leffler } 1677b032f27cSSam Leffler 1678b032f27cSSam Leffler static void 1679b032f27cSSam Leffler capinfomismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1680b032f27cSSam Leffler int reassoc, int resp, const char *tag, int capinfo) 1681b032f27cSSam Leffler { 1682b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1683b032f27cSSam Leffler 1684b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ANY, wh->i_addr2, 1685b032f27cSSam Leffler "deny %s request, %s mismatch 0x%x", 1686b032f27cSSam Leffler reassoc ? "reassoc" : "assoc", tag, capinfo); 1687b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_CAPINFO); 1688b032f27cSSam Leffler ieee80211_node_leave(ni); 1689b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_capmismatch++; 1690b032f27cSSam Leffler } 1691b032f27cSSam Leffler 1692b032f27cSSam Leffler static void 1693b032f27cSSam Leffler htcapmismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1694b032f27cSSam Leffler int reassoc, int resp) 1695b032f27cSSam Leffler { 1696b032f27cSSam Leffler IEEE80211_NOTE_MAC(ni->ni_vap, IEEE80211_MSG_ANY, wh->i_addr2, 1697b032f27cSSam Leffler "deny %s request, %s missing HT ie", reassoc ? "reassoc" : "assoc"); 1698b032f27cSSam Leffler /* XXX no better code */ 1699b8ee2a22SSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_MISSING_HT_CAPS); 1700b032f27cSSam Leffler ieee80211_node_leave(ni); 1701b032f27cSSam Leffler } 1702b032f27cSSam Leffler 1703b032f27cSSam Leffler static void 1704b032f27cSSam Leffler authalgreject(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1705b032f27cSSam Leffler int algo, int seq, int status) 1706b032f27cSSam Leffler { 1707b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1708b032f27cSSam Leffler 1709b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1710b032f27cSSam Leffler wh, NULL, "unsupported alg %d", algo); 1711b032f27cSSam Leffler vap->iv_stats.is_rx_auth_unsupported++; 1712b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, IEEE80211_FC0_SUBTYPE_AUTH, 1713b032f27cSSam Leffler seq | (status << 16)); 1714b032f27cSSam Leffler } 1715b032f27cSSam Leffler 1716b032f27cSSam Leffler static __inline int 1717b032f27cSSam Leffler ishtmixed(const uint8_t *ie) 1718b032f27cSSam Leffler { 1719b032f27cSSam Leffler const struct ieee80211_ie_htinfo *ht = 1720b032f27cSSam Leffler (const struct ieee80211_ie_htinfo *) ie; 1721b032f27cSSam Leffler return (ht->hi_byte2 & IEEE80211_HTINFO_OPMODE) == 1722b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_MIXED; 1723b032f27cSSam Leffler } 1724b032f27cSSam Leffler 1725b032f27cSSam Leffler static int 1726b032f27cSSam Leffler is11bclient(const uint8_t *rates, const uint8_t *xrates) 1727b032f27cSSam Leffler { 1728b032f27cSSam Leffler static const uint32_t brates = (1<<2*1)|(1<<2*2)|(1<<11)|(1<<2*11); 1729b032f27cSSam Leffler int i; 1730b032f27cSSam Leffler 1731b032f27cSSam Leffler /* NB: the 11b clients we care about will not have xrates */ 1732b032f27cSSam Leffler if (xrates != NULL || rates == NULL) 1733b032f27cSSam Leffler return 0; 1734b032f27cSSam Leffler for (i = 0; i < rates[1]; i++) { 1735b032f27cSSam Leffler int r = rates[2+i] & IEEE80211_RATE_VAL; 1736b032f27cSSam Leffler if (r > 2*11 || ((1<<r) & brates) == 0) 1737b032f27cSSam Leffler return 0; 1738b032f27cSSam Leffler } 1739b032f27cSSam Leffler return 1; 1740b032f27cSSam Leffler } 1741b032f27cSSam Leffler 1742b032f27cSSam Leffler static void 1743b032f27cSSam Leffler hostap_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m0, 1744c79f192cSAdrian Chadd int subtype, const struct ieee80211_rx_stats *rxs, int rssi, int nf) 1745b032f27cSSam Leffler { 1746b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1747b032f27cSSam Leffler struct ieee80211com *ic = ni->ni_ic; 1748b032f27cSSam Leffler struct ieee80211_frame *wh; 1749b032f27cSSam Leffler uint8_t *frm, *efrm, *sfrm; 1750b032f27cSSam Leffler uint8_t *ssid, *rates, *xrates, *wpa, *rsn, *wme, *ath, *htcap; 175151172f62SAdrian Chadd uint8_t *vhtcap, *vhtinfo; 1752b032f27cSSam Leffler int reassoc, resp; 1753b032f27cSSam Leffler uint8_t rate; 1754b032f27cSSam Leffler 1755b032f27cSSam Leffler wh = mtod(m0, struct ieee80211_frame *); 1756b032f27cSSam Leffler frm = (uint8_t *)&wh[1]; 1757b032f27cSSam Leffler efrm = mtod(m0, uint8_t *) + m0->m_len; 1758b032f27cSSam Leffler switch (subtype) { 1759b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_RESP: 1760b032f27cSSam Leffler /* 1761b032f27cSSam Leffler * We process beacon/probe response frames when scanning; 1762b032f27cSSam Leffler * otherwise we check beacon frames for overlapping non-ERP 1763b032f27cSSam Leffler * BSS in 11g and/or overlapping legacy BSS when in HT. 1764b032f27cSSam Leffler */ 17654ba33fd1SAndriy Voskoboinyk if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) { 1766b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1767b032f27cSSam Leffler return; 1768b032f27cSSam Leffler } 17694ba33fd1SAndriy Voskoboinyk /* FALLTHROUGH */ 17704ba33fd1SAndriy Voskoboinyk case IEEE80211_FC0_SUBTYPE_BEACON: { 17714ba33fd1SAndriy Voskoboinyk struct ieee80211_scanparams scan; 17724ba33fd1SAndriy Voskoboinyk 1773b032f27cSSam Leffler /* NB: accept off-channel frames */ 1774c79f192cSAdrian Chadd /* XXX TODO: use rxstatus to determine off-channel details */ 1775c79f192cSAdrian Chadd if (ieee80211_parse_beacon(ni, m0, ic->ic_curchan, &scan) &~ IEEE80211_BPARSE_OFFCHAN) 1776b032f27cSSam Leffler return; 1777b032f27cSSam Leffler /* 1778b032f27cSSam Leffler * Count frame now that we know it's to be processed. 1779b032f27cSSam Leffler */ 1780b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_BEACON) { 1781b032f27cSSam Leffler vap->iv_stats.is_rx_beacon++; /* XXX remove */ 1782b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_beacons); 1783b032f27cSSam Leffler } else 1784b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_proberesp); 1785b032f27cSSam Leffler /* 1786b032f27cSSam Leffler * If scanning, just pass information to the scan module. 1787b032f27cSSam Leffler */ 1788b032f27cSSam Leffler if (ic->ic_flags & IEEE80211_F_SCAN) { 1789b032f27cSSam Leffler if (scan.status == 0 && /* NB: on channel */ 1790b032f27cSSam Leffler (ic->ic_flags_ext & IEEE80211_FEXT_PROBECHAN)) { 1791b032f27cSSam Leffler /* 1792b032f27cSSam Leffler * Actively scanning a channel marked passive; 1793b032f27cSSam Leffler * send a probe request now that we know there 1794b032f27cSSam Leffler * is 802.11 traffic present. 1795b032f27cSSam Leffler * 1796b032f27cSSam Leffler * XXX check if the beacon we recv'd gives 1797b032f27cSSam Leffler * us what we need and suppress the probe req 1798b032f27cSSam Leffler */ 1799b032f27cSSam Leffler ieee80211_probe_curchan(vap, 1); 1800b032f27cSSam Leffler ic->ic_flags_ext &= ~IEEE80211_FEXT_PROBECHAN; 1801b032f27cSSam Leffler } 18022808a02bSAdrian Chadd ieee80211_add_scan(vap, ic->ic_curchan, &scan, wh, 18032808a02bSAdrian Chadd subtype, rssi, nf); 1804b032f27cSSam Leffler return; 1805b032f27cSSam Leffler } 1806b032f27cSSam Leffler /* 1807b032f27cSSam Leffler * Check beacon for overlapping bss w/ non ERP stations. 1808b032f27cSSam Leffler * If we detect one and protection is configured but not 1809b032f27cSSam Leffler * enabled, enable it and start a timer that'll bring us 1810b032f27cSSam Leffler * out if we stop seeing the bss. 1811b032f27cSSam Leffler */ 1812b032f27cSSam Leffler if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan) && 1813b032f27cSSam Leffler scan.status == 0 && /* NB: on-channel */ 1814b032f27cSSam Leffler ((scan.erp & 0x100) == 0 || /* NB: no ERP, 11b sta*/ 1815b032f27cSSam Leffler (scan.erp & IEEE80211_ERP_NON_ERP_PRESENT))) { 1816f1481c8dSAdrian Chadd vap->iv_lastnonerp = ticks; 1817f1481c8dSAdrian Chadd vap->iv_flags_ext |= IEEE80211_FEXT_NONERP_PR; 1818f1481c8dSAdrian Chadd /* 1819f1481c8dSAdrian Chadd * XXX TODO: this may need to check all VAPs? 1820f1481c8dSAdrian Chadd */ 1821f1481c8dSAdrian Chadd if (vap->iv_protmode != IEEE80211_PROT_NONE && 1822f1481c8dSAdrian Chadd (vap->iv_flags & IEEE80211_F_USEPROT) == 0) { 1823b032f27cSSam Leffler IEEE80211_NOTE_FRAME(vap, 1824b032f27cSSam Leffler IEEE80211_MSG_ASSOC, wh, 1825b032f27cSSam Leffler "non-ERP present on channel %d " 1826b032f27cSSam Leffler "(saw erp 0x%x from channel %d), " 1827b032f27cSSam Leffler "enable use of protection", 1828b032f27cSSam Leffler ic->ic_curchan->ic_ieee, 1829b032f27cSSam Leffler scan.erp, scan.chan); 1830f1481c8dSAdrian Chadd vap->iv_flags |= IEEE80211_F_USEPROT; 1831f1481c8dSAdrian Chadd ieee80211_vap_update_erp_protmode(vap); 1832b032f27cSSam Leffler } 1833b032f27cSSam Leffler } 1834b032f27cSSam Leffler /* 1835b032f27cSSam Leffler * Check beacon for non-HT station on HT channel 1836b032f27cSSam Leffler * and update HT BSS occupancy as appropriate. 1837b032f27cSSam Leffler */ 1838b032f27cSSam Leffler if (IEEE80211_IS_CHAN_HT(ic->ic_curchan)) { 1839b032f27cSSam Leffler if (scan.status & IEEE80211_BPARSE_OFFCHAN) { 1840b032f27cSSam Leffler /* 1841b032f27cSSam Leffler * Off control channel; only check frames 1842b032f27cSSam Leffler * that come in the extension channel when 1843b032f27cSSam Leffler * operating w/ HT40. 1844b032f27cSSam Leffler */ 1845b032f27cSSam Leffler if (!IEEE80211_IS_CHAN_HT40(ic->ic_curchan)) 1846b032f27cSSam Leffler break; 1847b032f27cSSam Leffler if (scan.chan != ic->ic_curchan->ic_extieee) 1848b032f27cSSam Leffler break; 1849b032f27cSSam Leffler } 1850b032f27cSSam Leffler if (scan.htinfo == NULL) { 1851f1481c8dSAdrian Chadd ieee80211_htprot_update(vap, 1852b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_PROTOPT | 1853b032f27cSSam Leffler IEEE80211_HTINFO_NONHT_PRESENT); 1854b032f27cSSam Leffler } else if (ishtmixed(scan.htinfo)) { 1855b032f27cSSam Leffler /* XXX? take NONHT_PRESENT from beacon? */ 1856f1481c8dSAdrian Chadd ieee80211_htprot_update(vap, 1857b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_MIXED | 1858b032f27cSSam Leffler IEEE80211_HTINFO_NONHT_PRESENT); 1859b032f27cSSam Leffler } 1860b032f27cSSam Leffler } 1861b032f27cSSam Leffler break; 1862b032f27cSSam Leffler } 1863b032f27cSSam Leffler 1864b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 1865b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 1866b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1867b032f27cSSam Leffler return; 1868b032f27cSSam Leffler } 1869b032f27cSSam Leffler /* 1870957458a8SAdrian Chadd * Consult the ACL policy module if setup. 1871957458a8SAdrian Chadd */ 18725a8801b0SBernhard Schmidt if (vap->iv_acl != NULL && !vap->iv_acl->iac_check(vap, wh)) { 1873957458a8SAdrian Chadd IEEE80211_DISCARD(vap, IEEE80211_MSG_ACL, 1874957458a8SAdrian Chadd wh, NULL, "%s", "disallowed by ACL"); 1875957458a8SAdrian Chadd vap->iv_stats.is_rx_acl++; 1876957458a8SAdrian Chadd return; 1877957458a8SAdrian Chadd } 1878957458a8SAdrian Chadd /* 1879b032f27cSSam Leffler * prreq frame format 1880b032f27cSSam Leffler * [tlv] ssid 1881b032f27cSSam Leffler * [tlv] supported rates 1882b032f27cSSam Leffler * [tlv] extended supported rates 1883b032f27cSSam Leffler */ 1884b032f27cSSam Leffler ssid = rates = xrates = NULL; 1885b032f27cSSam Leffler while (efrm - frm > 1) { 1886b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, frm[1] + 2, return); 1887b032f27cSSam Leffler switch (*frm) { 1888b032f27cSSam Leffler case IEEE80211_ELEMID_SSID: 1889b032f27cSSam Leffler ssid = frm; 1890b032f27cSSam Leffler break; 1891b032f27cSSam Leffler case IEEE80211_ELEMID_RATES: 1892b032f27cSSam Leffler rates = frm; 1893b032f27cSSam Leffler break; 1894b032f27cSSam Leffler case IEEE80211_ELEMID_XRATES: 1895b032f27cSSam Leffler xrates = frm; 1896b032f27cSSam Leffler break; 1897b032f27cSSam Leffler } 1898b032f27cSSam Leffler frm += frm[1] + 2; 1899b032f27cSSam Leffler } 1900b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE, return); 1901b032f27cSSam Leffler if (xrates != NULL) 1902b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(xrates, 1903b032f27cSSam Leffler IEEE80211_RATE_MAXSIZE - rates[1], return); 1904b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN, return); 1905b032f27cSSam Leffler IEEE80211_VERIFY_SSID(vap->iv_bss, ssid, return); 1906b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_HIDESSID) && ssid[1] == 0) { 1907b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 1908b032f27cSSam Leffler wh, NULL, 1909b032f27cSSam Leffler "%s", "no ssid with ssid suppression enabled"); 1910b032f27cSSam Leffler vap->iv_stats.is_rx_ssidmismatch++; /*XXX*/ 1911b032f27cSSam Leffler return; 1912b032f27cSSam Leffler } 1913b032f27cSSam Leffler 1914b032f27cSSam Leffler /* XXX find a better class or define it's own */ 1915b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_INPUT, wh->i_addr2, 1916b032f27cSSam Leffler "%s", "recv probe req"); 1917b032f27cSSam Leffler /* 1918b032f27cSSam Leffler * Some legacy 11b clients cannot hack a complete 1919b032f27cSSam Leffler * probe response frame. When the request includes 1920b032f27cSSam Leffler * only a bare-bones rate set, communicate this to 1921b032f27cSSam Leffler * the transmit side. 1922b032f27cSSam Leffler */ 1923b032f27cSSam Leffler ieee80211_send_proberesp(vap, wh->i_addr2, 1924b032f27cSSam Leffler is11bclient(rates, xrates) ? IEEE80211_SEND_LEGACY_11B : 0); 1925b032f27cSSam Leffler break; 1926b032f27cSSam Leffler 1927b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_AUTH: { 1928b032f27cSSam Leffler uint16_t algo, seq, status; 1929b032f27cSSam Leffler 1930b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 1931b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1932b032f27cSSam Leffler return; 1933b032f27cSSam Leffler } 1934b032f27cSSam Leffler if (!IEEE80211_ADDR_EQ(wh->i_addr3, vap->iv_bss->ni_bssid)) { 1935b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1936b032f27cSSam Leffler wh, NULL, "%s", "wrong bssid"); 1937b032f27cSSam Leffler vap->iv_stats.is_rx_wrongbss++; /*XXX unique stat?*/ 1938b032f27cSSam Leffler return; 1939b032f27cSSam Leffler } 1940b032f27cSSam Leffler /* 1941b032f27cSSam Leffler * auth frame format 1942b032f27cSSam Leffler * [2] algorithm 1943b032f27cSSam Leffler * [2] sequence 1944b032f27cSSam Leffler * [2] status 1945b032f27cSSam Leffler * [tlv*] challenge 1946b032f27cSSam Leffler */ 1947b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, 6, return); 1948b032f27cSSam Leffler algo = le16toh(*(uint16_t *)frm); 1949b032f27cSSam Leffler seq = le16toh(*(uint16_t *)(frm + 2)); 1950b032f27cSSam Leffler status = le16toh(*(uint16_t *)(frm + 4)); 1951b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_AUTH, wh->i_addr2, 1952b032f27cSSam Leffler "recv auth frame with algorithm %d seq %d", algo, seq); 1953b032f27cSSam Leffler /* 1954b032f27cSSam Leffler * Consult the ACL policy module if setup. 1955b032f27cSSam Leffler */ 19565a8801b0SBernhard Schmidt if (vap->iv_acl != NULL && !vap->iv_acl->iac_check(vap, wh)) { 1957b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ACL, 1958b032f27cSSam Leffler wh, NULL, "%s", "disallowed by ACL"); 1959b032f27cSSam Leffler vap->iv_stats.is_rx_acl++; 1960b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1961b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1962b032f27cSSam Leffler (seq+1) | (IEEE80211_STATUS_UNSPECIFIED<<16)); 1963b032f27cSSam Leffler return; 1964b032f27cSSam Leffler } 1965b032f27cSSam Leffler if (vap->iv_flags & IEEE80211_F_COUNTERM) { 1966b032f27cSSam Leffler IEEE80211_DISCARD(vap, 1967b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_CRYPTO, 1968b032f27cSSam Leffler wh, NULL, "%s", "TKIP countermeasures enabled"); 1969b032f27cSSam Leffler vap->iv_stats.is_rx_auth_countermeasures++; 1970b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1971b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1972b032f27cSSam Leffler IEEE80211_REASON_MIC_FAILURE); 1973b032f27cSSam Leffler return; 1974b032f27cSSam Leffler } 1975b032f27cSSam Leffler if (algo == IEEE80211_AUTH_ALG_SHARED) 19765463c4a4SSam Leffler hostap_auth_shared(ni, wh, frm + 6, efrm, rssi, nf, 1977b032f27cSSam Leffler seq, status); 19785463c4a4SSam Leffler else if (algo == IEEE80211_AUTH_ALG_OPEN) 19795463c4a4SSam Leffler hostap_auth_open(ni, wh, rssi, nf, seq, status); 1980b032f27cSSam Leffler else if (algo == IEEE80211_AUTH_ALG_LEAP) { 1981b032f27cSSam Leffler authalgreject(ni, wh, algo, 1982b032f27cSSam Leffler seq+1, IEEE80211_STATUS_ALG); 1983b032f27cSSam Leffler return; 1984b032f27cSSam Leffler } else { 1985b032f27cSSam Leffler /* 1986b032f27cSSam Leffler * We assume that an unknown algorithm is the result 1987b032f27cSSam Leffler * of a decryption failure on a shared key auth frame; 1988b032f27cSSam Leffler * return a status code appropriate for that instead 1989b032f27cSSam Leffler * of IEEE80211_STATUS_ALG. 1990b032f27cSSam Leffler * 1991b032f27cSSam Leffler * NB: a seq# of 4 is intentional; the decrypted 1992b032f27cSSam Leffler * frame likely has a bogus seq value. 1993b032f27cSSam Leffler */ 1994b032f27cSSam Leffler authalgreject(ni, wh, algo, 1995b032f27cSSam Leffler 4, IEEE80211_STATUS_CHALLENGE); 1996b032f27cSSam Leffler return; 1997b032f27cSSam Leffler } 1998b032f27cSSam Leffler break; 1999b032f27cSSam Leffler } 2000b032f27cSSam Leffler 2001b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ASSOC_REQ: 2002b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: { 2003b032f27cSSam Leffler uint16_t capinfo, lintval; 2004b032f27cSSam Leffler struct ieee80211_rsnparms rsnparms; 2005b032f27cSSam Leffler 2006b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 2007b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2008b032f27cSSam Leffler return; 2009b032f27cSSam Leffler } 2010b032f27cSSam Leffler if (!IEEE80211_ADDR_EQ(wh->i_addr3, vap->iv_bss->ni_bssid)) { 2011b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 2012b032f27cSSam Leffler wh, NULL, "%s", "wrong bssid"); 2013b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_bss++; 2014b032f27cSSam Leffler return; 2015b032f27cSSam Leffler } 2016b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) { 2017b032f27cSSam Leffler reassoc = 1; 2018b032f27cSSam Leffler resp = IEEE80211_FC0_SUBTYPE_REASSOC_RESP; 2019b032f27cSSam Leffler } else { 2020b032f27cSSam Leffler reassoc = 0; 2021b032f27cSSam Leffler resp = IEEE80211_FC0_SUBTYPE_ASSOC_RESP; 2022b032f27cSSam Leffler } 2023b032f27cSSam Leffler if (ni == vap->iv_bss) { 2024b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ANY, wh->i_addr2, 2025b032f27cSSam Leffler "deny %s request, sta not authenticated", 2026b032f27cSSam Leffler reassoc ? "reassoc" : "assoc"); 2027b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 2028b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DEAUTH, 2029b032f27cSSam Leffler IEEE80211_REASON_ASSOC_NOT_AUTHED); 2030b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_notauth++; 2031b032f27cSSam Leffler return; 2032b032f27cSSam Leffler } 2033b032f27cSSam Leffler 2034b032f27cSSam Leffler /* 2035b032f27cSSam Leffler * asreq frame format 2036b032f27cSSam Leffler * [2] capability information 2037b032f27cSSam Leffler * [2] listen interval 2038b032f27cSSam Leffler * [6*] current AP address (reassoc only) 2039b032f27cSSam Leffler * [tlv] ssid 2040b032f27cSSam Leffler * [tlv] supported rates 2041b032f27cSSam Leffler * [tlv] extended supported rates 2042b032f27cSSam Leffler * [tlv] WPA or RSN 2043b032f27cSSam Leffler * [tlv] HT capabilities 2044b032f27cSSam Leffler * [tlv] Atheros capabilities 2045b032f27cSSam Leffler */ 2046b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, (reassoc ? 10 : 4), return); 2047b032f27cSSam Leffler capinfo = le16toh(*(uint16_t *)frm); frm += 2; 2048b032f27cSSam Leffler lintval = le16toh(*(uint16_t *)frm); frm += 2; 2049b032f27cSSam Leffler if (reassoc) 2050b032f27cSSam Leffler frm += 6; /* ignore current AP info */ 2051b032f27cSSam Leffler ssid = rates = xrates = wpa = rsn = wme = ath = htcap = NULL; 205251172f62SAdrian Chadd vhtcap = vhtinfo = NULL; 2053b032f27cSSam Leffler sfrm = frm; 2054b032f27cSSam Leffler while (efrm - frm > 1) { 2055b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, frm[1] + 2, return); 2056b032f27cSSam Leffler switch (*frm) { 2057b032f27cSSam Leffler case IEEE80211_ELEMID_SSID: 2058b032f27cSSam Leffler ssid = frm; 2059b032f27cSSam Leffler break; 2060b032f27cSSam Leffler case IEEE80211_ELEMID_RATES: 2061b032f27cSSam Leffler rates = frm; 2062b032f27cSSam Leffler break; 2063b032f27cSSam Leffler case IEEE80211_ELEMID_XRATES: 2064b032f27cSSam Leffler xrates = frm; 2065b032f27cSSam Leffler break; 2066b032f27cSSam Leffler case IEEE80211_ELEMID_RSN: 2067b032f27cSSam Leffler rsn = frm; 2068b032f27cSSam Leffler break; 2069b032f27cSSam Leffler case IEEE80211_ELEMID_HTCAP: 2070b032f27cSSam Leffler htcap = frm; 2071b032f27cSSam Leffler break; 207251172f62SAdrian Chadd case IEEE80211_ELEMID_VHT_CAP: 207351172f62SAdrian Chadd vhtcap = frm; 207451172f62SAdrian Chadd break; 207551172f62SAdrian Chadd case IEEE80211_ELEMID_VHT_OPMODE: 207651172f62SAdrian Chadd vhtinfo = frm; 207751172f62SAdrian Chadd break; 2078b032f27cSSam Leffler case IEEE80211_ELEMID_VENDOR: 2079b032f27cSSam Leffler if (iswpaoui(frm)) 2080b032f27cSSam Leffler wpa = frm; 2081b032f27cSSam Leffler else if (iswmeinfo(frm)) 2082b032f27cSSam Leffler wme = frm; 2083616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 2084b032f27cSSam Leffler else if (isatherosoui(frm)) 2085b032f27cSSam Leffler ath = frm; 2086616190d0SSam Leffler #endif 20872bfc8a91SSam Leffler else if (vap->iv_flags_ht & IEEE80211_FHT_HTCOMPAT) { 2088b032f27cSSam Leffler if (ishtcapoui(frm) && htcap == NULL) 2089b032f27cSSam Leffler htcap = frm; 2090b032f27cSSam Leffler } 2091b032f27cSSam Leffler break; 2092b032f27cSSam Leffler } 2093b032f27cSSam Leffler frm += frm[1] + 2; 2094b032f27cSSam Leffler } 2095b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE, return); 2096b032f27cSSam Leffler if (xrates != NULL) 2097b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(xrates, 2098b032f27cSSam Leffler IEEE80211_RATE_MAXSIZE - rates[1], return); 2099b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN, return); 2100b032f27cSSam Leffler IEEE80211_VERIFY_SSID(vap->iv_bss, ssid, return); 2101b032f27cSSam Leffler if (htcap != NULL) { 2102b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(htcap[1], 2103b032f27cSSam Leffler htcap[0] == IEEE80211_ELEMID_VENDOR ? 2104b032f27cSSam Leffler 4 + sizeof(struct ieee80211_ie_htcap)-2 : 2105b032f27cSSam Leffler sizeof(struct ieee80211_ie_htcap)-2, 2106b032f27cSSam Leffler return); /* XXX just NULL out? */ 2107b032f27cSSam Leffler } 2108b032f27cSSam Leffler 210946788bb1SAdrian Chadd /* Validate VHT IEs */ 211046788bb1SAdrian Chadd if (vhtcap != NULL) { 211146788bb1SAdrian Chadd IEEE80211_VERIFY_LENGTH(vhtcap[1], 211246788bb1SAdrian Chadd sizeof(struct ieee80211_ie_vhtcap) - 2, 211346788bb1SAdrian Chadd return); 211446788bb1SAdrian Chadd } 211546788bb1SAdrian Chadd if (vhtinfo != NULL) { 211646788bb1SAdrian Chadd IEEE80211_VERIFY_LENGTH(vhtinfo[1], 211746788bb1SAdrian Chadd sizeof(struct ieee80211_ie_vht_operation) - 2, 211846788bb1SAdrian Chadd return); 211946788bb1SAdrian Chadd } 21207f19273cSAdrian Chadd 2121b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA) && 2122b032f27cSSam Leffler !wpa_assocreq(ni, &rsnparms, wh, wpa, rsn, capinfo)) 2123b032f27cSSam Leffler return; 2124b032f27cSSam Leffler /* discard challenge after association */ 2125b032f27cSSam Leffler if (ni->ni_challenge != NULL) { 2126b9b53389SAdrian Chadd IEEE80211_FREE(ni->ni_challenge, M_80211_NODE); 2127b032f27cSSam Leffler ni->ni_challenge = NULL; 2128b032f27cSSam Leffler } 2129b032f27cSSam Leffler /* NB: 802.11 spec says to ignore station's privacy bit */ 2130b032f27cSSam Leffler if ((capinfo & IEEE80211_CAPINFO_ESS) == 0) { 2131b032f27cSSam Leffler capinfomismatch(ni, wh, reassoc, resp, 2132b032f27cSSam Leffler "capability", capinfo); 2133b032f27cSSam Leffler return; 2134b032f27cSSam Leffler } 2135b032f27cSSam Leffler /* 2136b032f27cSSam Leffler * Disallow re-associate w/ invalid slot time setting. 2137b032f27cSSam Leffler */ 2138b032f27cSSam Leffler if (ni->ni_associd != 0 && 2139b032f27cSSam Leffler IEEE80211_IS_CHAN_ANYG(ic->ic_bsschan) && 2140b032f27cSSam Leffler ((ni->ni_capinfo ^ capinfo) & IEEE80211_CAPINFO_SHORT_SLOTTIME)) { 2141b032f27cSSam Leffler capinfomismatch(ni, wh, reassoc, resp, 2142b032f27cSSam Leffler "slot time", capinfo); 2143b032f27cSSam Leffler return; 2144b032f27cSSam Leffler } 2145b032f27cSSam Leffler rate = ieee80211_setup_rates(ni, rates, xrates, 2146b032f27cSSam Leffler IEEE80211_F_DOSORT | IEEE80211_F_DOFRATE | 2147b032f27cSSam Leffler IEEE80211_F_DONEGO | IEEE80211_F_DODEL); 2148b032f27cSSam Leffler if (rate & IEEE80211_RATE_BASIC) { 2149b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, "legacy", rate); 2150b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_norate++; 2151b032f27cSSam Leffler return; 2152b032f27cSSam Leffler } 2153b032f27cSSam Leffler /* 2154b032f27cSSam Leffler * If constrained to 11g-only stations reject an 2155b032f27cSSam Leffler * 11b-only station. We cheat a bit here by looking 2156b032f27cSSam Leffler * at the max negotiated xmit rate and assuming anyone 2157b032f27cSSam Leffler * with a best rate <24Mb/s is an 11b station. 2158b032f27cSSam Leffler */ 2159b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PUREG) && rate < 48) { 2160b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, "11g", rate); 2161b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_norate++; 2162b032f27cSSam Leffler return; 2163b032f27cSSam Leffler } 216451172f62SAdrian Chadd 2165b032f27cSSam Leffler /* 2166b032f27cSSam Leffler * Do HT rate set handling and setup HT node state. 2167b032f27cSSam Leffler */ 2168b032f27cSSam Leffler ni->ni_chan = vap->iv_bss->ni_chan; 216951172f62SAdrian Chadd 217051172f62SAdrian Chadd /* VHT */ 217120235662SAdrian Chadd if (IEEE80211_IS_CHAN_VHT(ni->ni_chan) && 21727f19273cSAdrian Chadd vhtcap != NULL && 217320235662SAdrian Chadd vhtinfo != NULL) { 217451172f62SAdrian Chadd /* XXX TODO; see below */ 217551172f62SAdrian Chadd printf("%s: VHT TODO!\n", __func__); 217651172f62SAdrian Chadd ieee80211_vht_node_init(ni); 217751172f62SAdrian Chadd ieee80211_vht_update_cap(ni, vhtcap, vhtinfo); 217851172f62SAdrian Chadd } else if (ni->ni_flags & IEEE80211_NODE_VHT) 217951172f62SAdrian Chadd ieee80211_vht_node_cleanup(ni); 218051172f62SAdrian Chadd 218151172f62SAdrian Chadd /* HT */ 2182b032f27cSSam Leffler if (IEEE80211_IS_CHAN_HT(ni->ni_chan) && htcap != NULL) { 2183b032f27cSSam Leffler rate = ieee80211_setup_htrates(ni, htcap, 2184b032f27cSSam Leffler IEEE80211_F_DOFMCS | IEEE80211_F_DONEGO | 2185b032f27cSSam Leffler IEEE80211_F_DOBRS); 2186b032f27cSSam Leffler if (rate & IEEE80211_RATE_BASIC) { 2187b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, 2188b032f27cSSam Leffler "HT", rate); 2189b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_norate++; 2190b032f27cSSam Leffler return; 2191b032f27cSSam Leffler } 2192fdabd982SSam Leffler ieee80211_ht_node_init(ni); 2193fdabd982SSam Leffler ieee80211_ht_updatehtcap(ni, htcap); 2194b032f27cSSam Leffler } else if (ni->ni_flags & IEEE80211_NODE_HT) 2195b032f27cSSam Leffler ieee80211_ht_node_cleanup(ni); 219651172f62SAdrian Chadd 219751172f62SAdrian Chadd /* Finally - this will use HT/VHT info to change node channel */ 219851172f62SAdrian Chadd if (IEEE80211_IS_CHAN_HT(ni->ni_chan) && htcap != NULL) { 219951172f62SAdrian Chadd ieee80211_ht_updatehtcap_final(ni); 220051172f62SAdrian Chadd } 220151172f62SAdrian Chadd 2202339ccfb3SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 22030e6cbef2SAdrian Chadd /* Always do ff node cleanup; for A-MSDU */ 2204339ccfb3SSam Leffler ieee80211_ff_node_cleanup(ni); 2205339ccfb3SSam Leffler #endif 2206b032f27cSSam Leffler /* 2207b032f27cSSam Leffler * Allow AMPDU operation only with unencrypted traffic 2208b032f27cSSam Leffler * or AES-CCM; the 11n spec only specifies these ciphers 2209b032f27cSSam Leffler * so permitting any others is undefined and can lead 2210b032f27cSSam Leffler * to interoperability problems. 2211b032f27cSSam Leffler */ 2212b032f27cSSam Leffler if ((ni->ni_flags & IEEE80211_NODE_HT) && 2213b032f27cSSam Leffler (((vap->iv_flags & IEEE80211_F_WPA) && 2214b032f27cSSam Leffler rsnparms.rsn_ucastcipher != IEEE80211_CIPHER_AES_CCM) || 2215b032f27cSSam Leffler (vap->iv_flags & (IEEE80211_F_WPA|IEEE80211_F_PRIVACY)) == IEEE80211_F_PRIVACY)) { 2216b032f27cSSam Leffler IEEE80211_NOTE(vap, 2217b032f27cSSam Leffler IEEE80211_MSG_ASSOC | IEEE80211_MSG_11N, ni, 2218b032f27cSSam Leffler "disallow HT use because WEP or TKIP requested, " 2219b032f27cSSam Leffler "capinfo 0x%x ucastcipher %d", capinfo, 2220b032f27cSSam Leffler rsnparms.rsn_ucastcipher); 2221b032f27cSSam Leffler ieee80211_ht_node_cleanup(ni); 22220e6cbef2SAdrian Chadd #ifdef IEEE80211_SUPPORT_SUPERG 22230e6cbef2SAdrian Chadd /* Always do ff node cleanup; for A-MSDU */ 22240e6cbef2SAdrian Chadd ieee80211_ff_node_cleanup(ni); 22250e6cbef2SAdrian Chadd #endif 2226b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_downgrade++; 2227b032f27cSSam Leffler } 2228b032f27cSSam Leffler /* 2229b032f27cSSam Leffler * If constrained to 11n-only stations reject legacy stations. 2230b032f27cSSam Leffler */ 22312bfc8a91SSam Leffler if ((vap->iv_flags_ht & IEEE80211_FHT_PUREN) && 2232b032f27cSSam Leffler (ni->ni_flags & IEEE80211_NODE_HT) == 0) { 2233b032f27cSSam Leffler htcapmismatch(ni, wh, reassoc, resp); 2234b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_nohtcap++; 2235b032f27cSSam Leffler return; 2236b032f27cSSam Leffler } 2237b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 22385463c4a4SSam Leffler ni->ni_noise = nf; 2239b032f27cSSam Leffler ni->ni_intval = lintval; 2240b032f27cSSam Leffler ni->ni_capinfo = capinfo; 2241b032f27cSSam Leffler ni->ni_fhdwell = vap->iv_bss->ni_fhdwell; 2242b032f27cSSam Leffler ni->ni_fhindex = vap->iv_bss->ni_fhindex; 2243b032f27cSSam Leffler /* 2244b032f27cSSam Leffler * Store the IEs. 2245b032f27cSSam Leffler * XXX maybe better to just expand 2246b032f27cSSam Leffler */ 2247b032f27cSSam Leffler if (ieee80211_ies_init(&ni->ni_ies, sfrm, efrm - sfrm)) { 2248b032f27cSSam Leffler #define setie(_ie, _off) ieee80211_ies_setie(ni->ni_ies, _ie, _off) 2249b032f27cSSam Leffler if (wpa != NULL) 2250b032f27cSSam Leffler setie(wpa_ie, wpa - sfrm); 2251b032f27cSSam Leffler if (rsn != NULL) 2252b032f27cSSam Leffler setie(rsn_ie, rsn - sfrm); 2253b032f27cSSam Leffler if (htcap != NULL) 2254b032f27cSSam Leffler setie(htcap_ie, htcap - sfrm); 2255b032f27cSSam Leffler if (wme != NULL) { 2256b032f27cSSam Leffler setie(wme_ie, wme - sfrm); 2257b032f27cSSam Leffler /* 2258b032f27cSSam Leffler * Mark node as capable of QoS. 2259b032f27cSSam Leffler */ 2260b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_QOS; 22618379e8dbSAdrian Chadd if (ieee80211_parse_wmeie(wme, wh, ni) > 0) { 22628379e8dbSAdrian Chadd if (ni->ni_uapsd != 0) 22638379e8dbSAdrian Chadd ni->ni_flags |= 22648379e8dbSAdrian Chadd IEEE80211_NODE_UAPSD; 22658379e8dbSAdrian Chadd else 22668379e8dbSAdrian Chadd ni->ni_flags &= 22678379e8dbSAdrian Chadd ~IEEE80211_NODE_UAPSD; 22688379e8dbSAdrian Chadd } 2269b032f27cSSam Leffler } else 22708379e8dbSAdrian Chadd ni->ni_flags &= 22718379e8dbSAdrian Chadd ~(IEEE80211_NODE_QOS | 22728379e8dbSAdrian Chadd IEEE80211_NODE_UAPSD); 2273616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 2274b032f27cSSam Leffler if (ath != NULL) { 2275b032f27cSSam Leffler setie(ath_ie, ath - sfrm); 2276b032f27cSSam Leffler /* 2277b032f27cSSam Leffler * Parse ATH station parameters. 2278b032f27cSSam Leffler */ 2279b032f27cSSam Leffler ieee80211_parse_ath(ni, ni->ni_ies.ath_ie); 2280b032f27cSSam Leffler } else 2281616190d0SSam Leffler #endif 2282b032f27cSSam Leffler ni->ni_ath_flags = 0; 2283b032f27cSSam Leffler #undef setie 2284b032f27cSSam Leffler } else { 2285b032f27cSSam Leffler ni->ni_flags &= ~IEEE80211_NODE_QOS; 22868379e8dbSAdrian Chadd ni->ni_flags &= ~IEEE80211_NODE_UAPSD; 2287b032f27cSSam Leffler ni->ni_ath_flags = 0; 2288b032f27cSSam Leffler } 2289b032f27cSSam Leffler ieee80211_node_join(ni, resp); 2290b032f27cSSam Leffler ieee80211_deliver_l2uf(ni); 2291b032f27cSSam Leffler break; 2292b032f27cSSam Leffler } 2293b032f27cSSam Leffler 2294b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_DEAUTH: 2295b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_DISASSOC: { 2296b032f27cSSam Leffler uint16_t reason; 2297b032f27cSSam Leffler 2298b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN || 2299b032f27cSSam Leffler /* NB: can happen when in promiscuous mode */ 2300b032f27cSSam Leffler !IEEE80211_ADDR_EQ(wh->i_addr1, vap->iv_myaddr)) { 2301b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2302b032f27cSSam Leffler break; 2303b032f27cSSam Leffler } 2304b032f27cSSam Leffler /* 2305b032f27cSSam Leffler * deauth/disassoc frame format 2306b032f27cSSam Leffler * [2] reason 2307b032f27cSSam Leffler */ 2308b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, 2, return); 2309b032f27cSSam Leffler reason = le16toh(*(uint16_t *)frm); 2310b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_DEAUTH) { 2311b032f27cSSam Leffler vap->iv_stats.is_rx_deauth++; 2312b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_deauth); 2313b032f27cSSam Leffler } else { 2314b032f27cSSam Leffler vap->iv_stats.is_rx_disassoc++; 2315b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_disassoc); 2316b032f27cSSam Leffler } 2317b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_AUTH, ni, 2318d72d72d3SAndriy Voskoboinyk "recv %s (reason: %d (%s))", 23194357a5d1SAndriy Voskoboinyk ieee80211_mgt_subtype_name(subtype), 2320d72d72d3SAndriy Voskoboinyk reason, ieee80211_reason_to_string(reason)); 2321b032f27cSSam Leffler if (ni != vap->iv_bss) 2322b032f27cSSam Leffler ieee80211_node_leave(ni); 2323b032f27cSSam Leffler break; 2324b032f27cSSam Leffler } 2325b032f27cSSam Leffler 2326b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ACTION: 232796283082SBernhard Schmidt case IEEE80211_FC0_SUBTYPE_ACTION_NOACK: 2328893c4d6eSBernhard Schmidt if (ni == vap->iv_bss) { 2329893c4d6eSBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 2330893c4d6eSBernhard Schmidt wh, NULL, "%s", "unknown node"); 2331893c4d6eSBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 2332893c4d6eSBernhard Schmidt } else if (!IEEE80211_ADDR_EQ(vap->iv_myaddr, wh->i_addr1) && 2333893c4d6eSBernhard Schmidt !IEEE80211_IS_MULTICAST(wh->i_addr1)) { 2334893c4d6eSBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 2335893c4d6eSBernhard Schmidt wh, NULL, "%s", "not for us"); 2336893c4d6eSBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 2337893c4d6eSBernhard Schmidt } else if (vap->iv_state != IEEE80211_S_RUN) { 233896283082SBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 233996283082SBernhard Schmidt wh, NULL, "wrong state %s", 234096283082SBernhard Schmidt ieee80211_state_name[vap->iv_state]); 2341b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2342893c4d6eSBernhard Schmidt } else { 2343893c4d6eSBernhard Schmidt if (ieee80211_parse_action(ni, m0) == 0) 2344893c4d6eSBernhard Schmidt (void)ic->ic_recv_action(ni, wh, frm, efrm); 234596283082SBernhard Schmidt } 2346b032f27cSSam Leffler break; 2347b032f27cSSam Leffler 2348b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ASSOC_RESP: 2349b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: 2350665d5ae9SAndriy Voskoboinyk case IEEE80211_FC0_SUBTYPE_TIMING_ADV: 235196283082SBernhard Schmidt case IEEE80211_FC0_SUBTYPE_ATIM: 235296283082SBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 235396283082SBernhard Schmidt wh, NULL, "%s", "not handled"); 235496283082SBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 235596283082SBernhard Schmidt break; 235696283082SBernhard Schmidt 2357b032f27cSSam Leffler default: 2358b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 2359b032f27cSSam Leffler wh, "mgt", "subtype 0x%x not handled", subtype); 2360b032f27cSSam Leffler vap->iv_stats.is_rx_badsubtype++; 2361b032f27cSSam Leffler break; 2362b032f27cSSam Leffler } 2363b032f27cSSam Leffler } 2364b032f27cSSam Leffler 236549eae5f7SSam Leffler static void 236649eae5f7SSam Leffler hostap_recv_ctl(struct ieee80211_node *ni, struct mbuf *m, int subtype) 236749eae5f7SSam Leffler { 236849eae5f7SSam Leffler switch (subtype) { 236949eae5f7SSam Leffler case IEEE80211_FC0_SUBTYPE_PS_POLL: 2370e7f0d7cfSAdrian Chadd ni->ni_vap->iv_recv_pspoll(ni, m); 237149eae5f7SSam Leffler break; 237249eae5f7SSam Leffler case IEEE80211_FC0_SUBTYPE_BAR: 237349eae5f7SSam Leffler ieee80211_recv_bar(ni, m); 237449eae5f7SSam Leffler break; 237549eae5f7SSam Leffler } 237649eae5f7SSam Leffler } 237749eae5f7SSam Leffler 2378b032f27cSSam Leffler /* 2379b032f27cSSam Leffler * Process a received ps-poll frame. 2380b032f27cSSam Leffler */ 2381e7f0d7cfSAdrian Chadd void 2382e7f0d7cfSAdrian Chadd ieee80211_recv_pspoll(struct ieee80211_node *ni, struct mbuf *m0) 2383b032f27cSSam Leffler { 2384b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 23855cda6006SAdrian Chadd struct ieee80211com *ic = vap->iv_ic; 2386b032f27cSSam Leffler struct ieee80211_frame_min *wh; 2387b032f27cSSam Leffler struct mbuf *m; 2388b032f27cSSam Leffler uint16_t aid; 2389b032f27cSSam Leffler int qlen; 2390b032f27cSSam Leffler 2391b032f27cSSam Leffler wh = mtod(m0, struct ieee80211_frame_min *); 2392b032f27cSSam Leffler if (ni->ni_associd == 0) { 2393b032f27cSSam Leffler IEEE80211_DISCARD(vap, 2394b032f27cSSam Leffler IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG, 2395b032f27cSSam Leffler (struct ieee80211_frame *) wh, NULL, 2396b032f27cSSam Leffler "%s", "unassociated station"); 2397b032f27cSSam Leffler vap->iv_stats.is_ps_unassoc++; 2398b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_DEAUTH, 2399b032f27cSSam Leffler IEEE80211_REASON_NOT_ASSOCED); 2400b032f27cSSam Leffler return; 2401b032f27cSSam Leffler } 2402b032f27cSSam Leffler 2403b032f27cSSam Leffler aid = le16toh(*(uint16_t *)wh->i_dur); 2404b032f27cSSam Leffler if (aid != ni->ni_associd) { 2405b032f27cSSam Leffler IEEE80211_DISCARD(vap, 2406b032f27cSSam Leffler IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG, 2407b032f27cSSam Leffler (struct ieee80211_frame *) wh, NULL, 2408b032f27cSSam Leffler "aid mismatch: sta aid 0x%x poll aid 0x%x", 2409b032f27cSSam Leffler ni->ni_associd, aid); 2410b032f27cSSam Leffler vap->iv_stats.is_ps_badaid++; 2411693e3122SSam Leffler /* 2412693e3122SSam Leffler * NB: We used to deauth the station but it turns out 2413693e3122SSam Leffler * the Blackberry Curve 8230 (and perhaps other devices) 2414693e3122SSam Leffler * sometimes send the wrong AID when WME is negotiated. 2415693e3122SSam Leffler * Being more lenient here seems ok as we already check 2416693e3122SSam Leffler * the station is associated and we only return frames 2417693e3122SSam Leffler * queued for the station (i.e. we don't use the AID). 2418693e3122SSam Leffler */ 2419b032f27cSSam Leffler return; 2420b032f27cSSam Leffler } 2421b032f27cSSam Leffler 2422b032f27cSSam Leffler /* Okay, take the first queued packet and put it out... */ 242363092fceSSam Leffler m = ieee80211_node_psq_dequeue(ni, &qlen); 2424b032f27cSSam Leffler if (m == NULL) { 2425b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_POWER, wh->i_addr2, 2426b032f27cSSam Leffler "%s", "recv ps-poll, but queue empty"); 2427b032f27cSSam Leffler ieee80211_send_nulldata(ieee80211_ref_node(ni)); 2428b032f27cSSam Leffler vap->iv_stats.is_ps_qempty++; /* XXX node stat */ 2429b032f27cSSam Leffler if (vap->iv_set_tim != NULL) 2430b032f27cSSam Leffler vap->iv_set_tim(ni, 0); /* just in case */ 2431b032f27cSSam Leffler return; 2432b032f27cSSam Leffler } 2433b032f27cSSam Leffler /* 2434b032f27cSSam Leffler * If there are more packets, set the more packets bit 2435b032f27cSSam Leffler * in the packet dispatched to the station; otherwise 2436b032f27cSSam Leffler * turn off the TIM bit. 2437b032f27cSSam Leffler */ 2438b032f27cSSam Leffler if (qlen != 0) { 2439b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_POWER, ni, 2440b032f27cSSam Leffler "recv ps-poll, send packet, %u still queued", qlen); 2441b032f27cSSam Leffler m->m_flags |= M_MORE_DATA; 2442b032f27cSSam Leffler } else { 2443b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_POWER, ni, 2444b032f27cSSam Leffler "%s", "recv ps-poll, send packet, queue empty"); 2445b032f27cSSam Leffler if (vap->iv_set_tim != NULL) 2446b032f27cSSam Leffler vap->iv_set_tim(ni, 0); 2447b032f27cSSam Leffler } 2448b032f27cSSam Leffler m->m_flags |= M_PWR_SAV; /* bypass PS handling */ 244963092fceSSam Leffler 24507ea3aadaSAdrian Chadd /* 24515cda6006SAdrian Chadd * Do the right thing; if it's an encap'ed frame then 2452d3a4ade3SAdrian Chadd * call ieee80211_parent_xmitpkt() else 2453e7495198SAdrian Chadd * call ieee80211_vap_xmitpkt(). 24547ea3aadaSAdrian Chadd */ 24555cda6006SAdrian Chadd if (m->m_flags & M_ENCAP) { 2456d3a4ade3SAdrian Chadd (void) ieee80211_parent_xmitpkt(ic, m); 24575cda6006SAdrian Chadd } else { 2458e7495198SAdrian Chadd (void) ieee80211_vap_xmitpkt(vap, m); 24597ea3aadaSAdrian Chadd } 2460b032f27cSSam Leffler } 2461