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> 68*8379e8dbSAdrian 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 */ 209b032f27cSSam Leffler ic->ic_flags_ext &= ~IEEE80211_FEXT_NONERP_PR; 2102bfc8a91SSam Leffler ic->ic_flags_ht &= ~IEEE80211_FHT_NONHT_PR; 211b032f27cSSam Leffler /* fall thru... */ 212b032f27cSSam Leffler case IEEE80211_S_CAC: 213b032f27cSSam Leffler /* 214b032f27cSSam Leffler * NB: We may get here because of a manual channel 215b032f27cSSam Leffler * change in which case we need to stop CAC 216b032f27cSSam Leffler * XXX no need to stop if ostate RUN but it's ok 217b032f27cSSam Leffler */ 218b032f27cSSam Leffler ieee80211_dfs_cac_stop(vap); 219b032f27cSSam Leffler /* fall thru... */ 220b032f27cSSam Leffler case IEEE80211_S_INIT: 221b032f27cSSam Leffler if (vap->iv_des_chan != IEEE80211_CHAN_ANYC && 222b032f27cSSam Leffler !IEEE80211_IS_CHAN_RADAR(vap->iv_des_chan)) { 223b032f27cSSam Leffler /* 224b032f27cSSam Leffler * Already have a channel; bypass the 225b032f27cSSam Leffler * scan and startup immediately. 226b032f27cSSam Leffler * ieee80211_create_ibss will call back to 227b032f27cSSam Leffler * move us to RUN state. 228b032f27cSSam Leffler */ 229b032f27cSSam Leffler ieee80211_create_ibss(vap, vap->iv_des_chan); 230b032f27cSSam Leffler break; 231b032f27cSSam Leffler } 232b032f27cSSam Leffler /* 233b032f27cSSam Leffler * Initiate a scan. We can come here as a result 234b032f27cSSam Leffler * of an IEEE80211_IOC_SCAN_REQ too in which case 235b032f27cSSam Leffler * the vap will be marked with IEEE80211_FEXT_SCANREQ 236b032f27cSSam Leffler * and the scan request parameters will be present 237b032f27cSSam Leffler * in iv_scanreq. Otherwise we do the default. 238b032f27cSSam Leffler */ 239b032f27cSSam Leffler if (vap->iv_flags_ext & IEEE80211_FEXT_SCANREQ) { 240b032f27cSSam Leffler ieee80211_check_scan(vap, 241b032f27cSSam Leffler vap->iv_scanreq_flags, 242b032f27cSSam Leffler vap->iv_scanreq_duration, 243b032f27cSSam Leffler vap->iv_scanreq_mindwell, 244b032f27cSSam Leffler vap->iv_scanreq_maxdwell, 245b032f27cSSam Leffler vap->iv_scanreq_nssid, vap->iv_scanreq_ssid); 246b032f27cSSam Leffler vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANREQ; 247b032f27cSSam Leffler } else 248b032f27cSSam Leffler ieee80211_check_scan_current(vap); 249b032f27cSSam Leffler break; 250b032f27cSSam Leffler case IEEE80211_S_SCAN: 251b032f27cSSam Leffler /* 252b032f27cSSam Leffler * A state change requires a reset; scan. 253b032f27cSSam Leffler */ 254b032f27cSSam Leffler ieee80211_check_scan_current(vap); 255b032f27cSSam Leffler break; 256b032f27cSSam Leffler default: 257b032f27cSSam Leffler break; 258b032f27cSSam Leffler } 259b032f27cSSam Leffler break; 260b032f27cSSam Leffler case IEEE80211_S_CAC: 261b032f27cSSam Leffler /* 262b032f27cSSam Leffler * Start CAC on a DFS channel. We come here when starting 263b032f27cSSam Leffler * a bss on a DFS channel (see ieee80211_create_ibss). 264b032f27cSSam Leffler */ 265b032f27cSSam Leffler ieee80211_dfs_cac_start(vap); 266b032f27cSSam Leffler break; 267b032f27cSSam Leffler case IEEE80211_S_RUN: 268b032f27cSSam Leffler if (vap->iv_flags & IEEE80211_F_WPA) { 269b032f27cSSam Leffler /* XXX validate prerequisites */ 270b032f27cSSam Leffler } 271b032f27cSSam Leffler switch (ostate) { 272b032f27cSSam Leffler case IEEE80211_S_INIT: 273b032f27cSSam Leffler /* 274b032f27cSSam Leffler * Already have a channel; bypass the 275b032f27cSSam Leffler * scan and startup immediately. 276b032f27cSSam Leffler * Note that ieee80211_create_ibss will call 277b032f27cSSam Leffler * back to do a RUN->RUN state change. 278b032f27cSSam Leffler */ 279b032f27cSSam Leffler ieee80211_create_ibss(vap, 280b032f27cSSam Leffler ieee80211_ht_adjust_channel(ic, 2812bfc8a91SSam Leffler ic->ic_curchan, vap->iv_flags_ht)); 282b032f27cSSam Leffler /* NB: iv_bss is changed on return */ 283b032f27cSSam Leffler break; 284b032f27cSSam Leffler case IEEE80211_S_CAC: 285b032f27cSSam Leffler /* 286b032f27cSSam Leffler * NB: This is the normal state change when CAC 287b032f27cSSam Leffler * expires and no radar was detected; no need to 288b032f27cSSam Leffler * clear the CAC timer as it's already expired. 289b032f27cSSam Leffler */ 290b032f27cSSam Leffler /* fall thru... */ 291b032f27cSSam Leffler case IEEE80211_S_CSA: 292b032f27cSSam Leffler /* 2934e150988SSam Leffler * Shorten inactivity timer of associated stations 2944e150988SSam Leffler * to weed out sta's that don't follow a CSA. 2954e150988SSam Leffler */ 2967db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 2977db788c6SAndriy Voskoboinyk sta_csa, NULL); 2984e150988SSam Leffler /* 299b032f27cSSam Leffler * Update bss node channel to reflect where 300b032f27cSSam Leffler * we landed after CSA. 301b032f27cSSam Leffler */ 302b032f27cSSam Leffler ieee80211_node_set_chan(vap->iv_bss, 303b032f27cSSam Leffler ieee80211_ht_adjust_channel(ic, ic->ic_curchan, 304b032f27cSSam Leffler ieee80211_htchanflags(vap->iv_bss->ni_chan))); 305b032f27cSSam Leffler /* XXX bypass debug msgs */ 306b032f27cSSam Leffler break; 307b032f27cSSam Leffler case IEEE80211_S_SCAN: 308b032f27cSSam Leffler case IEEE80211_S_RUN: 309b032f27cSSam Leffler #ifdef IEEE80211_DEBUG 310b032f27cSSam Leffler if (ieee80211_msg_debug(vap)) { 311b032f27cSSam Leffler struct ieee80211_node *ni = vap->iv_bss; 312b032f27cSSam Leffler ieee80211_note(vap, 313b032f27cSSam Leffler "synchronized with %s ssid ", 314b032f27cSSam Leffler ether_sprintf(ni->ni_bssid)); 315b032f27cSSam Leffler ieee80211_print_essid(ni->ni_essid, 316b032f27cSSam Leffler ni->ni_esslen); 317b032f27cSSam Leffler /* XXX MCS/HT */ 318b032f27cSSam Leffler printf(" channel %d start %uMb\n", 319b032f27cSSam Leffler ieee80211_chan2ieee(ic, ic->ic_curchan), 320b032f27cSSam Leffler IEEE80211_RATE2MBS(ni->ni_txrate)); 321b032f27cSSam Leffler } 322b032f27cSSam Leffler #endif 323b032f27cSSam Leffler break; 324b032f27cSSam Leffler default: 325b032f27cSSam Leffler break; 326b032f27cSSam Leffler } 327b032f27cSSam Leffler /* 328b032f27cSSam Leffler * Start/stop the authenticator. We delay until here 329b032f27cSSam Leffler * to allow configuration to happen out of order. 330b032f27cSSam Leffler */ 331b032f27cSSam Leffler if (vap->iv_auth->ia_attach != NULL) { 332b032f27cSSam Leffler /* XXX check failure */ 333b032f27cSSam Leffler vap->iv_auth->ia_attach(vap); 334b032f27cSSam Leffler } else if (vap->iv_auth->ia_detach != NULL) { 335b032f27cSSam Leffler vap->iv_auth->ia_detach(vap); 336b032f27cSSam Leffler } 337b032f27cSSam Leffler ieee80211_node_authorize(vap->iv_bss); 338b032f27cSSam Leffler break; 3397131987dSSam Leffler case IEEE80211_S_CSA: 3407131987dSSam Leffler if (ostate == IEEE80211_S_RUN && isbandchange(ic)) { 3417131987dSSam Leffler /* 3427131987dSSam Leffler * On a ``band change'' silently drop associated 3437131987dSSam Leffler * stations as they must re-associate before they 3447131987dSSam Leffler * can pass traffic (as otherwise protocol state 3457131987dSSam Leffler * such as capabilities and the negotiated rate 3467131987dSSam Leffler * set may/will be wrong). 3477131987dSSam Leffler */ 3487db788c6SAndriy Voskoboinyk ieee80211_iterate_nodes_vap(&ic->ic_sta, vap, 3497db788c6SAndriy Voskoboinyk sta_drop, NULL); 3507131987dSSam Leffler } 3517131987dSSam Leffler break; 352b032f27cSSam Leffler default: 353b032f27cSSam Leffler break; 354b032f27cSSam Leffler } 355b032f27cSSam Leffler return 0; 356b032f27cSSam Leffler } 357b032f27cSSam Leffler 358b032f27cSSam Leffler static void 359b032f27cSSam Leffler hostap_deliver_data(struct ieee80211vap *vap, 360b032f27cSSam Leffler struct ieee80211_node *ni, struct mbuf *m) 361b032f27cSSam Leffler { 362b032f27cSSam Leffler struct ether_header *eh = mtod(m, struct ether_header *); 363b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 364b032f27cSSam Leffler 365e1cfcbcbSSam Leffler /* clear driver/net80211 flags before passing up */ 36686bd0491SAndre Oppermann m->m_flags &= ~(M_MCAST | M_BCAST); 36786bd0491SAndre Oppermann m_clrprotoflags(m); 368e1cfcbcbSSam Leffler 369b032f27cSSam Leffler KASSERT(vap->iv_opmode == IEEE80211_M_HOSTAP, 370b032f27cSSam Leffler ("gack, opmode %d", vap->iv_opmode)); 371b032f27cSSam Leffler /* 372b032f27cSSam Leffler * Do accounting. 373b032f27cSSam Leffler */ 374dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 375b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_data); 376b032f27cSSam Leffler IEEE80211_NODE_STAT_ADD(ni, rx_bytes, m->m_pkthdr.len); 377b032f27cSSam Leffler if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 378b032f27cSSam Leffler m->m_flags |= M_MCAST; /* XXX M_BCAST? */ 379b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_mcast); 380b032f27cSSam Leffler } else 381b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_ucast); 382b032f27cSSam Leffler 383b032f27cSSam Leffler /* perform as a bridge within the AP */ 384b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_NOBRIDGE) == 0) { 385b032f27cSSam Leffler struct mbuf *mcopy = NULL; 386b032f27cSSam Leffler 387b032f27cSSam Leffler if (m->m_flags & M_MCAST) { 388eb1b1807SGleb Smirnoff mcopy = m_dup(m, M_NOWAIT); 389b032f27cSSam Leffler if (mcopy == NULL) 390dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 391b032f27cSSam Leffler else 392b032f27cSSam Leffler mcopy->m_flags |= M_MCAST; 393b032f27cSSam Leffler } else { 394b032f27cSSam Leffler /* 395b032f27cSSam Leffler * Check if the destination is associated with the 396b032f27cSSam Leffler * same vap and authorized to receive traffic. 397b032f27cSSam Leffler * Beware of traffic destined for the vap itself; 398b032f27cSSam Leffler * sending it will not work; just let it be delivered 399b032f27cSSam Leffler * normally. 400b032f27cSSam Leffler */ 401b032f27cSSam Leffler struct ieee80211_node *sta = ieee80211_find_vap_node( 402b032f27cSSam Leffler &vap->iv_ic->ic_sta, vap, eh->ether_dhost); 403b032f27cSSam Leffler if (sta != NULL) { 404b032f27cSSam Leffler if (ieee80211_node_is_authorized(sta)) { 405b032f27cSSam Leffler /* 406b032f27cSSam Leffler * Beware of sending to ourself; this 407b032f27cSSam Leffler * needs to happen via the normal 408b032f27cSSam Leffler * input path. 409b032f27cSSam Leffler */ 410b032f27cSSam Leffler if (sta != vap->iv_bss) { 411b032f27cSSam Leffler mcopy = m; 412b032f27cSSam Leffler m = NULL; 413b032f27cSSam Leffler } 414b032f27cSSam Leffler } else { 415b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 416b032f27cSSam Leffler IEEE80211_NODE_STAT(sta, rx_unauth); 417b032f27cSSam Leffler } 418b032f27cSSam Leffler ieee80211_free_node(sta); 419b032f27cSSam Leffler } 420b032f27cSSam Leffler } 4214d4d5e25SAndriy Voskoboinyk if (mcopy != NULL) 4224d4d5e25SAndriy Voskoboinyk (void) ieee80211_vap_xmitpkt(vap, mcopy); 423b032f27cSSam Leffler } 424b032f27cSSam Leffler if (m != NULL) { 425b032f27cSSam Leffler /* 426b032f27cSSam Leffler * Mark frame as coming from vap's interface. 427b032f27cSSam Leffler */ 428b032f27cSSam Leffler m->m_pkthdr.rcvif = ifp; 429b032f27cSSam Leffler if (m->m_flags & M_MCAST) { 430b032f27cSSam Leffler /* 431b032f27cSSam Leffler * Spam DWDS vap's w/ multicast traffic. 432b032f27cSSam Leffler */ 433b032f27cSSam Leffler /* XXX only if dwds in use? */ 434b032f27cSSam Leffler ieee80211_dwds_mcast(vap, m); 435b032f27cSSam Leffler } 436b032f27cSSam Leffler if (ni->ni_vlan != 0) { 437b032f27cSSam Leffler /* attach vlan tag */ 438b032f27cSSam Leffler m->m_pkthdr.ether_vtag = ni->ni_vlan; 439b032f27cSSam Leffler m->m_flags |= M_VLANTAG; 440b032f27cSSam Leffler } 441b032f27cSSam Leffler ifp->if_input(ifp, m); 442b032f27cSSam Leffler } 443b032f27cSSam Leffler } 444b032f27cSSam Leffler 445b032f27cSSam Leffler /* 446b032f27cSSam Leffler * Decide if a received management frame should be 447b032f27cSSam Leffler * printed when debugging is enabled. This filters some 448b032f27cSSam Leffler * of the less interesting frames that come frequently 449b032f27cSSam Leffler * (e.g. beacons). 450b032f27cSSam Leffler */ 451b032f27cSSam Leffler static __inline int 452b032f27cSSam Leffler doprint(struct ieee80211vap *vap, int subtype) 453b032f27cSSam Leffler { 454b032f27cSSam Leffler switch (subtype) { 455b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_BEACON: 456b032f27cSSam Leffler return (vap->iv_ic->ic_flags & IEEE80211_F_SCAN); 457b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 458b032f27cSSam Leffler return 0; 459b032f27cSSam Leffler } 460b032f27cSSam Leffler return 1; 461b032f27cSSam Leffler } 462b032f27cSSam Leffler 463b032f27cSSam Leffler /* 464b032f27cSSam Leffler * Process a received frame. The node associated with the sender 465b032f27cSSam Leffler * should be supplied. If nothing was found in the node table then 466b032f27cSSam Leffler * the caller is assumed to supply a reference to iv_bss instead. 467b032f27cSSam Leffler * The RSSI and a timestamp are also supplied. The RSSI data is used 468b032f27cSSam Leffler * during AP scanning to select a AP to associate with; it can have 469b032f27cSSam Leffler * any units so long as values have consistent units and higher values 470b032f27cSSam Leffler * mean ``better signal''. The receive timestamp is currently not used 471b032f27cSSam Leffler * by the 802.11 layer. 472b032f27cSSam Leffler */ 473b032f27cSSam Leffler static int 474c79f192cSAdrian Chadd hostap_input(struct ieee80211_node *ni, struct mbuf *m, 475c79f192cSAdrian Chadd const struct ieee80211_rx_stats *rxs, int rssi, int nf) 476b032f27cSSam Leffler { 477b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 478b032f27cSSam Leffler struct ieee80211com *ic = ni->ni_ic; 479b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 480b032f27cSSam Leffler struct ieee80211_frame *wh; 481b032f27cSSam Leffler struct ieee80211_key *key; 482b032f27cSSam Leffler struct ether_header *eh; 4832b80a340SRui Paulo int hdrspace, need_tap = 1; /* mbuf need to be tapped. */ 484b032f27cSSam Leffler uint8_t dir, type, subtype, qos; 485b032f27cSSam Leffler uint8_t *bssid; 486fe75b452SAdrian Chadd int is_hw_decrypted = 0; 487fe75b452SAdrian Chadd int has_decrypted = 0; 488fe75b452SAdrian Chadd 489fe75b452SAdrian Chadd /* 490fe75b452SAdrian Chadd * Some devices do hardware decryption all the way through 491fe75b452SAdrian Chadd * to pretending the frame wasn't encrypted in the first place. 492fe75b452SAdrian Chadd * So, tag it appropriately so it isn't discarded inappropriately. 493fe75b452SAdrian Chadd */ 494fe75b452SAdrian Chadd if ((rxs != NULL) && (rxs->c_pktflags & IEEE80211_RX_F_DECRYPTED)) 495fe75b452SAdrian Chadd is_hw_decrypted = 1; 496b032f27cSSam Leffler 49745f856e3SSam Leffler if (m->m_flags & M_AMPDU_MPDU) { 498b032f27cSSam Leffler /* 499b032f27cSSam Leffler * Fastpath for A-MPDU reorder q resubmission. Frames 50045f856e3SSam Leffler * w/ M_AMPDU_MPDU marked have already passed through 50145f856e3SSam Leffler * here but were received out of order and been held on 50245f856e3SSam Leffler * the reorder queue. When resubmitted they are marked 50345f856e3SSam Leffler * with the M_AMPDU_MPDU flag and we can bypass most of 50445f856e3SSam Leffler * the normal processing. 505b032f27cSSam Leffler */ 506b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 507b032f27cSSam Leffler type = IEEE80211_FC0_TYPE_DATA; 508b032f27cSSam Leffler dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 509b032f27cSSam Leffler subtype = IEEE80211_FC0_SUBTYPE_QOS; 510b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); /* XXX optimize? */ 511b032f27cSSam Leffler goto resubmit_ampdu; 512b032f27cSSam Leffler } 513b032f27cSSam Leffler 514b032f27cSSam Leffler KASSERT(ni != NULL, ("null node")); 515b032f27cSSam Leffler ni->ni_inact = ni->ni_inact_reload; 516b032f27cSSam Leffler 517b032f27cSSam Leffler type = -1; /* undefined */ 518b032f27cSSam Leffler 519b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame_min)) { 520b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 521b032f27cSSam Leffler ni->ni_macaddr, NULL, 522b032f27cSSam Leffler "too short (1): len %u", m->m_pkthdr.len); 523b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 524b032f27cSSam Leffler goto out; 525b032f27cSSam Leffler } 526b032f27cSSam Leffler /* 527b032f27cSSam Leffler * Bit of a cheat here, we use a pointer for a 3-address 528b032f27cSSam Leffler * frame format but don't reference fields past outside 529b032f27cSSam Leffler * ieee80211_frame_min w/o first validating the data is 530b032f27cSSam Leffler * present. 531b032f27cSSam Leffler */ 532b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 533b032f27cSSam Leffler 534b032f27cSSam Leffler if ((wh->i_fc[0] & IEEE80211_FC0_VERSION_MASK) != 535b032f27cSSam Leffler IEEE80211_FC0_VERSION_0) { 536b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 537dc7bf546SSam Leffler ni->ni_macaddr, NULL, "wrong version, fc %02x:%02x", 538dc7bf546SSam Leffler wh->i_fc[0], wh->i_fc[1]); 539b032f27cSSam Leffler vap->iv_stats.is_rx_badversion++; 540b032f27cSSam Leffler goto err; 541b032f27cSSam Leffler } 542b032f27cSSam Leffler 543b032f27cSSam Leffler dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK; 544b032f27cSSam Leffler type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK; 545b032f27cSSam Leffler subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK; 546b032f27cSSam Leffler if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) { 547b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_NODS) 548b032f27cSSam Leffler bssid = wh->i_addr1; 549b032f27cSSam Leffler else if (type == IEEE80211_FC0_TYPE_CTL) 550b032f27cSSam Leffler bssid = wh->i_addr1; 551b032f27cSSam Leffler else { 552b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) { 553b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, 554b032f27cSSam Leffler IEEE80211_MSG_ANY, ni->ni_macaddr, 555b032f27cSSam Leffler NULL, "too short (2): len %u", 556b032f27cSSam Leffler m->m_pkthdr.len); 557b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 558b032f27cSSam Leffler goto out; 559b032f27cSSam Leffler } 560b032f27cSSam Leffler bssid = wh->i_addr3; 561b032f27cSSam Leffler } 562b032f27cSSam Leffler /* 563b032f27cSSam Leffler * Validate the bssid. 564b032f27cSSam Leffler */ 565b032f27cSSam Leffler if (!(type == IEEE80211_FC0_TYPE_MGT && 566b032f27cSSam Leffler subtype == IEEE80211_FC0_SUBTYPE_BEACON) && 567b032f27cSSam Leffler !IEEE80211_ADDR_EQ(bssid, vap->iv_bss->ni_bssid) && 568b032f27cSSam Leffler !IEEE80211_ADDR_EQ(bssid, ifp->if_broadcastaddr)) { 569b032f27cSSam Leffler /* not interested in */ 570b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 571b032f27cSSam Leffler bssid, NULL, "%s", "not to bss"); 572b032f27cSSam Leffler vap->iv_stats.is_rx_wrongbss++; 573b032f27cSSam Leffler goto out; 574b032f27cSSam Leffler } 575b032f27cSSam Leffler 576b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 5775463c4a4SSam Leffler ni->ni_noise = nf; 578c3ebe019SAdrian Chadd if (IEEE80211_HAS_SEQ(type, subtype)) { 579b032f27cSSam Leffler uint8_t tid = ieee80211_gettid(wh); 580b032f27cSSam Leffler if (IEEE80211_QOS_HAS_SEQ(wh) && 581b032f27cSSam Leffler TID_TO_WME_AC(tid) >= WME_AC_VI) 582b032f27cSSam Leffler ic->ic_wme.wme_hipri_traffic++; 58385c4e670SAdrian Chadd if (! ieee80211_check_rxseq(ni, wh, bssid, rxs)) 584b032f27cSSam Leffler goto out; 585b032f27cSSam Leffler } 586b032f27cSSam Leffler } 587b032f27cSSam Leffler 588b032f27cSSam Leffler switch (type) { 589b032f27cSSam Leffler case IEEE80211_FC0_TYPE_DATA: 590b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); 591b032f27cSSam Leffler if (m->m_len < hdrspace && 592b032f27cSSam Leffler (m = m_pullup(m, hdrspace)) == NULL) { 593b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 594b032f27cSSam Leffler ni->ni_macaddr, NULL, 595b032f27cSSam Leffler "data too short: expecting %u", hdrspace); 596b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 597b032f27cSSam Leffler goto out; /* XXX */ 598b032f27cSSam Leffler } 599b032f27cSSam Leffler if (!(dir == IEEE80211_FC1_DIR_TODS || 600b032f27cSSam Leffler (dir == IEEE80211_FC1_DIR_DSTODS && 601b032f27cSSam Leffler (vap->iv_flags & IEEE80211_F_DWDS)))) { 602b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_DSTODS) { 603b032f27cSSam Leffler IEEE80211_DISCARD(vap, 604b032f27cSSam Leffler IEEE80211_MSG_INPUT, wh, "data", 605b032f27cSSam Leffler "incorrect dir 0x%x", dir); 606b032f27cSSam Leffler } else { 607b032f27cSSam Leffler IEEE80211_DISCARD(vap, 608b032f27cSSam Leffler IEEE80211_MSG_INPUT | 609b032f27cSSam Leffler IEEE80211_MSG_WDS, wh, 610b032f27cSSam Leffler "4-address data", 611b032f27cSSam Leffler "%s", "DWDS not enabled"); 612b032f27cSSam Leffler } 613b032f27cSSam Leffler vap->iv_stats.is_rx_wrongdir++; 614b032f27cSSam Leffler goto out; 615b032f27cSSam Leffler } 616b032f27cSSam Leffler /* check if source STA is associated */ 617b032f27cSSam Leffler if (ni == vap->iv_bss) { 618b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 619b032f27cSSam Leffler wh, "data", "%s", "unknown src"); 620b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 621b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DEAUTH, 622b032f27cSSam Leffler IEEE80211_REASON_NOT_AUTHED); 623b032f27cSSam Leffler vap->iv_stats.is_rx_notassoc++; 624b032f27cSSam Leffler goto err; 625b032f27cSSam Leffler } 626b032f27cSSam Leffler if (ni->ni_associd == 0) { 627b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 628b032f27cSSam Leffler wh, "data", "%s", "unassoc src"); 629b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, 630b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DISASSOC, 631b032f27cSSam Leffler IEEE80211_REASON_NOT_ASSOCED); 632b032f27cSSam Leffler vap->iv_stats.is_rx_notassoc++; 633b032f27cSSam Leffler goto err; 634b032f27cSSam Leffler } 635b032f27cSSam Leffler 636b032f27cSSam Leffler /* 637b032f27cSSam Leffler * Check for power save state change. 638b032f27cSSam Leffler * XXX out-of-order A-MPDU frames? 639b032f27cSSam Leffler */ 640b032f27cSSam Leffler if (((wh->i_fc[1] & IEEE80211_FC1_PWR_MGT) ^ 641b032f27cSSam Leffler (ni->ni_flags & IEEE80211_NODE_PWR_MGT))) 642e7f0d7cfSAdrian Chadd vap->iv_node_ps(ni, 643b032f27cSSam Leffler wh->i_fc[1] & IEEE80211_FC1_PWR_MGT); 644b032f27cSSam Leffler /* 645b032f27cSSam Leffler * For 4-address packets handle WDS discovery 646b032f27cSSam Leffler * notifications. Once a WDS link is setup frames 647b032f27cSSam Leffler * are just delivered to the WDS vap (see below). 648b032f27cSSam Leffler */ 649b032f27cSSam Leffler if (dir == IEEE80211_FC1_DIR_DSTODS && ni->ni_wdsvap == NULL) { 650b032f27cSSam Leffler if (!ieee80211_node_is_authorized(ni)) { 651b032f27cSSam Leffler IEEE80211_DISCARD(vap, 652b032f27cSSam Leffler IEEE80211_MSG_INPUT | 653b032f27cSSam Leffler IEEE80211_MSG_WDS, wh, 654b032f27cSSam Leffler "4-address data", 655b032f27cSSam Leffler "%s", "unauthorized port"); 656b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 657b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unauth); 658b032f27cSSam Leffler goto err; 659b032f27cSSam Leffler } 660b032f27cSSam Leffler ieee80211_dwds_discover(ni, m); 661b032f27cSSam Leffler return type; 662b032f27cSSam Leffler } 663b032f27cSSam Leffler 664b032f27cSSam Leffler /* 66545f856e3SSam Leffler * Handle A-MPDU re-ordering. If the frame is to be 66645f856e3SSam Leffler * processed directly then ieee80211_ampdu_reorder 667b032f27cSSam Leffler * will return 0; otherwise it has consumed the mbuf 668b032f27cSSam Leffler * and we should do nothing more with it. 669b032f27cSSam Leffler */ 67045f856e3SSam Leffler if ((m->m_flags & M_AMPDU) && 67185c4e670SAdrian Chadd ieee80211_ampdu_reorder(ni, m, rxs) != 0) { 672b032f27cSSam Leffler m = NULL; 673b032f27cSSam Leffler goto out; 674b032f27cSSam Leffler } 675b032f27cSSam Leffler resubmit_ampdu: 676b032f27cSSam Leffler 677b032f27cSSam Leffler /* 678b032f27cSSam Leffler * Handle privacy requirements. Note that we 679b032f27cSSam Leffler * must not be preempted from here until after 680b032f27cSSam Leffler * we (potentially) call ieee80211_crypto_demic; 681b032f27cSSam Leffler * otherwise we may violate assumptions in the 682b032f27cSSam Leffler * crypto cipher modules used to do delayed update 683b032f27cSSam Leffler * of replay sequence numbers. 684b032f27cSSam Leffler */ 685fe75b452SAdrian Chadd if (is_hw_decrypted || wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 686b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 687b032f27cSSam Leffler /* 688b032f27cSSam Leffler * Discard encrypted frames when privacy is off. 689b032f27cSSam Leffler */ 690b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 691b032f27cSSam Leffler wh, "WEP", "%s", "PRIVACY off"); 692b032f27cSSam Leffler vap->iv_stats.is_rx_noprivacy++; 693b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_noprivacy); 694b032f27cSSam Leffler goto out; 695b032f27cSSam Leffler } 696fe75b452SAdrian Chadd if (ieee80211_crypto_decap(ni, m, hdrspace, &key) == 0) { 697b032f27cSSam Leffler /* NB: stats+msgs handled in crypto_decap */ 698b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_wepfail); 699b032f27cSSam Leffler goto out; 700b032f27cSSam Leffler } 701b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 7025945b5f5SKevin Lo wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED; 703fe75b452SAdrian Chadd has_decrypted = 1; 704b032f27cSSam Leffler } else { 705b032f27cSSam Leffler /* XXX M_WEP and IEEE80211_F_PRIVACY */ 706b032f27cSSam Leffler key = NULL; 707b032f27cSSam Leffler } 708b032f27cSSam Leffler 709b032f27cSSam Leffler /* 710b032f27cSSam Leffler * Save QoS bits for use below--before we strip the header. 711b032f27cSSam Leffler */ 712f3f08e16SAndriy Voskoboinyk if (subtype == IEEE80211_FC0_SUBTYPE_QOS) 713f3f08e16SAndriy Voskoboinyk qos = ieee80211_getqos(wh)[0]; 714f3f08e16SAndriy Voskoboinyk else 715b032f27cSSam Leffler qos = 0; 716b032f27cSSam Leffler 717b032f27cSSam Leffler /* 718b032f27cSSam Leffler * Next up, any fragmentation. 719b032f27cSSam Leffler */ 720b032f27cSSam Leffler if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) { 721b032f27cSSam Leffler m = ieee80211_defrag(ni, m, hdrspace); 722b032f27cSSam Leffler if (m == NULL) { 723b032f27cSSam Leffler /* Fragment dropped or frame not complete yet */ 724b032f27cSSam Leffler goto out; 725b032f27cSSam Leffler } 726b032f27cSSam Leffler } 727b032f27cSSam Leffler wh = NULL; /* no longer valid, catch any uses */ 728b032f27cSSam Leffler 729b032f27cSSam Leffler /* 730b032f27cSSam Leffler * Next strip any MSDU crypto bits. 731b032f27cSSam Leffler */ 732b032f27cSSam Leffler if (key != NULL && !ieee80211_crypto_demic(vap, key, m, 0)) { 733b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 734b032f27cSSam Leffler ni->ni_macaddr, "data", "%s", "demic error"); 735b032f27cSSam Leffler vap->iv_stats.is_rx_demicfail++; 736b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_demicfail); 737b032f27cSSam Leffler goto out; 738b032f27cSSam Leffler } 739b032f27cSSam Leffler /* copy to listener after decrypt */ 7405463c4a4SSam Leffler if (ieee80211_radiotap_active_vap(vap)) 7415463c4a4SSam Leffler ieee80211_radiotap_rx(vap, m); 742b032f27cSSam Leffler need_tap = 0; 743b032f27cSSam Leffler /* 744b032f27cSSam Leffler * Finally, strip the 802.11 header. 745b032f27cSSam Leffler */ 746b032f27cSSam Leffler m = ieee80211_decap(vap, m, hdrspace); 747b032f27cSSam Leffler if (m == NULL) { 748b032f27cSSam Leffler /* XXX mask bit to check for both */ 749b032f27cSSam Leffler /* don't count Null data frames as errors */ 750b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_NODATA || 751b032f27cSSam Leffler subtype == IEEE80211_FC0_SUBTYPE_QOS_NULL) 752b032f27cSSam Leffler goto out; 753b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 754b032f27cSSam Leffler ni->ni_macaddr, "data", "%s", "decap error"); 755b032f27cSSam Leffler vap->iv_stats.is_rx_decap++; 756b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_decap); 757b032f27cSSam Leffler goto err; 758b032f27cSSam Leffler } 759b032f27cSSam Leffler eh = mtod(m, struct ether_header *); 760b032f27cSSam Leffler if (!ieee80211_node_is_authorized(ni)) { 761b032f27cSSam Leffler /* 762b032f27cSSam Leffler * Deny any non-PAE frames received prior to 763b032f27cSSam Leffler * authorization. For open/shared-key 764b032f27cSSam Leffler * authentication the port is mark authorized 765b032f27cSSam Leffler * after authentication completes. For 802.1x 766b032f27cSSam Leffler * the port is not marked authorized by the 767b032f27cSSam Leffler * authenticator until the handshake has completed. 768b032f27cSSam Leffler */ 769b032f27cSSam Leffler if (eh->ether_type != htons(ETHERTYPE_PAE)) { 770b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_INPUT, 771b032f27cSSam Leffler eh->ether_shost, "data", 772b032f27cSSam Leffler "unauthorized port: ether type 0x%x len %u", 773b032f27cSSam Leffler eh->ether_type, m->m_pkthdr.len); 774b032f27cSSam Leffler vap->iv_stats.is_rx_unauth++; 775b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unauth); 776b032f27cSSam Leffler goto err; 777b032f27cSSam Leffler } 778b032f27cSSam Leffler } else { 779b032f27cSSam Leffler /* 780b032f27cSSam Leffler * When denying unencrypted frames, discard 781b032f27cSSam Leffler * any non-PAE frames received without encryption. 782b032f27cSSam Leffler */ 783b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_DROPUNENC) && 784fe75b452SAdrian Chadd ((has_decrypted == 0) && (m->m_flags & M_WEP) == 0) && 785fe75b452SAdrian Chadd (is_hw_decrypted == 0) && 786b032f27cSSam Leffler eh->ether_type != htons(ETHERTYPE_PAE)) { 787b032f27cSSam Leffler /* 788b032f27cSSam Leffler * Drop unencrypted frames. 789b032f27cSSam Leffler */ 790b032f27cSSam Leffler vap->iv_stats.is_rx_unencrypted++; 791b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_unencrypted); 792b032f27cSSam Leffler goto out; 793b032f27cSSam Leffler } 794b032f27cSSam Leffler } 795b032f27cSSam Leffler /* XXX require HT? */ 796b032f27cSSam Leffler if (qos & IEEE80211_QOS_AMSDU) { 797b032f27cSSam Leffler m = ieee80211_decap_amsdu(ni, m); 798b032f27cSSam Leffler if (m == NULL) 799b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 800616190d0SSam Leffler } else { 801616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 802616190d0SSam Leffler m = ieee80211_decap_fastframe(vap, ni, m); 803b032f27cSSam Leffler if (m == NULL) 804b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 805616190d0SSam Leffler #endif 806b032f27cSSam Leffler } 807b032f27cSSam Leffler if (dir == IEEE80211_FC1_DIR_DSTODS && ni->ni_wdsvap != NULL) 808b032f27cSSam Leffler ieee80211_deliver_data(ni->ni_wdsvap, ni, m); 809b032f27cSSam Leffler else 810b032f27cSSam Leffler hostap_deliver_data(vap, ni, m); 811b032f27cSSam Leffler return IEEE80211_FC0_TYPE_DATA; 812b032f27cSSam Leffler 813b032f27cSSam Leffler case IEEE80211_FC0_TYPE_MGT: 814b032f27cSSam Leffler vap->iv_stats.is_rx_mgmt++; 815b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_mgmt); 816b032f27cSSam Leffler if (dir != IEEE80211_FC1_DIR_NODS) { 817b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 818b032f27cSSam Leffler wh, "mgt", "incorrect dir 0x%x", dir); 819b032f27cSSam Leffler vap->iv_stats.is_rx_wrongdir++; 820b032f27cSSam Leffler goto err; 821b032f27cSSam Leffler } 822b032f27cSSam Leffler if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) { 823b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_ANY, 824b032f27cSSam Leffler ni->ni_macaddr, "mgt", "too short: len %u", 825b032f27cSSam Leffler m->m_pkthdr.len); 826b032f27cSSam Leffler vap->iv_stats.is_rx_tooshort++; 827b032f27cSSam Leffler goto out; 828b032f27cSSam Leffler } 829b032f27cSSam Leffler if (IEEE80211_IS_MULTICAST(wh->i_addr2)) { 830b032f27cSSam Leffler /* ensure return frames are unicast */ 831b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 832b032f27cSSam Leffler wh, NULL, "source is multicast: %s", 833b032f27cSSam Leffler ether_sprintf(wh->i_addr2)); 834b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; /* XXX stat */ 835b032f27cSSam Leffler goto out; 836b032f27cSSam Leffler } 837b032f27cSSam Leffler #ifdef IEEE80211_DEBUG 838b032f27cSSam Leffler if ((ieee80211_msg_debug(vap) && doprint(vap, subtype)) || 839b032f27cSSam Leffler ieee80211_msg_dumppkts(vap)) { 840b032f27cSSam Leffler if_printf(ifp, "received %s from %s rssi %d\n", 8414357a5d1SAndriy Voskoboinyk ieee80211_mgt_subtype_name(subtype), 842b032f27cSSam Leffler ether_sprintf(wh->i_addr2), rssi); 843b032f27cSSam Leffler } 844b032f27cSSam Leffler #endif 8455945b5f5SKevin Lo if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) { 846b032f27cSSam Leffler if (subtype != IEEE80211_FC0_SUBTYPE_AUTH) { 847b032f27cSSam Leffler /* 848b032f27cSSam Leffler * Only shared key auth frames with a challenge 849b032f27cSSam Leffler * should be encrypted, discard all others. 850b032f27cSSam Leffler */ 851b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 852b032f27cSSam Leffler wh, NULL, 853b032f27cSSam Leffler "%s", "WEP set but not permitted"); 854b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; /* XXX */ 855b032f27cSSam Leffler goto out; 856b032f27cSSam Leffler } 857b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 858b032f27cSSam Leffler /* 859b032f27cSSam Leffler * Discard encrypted frames when privacy is off. 860b032f27cSSam Leffler */ 861b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 862b032f27cSSam Leffler wh, NULL, "%s", "WEP set but PRIVACY off"); 863b032f27cSSam Leffler vap->iv_stats.is_rx_noprivacy++; 864b032f27cSSam Leffler goto out; 865b032f27cSSam Leffler } 866b032f27cSSam Leffler hdrspace = ieee80211_hdrspace(ic, wh); 867fe75b452SAdrian Chadd if (ieee80211_crypto_decap(ni, m, hdrspace, &key) == 0) { 868b032f27cSSam Leffler /* NB: stats+msgs handled in crypto_decap */ 869b032f27cSSam Leffler goto out; 870b032f27cSSam Leffler } 871b032f27cSSam Leffler wh = mtod(m, struct ieee80211_frame *); 8725945b5f5SKevin Lo wh->i_fc[1] &= ~IEEE80211_FC1_PROTECTED; 873fe75b452SAdrian Chadd has_decrypted = 1; 874b032f27cSSam Leffler } 8754e87d54aSRui Paulo /* 8764e87d54aSRui Paulo * Pass the packet to radiotap before calling iv_recv_mgmt(). 8774e87d54aSRui Paulo * Otherwise iv_recv_mgmt() might pass another packet to 8784e87d54aSRui Paulo * radiotap, resulting in out of order packet captures. 8794e87d54aSRui Paulo */ 880323f12abSRui Paulo if (ieee80211_radiotap_active_vap(vap)) 881323f12abSRui Paulo ieee80211_radiotap_rx(vap, m); 882323f12abSRui Paulo need_tap = 0; 883c79f192cSAdrian Chadd vap->iv_recv_mgmt(ni, m, subtype, rxs, rssi, nf); 8848bbd3e41SSam Leffler goto out; 885b032f27cSSam Leffler 886b032f27cSSam Leffler case IEEE80211_FC0_TYPE_CTL: 887b032f27cSSam Leffler vap->iv_stats.is_rx_ctl++; 888b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_ctrl); 88949eae5f7SSam Leffler vap->iv_recv_ctl(ni, m, subtype); 890b032f27cSSam Leffler goto out; 891b032f27cSSam Leffler default: 892b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 893b032f27cSSam Leffler wh, "bad", "frame type 0x%x", type); 894b032f27cSSam Leffler /* should not come here */ 895b032f27cSSam Leffler break; 896b032f27cSSam Leffler } 897b032f27cSSam Leffler err: 898dea45121SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 899b032f27cSSam Leffler out: 900b032f27cSSam Leffler if (m != NULL) { 901a6c3cf3eSSam Leffler if (need_tap && ieee80211_radiotap_active_vap(vap)) 9025463c4a4SSam Leffler ieee80211_radiotap_rx(vap, m); 903b032f27cSSam Leffler m_freem(m); 904b032f27cSSam Leffler } 905b032f27cSSam Leffler return type; 906b032f27cSSam Leffler } 907b032f27cSSam Leffler 908b032f27cSSam Leffler static void 909b032f27cSSam Leffler hostap_auth_open(struct ieee80211_node *ni, struct ieee80211_frame *wh, 9105463c4a4SSam Leffler int rssi, int nf, uint16_t seq, uint16_t status) 911b032f27cSSam Leffler { 912b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 913b032f27cSSam Leffler 914b032f27cSSam Leffler KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 915b032f27cSSam Leffler 916b032f27cSSam Leffler if (ni->ni_authmode == IEEE80211_AUTH_SHARED) { 917b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 918b032f27cSSam Leffler ni->ni_macaddr, "open auth", 919b032f27cSSam Leffler "bad sta auth mode %u", ni->ni_authmode); 920b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; /* XXX */ 921b032f27cSSam Leffler /* 922b032f27cSSam Leffler * Clear any challenge text that may be there if 923b032f27cSSam Leffler * a previous shared key auth failed and then an 924b032f27cSSam Leffler * open auth is attempted. 925b032f27cSSam Leffler */ 926b032f27cSSam Leffler if (ni->ni_challenge != NULL) { 927b9b53389SAdrian Chadd IEEE80211_FREE(ni->ni_challenge, M_80211_NODE); 928b032f27cSSam Leffler ni->ni_challenge = NULL; 929b032f27cSSam Leffler } 930b032f27cSSam Leffler /* XXX hack to workaround calling convention */ 931b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 932b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 933b032f27cSSam Leffler (seq + 1) | (IEEE80211_STATUS_ALG<<16)); 934b032f27cSSam Leffler return; 935b032f27cSSam Leffler } 936b032f27cSSam Leffler if (seq != IEEE80211_AUTH_OPEN_REQUEST) { 937b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 938b032f27cSSam Leffler return; 939b032f27cSSam Leffler } 940b032f27cSSam Leffler /* always accept open authentication requests */ 941b032f27cSSam Leffler if (ni == vap->iv_bss) { 942b032f27cSSam Leffler ni = ieee80211_dup_bss(vap, wh->i_addr2); 943b032f27cSSam Leffler if (ni == NULL) 944b032f27cSSam Leffler return; 945b032f27cSSam Leffler } else if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0) 946b032f27cSSam Leffler (void) ieee80211_ref_node(ni); 947b032f27cSSam Leffler /* 948b032f27cSSam Leffler * Mark the node as referenced to reflect that it's 949b032f27cSSam Leffler * reference count has been bumped to insure it remains 950b032f27cSSam Leffler * after the transaction completes. 951b032f27cSSam Leffler */ 952b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_AREF; 9531b999d64SSam Leffler /* 95412c290feSSam Leffler * Mark the node as requiring a valid association id 9551b999d64SSam Leffler * before outbound traffic is permitted. 9561b999d64SSam Leffler */ 9571b999d64SSam Leffler ni->ni_flags |= IEEE80211_NODE_ASSOCID; 958b032f27cSSam Leffler 959b032f27cSSam Leffler if (vap->iv_acl != NULL && 960b032f27cSSam Leffler vap->iv_acl->iac_getpolicy(vap) == IEEE80211_MACCMD_POLICY_RADIUS) { 961b032f27cSSam Leffler /* 962b032f27cSSam Leffler * When the ACL policy is set to RADIUS we defer the 963b032f27cSSam Leffler * authorization to a user agent. Dispatch an event, 964b032f27cSSam Leffler * a subsequent MLME call will decide the fate of the 965b032f27cSSam Leffler * station. If the user agent is not present then the 966b032f27cSSam Leffler * node will be reclaimed due to inactivity. 967b032f27cSSam Leffler */ 968b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 969b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_ACL, ni->ni_macaddr, 970b032f27cSSam Leffler "%s", "station authentication defered (radius acl)"); 971b032f27cSSam Leffler ieee80211_notify_node_auth(ni); 972b032f27cSSam Leffler } else { 973b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 974b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 975b032f27cSSam Leffler IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, ni->ni_macaddr, 976b032f27cSSam Leffler "%s", "station authenticated (open)"); 977b032f27cSSam Leffler /* 978b032f27cSSam Leffler * When 802.1x is not in use mark the port 979b032f27cSSam Leffler * authorized at this point so traffic can flow. 980b032f27cSSam Leffler */ 981b032f27cSSam Leffler if (ni->ni_authmode != IEEE80211_AUTH_8021X) 982b032f27cSSam Leffler ieee80211_node_authorize(ni); 983b032f27cSSam Leffler } 984b032f27cSSam Leffler } 985b032f27cSSam Leffler 986b032f27cSSam Leffler static void 987b032f27cSSam Leffler hostap_auth_shared(struct ieee80211_node *ni, struct ieee80211_frame *wh, 9885463c4a4SSam Leffler uint8_t *frm, uint8_t *efrm, int rssi, int nf, 989b032f27cSSam Leffler uint16_t seq, uint16_t status) 990b032f27cSSam Leffler { 991b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 992b032f27cSSam Leffler uint8_t *challenge; 993b032f27cSSam Leffler int allocbs, estatus; 994b032f27cSSam Leffler 995b032f27cSSam Leffler KASSERT(vap->iv_state == IEEE80211_S_RUN, ("state %d", vap->iv_state)); 996b032f27cSSam Leffler 997b032f27cSSam Leffler /* 998b032f27cSSam Leffler * NB: this can happen as we allow pre-shared key 999b032f27cSSam Leffler * authentication to be enabled w/o wep being turned 1000b032f27cSSam Leffler * on so that configuration of these can be done 1001b032f27cSSam Leffler * in any order. It may be better to enforce the 1002b032f27cSSam Leffler * ordering in which case this check would just be 1003b032f27cSSam Leffler * for sanity/consistency. 1004b032f27cSSam Leffler */ 1005b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0) { 1006b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1007b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1008b032f27cSSam Leffler "%s", " PRIVACY is disabled"); 1009b032f27cSSam Leffler estatus = IEEE80211_STATUS_ALG; 1010b032f27cSSam Leffler goto bad; 1011b032f27cSSam Leffler } 1012b032f27cSSam Leffler /* 1013b032f27cSSam Leffler * Pre-shared key authentication is evil; accept 1014b032f27cSSam Leffler * it only if explicitly configured (it is supported 1015b032f27cSSam Leffler * mainly for compatibility with clients like Mac OS X). 1016b032f27cSSam Leffler */ 1017b032f27cSSam Leffler if (ni->ni_authmode != IEEE80211_AUTH_AUTO && 1018b032f27cSSam Leffler ni->ni_authmode != IEEE80211_AUTH_SHARED) { 1019b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1020b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1021b032f27cSSam Leffler "bad sta auth mode %u", ni->ni_authmode); 1022b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; /* XXX maybe a unique error? */ 1023b032f27cSSam Leffler estatus = IEEE80211_STATUS_ALG; 1024b032f27cSSam Leffler goto bad; 1025b032f27cSSam Leffler } 1026b032f27cSSam Leffler 1027b032f27cSSam Leffler challenge = NULL; 1028b032f27cSSam Leffler if (frm + 1 < efrm) { 1029b032f27cSSam Leffler if ((frm[1] + 2) > (efrm - frm)) { 1030b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1031b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1032b032f27cSSam Leffler "ie %d/%d too long", 1033b032f27cSSam Leffler frm[0], (frm[1] + 2) - (efrm - frm)); 1034b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1035b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1036b032f27cSSam Leffler goto bad; 1037b032f27cSSam Leffler } 1038b032f27cSSam Leffler if (*frm == IEEE80211_ELEMID_CHALLENGE) 1039b032f27cSSam Leffler challenge = frm; 1040b032f27cSSam Leffler frm += frm[1] + 2; 1041b032f27cSSam Leffler } 1042b032f27cSSam Leffler switch (seq) { 1043b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_CHALLENGE: 1044b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_RESPONSE: 1045b032f27cSSam Leffler if (challenge == NULL) { 1046b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1047b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1048b032f27cSSam Leffler "%s", "no challenge"); 1049b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1050b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1051b032f27cSSam Leffler goto bad; 1052b032f27cSSam Leffler } 1053b032f27cSSam Leffler if (challenge[1] != IEEE80211_CHALLENGE_LEN) { 1054b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1055b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1056b032f27cSSam Leffler "bad challenge len %d", challenge[1]); 1057b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1058b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1059b032f27cSSam Leffler goto bad; 1060b032f27cSSam Leffler } 1061b032f27cSSam Leffler default: 1062b032f27cSSam Leffler break; 1063b032f27cSSam Leffler } 1064b032f27cSSam Leffler switch (seq) { 1065b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_REQUEST: 1066b032f27cSSam Leffler if (ni == vap->iv_bss) { 1067b032f27cSSam Leffler ni = ieee80211_dup_bss(vap, wh->i_addr2); 1068b032f27cSSam Leffler if (ni == NULL) { 1069b032f27cSSam Leffler /* NB: no way to return an error */ 1070b032f27cSSam Leffler return; 1071b032f27cSSam Leffler } 1072b032f27cSSam Leffler allocbs = 1; 1073b032f27cSSam Leffler } else { 1074b032f27cSSam Leffler if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0) 1075b032f27cSSam Leffler (void) ieee80211_ref_node(ni); 1076b032f27cSSam Leffler allocbs = 0; 1077b032f27cSSam Leffler } 1078b032f27cSSam Leffler /* 1079b032f27cSSam Leffler * Mark the node as referenced to reflect that it's 1080b032f27cSSam Leffler * reference count has been bumped to insure it remains 1081b032f27cSSam Leffler * after the transaction completes. 1082b032f27cSSam Leffler */ 1083b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_AREF; 10841b999d64SSam Leffler /* 10856dbbec93SAndriy Voskoboinyk * Mark the node as requiring a valid association id 10861b999d64SSam Leffler * before outbound traffic is permitted. 10871b999d64SSam Leffler */ 10881b999d64SSam Leffler ni->ni_flags |= IEEE80211_NODE_ASSOCID; 1089b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 10905463c4a4SSam Leffler ni->ni_noise = nf; 1091b032f27cSSam Leffler if (!ieee80211_alloc_challenge(ni)) { 1092b032f27cSSam Leffler /* NB: don't return error so they rexmit */ 1093b032f27cSSam Leffler return; 1094b032f27cSSam Leffler } 1095b032f27cSSam Leffler get_random_bytes(ni->ni_challenge, 1096b032f27cSSam Leffler IEEE80211_CHALLENGE_LEN); 1097b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, 1098b032f27cSSam Leffler ni, "shared key %sauth request", allocbs ? "" : "re"); 1099b032f27cSSam Leffler /* 1100b032f27cSSam Leffler * When the ACL policy is set to RADIUS we defer the 1101b032f27cSSam Leffler * authorization to a user agent. Dispatch an event, 1102b032f27cSSam Leffler * a subsequent MLME call will decide the fate of the 1103b032f27cSSam Leffler * station. If the user agent is not present then the 1104b032f27cSSam Leffler * node will be reclaimed due to inactivity. 1105b032f27cSSam Leffler */ 1106b032f27cSSam Leffler if (vap->iv_acl != NULL && 1107b032f27cSSam Leffler vap->iv_acl->iac_getpolicy(vap) == IEEE80211_MACCMD_POLICY_RADIUS) { 1108b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, 1109b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_ACL, 1110b032f27cSSam Leffler ni->ni_macaddr, 1111b032f27cSSam Leffler "%s", "station authentication defered (radius acl)"); 1112b032f27cSSam Leffler ieee80211_notify_node_auth(ni); 1113b032f27cSSam Leffler return; 1114b032f27cSSam Leffler } 1115b032f27cSSam Leffler break; 1116b032f27cSSam Leffler case IEEE80211_AUTH_SHARED_RESPONSE: 1117b032f27cSSam Leffler if (ni == vap->iv_bss) { 1118b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1119b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1120b032f27cSSam Leffler "%s", "unknown station"); 1121b032f27cSSam Leffler /* NB: don't send a response */ 1122b032f27cSSam Leffler return; 1123b032f27cSSam Leffler } 1124b032f27cSSam Leffler if (ni->ni_challenge == NULL) { 1125b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1126b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1127b032f27cSSam Leffler "%s", "no challenge recorded"); 1128b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1129b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1130b032f27cSSam Leffler goto bad; 1131b032f27cSSam Leffler } 1132b032f27cSSam Leffler if (memcmp(ni->ni_challenge, &challenge[2], 1133b032f27cSSam Leffler challenge[1]) != 0) { 1134b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1135b032f27cSSam Leffler ni->ni_macaddr, "shared key response", 1136b032f27cSSam Leffler "%s", "challenge mismatch"); 1137b032f27cSSam Leffler vap->iv_stats.is_rx_auth_fail++; 1138b032f27cSSam Leffler estatus = IEEE80211_STATUS_CHALLENGE; 1139b032f27cSSam Leffler goto bad; 1140b032f27cSSam Leffler } 1141b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH, 1142b032f27cSSam Leffler ni, "%s", "station authenticated (shared key)"); 1143b032f27cSSam Leffler ieee80211_node_authorize(ni); 1144b032f27cSSam Leffler break; 1145b032f27cSSam Leffler default: 1146b032f27cSSam Leffler IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_AUTH, 1147b032f27cSSam Leffler ni->ni_macaddr, "shared key auth", 1148b032f27cSSam Leffler "bad seq %d", seq); 1149b032f27cSSam Leffler vap->iv_stats.is_rx_bad_auth++; 1150b032f27cSSam Leffler estatus = IEEE80211_STATUS_SEQUENCE; 1151b032f27cSSam Leffler goto bad; 1152b032f27cSSam Leffler } 1153b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_AUTH, seq + 1); 1154b032f27cSSam Leffler return; 1155b032f27cSSam Leffler bad: 1156b032f27cSSam Leffler /* 1157b032f27cSSam Leffler * Send an error response; but only when operating as an AP. 1158b032f27cSSam Leffler */ 1159b032f27cSSam Leffler /* XXX hack to workaround calling convention */ 1160b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1161b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1162b032f27cSSam Leffler (seq + 1) | (estatus<<16)); 1163b032f27cSSam Leffler } 1164b032f27cSSam Leffler 1165b032f27cSSam Leffler /* 1166b032f27cSSam Leffler * Convert a WPA cipher selector OUI to an internal 1167b032f27cSSam Leffler * cipher algorithm. Where appropriate we also 1168b032f27cSSam Leffler * record any key length. 1169b032f27cSSam Leffler */ 1170b032f27cSSam Leffler static int 117195d9a127SAndriy Voskoboinyk wpa_cipher(const uint8_t *sel, uint8_t *keylen, uint8_t *cipher) 1172b032f27cSSam Leffler { 1173b032f27cSSam Leffler #define WPA_SEL(x) (((x)<<24)|WPA_OUI) 117431021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1175b032f27cSSam Leffler 1176b032f27cSSam Leffler switch (w) { 1177b032f27cSSam Leffler case WPA_SEL(WPA_CSE_NULL): 117895d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_NONE; 117995d9a127SAndriy Voskoboinyk break; 1180b032f27cSSam Leffler case WPA_SEL(WPA_CSE_WEP40): 1181b032f27cSSam Leffler if (keylen) 1182b032f27cSSam Leffler *keylen = 40 / NBBY; 118395d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 118495d9a127SAndriy Voskoboinyk break; 1185b032f27cSSam Leffler case WPA_SEL(WPA_CSE_WEP104): 1186b032f27cSSam Leffler if (keylen) 1187b032f27cSSam Leffler *keylen = 104 / NBBY; 118895d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 118995d9a127SAndriy Voskoboinyk break; 1190b032f27cSSam Leffler case WPA_SEL(WPA_CSE_TKIP): 119195d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_TKIP; 119295d9a127SAndriy Voskoboinyk break; 1193b032f27cSSam Leffler case WPA_SEL(WPA_CSE_CCMP): 119495d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_CCM; 119595d9a127SAndriy Voskoboinyk break; 119695d9a127SAndriy Voskoboinyk default: 119795d9a127SAndriy Voskoboinyk return (EINVAL); 1198b032f27cSSam Leffler } 119995d9a127SAndriy Voskoboinyk 120095d9a127SAndriy Voskoboinyk return (0); 1201b032f27cSSam Leffler #undef WPA_SEL 1202b032f27cSSam Leffler } 1203b032f27cSSam Leffler 1204b032f27cSSam Leffler /* 1205b032f27cSSam Leffler * Convert a WPA key management/authentication algorithm 1206b032f27cSSam Leffler * to an internal code. 1207b032f27cSSam Leffler */ 1208b032f27cSSam Leffler static int 1209b032f27cSSam Leffler wpa_keymgmt(const uint8_t *sel) 1210b032f27cSSam Leffler { 1211b032f27cSSam Leffler #define WPA_SEL(x) (((x)<<24)|WPA_OUI) 121231021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1213b032f27cSSam Leffler 1214b032f27cSSam Leffler switch (w) { 1215b032f27cSSam Leffler case WPA_SEL(WPA_ASE_8021X_UNSPEC): 1216b032f27cSSam Leffler return WPA_ASE_8021X_UNSPEC; 1217b032f27cSSam Leffler case WPA_SEL(WPA_ASE_8021X_PSK): 1218b032f27cSSam Leffler return WPA_ASE_8021X_PSK; 1219b032f27cSSam Leffler case WPA_SEL(WPA_ASE_NONE): 1220b032f27cSSam Leffler return WPA_ASE_NONE; 1221b032f27cSSam Leffler } 1222b032f27cSSam Leffler return 0; /* NB: so is discarded */ 1223b032f27cSSam Leffler #undef WPA_SEL 1224b032f27cSSam Leffler } 1225b032f27cSSam Leffler 1226b032f27cSSam Leffler /* 1227b032f27cSSam Leffler * Parse a WPA information element to collect parameters. 1228b032f27cSSam Leffler * Note that we do not validate security parameters; that 1229b032f27cSSam Leffler * is handled by the authenticator; the parsing done here 1230b032f27cSSam Leffler * is just for internal use in making operational decisions. 1231b032f27cSSam Leffler */ 1232b032f27cSSam Leffler static int 1233b032f27cSSam Leffler ieee80211_parse_wpa(struct ieee80211vap *vap, const uint8_t *frm, 1234b032f27cSSam Leffler struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh) 1235b032f27cSSam Leffler { 1236b032f27cSSam Leffler uint8_t len = frm[1]; 1237b032f27cSSam Leffler uint32_t w; 123895d9a127SAndriy Voskoboinyk int error, n; 1239b032f27cSSam Leffler 1240b032f27cSSam Leffler /* 1241b032f27cSSam Leffler * Check the length once for fixed parts: OUI, type, 1242b032f27cSSam Leffler * version, mcast cipher, and 2 selector counts. 1243b032f27cSSam Leffler * Other, variable-length data, must be checked separately. 1244b032f27cSSam Leffler */ 1245b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA1) == 0) { 1246b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1247b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1248b032f27cSSam Leffler wh, "WPA", "not WPA, flags 0x%x", vap->iv_flags); 1249b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1250b032f27cSSam Leffler } 1251b032f27cSSam Leffler if (len < 14) { 1252b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1253b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1254b032f27cSSam Leffler wh, "WPA", "too short, len %u", len); 1255b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1256b032f27cSSam Leffler } 1257b032f27cSSam Leffler frm += 6, len -= 4; /* NB: len is payload only */ 1258f59310a1SRui Paulo /* NB: iswpaoui already validated the OUI and type */ 125931021a2bSAndriy Voskoboinyk w = le16dec(frm); 1260b032f27cSSam Leffler if (w != WPA_VERSION) { 1261b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1262b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1263b032f27cSSam Leffler wh, "WPA", "bad version %u", w); 1264b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1265b032f27cSSam Leffler } 1266b032f27cSSam Leffler frm += 2, len -= 2; 1267b032f27cSSam Leffler 1268b032f27cSSam Leffler memset(rsn, 0, sizeof(*rsn)); 1269b032f27cSSam Leffler 1270b032f27cSSam Leffler /* multicast/group cipher */ 127195d9a127SAndriy Voskoboinyk error = wpa_cipher(frm, &rsn->rsn_mcastkeylen, &rsn->rsn_mcastcipher); 127295d9a127SAndriy Voskoboinyk if (error != 0) { 127395d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 127495d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 127595d9a127SAndriy Voskoboinyk wh, "WPA", "unknown mcast cipher suite %08X", 127695d9a127SAndriy Voskoboinyk le32dec(frm)); 127795d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 127895d9a127SAndriy Voskoboinyk } 1279b032f27cSSam Leffler frm += 4, len -= 4; 1280b032f27cSSam Leffler 1281b032f27cSSam Leffler /* unicast ciphers */ 128231021a2bSAndriy Voskoboinyk n = le16dec(frm); 1283b032f27cSSam Leffler frm += 2, len -= 2; 1284b032f27cSSam Leffler if (len < n*4+2) { 1285b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1286b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1287b032f27cSSam Leffler wh, "WPA", "ucast cipher data too short; len %u, n %u", 1288b032f27cSSam Leffler len, n); 1289b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1290b032f27cSSam Leffler } 1291b032f27cSSam Leffler w = 0; 1292b032f27cSSam Leffler for (; n > 0; n--) { 129395d9a127SAndriy Voskoboinyk uint8_t cipher; 129495d9a127SAndriy Voskoboinyk 129595d9a127SAndriy Voskoboinyk error = wpa_cipher(frm, &rsn->rsn_ucastkeylen, &cipher); 129695d9a127SAndriy Voskoboinyk if (error == 0) 129795d9a127SAndriy Voskoboinyk w |= 1 << cipher; 129895d9a127SAndriy Voskoboinyk 1299b032f27cSSam Leffler frm += 4, len -= 4; 1300b032f27cSSam Leffler } 130195d9a127SAndriy Voskoboinyk if (w == 0) { 130295d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 130395d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 130495d9a127SAndriy Voskoboinyk wh, "WPA", "no usable pairwise cipher suite found (w=%d)", 130595d9a127SAndriy Voskoboinyk w); 130695d9a127SAndriy Voskoboinyk return IEEE80211_REASON_PAIRWISE_CIPHER_INVALID; 130795d9a127SAndriy Voskoboinyk } 130895d9a127SAndriy Voskoboinyk /* XXX other? */ 130995d9a127SAndriy Voskoboinyk if (w & (1 << IEEE80211_CIPHER_AES_CCM)) 1310b032f27cSSam Leffler rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM; 131195d9a127SAndriy Voskoboinyk else 131295d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP; 1313b032f27cSSam Leffler 1314b032f27cSSam Leffler /* key management algorithms */ 131531021a2bSAndriy Voskoboinyk n = le16dec(frm); 1316b032f27cSSam Leffler frm += 2, len -= 2; 1317b032f27cSSam Leffler if (len < n*4) { 1318b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1319b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1320b032f27cSSam Leffler wh, "WPA", "key mgmt alg data too short; len %u, n %u", 1321b032f27cSSam Leffler len, n); 1322b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1323b032f27cSSam Leffler } 1324b032f27cSSam Leffler w = 0; 1325b032f27cSSam Leffler for (; n > 0; n--) { 1326b032f27cSSam Leffler w |= wpa_keymgmt(frm); 1327b032f27cSSam Leffler frm += 4, len -= 4; 1328b032f27cSSam Leffler } 1329b032f27cSSam Leffler if (w & WPA_ASE_8021X_UNSPEC) 1330b032f27cSSam Leffler rsn->rsn_keymgmt = WPA_ASE_8021X_UNSPEC; 1331b032f27cSSam Leffler else 1332b032f27cSSam Leffler rsn->rsn_keymgmt = WPA_ASE_8021X_PSK; 1333b032f27cSSam Leffler 1334b032f27cSSam Leffler if (len > 2) /* optional capabilities */ 133531021a2bSAndriy Voskoboinyk rsn->rsn_caps = le16dec(frm); 1336b032f27cSSam Leffler 1337b032f27cSSam Leffler return 0; 1338b032f27cSSam Leffler } 1339b032f27cSSam Leffler 1340b032f27cSSam Leffler /* 1341b032f27cSSam Leffler * Convert an RSN cipher selector OUI to an internal 1342b032f27cSSam Leffler * cipher algorithm. Where appropriate we also 1343b032f27cSSam Leffler * record any key length. 1344b032f27cSSam Leffler */ 1345b032f27cSSam Leffler static int 134695d9a127SAndriy Voskoboinyk rsn_cipher(const uint8_t *sel, uint8_t *keylen, uint8_t *cipher) 1347b032f27cSSam Leffler { 1348b032f27cSSam Leffler #define RSN_SEL(x) (((x)<<24)|RSN_OUI) 134931021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1350b032f27cSSam Leffler 1351b032f27cSSam Leffler switch (w) { 1352b032f27cSSam Leffler case RSN_SEL(RSN_CSE_NULL): 135395d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_NONE; 135495d9a127SAndriy Voskoboinyk break; 1355b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WEP40): 1356b032f27cSSam Leffler if (keylen) 1357b032f27cSSam Leffler *keylen = 40 / NBBY; 135895d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 135995d9a127SAndriy Voskoboinyk break; 1360b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WEP104): 1361b032f27cSSam Leffler if (keylen) 1362b032f27cSSam Leffler *keylen = 104 / NBBY; 136395d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_WEP; 136495d9a127SAndriy Voskoboinyk break; 1365b032f27cSSam Leffler case RSN_SEL(RSN_CSE_TKIP): 136695d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_TKIP; 136795d9a127SAndriy Voskoboinyk break; 1368b032f27cSSam Leffler case RSN_SEL(RSN_CSE_CCMP): 136995d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_CCM; 137095d9a127SAndriy Voskoboinyk break; 1371b032f27cSSam Leffler case RSN_SEL(RSN_CSE_WRAP): 137295d9a127SAndriy Voskoboinyk *cipher = IEEE80211_CIPHER_AES_OCB; 137395d9a127SAndriy Voskoboinyk break; 137495d9a127SAndriy Voskoboinyk default: 137595d9a127SAndriy Voskoboinyk return (EINVAL); 1376b032f27cSSam Leffler } 137795d9a127SAndriy Voskoboinyk 137895d9a127SAndriy Voskoboinyk return (0); 1379b032f27cSSam Leffler #undef WPA_SEL 1380b032f27cSSam Leffler } 1381b032f27cSSam Leffler 1382b032f27cSSam Leffler /* 1383b032f27cSSam Leffler * Convert an RSN key management/authentication algorithm 1384b032f27cSSam Leffler * to an internal code. 1385b032f27cSSam Leffler */ 1386b032f27cSSam Leffler static int 1387b032f27cSSam Leffler rsn_keymgmt(const uint8_t *sel) 1388b032f27cSSam Leffler { 1389b032f27cSSam Leffler #define RSN_SEL(x) (((x)<<24)|RSN_OUI) 139031021a2bSAndriy Voskoboinyk uint32_t w = le32dec(sel); 1391b032f27cSSam Leffler 1392b032f27cSSam Leffler switch (w) { 1393b032f27cSSam Leffler case RSN_SEL(RSN_ASE_8021X_UNSPEC): 1394b032f27cSSam Leffler return RSN_ASE_8021X_UNSPEC; 1395b032f27cSSam Leffler case RSN_SEL(RSN_ASE_8021X_PSK): 1396b032f27cSSam Leffler return RSN_ASE_8021X_PSK; 1397b032f27cSSam Leffler case RSN_SEL(RSN_ASE_NONE): 1398b032f27cSSam Leffler return RSN_ASE_NONE; 1399b032f27cSSam Leffler } 1400b032f27cSSam Leffler return 0; /* NB: so is discarded */ 1401b032f27cSSam Leffler #undef RSN_SEL 1402b032f27cSSam Leffler } 1403b032f27cSSam Leffler 1404b032f27cSSam Leffler /* 1405b032f27cSSam Leffler * Parse a WPA/RSN information element to collect parameters 1406b032f27cSSam Leffler * and validate the parameters against what has been 1407b032f27cSSam Leffler * configured for the system. 1408b032f27cSSam Leffler */ 1409b032f27cSSam Leffler static int 1410b032f27cSSam Leffler ieee80211_parse_rsn(struct ieee80211vap *vap, const uint8_t *frm, 1411b032f27cSSam Leffler struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh) 1412b032f27cSSam Leffler { 1413b032f27cSSam Leffler uint8_t len = frm[1]; 1414b032f27cSSam Leffler uint32_t w; 141595d9a127SAndriy Voskoboinyk int error, n; 1416b032f27cSSam Leffler 1417b032f27cSSam Leffler /* 1418b032f27cSSam Leffler * Check the length once for fixed parts: 1419b032f27cSSam Leffler * version, mcast cipher, and 2 selector counts. 1420b032f27cSSam Leffler * Other, variable-length data, must be checked separately. 1421b032f27cSSam Leffler */ 1422b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA2) == 0) { 1423b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1424b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1425b032f27cSSam Leffler wh, "WPA", "not RSN, flags 0x%x", vap->iv_flags); 1426b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1427b032f27cSSam Leffler } 142895d9a127SAndriy Voskoboinyk /* XXX may be shorter */ 1429b032f27cSSam Leffler if (len < 10) { 1430b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1431b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1432b032f27cSSam Leffler wh, "RSN", "too short, len %u", len); 1433b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1434b032f27cSSam Leffler } 1435b032f27cSSam Leffler frm += 2; 143631021a2bSAndriy Voskoboinyk w = le16dec(frm); 1437b032f27cSSam Leffler if (w != RSN_VERSION) { 1438b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1439b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1440b032f27cSSam Leffler wh, "RSN", "bad version %u", w); 144195d9a127SAndriy Voskoboinyk return IEEE80211_REASON_UNSUPP_RSN_IE_VERSION; 1442b032f27cSSam Leffler } 1443b032f27cSSam Leffler frm += 2, len -= 2; 1444b032f27cSSam Leffler 1445b032f27cSSam Leffler memset(rsn, 0, sizeof(*rsn)); 1446b032f27cSSam Leffler 1447b032f27cSSam Leffler /* multicast/group cipher */ 144895d9a127SAndriy Voskoboinyk error = rsn_cipher(frm, &rsn->rsn_mcastkeylen, &rsn->rsn_mcastcipher); 144995d9a127SAndriy Voskoboinyk if (error != 0) { 145095d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 145195d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 145295d9a127SAndriy Voskoboinyk wh, "RSN", "unknown mcast cipher suite %08X", 145395d9a127SAndriy Voskoboinyk le32dec(frm)); 145495d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 145595d9a127SAndriy Voskoboinyk } 145695d9a127SAndriy Voskoboinyk if (rsn->rsn_mcastcipher == IEEE80211_CIPHER_NONE) { 145795d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 145895d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 145995d9a127SAndriy Voskoboinyk wh, "RSN", "invalid mcast cipher suite %d", 146095d9a127SAndriy Voskoboinyk rsn->rsn_mcastcipher); 146195d9a127SAndriy Voskoboinyk return IEEE80211_REASON_GROUP_CIPHER_INVALID; 146295d9a127SAndriy Voskoboinyk } 1463b032f27cSSam Leffler frm += 4, len -= 4; 1464b032f27cSSam Leffler 1465b032f27cSSam Leffler /* unicast ciphers */ 146631021a2bSAndriy Voskoboinyk n = le16dec(frm); 1467b032f27cSSam Leffler frm += 2, len -= 2; 1468b032f27cSSam Leffler if (len < n*4+2) { 1469b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1470b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1471b032f27cSSam Leffler wh, "RSN", "ucast cipher data too short; len %u, n %u", 1472b032f27cSSam Leffler len, n); 1473b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1474b032f27cSSam Leffler } 1475b032f27cSSam Leffler w = 0; 147695d9a127SAndriy Voskoboinyk 1477b032f27cSSam Leffler for (; n > 0; n--) { 147895d9a127SAndriy Voskoboinyk uint8_t cipher; 147995d9a127SAndriy Voskoboinyk 148095d9a127SAndriy Voskoboinyk error = rsn_cipher(frm, &rsn->rsn_ucastkeylen, &cipher); 148195d9a127SAndriy Voskoboinyk if (error == 0) 148295d9a127SAndriy Voskoboinyk w |= 1 << cipher; 148395d9a127SAndriy Voskoboinyk 1484b032f27cSSam Leffler frm += 4, len -= 4; 1485b032f27cSSam Leffler } 148695d9a127SAndriy Voskoboinyk if (w & (1 << IEEE80211_CIPHER_AES_CCM)) 1487b032f27cSSam Leffler rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM; 148895d9a127SAndriy Voskoboinyk else if (w & (1 << IEEE80211_CIPHER_AES_OCB)) 148995d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_OCB; 149095d9a127SAndriy Voskoboinyk else if (w & (1 << IEEE80211_CIPHER_TKIP)) 149195d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP; 149295d9a127SAndriy Voskoboinyk else if ((w & (1 << IEEE80211_CIPHER_NONE)) && 149395d9a127SAndriy Voskoboinyk (rsn->rsn_mcastcipher == IEEE80211_CIPHER_WEP || 149495d9a127SAndriy Voskoboinyk rsn->rsn_mcastcipher == IEEE80211_CIPHER_TKIP)) 149595d9a127SAndriy Voskoboinyk rsn->rsn_ucastcipher = IEEE80211_CIPHER_NONE; 149695d9a127SAndriy Voskoboinyk else { 149795d9a127SAndriy Voskoboinyk IEEE80211_DISCARD_IE(vap, 149895d9a127SAndriy Voskoboinyk IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 149995d9a127SAndriy Voskoboinyk wh, "RSN", "no usable pairwise cipher suite found (w=%d)", 150095d9a127SAndriy Voskoboinyk w); 150195d9a127SAndriy Voskoboinyk return IEEE80211_REASON_PAIRWISE_CIPHER_INVALID; 150295d9a127SAndriy Voskoboinyk } 1503b032f27cSSam Leffler 1504b032f27cSSam Leffler /* key management algorithms */ 150531021a2bSAndriy Voskoboinyk n = le16dec(frm); 1506b032f27cSSam Leffler frm += 2, len -= 2; 1507b032f27cSSam Leffler if (len < n*4) { 1508b032f27cSSam Leffler IEEE80211_DISCARD_IE(vap, 1509b032f27cSSam Leffler IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA, 1510b032f27cSSam Leffler wh, "RSN", "key mgmt alg data too short; len %u, n %u", 1511b032f27cSSam Leffler len, n); 1512b032f27cSSam Leffler return IEEE80211_REASON_IE_INVALID; 1513b032f27cSSam Leffler } 1514b032f27cSSam Leffler w = 0; 1515b032f27cSSam Leffler for (; n > 0; n--) { 1516b032f27cSSam Leffler w |= rsn_keymgmt(frm); 1517b032f27cSSam Leffler frm += 4, len -= 4; 1518b032f27cSSam Leffler } 1519b032f27cSSam Leffler if (w & RSN_ASE_8021X_UNSPEC) 1520b032f27cSSam Leffler rsn->rsn_keymgmt = RSN_ASE_8021X_UNSPEC; 1521b032f27cSSam Leffler else 1522b032f27cSSam Leffler rsn->rsn_keymgmt = RSN_ASE_8021X_PSK; 1523b032f27cSSam Leffler 1524b032f27cSSam Leffler /* optional RSN capabilities */ 1525b032f27cSSam Leffler if (len > 2) 152631021a2bSAndriy Voskoboinyk rsn->rsn_caps = le16dec(frm); 1527b032f27cSSam Leffler /* XXXPMKID */ 1528b032f27cSSam Leffler 1529b032f27cSSam Leffler return 0; 1530b032f27cSSam Leffler } 1531b032f27cSSam Leffler 1532b032f27cSSam Leffler /* 1533a4641f4eSPedro F. Giffuni * WPA/802.11i association request processing. 1534b032f27cSSam Leffler */ 1535b032f27cSSam Leffler static int 1536b032f27cSSam Leffler wpa_assocreq(struct ieee80211_node *ni, struct ieee80211_rsnparms *rsnparms, 1537b032f27cSSam Leffler const struct ieee80211_frame *wh, const uint8_t *wpa, 1538b032f27cSSam Leffler const uint8_t *rsn, uint16_t capinfo) 1539b032f27cSSam Leffler { 1540b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1541b032f27cSSam Leffler uint8_t reason; 1542b032f27cSSam Leffler int badwparsn; 1543b032f27cSSam Leffler 1544b032f27cSSam Leffler ni->ni_flags &= ~(IEEE80211_NODE_WPS|IEEE80211_NODE_TSN); 1545b032f27cSSam Leffler if (wpa == NULL && rsn == NULL) { 1546b032f27cSSam Leffler if (vap->iv_flags_ext & IEEE80211_FEXT_WPS) { 1547b032f27cSSam Leffler /* 1548b032f27cSSam Leffler * W-Fi Protected Setup (WPS) permits 1549b032f27cSSam Leffler * clients to associate and pass EAPOL frames 1550b032f27cSSam Leffler * to establish initial credentials. 1551b032f27cSSam Leffler */ 1552b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_WPS; 1553b032f27cSSam Leffler return 1; 1554b032f27cSSam Leffler } 1555b032f27cSSam Leffler if ((vap->iv_flags_ext & IEEE80211_FEXT_TSN) && 1556b032f27cSSam Leffler (capinfo & IEEE80211_CAPINFO_PRIVACY)) { 1557b032f27cSSam Leffler /* 1558b032f27cSSam Leffler * Transitional Security Network. Permits clients 1559b032f27cSSam Leffler * to associate and use WEP while WPA is configured. 1560b032f27cSSam Leffler */ 1561b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_TSN; 1562b032f27cSSam Leffler return 1; 1563b032f27cSSam Leffler } 1564b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, 1565b032f27cSSam Leffler wh, NULL, "%s", "no WPA/RSN IE in association request"); 1566b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1567b032f27cSSam Leffler reason = IEEE80211_REASON_IE_INVALID; 1568b032f27cSSam Leffler goto bad; 1569b032f27cSSam Leffler } 1570b032f27cSSam Leffler /* assert right association security credentials */ 1571b032f27cSSam Leffler badwparsn = 0; /* NB: to silence compiler */ 1572b032f27cSSam Leffler switch (vap->iv_flags & IEEE80211_F_WPA) { 1573b032f27cSSam Leffler case IEEE80211_F_WPA1: 1574b032f27cSSam Leffler badwparsn = (wpa == NULL); 1575b032f27cSSam Leffler break; 1576b032f27cSSam Leffler case IEEE80211_F_WPA2: 1577b032f27cSSam Leffler badwparsn = (rsn == NULL); 1578b032f27cSSam Leffler break; 1579b032f27cSSam Leffler case IEEE80211_F_WPA1|IEEE80211_F_WPA2: 1580b032f27cSSam Leffler badwparsn = (wpa == NULL && rsn == NULL); 1581b032f27cSSam Leffler break; 1582b032f27cSSam Leffler } 1583b032f27cSSam Leffler if (badwparsn) { 1584b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, 1585b032f27cSSam Leffler wh, NULL, 1586b032f27cSSam Leffler "%s", "missing WPA/RSN IE in association request"); 1587b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1588b032f27cSSam Leffler reason = IEEE80211_REASON_IE_INVALID; 1589b032f27cSSam Leffler goto bad; 1590b032f27cSSam Leffler } 1591b032f27cSSam Leffler /* 1592b032f27cSSam Leffler * Parse WPA/RSN information element. 1593b032f27cSSam Leffler */ 1594b032f27cSSam Leffler if (wpa != NULL) 1595b032f27cSSam Leffler reason = ieee80211_parse_wpa(vap, wpa, rsnparms, wh); 1596b032f27cSSam Leffler else 1597b032f27cSSam Leffler reason = ieee80211_parse_rsn(vap, rsn, rsnparms, wh); 1598b032f27cSSam Leffler if (reason != 0) { 159995d9a127SAndriy Voskoboinyk /* XXX wpa->rsn fallback? */ 1600b032f27cSSam Leffler /* XXX distinguish WPA/RSN? */ 1601b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_badwpaie++; 1602b032f27cSSam Leffler goto bad; 1603b032f27cSSam Leffler } 1604b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA, ni, 1605b032f27cSSam Leffler "%s ie: mc %u/%u uc %u/%u key %u caps 0x%x", 1606b032f27cSSam Leffler wpa != NULL ? "WPA" : "RSN", 1607b032f27cSSam Leffler rsnparms->rsn_mcastcipher, rsnparms->rsn_mcastkeylen, 1608b032f27cSSam Leffler rsnparms->rsn_ucastcipher, rsnparms->rsn_ucastkeylen, 1609b032f27cSSam Leffler rsnparms->rsn_keymgmt, rsnparms->rsn_caps); 1610b032f27cSSam Leffler 1611b032f27cSSam Leffler return 1; 1612b032f27cSSam Leffler bad: 1613b032f27cSSam Leffler ieee80211_node_deauth(ni, reason); 1614b032f27cSSam Leffler return 0; 1615b032f27cSSam Leffler } 1616b032f27cSSam Leffler 1617b032f27cSSam Leffler /* XXX find a better place for definition */ 1618b032f27cSSam Leffler struct l2_update_frame { 1619b032f27cSSam Leffler struct ether_header eh; 1620b032f27cSSam Leffler uint8_t dsap; 1621b032f27cSSam Leffler uint8_t ssap; 1622b032f27cSSam Leffler uint8_t control; 1623b032f27cSSam Leffler uint8_t xid[3]; 1624b032f27cSSam Leffler } __packed; 1625b032f27cSSam Leffler 1626b032f27cSSam Leffler /* 1627b032f27cSSam Leffler * Deliver a TGf L2UF frame on behalf of a station. 1628b032f27cSSam Leffler * This primes any bridge when the station is roaming 1629b032f27cSSam Leffler * between ap's on the same wired network. 1630b032f27cSSam Leffler */ 1631b032f27cSSam Leffler static void 1632b032f27cSSam Leffler ieee80211_deliver_l2uf(struct ieee80211_node *ni) 1633b032f27cSSam Leffler { 1634b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1635b032f27cSSam Leffler struct ifnet *ifp = vap->iv_ifp; 1636b032f27cSSam Leffler struct mbuf *m; 1637b032f27cSSam Leffler struct l2_update_frame *l2uf; 1638b032f27cSSam Leffler struct ether_header *eh; 1639b032f27cSSam Leffler 1640b032f27cSSam Leffler m = m_gethdr(M_NOWAIT, MT_DATA); 1641b032f27cSSam Leffler if (m == NULL) { 1642b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_ASSOC, ni, 1643b032f27cSSam Leffler "%s", "no mbuf for l2uf frame"); 1644b032f27cSSam Leffler vap->iv_stats.is_rx_nobuf++; /* XXX not right */ 1645b032f27cSSam Leffler return; 1646b032f27cSSam Leffler } 1647b032f27cSSam Leffler l2uf = mtod(m, struct l2_update_frame *); 1648b032f27cSSam Leffler eh = &l2uf->eh; 1649b032f27cSSam Leffler /* dst: Broadcast address */ 1650b032f27cSSam Leffler IEEE80211_ADDR_COPY(eh->ether_dhost, ifp->if_broadcastaddr); 1651b032f27cSSam Leffler /* src: associated STA */ 1652b032f27cSSam Leffler IEEE80211_ADDR_COPY(eh->ether_shost, ni->ni_macaddr); 1653b032f27cSSam Leffler eh->ether_type = htons(sizeof(*l2uf) - sizeof(*eh)); 1654b032f27cSSam Leffler 1655b032f27cSSam Leffler l2uf->dsap = 0; 1656b032f27cSSam Leffler l2uf->ssap = 0; 1657b032f27cSSam Leffler l2uf->control = 0xf5; 1658b032f27cSSam Leffler l2uf->xid[0] = 0x81; 1659b032f27cSSam Leffler l2uf->xid[1] = 0x80; 1660b032f27cSSam Leffler l2uf->xid[2] = 0x00; 1661b032f27cSSam Leffler 1662b032f27cSSam Leffler m->m_pkthdr.len = m->m_len = sizeof(*l2uf); 1663b032f27cSSam Leffler hostap_deliver_data(vap, ni, m); 1664b032f27cSSam Leffler } 1665b032f27cSSam Leffler 1666b032f27cSSam Leffler static void 1667b032f27cSSam Leffler ratesetmismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1668b032f27cSSam Leffler int reassoc, int resp, const char *tag, int rate) 1669b032f27cSSam Leffler { 1670b032f27cSSam Leffler IEEE80211_NOTE_MAC(ni->ni_vap, IEEE80211_MSG_ANY, wh->i_addr2, 1671b032f27cSSam Leffler "deny %s request, %s rate set mismatch, rate/MCS %d", 1672b032f27cSSam Leffler reassoc ? "reassoc" : "assoc", tag, rate & IEEE80211_RATE_VAL); 1673b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_BASIC_RATE); 1674b032f27cSSam Leffler ieee80211_node_leave(ni); 1675b032f27cSSam Leffler } 1676b032f27cSSam Leffler 1677b032f27cSSam Leffler static void 1678b032f27cSSam Leffler capinfomismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1679b032f27cSSam Leffler int reassoc, int resp, const char *tag, int capinfo) 1680b032f27cSSam Leffler { 1681b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1682b032f27cSSam Leffler 1683b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ANY, wh->i_addr2, 1684b032f27cSSam Leffler "deny %s request, %s mismatch 0x%x", 1685b032f27cSSam Leffler reassoc ? "reassoc" : "assoc", tag, capinfo); 1686b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_CAPINFO); 1687b032f27cSSam Leffler ieee80211_node_leave(ni); 1688b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_capmismatch++; 1689b032f27cSSam Leffler } 1690b032f27cSSam Leffler 1691b032f27cSSam Leffler static void 1692b032f27cSSam Leffler htcapmismatch(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1693b032f27cSSam Leffler int reassoc, int resp) 1694b032f27cSSam Leffler { 1695b032f27cSSam Leffler IEEE80211_NOTE_MAC(ni->ni_vap, IEEE80211_MSG_ANY, wh->i_addr2, 1696b032f27cSSam Leffler "deny %s request, %s missing HT ie", reassoc ? "reassoc" : "assoc"); 1697b032f27cSSam Leffler /* XXX no better code */ 1698b8ee2a22SSam Leffler IEEE80211_SEND_MGMT(ni, resp, IEEE80211_STATUS_MISSING_HT_CAPS); 1699b032f27cSSam Leffler ieee80211_node_leave(ni); 1700b032f27cSSam Leffler } 1701b032f27cSSam Leffler 1702b032f27cSSam Leffler static void 1703b032f27cSSam Leffler authalgreject(struct ieee80211_node *ni, const struct ieee80211_frame *wh, 1704b032f27cSSam Leffler int algo, int seq, int status) 1705b032f27cSSam Leffler { 1706b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1707b032f27cSSam Leffler 1708b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1709b032f27cSSam Leffler wh, NULL, "unsupported alg %d", algo); 1710b032f27cSSam Leffler vap->iv_stats.is_rx_auth_unsupported++; 1711b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, IEEE80211_FC0_SUBTYPE_AUTH, 1712b032f27cSSam Leffler seq | (status << 16)); 1713b032f27cSSam Leffler } 1714b032f27cSSam Leffler 1715b032f27cSSam Leffler static __inline int 1716b032f27cSSam Leffler ishtmixed(const uint8_t *ie) 1717b032f27cSSam Leffler { 1718b032f27cSSam Leffler const struct ieee80211_ie_htinfo *ht = 1719b032f27cSSam Leffler (const struct ieee80211_ie_htinfo *) ie; 1720b032f27cSSam Leffler return (ht->hi_byte2 & IEEE80211_HTINFO_OPMODE) == 1721b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_MIXED; 1722b032f27cSSam Leffler } 1723b032f27cSSam Leffler 1724b032f27cSSam Leffler static int 1725b032f27cSSam Leffler is11bclient(const uint8_t *rates, const uint8_t *xrates) 1726b032f27cSSam Leffler { 1727b032f27cSSam Leffler static const uint32_t brates = (1<<2*1)|(1<<2*2)|(1<<11)|(1<<2*11); 1728b032f27cSSam Leffler int i; 1729b032f27cSSam Leffler 1730b032f27cSSam Leffler /* NB: the 11b clients we care about will not have xrates */ 1731b032f27cSSam Leffler if (xrates != NULL || rates == NULL) 1732b032f27cSSam Leffler return 0; 1733b032f27cSSam Leffler for (i = 0; i < rates[1]; i++) { 1734b032f27cSSam Leffler int r = rates[2+i] & IEEE80211_RATE_VAL; 1735b032f27cSSam Leffler if (r > 2*11 || ((1<<r) & brates) == 0) 1736b032f27cSSam Leffler return 0; 1737b032f27cSSam Leffler } 1738b032f27cSSam Leffler return 1; 1739b032f27cSSam Leffler } 1740b032f27cSSam Leffler 1741b032f27cSSam Leffler static void 1742b032f27cSSam Leffler hostap_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m0, 1743c79f192cSAdrian Chadd int subtype, const struct ieee80211_rx_stats *rxs, int rssi, int nf) 1744b032f27cSSam Leffler { 1745b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 1746b032f27cSSam Leffler struct ieee80211com *ic = ni->ni_ic; 1747b032f27cSSam Leffler struct ieee80211_frame *wh; 1748b032f27cSSam Leffler uint8_t *frm, *efrm, *sfrm; 1749b032f27cSSam Leffler uint8_t *ssid, *rates, *xrates, *wpa, *rsn, *wme, *ath, *htcap; 175051172f62SAdrian Chadd uint8_t *vhtcap, *vhtinfo; 1751b032f27cSSam Leffler int reassoc, resp; 1752b032f27cSSam Leffler uint8_t rate; 1753b032f27cSSam Leffler 1754b032f27cSSam Leffler wh = mtod(m0, struct ieee80211_frame *); 1755b032f27cSSam Leffler frm = (uint8_t *)&wh[1]; 1756b032f27cSSam Leffler efrm = mtod(m0, uint8_t *) + m0->m_len; 1757b032f27cSSam Leffler switch (subtype) { 1758b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_RESP: 1759b032f27cSSam Leffler /* 1760b032f27cSSam Leffler * We process beacon/probe response frames when scanning; 1761b032f27cSSam Leffler * otherwise we check beacon frames for overlapping non-ERP 1762b032f27cSSam Leffler * BSS in 11g and/or overlapping legacy BSS when in HT. 1763b032f27cSSam Leffler */ 17644ba33fd1SAndriy Voskoboinyk if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) { 1765b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1766b032f27cSSam Leffler return; 1767b032f27cSSam Leffler } 17684ba33fd1SAndriy Voskoboinyk /* FALLTHROUGH */ 17694ba33fd1SAndriy Voskoboinyk case IEEE80211_FC0_SUBTYPE_BEACON: { 17704ba33fd1SAndriy Voskoboinyk struct ieee80211_scanparams scan; 17714ba33fd1SAndriy Voskoboinyk 1772b032f27cSSam Leffler /* NB: accept off-channel frames */ 1773c79f192cSAdrian Chadd /* XXX TODO: use rxstatus to determine off-channel details */ 1774c79f192cSAdrian Chadd if (ieee80211_parse_beacon(ni, m0, ic->ic_curchan, &scan) &~ IEEE80211_BPARSE_OFFCHAN) 1775b032f27cSSam Leffler return; 1776b032f27cSSam Leffler /* 1777b032f27cSSam Leffler * Count frame now that we know it's to be processed. 1778b032f27cSSam Leffler */ 1779b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_BEACON) { 1780b032f27cSSam Leffler vap->iv_stats.is_rx_beacon++; /* XXX remove */ 1781b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_beacons); 1782b032f27cSSam Leffler } else 1783b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_proberesp); 1784b032f27cSSam Leffler /* 1785b032f27cSSam Leffler * If scanning, just pass information to the scan module. 1786b032f27cSSam Leffler */ 1787b032f27cSSam Leffler if (ic->ic_flags & IEEE80211_F_SCAN) { 1788b032f27cSSam Leffler if (scan.status == 0 && /* NB: on channel */ 1789b032f27cSSam Leffler (ic->ic_flags_ext & IEEE80211_FEXT_PROBECHAN)) { 1790b032f27cSSam Leffler /* 1791b032f27cSSam Leffler * Actively scanning a channel marked passive; 1792b032f27cSSam Leffler * send a probe request now that we know there 1793b032f27cSSam Leffler * is 802.11 traffic present. 1794b032f27cSSam Leffler * 1795b032f27cSSam Leffler * XXX check if the beacon we recv'd gives 1796b032f27cSSam Leffler * us what we need and suppress the probe req 1797b032f27cSSam Leffler */ 1798b032f27cSSam Leffler ieee80211_probe_curchan(vap, 1); 1799b032f27cSSam Leffler ic->ic_flags_ext &= ~IEEE80211_FEXT_PROBECHAN; 1800b032f27cSSam Leffler } 18012808a02bSAdrian Chadd ieee80211_add_scan(vap, ic->ic_curchan, &scan, wh, 18022808a02bSAdrian Chadd subtype, rssi, nf); 1803b032f27cSSam Leffler return; 1804b032f27cSSam Leffler } 1805b032f27cSSam Leffler /* 1806b032f27cSSam Leffler * Check beacon for overlapping bss w/ non ERP stations. 1807b032f27cSSam Leffler * If we detect one and protection is configured but not 1808b032f27cSSam Leffler * enabled, enable it and start a timer that'll bring us 1809b032f27cSSam Leffler * out if we stop seeing the bss. 1810b032f27cSSam Leffler */ 1811b032f27cSSam Leffler if (IEEE80211_IS_CHAN_ANYG(ic->ic_curchan) && 1812b032f27cSSam Leffler scan.status == 0 && /* NB: on-channel */ 1813b032f27cSSam Leffler ((scan.erp & 0x100) == 0 || /* NB: no ERP, 11b sta*/ 1814b032f27cSSam Leffler (scan.erp & IEEE80211_ERP_NON_ERP_PRESENT))) { 1815b032f27cSSam Leffler ic->ic_lastnonerp = ticks; 1816b032f27cSSam Leffler ic->ic_flags_ext |= IEEE80211_FEXT_NONERP_PR; 1817b032f27cSSam Leffler if (ic->ic_protmode != IEEE80211_PROT_NONE && 1818b032f27cSSam Leffler (ic->ic_flags & IEEE80211_F_USEPROT) == 0) { 1819b032f27cSSam Leffler IEEE80211_NOTE_FRAME(vap, 1820b032f27cSSam Leffler IEEE80211_MSG_ASSOC, wh, 1821b032f27cSSam Leffler "non-ERP present on channel %d " 1822b032f27cSSam Leffler "(saw erp 0x%x from channel %d), " 1823b032f27cSSam Leffler "enable use of protection", 1824b032f27cSSam Leffler ic->ic_curchan->ic_ieee, 1825b032f27cSSam Leffler scan.erp, scan.chan); 1826b032f27cSSam Leffler ic->ic_flags |= IEEE80211_F_USEPROT; 1827b032f27cSSam Leffler ieee80211_notify_erp(ic); 1828b032f27cSSam Leffler } 1829b032f27cSSam Leffler } 1830b032f27cSSam Leffler /* 1831b032f27cSSam Leffler * Check beacon for non-HT station on HT channel 1832b032f27cSSam Leffler * and update HT BSS occupancy as appropriate. 1833b032f27cSSam Leffler */ 1834b032f27cSSam Leffler if (IEEE80211_IS_CHAN_HT(ic->ic_curchan)) { 1835b032f27cSSam Leffler if (scan.status & IEEE80211_BPARSE_OFFCHAN) { 1836b032f27cSSam Leffler /* 1837b032f27cSSam Leffler * Off control channel; only check frames 1838b032f27cSSam Leffler * that come in the extension channel when 1839b032f27cSSam Leffler * operating w/ HT40. 1840b032f27cSSam Leffler */ 1841b032f27cSSam Leffler if (!IEEE80211_IS_CHAN_HT40(ic->ic_curchan)) 1842b032f27cSSam Leffler break; 1843b032f27cSSam Leffler if (scan.chan != ic->ic_curchan->ic_extieee) 1844b032f27cSSam Leffler break; 1845b032f27cSSam Leffler } 1846b032f27cSSam Leffler if (scan.htinfo == NULL) { 1847b032f27cSSam Leffler ieee80211_htprot_update(ic, 1848b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_PROTOPT | 1849b032f27cSSam Leffler IEEE80211_HTINFO_NONHT_PRESENT); 1850b032f27cSSam Leffler } else if (ishtmixed(scan.htinfo)) { 1851b032f27cSSam Leffler /* XXX? take NONHT_PRESENT from beacon? */ 1852b032f27cSSam Leffler ieee80211_htprot_update(ic, 1853b032f27cSSam Leffler IEEE80211_HTINFO_OPMODE_MIXED | 1854b032f27cSSam Leffler IEEE80211_HTINFO_NONHT_PRESENT); 1855b032f27cSSam Leffler } 1856b032f27cSSam Leffler } 1857b032f27cSSam Leffler break; 1858b032f27cSSam Leffler } 1859b032f27cSSam Leffler 1860b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_PROBE_REQ: 1861b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 1862b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1863b032f27cSSam Leffler return; 1864b032f27cSSam Leffler } 1865b032f27cSSam Leffler /* 1866957458a8SAdrian Chadd * Consult the ACL policy module if setup. 1867957458a8SAdrian Chadd */ 18685a8801b0SBernhard Schmidt if (vap->iv_acl != NULL && !vap->iv_acl->iac_check(vap, wh)) { 1869957458a8SAdrian Chadd IEEE80211_DISCARD(vap, IEEE80211_MSG_ACL, 1870957458a8SAdrian Chadd wh, NULL, "%s", "disallowed by ACL"); 1871957458a8SAdrian Chadd vap->iv_stats.is_rx_acl++; 1872957458a8SAdrian Chadd return; 1873957458a8SAdrian Chadd } 1874957458a8SAdrian Chadd /* 1875b032f27cSSam Leffler * prreq frame format 1876b032f27cSSam Leffler * [tlv] ssid 1877b032f27cSSam Leffler * [tlv] supported rates 1878b032f27cSSam Leffler * [tlv] extended supported rates 1879b032f27cSSam Leffler */ 1880b032f27cSSam Leffler ssid = rates = xrates = NULL; 1881b032f27cSSam Leffler while (efrm - frm > 1) { 1882b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, frm[1] + 2, return); 1883b032f27cSSam Leffler switch (*frm) { 1884b032f27cSSam Leffler case IEEE80211_ELEMID_SSID: 1885b032f27cSSam Leffler ssid = frm; 1886b032f27cSSam Leffler break; 1887b032f27cSSam Leffler case IEEE80211_ELEMID_RATES: 1888b032f27cSSam Leffler rates = frm; 1889b032f27cSSam Leffler break; 1890b032f27cSSam Leffler case IEEE80211_ELEMID_XRATES: 1891b032f27cSSam Leffler xrates = frm; 1892b032f27cSSam Leffler break; 1893b032f27cSSam Leffler } 1894b032f27cSSam Leffler frm += frm[1] + 2; 1895b032f27cSSam Leffler } 1896b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE, return); 1897b032f27cSSam Leffler if (xrates != NULL) 1898b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(xrates, 1899b032f27cSSam Leffler IEEE80211_RATE_MAXSIZE - rates[1], return); 1900b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN, return); 1901b032f27cSSam Leffler IEEE80211_VERIFY_SSID(vap->iv_bss, ssid, return); 1902b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_HIDESSID) && ssid[1] == 0) { 1903b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 1904b032f27cSSam Leffler wh, NULL, 1905b032f27cSSam Leffler "%s", "no ssid with ssid suppression enabled"); 1906b032f27cSSam Leffler vap->iv_stats.is_rx_ssidmismatch++; /*XXX*/ 1907b032f27cSSam Leffler return; 1908b032f27cSSam Leffler } 1909b032f27cSSam Leffler 1910b032f27cSSam Leffler /* XXX find a better class or define it's own */ 1911b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_INPUT, wh->i_addr2, 1912b032f27cSSam Leffler "%s", "recv probe req"); 1913b032f27cSSam Leffler /* 1914b032f27cSSam Leffler * Some legacy 11b clients cannot hack a complete 1915b032f27cSSam Leffler * probe response frame. When the request includes 1916b032f27cSSam Leffler * only a bare-bones rate set, communicate this to 1917b032f27cSSam Leffler * the transmit side. 1918b032f27cSSam Leffler */ 1919b032f27cSSam Leffler ieee80211_send_proberesp(vap, wh->i_addr2, 1920b032f27cSSam Leffler is11bclient(rates, xrates) ? IEEE80211_SEND_LEGACY_11B : 0); 1921b032f27cSSam Leffler break; 1922b032f27cSSam Leffler 1923b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_AUTH: { 1924b032f27cSSam Leffler uint16_t algo, seq, status; 1925b032f27cSSam Leffler 1926b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 1927b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 1928b032f27cSSam Leffler return; 1929b032f27cSSam Leffler } 1930b032f27cSSam Leffler if (!IEEE80211_ADDR_EQ(wh->i_addr3, vap->iv_bss->ni_bssid)) { 1931b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 1932b032f27cSSam Leffler wh, NULL, "%s", "wrong bssid"); 1933b032f27cSSam Leffler vap->iv_stats.is_rx_wrongbss++; /*XXX unique stat?*/ 1934b032f27cSSam Leffler return; 1935b032f27cSSam Leffler } 1936b032f27cSSam Leffler /* 1937b032f27cSSam Leffler * auth frame format 1938b032f27cSSam Leffler * [2] algorithm 1939b032f27cSSam Leffler * [2] sequence 1940b032f27cSSam Leffler * [2] status 1941b032f27cSSam Leffler * [tlv*] challenge 1942b032f27cSSam Leffler */ 1943b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, 6, return); 1944b032f27cSSam Leffler algo = le16toh(*(uint16_t *)frm); 1945b032f27cSSam Leffler seq = le16toh(*(uint16_t *)(frm + 2)); 1946b032f27cSSam Leffler status = le16toh(*(uint16_t *)(frm + 4)); 1947b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_AUTH, wh->i_addr2, 1948b032f27cSSam Leffler "recv auth frame with algorithm %d seq %d", algo, seq); 1949b032f27cSSam Leffler /* 1950b032f27cSSam Leffler * Consult the ACL policy module if setup. 1951b032f27cSSam Leffler */ 19525a8801b0SBernhard Schmidt if (vap->iv_acl != NULL && !vap->iv_acl->iac_check(vap, wh)) { 1953b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ACL, 1954b032f27cSSam Leffler wh, NULL, "%s", "disallowed by ACL"); 1955b032f27cSSam Leffler vap->iv_stats.is_rx_acl++; 1956b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1957b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1958b032f27cSSam Leffler (seq+1) | (IEEE80211_STATUS_UNSPECIFIED<<16)); 1959b032f27cSSam Leffler return; 1960b032f27cSSam Leffler } 1961b032f27cSSam Leffler if (vap->iv_flags & IEEE80211_F_COUNTERM) { 1962b032f27cSSam Leffler IEEE80211_DISCARD(vap, 1963b032f27cSSam Leffler IEEE80211_MSG_AUTH | IEEE80211_MSG_CRYPTO, 1964b032f27cSSam Leffler wh, NULL, "%s", "TKIP countermeasures enabled"); 1965b032f27cSSam Leffler vap->iv_stats.is_rx_auth_countermeasures++; 1966b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 1967b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_AUTH, 1968b032f27cSSam Leffler IEEE80211_REASON_MIC_FAILURE); 1969b032f27cSSam Leffler return; 1970b032f27cSSam Leffler } 1971b032f27cSSam Leffler if (algo == IEEE80211_AUTH_ALG_SHARED) 19725463c4a4SSam Leffler hostap_auth_shared(ni, wh, frm + 6, efrm, rssi, nf, 1973b032f27cSSam Leffler seq, status); 19745463c4a4SSam Leffler else if (algo == IEEE80211_AUTH_ALG_OPEN) 19755463c4a4SSam Leffler hostap_auth_open(ni, wh, rssi, nf, seq, status); 1976b032f27cSSam Leffler else if (algo == IEEE80211_AUTH_ALG_LEAP) { 1977b032f27cSSam Leffler authalgreject(ni, wh, algo, 1978b032f27cSSam Leffler seq+1, IEEE80211_STATUS_ALG); 1979b032f27cSSam Leffler return; 1980b032f27cSSam Leffler } else { 1981b032f27cSSam Leffler /* 1982b032f27cSSam Leffler * We assume that an unknown algorithm is the result 1983b032f27cSSam Leffler * of a decryption failure on a shared key auth frame; 1984b032f27cSSam Leffler * return a status code appropriate for that instead 1985b032f27cSSam Leffler * of IEEE80211_STATUS_ALG. 1986b032f27cSSam Leffler * 1987b032f27cSSam Leffler * NB: a seq# of 4 is intentional; the decrypted 1988b032f27cSSam Leffler * frame likely has a bogus seq value. 1989b032f27cSSam Leffler */ 1990b032f27cSSam Leffler authalgreject(ni, wh, algo, 1991b032f27cSSam Leffler 4, IEEE80211_STATUS_CHALLENGE); 1992b032f27cSSam Leffler return; 1993b032f27cSSam Leffler } 1994b032f27cSSam Leffler break; 1995b032f27cSSam Leffler } 1996b032f27cSSam Leffler 1997b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ASSOC_REQ: 1998b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: { 1999b032f27cSSam Leffler uint16_t capinfo, lintval; 2000b032f27cSSam Leffler struct ieee80211_rsnparms rsnparms; 2001b032f27cSSam Leffler 2002b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN) { 2003b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2004b032f27cSSam Leffler return; 2005b032f27cSSam Leffler } 2006b032f27cSSam Leffler if (!IEEE80211_ADDR_EQ(wh->i_addr3, vap->iv_bss->ni_bssid)) { 2007b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 2008b032f27cSSam Leffler wh, NULL, "%s", "wrong bssid"); 2009b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_bss++; 2010b032f27cSSam Leffler return; 2011b032f27cSSam Leffler } 2012b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) { 2013b032f27cSSam Leffler reassoc = 1; 2014b032f27cSSam Leffler resp = IEEE80211_FC0_SUBTYPE_REASSOC_RESP; 2015b032f27cSSam Leffler } else { 2016b032f27cSSam Leffler reassoc = 0; 2017b032f27cSSam Leffler resp = IEEE80211_FC0_SUBTYPE_ASSOC_RESP; 2018b032f27cSSam Leffler } 2019b032f27cSSam Leffler if (ni == vap->iv_bss) { 2020b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ANY, wh->i_addr2, 2021b032f27cSSam Leffler "deny %s request, sta not authenticated", 2022b032f27cSSam Leffler reassoc ? "reassoc" : "assoc"); 2023b032f27cSSam Leffler ieee80211_send_error(ni, wh->i_addr2, 2024b032f27cSSam Leffler IEEE80211_FC0_SUBTYPE_DEAUTH, 2025b032f27cSSam Leffler IEEE80211_REASON_ASSOC_NOT_AUTHED); 2026b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_notauth++; 2027b032f27cSSam Leffler return; 2028b032f27cSSam Leffler } 2029b032f27cSSam Leffler 2030b032f27cSSam Leffler /* 2031b032f27cSSam Leffler * asreq frame format 2032b032f27cSSam Leffler * [2] capability information 2033b032f27cSSam Leffler * [2] listen interval 2034b032f27cSSam Leffler * [6*] current AP address (reassoc only) 2035b032f27cSSam Leffler * [tlv] ssid 2036b032f27cSSam Leffler * [tlv] supported rates 2037b032f27cSSam Leffler * [tlv] extended supported rates 2038b032f27cSSam Leffler * [tlv] WPA or RSN 2039b032f27cSSam Leffler * [tlv] HT capabilities 2040b032f27cSSam Leffler * [tlv] Atheros capabilities 2041b032f27cSSam Leffler */ 2042b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, (reassoc ? 10 : 4), return); 2043b032f27cSSam Leffler capinfo = le16toh(*(uint16_t *)frm); frm += 2; 2044b032f27cSSam Leffler lintval = le16toh(*(uint16_t *)frm); frm += 2; 2045b032f27cSSam Leffler if (reassoc) 2046b032f27cSSam Leffler frm += 6; /* ignore current AP info */ 2047b032f27cSSam Leffler ssid = rates = xrates = wpa = rsn = wme = ath = htcap = NULL; 204851172f62SAdrian Chadd vhtcap = vhtinfo = NULL; 2049b032f27cSSam Leffler sfrm = frm; 2050b032f27cSSam Leffler while (efrm - frm > 1) { 2051b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, frm[1] + 2, return); 2052b032f27cSSam Leffler switch (*frm) { 2053b032f27cSSam Leffler case IEEE80211_ELEMID_SSID: 2054b032f27cSSam Leffler ssid = frm; 2055b032f27cSSam Leffler break; 2056b032f27cSSam Leffler case IEEE80211_ELEMID_RATES: 2057b032f27cSSam Leffler rates = frm; 2058b032f27cSSam Leffler break; 2059b032f27cSSam Leffler case IEEE80211_ELEMID_XRATES: 2060b032f27cSSam Leffler xrates = frm; 2061b032f27cSSam Leffler break; 2062b032f27cSSam Leffler case IEEE80211_ELEMID_RSN: 2063b032f27cSSam Leffler rsn = frm; 2064b032f27cSSam Leffler break; 2065b032f27cSSam Leffler case IEEE80211_ELEMID_HTCAP: 2066b032f27cSSam Leffler htcap = frm; 2067b032f27cSSam Leffler break; 206851172f62SAdrian Chadd case IEEE80211_ELEMID_VHT_CAP: 206951172f62SAdrian Chadd vhtcap = frm; 207051172f62SAdrian Chadd break; 207151172f62SAdrian Chadd case IEEE80211_ELEMID_VHT_OPMODE: 207251172f62SAdrian Chadd vhtinfo = frm; 207351172f62SAdrian Chadd break; 2074b032f27cSSam Leffler case IEEE80211_ELEMID_VENDOR: 2075b032f27cSSam Leffler if (iswpaoui(frm)) 2076b032f27cSSam Leffler wpa = frm; 2077b032f27cSSam Leffler else if (iswmeinfo(frm)) 2078b032f27cSSam Leffler wme = frm; 2079616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 2080b032f27cSSam Leffler else if (isatherosoui(frm)) 2081b032f27cSSam Leffler ath = frm; 2082616190d0SSam Leffler #endif 20832bfc8a91SSam Leffler else if (vap->iv_flags_ht & IEEE80211_FHT_HTCOMPAT) { 2084b032f27cSSam Leffler if (ishtcapoui(frm) && htcap == NULL) 2085b032f27cSSam Leffler htcap = frm; 2086b032f27cSSam Leffler } 2087b032f27cSSam Leffler break; 2088b032f27cSSam Leffler } 2089b032f27cSSam Leffler frm += frm[1] + 2; 2090b032f27cSSam Leffler } 2091b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE, return); 2092b032f27cSSam Leffler if (xrates != NULL) 2093b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(xrates, 2094b032f27cSSam Leffler IEEE80211_RATE_MAXSIZE - rates[1], return); 2095b032f27cSSam Leffler IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN, return); 2096b032f27cSSam Leffler IEEE80211_VERIFY_SSID(vap->iv_bss, ssid, return); 2097b032f27cSSam Leffler if (htcap != NULL) { 2098b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(htcap[1], 2099b032f27cSSam Leffler htcap[0] == IEEE80211_ELEMID_VENDOR ? 2100b032f27cSSam Leffler 4 + sizeof(struct ieee80211_ie_htcap)-2 : 2101b032f27cSSam Leffler sizeof(struct ieee80211_ie_htcap)-2, 2102b032f27cSSam Leffler return); /* XXX just NULL out? */ 2103b032f27cSSam Leffler } 2104b032f27cSSam Leffler 210546788bb1SAdrian Chadd /* Validate VHT IEs */ 210646788bb1SAdrian Chadd if (vhtcap != NULL) { 210746788bb1SAdrian Chadd IEEE80211_VERIFY_LENGTH(vhtcap[1], 210846788bb1SAdrian Chadd sizeof(struct ieee80211_ie_vhtcap) - 2, 210946788bb1SAdrian Chadd return); 211046788bb1SAdrian Chadd } 211146788bb1SAdrian Chadd if (vhtinfo != NULL) { 211246788bb1SAdrian Chadd IEEE80211_VERIFY_LENGTH(vhtinfo[1], 211346788bb1SAdrian Chadd sizeof(struct ieee80211_ie_vht_operation) - 2, 211446788bb1SAdrian Chadd return); 211546788bb1SAdrian Chadd } 21167f19273cSAdrian Chadd 2117b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_WPA) && 2118b032f27cSSam Leffler !wpa_assocreq(ni, &rsnparms, wh, wpa, rsn, capinfo)) 2119b032f27cSSam Leffler return; 2120b032f27cSSam Leffler /* discard challenge after association */ 2121b032f27cSSam Leffler if (ni->ni_challenge != NULL) { 2122b9b53389SAdrian Chadd IEEE80211_FREE(ni->ni_challenge, M_80211_NODE); 2123b032f27cSSam Leffler ni->ni_challenge = NULL; 2124b032f27cSSam Leffler } 2125b032f27cSSam Leffler /* NB: 802.11 spec says to ignore station's privacy bit */ 2126b032f27cSSam Leffler if ((capinfo & IEEE80211_CAPINFO_ESS) == 0) { 2127b032f27cSSam Leffler capinfomismatch(ni, wh, reassoc, resp, 2128b032f27cSSam Leffler "capability", capinfo); 2129b032f27cSSam Leffler return; 2130b032f27cSSam Leffler } 2131b032f27cSSam Leffler /* 2132b032f27cSSam Leffler * Disallow re-associate w/ invalid slot time setting. 2133b032f27cSSam Leffler */ 2134b032f27cSSam Leffler if (ni->ni_associd != 0 && 2135b032f27cSSam Leffler IEEE80211_IS_CHAN_ANYG(ic->ic_bsschan) && 2136b032f27cSSam Leffler ((ni->ni_capinfo ^ capinfo) & IEEE80211_CAPINFO_SHORT_SLOTTIME)) { 2137b032f27cSSam Leffler capinfomismatch(ni, wh, reassoc, resp, 2138b032f27cSSam Leffler "slot time", capinfo); 2139b032f27cSSam Leffler return; 2140b032f27cSSam Leffler } 2141b032f27cSSam Leffler rate = ieee80211_setup_rates(ni, rates, xrates, 2142b032f27cSSam Leffler IEEE80211_F_DOSORT | IEEE80211_F_DOFRATE | 2143b032f27cSSam Leffler IEEE80211_F_DONEGO | IEEE80211_F_DODEL); 2144b032f27cSSam Leffler if (rate & IEEE80211_RATE_BASIC) { 2145b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, "legacy", rate); 2146b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_norate++; 2147b032f27cSSam Leffler return; 2148b032f27cSSam Leffler } 2149b032f27cSSam Leffler /* 2150b032f27cSSam Leffler * If constrained to 11g-only stations reject an 2151b032f27cSSam Leffler * 11b-only station. We cheat a bit here by looking 2152b032f27cSSam Leffler * at the max negotiated xmit rate and assuming anyone 2153b032f27cSSam Leffler * with a best rate <24Mb/s is an 11b station. 2154b032f27cSSam Leffler */ 2155b032f27cSSam Leffler if ((vap->iv_flags & IEEE80211_F_PUREG) && rate < 48) { 2156b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, "11g", rate); 2157b032f27cSSam Leffler vap->iv_stats.is_rx_assoc_norate++; 2158b032f27cSSam Leffler return; 2159b032f27cSSam Leffler } 216051172f62SAdrian Chadd 2161b032f27cSSam Leffler /* 2162b032f27cSSam Leffler * Do HT rate set handling and setup HT node state. 2163b032f27cSSam Leffler */ 2164b032f27cSSam Leffler ni->ni_chan = vap->iv_bss->ni_chan; 216551172f62SAdrian Chadd 216651172f62SAdrian Chadd /* VHT */ 216720235662SAdrian Chadd if (IEEE80211_IS_CHAN_VHT(ni->ni_chan) && 21687f19273cSAdrian Chadd vhtcap != NULL && 216920235662SAdrian Chadd vhtinfo != NULL) { 217051172f62SAdrian Chadd /* XXX TODO; see below */ 217151172f62SAdrian Chadd printf("%s: VHT TODO!\n", __func__); 217251172f62SAdrian Chadd ieee80211_vht_node_init(ni); 217351172f62SAdrian Chadd ieee80211_vht_update_cap(ni, vhtcap, vhtinfo); 217451172f62SAdrian Chadd } else if (ni->ni_flags & IEEE80211_NODE_VHT) 217551172f62SAdrian Chadd ieee80211_vht_node_cleanup(ni); 217651172f62SAdrian Chadd 217751172f62SAdrian Chadd /* HT */ 2178b032f27cSSam Leffler if (IEEE80211_IS_CHAN_HT(ni->ni_chan) && htcap != NULL) { 2179b032f27cSSam Leffler rate = ieee80211_setup_htrates(ni, htcap, 2180b032f27cSSam Leffler IEEE80211_F_DOFMCS | IEEE80211_F_DONEGO | 2181b032f27cSSam Leffler IEEE80211_F_DOBRS); 2182b032f27cSSam Leffler if (rate & IEEE80211_RATE_BASIC) { 2183b032f27cSSam Leffler ratesetmismatch(ni, wh, reassoc, resp, 2184b032f27cSSam Leffler "HT", rate); 2185b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_norate++; 2186b032f27cSSam Leffler return; 2187b032f27cSSam Leffler } 2188fdabd982SSam Leffler ieee80211_ht_node_init(ni); 2189fdabd982SSam Leffler ieee80211_ht_updatehtcap(ni, htcap); 2190b032f27cSSam Leffler } else if (ni->ni_flags & IEEE80211_NODE_HT) 2191b032f27cSSam Leffler ieee80211_ht_node_cleanup(ni); 219251172f62SAdrian Chadd 219351172f62SAdrian Chadd /* Finally - this will use HT/VHT info to change node channel */ 219451172f62SAdrian Chadd if (IEEE80211_IS_CHAN_HT(ni->ni_chan) && htcap != NULL) { 219551172f62SAdrian Chadd ieee80211_ht_updatehtcap_final(ni); 219651172f62SAdrian Chadd } 219751172f62SAdrian Chadd 2198339ccfb3SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 21990e6cbef2SAdrian Chadd /* Always do ff node cleanup; for A-MSDU */ 2200339ccfb3SSam Leffler ieee80211_ff_node_cleanup(ni); 2201339ccfb3SSam Leffler #endif 2202b032f27cSSam Leffler /* 2203b032f27cSSam Leffler * Allow AMPDU operation only with unencrypted traffic 2204b032f27cSSam Leffler * or AES-CCM; the 11n spec only specifies these ciphers 2205b032f27cSSam Leffler * so permitting any others is undefined and can lead 2206b032f27cSSam Leffler * to interoperability problems. 2207b032f27cSSam Leffler */ 2208b032f27cSSam Leffler if ((ni->ni_flags & IEEE80211_NODE_HT) && 2209b032f27cSSam Leffler (((vap->iv_flags & IEEE80211_F_WPA) && 2210b032f27cSSam Leffler rsnparms.rsn_ucastcipher != IEEE80211_CIPHER_AES_CCM) || 2211b032f27cSSam Leffler (vap->iv_flags & (IEEE80211_F_WPA|IEEE80211_F_PRIVACY)) == IEEE80211_F_PRIVACY)) { 2212b032f27cSSam Leffler IEEE80211_NOTE(vap, 2213b032f27cSSam Leffler IEEE80211_MSG_ASSOC | IEEE80211_MSG_11N, ni, 2214b032f27cSSam Leffler "disallow HT use because WEP or TKIP requested, " 2215b032f27cSSam Leffler "capinfo 0x%x ucastcipher %d", capinfo, 2216b032f27cSSam Leffler rsnparms.rsn_ucastcipher); 2217b032f27cSSam Leffler ieee80211_ht_node_cleanup(ni); 22180e6cbef2SAdrian Chadd #ifdef IEEE80211_SUPPORT_SUPERG 22190e6cbef2SAdrian Chadd /* Always do ff node cleanup; for A-MSDU */ 22200e6cbef2SAdrian Chadd ieee80211_ff_node_cleanup(ni); 22210e6cbef2SAdrian Chadd #endif 2222b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_downgrade++; 2223b032f27cSSam Leffler } 2224b032f27cSSam Leffler /* 2225b032f27cSSam Leffler * If constrained to 11n-only stations reject legacy stations. 2226b032f27cSSam Leffler */ 22272bfc8a91SSam Leffler if ((vap->iv_flags_ht & IEEE80211_FHT_PUREN) && 2228b032f27cSSam Leffler (ni->ni_flags & IEEE80211_NODE_HT) == 0) { 2229b032f27cSSam Leffler htcapmismatch(ni, wh, reassoc, resp); 2230b032f27cSSam Leffler vap->iv_stats.is_ht_assoc_nohtcap++; 2231b032f27cSSam Leffler return; 2232b032f27cSSam Leffler } 2233b032f27cSSam Leffler IEEE80211_RSSI_LPF(ni->ni_avgrssi, rssi); 22345463c4a4SSam Leffler ni->ni_noise = nf; 2235b032f27cSSam Leffler ni->ni_intval = lintval; 2236b032f27cSSam Leffler ni->ni_capinfo = capinfo; 2237b032f27cSSam Leffler ni->ni_fhdwell = vap->iv_bss->ni_fhdwell; 2238b032f27cSSam Leffler ni->ni_fhindex = vap->iv_bss->ni_fhindex; 2239b032f27cSSam Leffler /* 2240b032f27cSSam Leffler * Store the IEs. 2241b032f27cSSam Leffler * XXX maybe better to just expand 2242b032f27cSSam Leffler */ 2243b032f27cSSam Leffler if (ieee80211_ies_init(&ni->ni_ies, sfrm, efrm - sfrm)) { 2244b032f27cSSam Leffler #define setie(_ie, _off) ieee80211_ies_setie(ni->ni_ies, _ie, _off) 2245b032f27cSSam Leffler if (wpa != NULL) 2246b032f27cSSam Leffler setie(wpa_ie, wpa - sfrm); 2247b032f27cSSam Leffler if (rsn != NULL) 2248b032f27cSSam Leffler setie(rsn_ie, rsn - sfrm); 2249b032f27cSSam Leffler if (htcap != NULL) 2250b032f27cSSam Leffler setie(htcap_ie, htcap - sfrm); 2251b032f27cSSam Leffler if (wme != NULL) { 2252b032f27cSSam Leffler setie(wme_ie, wme - sfrm); 2253b032f27cSSam Leffler /* 2254b032f27cSSam Leffler * Mark node as capable of QoS. 2255b032f27cSSam Leffler */ 2256b032f27cSSam Leffler ni->ni_flags |= IEEE80211_NODE_QOS; 2257*8379e8dbSAdrian Chadd if (ieee80211_parse_wmeie(wme, wh, ni) > 0) { 2258*8379e8dbSAdrian Chadd if (ni->ni_uapsd != 0) 2259*8379e8dbSAdrian Chadd ni->ni_flags |= 2260*8379e8dbSAdrian Chadd IEEE80211_NODE_UAPSD; 2261*8379e8dbSAdrian Chadd else 2262*8379e8dbSAdrian Chadd ni->ni_flags &= 2263*8379e8dbSAdrian Chadd ~IEEE80211_NODE_UAPSD; 2264*8379e8dbSAdrian Chadd } 2265b032f27cSSam Leffler } else 2266*8379e8dbSAdrian Chadd ni->ni_flags &= 2267*8379e8dbSAdrian Chadd ~(IEEE80211_NODE_QOS | 2268*8379e8dbSAdrian Chadd IEEE80211_NODE_UAPSD); 2269616190d0SSam Leffler #ifdef IEEE80211_SUPPORT_SUPERG 2270b032f27cSSam Leffler if (ath != NULL) { 2271b032f27cSSam Leffler setie(ath_ie, ath - sfrm); 2272b032f27cSSam Leffler /* 2273b032f27cSSam Leffler * Parse ATH station parameters. 2274b032f27cSSam Leffler */ 2275b032f27cSSam Leffler ieee80211_parse_ath(ni, ni->ni_ies.ath_ie); 2276b032f27cSSam Leffler } else 2277616190d0SSam Leffler #endif 2278b032f27cSSam Leffler ni->ni_ath_flags = 0; 2279b032f27cSSam Leffler #undef setie 2280b032f27cSSam Leffler } else { 2281b032f27cSSam Leffler ni->ni_flags &= ~IEEE80211_NODE_QOS; 2282*8379e8dbSAdrian Chadd ni->ni_flags &= ~IEEE80211_NODE_UAPSD; 2283b032f27cSSam Leffler ni->ni_ath_flags = 0; 2284b032f27cSSam Leffler } 2285b032f27cSSam Leffler ieee80211_node_join(ni, resp); 2286b032f27cSSam Leffler ieee80211_deliver_l2uf(ni); 2287b032f27cSSam Leffler break; 2288b032f27cSSam Leffler } 2289b032f27cSSam Leffler 2290b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_DEAUTH: 2291b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_DISASSOC: { 2292b032f27cSSam Leffler uint16_t reason; 2293b032f27cSSam Leffler 2294b032f27cSSam Leffler if (vap->iv_state != IEEE80211_S_RUN || 2295b032f27cSSam Leffler /* NB: can happen when in promiscuous mode */ 2296b032f27cSSam Leffler !IEEE80211_ADDR_EQ(wh->i_addr1, vap->iv_myaddr)) { 2297b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2298b032f27cSSam Leffler break; 2299b032f27cSSam Leffler } 2300b032f27cSSam Leffler /* 2301b032f27cSSam Leffler * deauth/disassoc frame format 2302b032f27cSSam Leffler * [2] reason 2303b032f27cSSam Leffler */ 2304b032f27cSSam Leffler IEEE80211_VERIFY_LENGTH(efrm - frm, 2, return); 2305b032f27cSSam Leffler reason = le16toh(*(uint16_t *)frm); 2306b032f27cSSam Leffler if (subtype == IEEE80211_FC0_SUBTYPE_DEAUTH) { 2307b032f27cSSam Leffler vap->iv_stats.is_rx_deauth++; 2308b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_deauth); 2309b032f27cSSam Leffler } else { 2310b032f27cSSam Leffler vap->iv_stats.is_rx_disassoc++; 2311b032f27cSSam Leffler IEEE80211_NODE_STAT(ni, rx_disassoc); 2312b032f27cSSam Leffler } 2313b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_AUTH, ni, 2314d72d72d3SAndriy Voskoboinyk "recv %s (reason: %d (%s))", 23154357a5d1SAndriy Voskoboinyk ieee80211_mgt_subtype_name(subtype), 2316d72d72d3SAndriy Voskoboinyk reason, ieee80211_reason_to_string(reason)); 2317b032f27cSSam Leffler if (ni != vap->iv_bss) 2318b032f27cSSam Leffler ieee80211_node_leave(ni); 2319b032f27cSSam Leffler break; 2320b032f27cSSam Leffler } 2321b032f27cSSam Leffler 2322b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ACTION: 232396283082SBernhard Schmidt case IEEE80211_FC0_SUBTYPE_ACTION_NOACK: 2324893c4d6eSBernhard Schmidt if (ni == vap->iv_bss) { 2325893c4d6eSBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 2326893c4d6eSBernhard Schmidt wh, NULL, "%s", "unknown node"); 2327893c4d6eSBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 2328893c4d6eSBernhard Schmidt } else if (!IEEE80211_ADDR_EQ(vap->iv_myaddr, wh->i_addr1) && 2329893c4d6eSBernhard Schmidt !IEEE80211_IS_MULTICAST(wh->i_addr1)) { 2330893c4d6eSBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 2331893c4d6eSBernhard Schmidt wh, NULL, "%s", "not for us"); 2332893c4d6eSBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 2333893c4d6eSBernhard Schmidt } else if (vap->iv_state != IEEE80211_S_RUN) { 233496283082SBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 233596283082SBernhard Schmidt wh, NULL, "wrong state %s", 233696283082SBernhard Schmidt ieee80211_state_name[vap->iv_state]); 2337b032f27cSSam Leffler vap->iv_stats.is_rx_mgtdiscard++; 2338893c4d6eSBernhard Schmidt } else { 2339893c4d6eSBernhard Schmidt if (ieee80211_parse_action(ni, m0) == 0) 2340893c4d6eSBernhard Schmidt (void)ic->ic_recv_action(ni, wh, frm, efrm); 234196283082SBernhard Schmidt } 2342b032f27cSSam Leffler break; 2343b032f27cSSam Leffler 2344b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_ASSOC_RESP: 2345b032f27cSSam Leffler case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: 2346665d5ae9SAndriy Voskoboinyk case IEEE80211_FC0_SUBTYPE_TIMING_ADV: 234796283082SBernhard Schmidt case IEEE80211_FC0_SUBTYPE_ATIM: 234896283082SBernhard Schmidt IEEE80211_DISCARD(vap, IEEE80211_MSG_INPUT, 234996283082SBernhard Schmidt wh, NULL, "%s", "not handled"); 235096283082SBernhard Schmidt vap->iv_stats.is_rx_mgtdiscard++; 235196283082SBernhard Schmidt break; 235296283082SBernhard Schmidt 2353b032f27cSSam Leffler default: 2354b032f27cSSam Leffler IEEE80211_DISCARD(vap, IEEE80211_MSG_ANY, 2355b032f27cSSam Leffler wh, "mgt", "subtype 0x%x not handled", subtype); 2356b032f27cSSam Leffler vap->iv_stats.is_rx_badsubtype++; 2357b032f27cSSam Leffler break; 2358b032f27cSSam Leffler } 2359b032f27cSSam Leffler } 2360b032f27cSSam Leffler 236149eae5f7SSam Leffler static void 236249eae5f7SSam Leffler hostap_recv_ctl(struct ieee80211_node *ni, struct mbuf *m, int subtype) 236349eae5f7SSam Leffler { 236449eae5f7SSam Leffler switch (subtype) { 236549eae5f7SSam Leffler case IEEE80211_FC0_SUBTYPE_PS_POLL: 2366e7f0d7cfSAdrian Chadd ni->ni_vap->iv_recv_pspoll(ni, m); 236749eae5f7SSam Leffler break; 236849eae5f7SSam Leffler case IEEE80211_FC0_SUBTYPE_BAR: 236949eae5f7SSam Leffler ieee80211_recv_bar(ni, m); 237049eae5f7SSam Leffler break; 237149eae5f7SSam Leffler } 237249eae5f7SSam Leffler } 237349eae5f7SSam Leffler 2374b032f27cSSam Leffler /* 2375b032f27cSSam Leffler * Process a received ps-poll frame. 2376b032f27cSSam Leffler */ 2377e7f0d7cfSAdrian Chadd void 2378e7f0d7cfSAdrian Chadd ieee80211_recv_pspoll(struct ieee80211_node *ni, struct mbuf *m0) 2379b032f27cSSam Leffler { 2380b032f27cSSam Leffler struct ieee80211vap *vap = ni->ni_vap; 23815cda6006SAdrian Chadd struct ieee80211com *ic = vap->iv_ic; 2382b032f27cSSam Leffler struct ieee80211_frame_min *wh; 2383b032f27cSSam Leffler struct mbuf *m; 2384b032f27cSSam Leffler uint16_t aid; 2385b032f27cSSam Leffler int qlen; 2386b032f27cSSam Leffler 2387b032f27cSSam Leffler wh = mtod(m0, struct ieee80211_frame_min *); 2388b032f27cSSam Leffler if (ni->ni_associd == 0) { 2389b032f27cSSam Leffler IEEE80211_DISCARD(vap, 2390b032f27cSSam Leffler IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG, 2391b032f27cSSam Leffler (struct ieee80211_frame *) wh, NULL, 2392b032f27cSSam Leffler "%s", "unassociated station"); 2393b032f27cSSam Leffler vap->iv_stats.is_ps_unassoc++; 2394b032f27cSSam Leffler IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_DEAUTH, 2395b032f27cSSam Leffler IEEE80211_REASON_NOT_ASSOCED); 2396b032f27cSSam Leffler return; 2397b032f27cSSam Leffler } 2398b032f27cSSam Leffler 2399b032f27cSSam Leffler aid = le16toh(*(uint16_t *)wh->i_dur); 2400b032f27cSSam Leffler if (aid != ni->ni_associd) { 2401b032f27cSSam Leffler IEEE80211_DISCARD(vap, 2402b032f27cSSam Leffler IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG, 2403b032f27cSSam Leffler (struct ieee80211_frame *) wh, NULL, 2404b032f27cSSam Leffler "aid mismatch: sta aid 0x%x poll aid 0x%x", 2405b032f27cSSam Leffler ni->ni_associd, aid); 2406b032f27cSSam Leffler vap->iv_stats.is_ps_badaid++; 2407693e3122SSam Leffler /* 2408693e3122SSam Leffler * NB: We used to deauth the station but it turns out 2409693e3122SSam Leffler * the Blackberry Curve 8230 (and perhaps other devices) 2410693e3122SSam Leffler * sometimes send the wrong AID when WME is negotiated. 2411693e3122SSam Leffler * Being more lenient here seems ok as we already check 2412693e3122SSam Leffler * the station is associated and we only return frames 2413693e3122SSam Leffler * queued for the station (i.e. we don't use the AID). 2414693e3122SSam Leffler */ 2415b032f27cSSam Leffler return; 2416b032f27cSSam Leffler } 2417b032f27cSSam Leffler 2418b032f27cSSam Leffler /* Okay, take the first queued packet and put it out... */ 241963092fceSSam Leffler m = ieee80211_node_psq_dequeue(ni, &qlen); 2420b032f27cSSam Leffler if (m == NULL) { 2421b032f27cSSam Leffler IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_POWER, wh->i_addr2, 2422b032f27cSSam Leffler "%s", "recv ps-poll, but queue empty"); 2423b032f27cSSam Leffler ieee80211_send_nulldata(ieee80211_ref_node(ni)); 2424b032f27cSSam Leffler vap->iv_stats.is_ps_qempty++; /* XXX node stat */ 2425b032f27cSSam Leffler if (vap->iv_set_tim != NULL) 2426b032f27cSSam Leffler vap->iv_set_tim(ni, 0); /* just in case */ 2427b032f27cSSam Leffler return; 2428b032f27cSSam Leffler } 2429b032f27cSSam Leffler /* 2430b032f27cSSam Leffler * If there are more packets, set the more packets bit 2431b032f27cSSam Leffler * in the packet dispatched to the station; otherwise 2432b032f27cSSam Leffler * turn off the TIM bit. 2433b032f27cSSam Leffler */ 2434b032f27cSSam Leffler if (qlen != 0) { 2435b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_POWER, ni, 2436b032f27cSSam Leffler "recv ps-poll, send packet, %u still queued", qlen); 2437b032f27cSSam Leffler m->m_flags |= M_MORE_DATA; 2438b032f27cSSam Leffler } else { 2439b032f27cSSam Leffler IEEE80211_NOTE(vap, IEEE80211_MSG_POWER, ni, 2440b032f27cSSam Leffler "%s", "recv ps-poll, send packet, queue empty"); 2441b032f27cSSam Leffler if (vap->iv_set_tim != NULL) 2442b032f27cSSam Leffler vap->iv_set_tim(ni, 0); 2443b032f27cSSam Leffler } 2444b032f27cSSam Leffler m->m_flags |= M_PWR_SAV; /* bypass PS handling */ 244563092fceSSam Leffler 24467ea3aadaSAdrian Chadd /* 24475cda6006SAdrian Chadd * Do the right thing; if it's an encap'ed frame then 2448d3a4ade3SAdrian Chadd * call ieee80211_parent_xmitpkt() else 2449e7495198SAdrian Chadd * call ieee80211_vap_xmitpkt(). 24507ea3aadaSAdrian Chadd */ 24515cda6006SAdrian Chadd if (m->m_flags & M_ENCAP) { 2452d3a4ade3SAdrian Chadd (void) ieee80211_parent_xmitpkt(ic, m); 24535cda6006SAdrian Chadd } else { 2454e7495198SAdrian Chadd (void) ieee80211_vap_xmitpkt(vap, m); 24557ea3aadaSAdrian Chadd } 2456b032f27cSSam Leffler } 2457