Home | History | Annotate | Line # | Download | only in net80211
ieee80211_input.c revision 1.95
      1  1.95      maxv /*	$NetBSD: ieee80211_input.c,v 1.95 2018/01/16 14:01:13 maxv Exp $	*/
      2  1.92      maxv 
      3  1.92      maxv /*
      4   1.1    dyoung  * Copyright (c) 2001 Atsushi Onoe
      5  1.40    dyoung  * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
      6   1.1    dyoung  * All rights reserved.
      7   1.1    dyoung  *
      8   1.1    dyoung  * Redistribution and use in source and binary forms, with or without
      9   1.1    dyoung  * modification, are permitted provided that the following conditions
     10   1.1    dyoung  * are met:
     11   1.1    dyoung  * 1. Redistributions of source code must retain the above copyright
     12   1.1    dyoung  *    notice, this list of conditions and the following disclaimer.
     13   1.1    dyoung  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1    dyoung  *    notice, this list of conditions and the following disclaimer in the
     15   1.1    dyoung  *    documentation and/or other materials provided with the distribution.
     16   1.1    dyoung  * 3. The name of the author may not be used to endorse or promote products
     17   1.1    dyoung  *    derived from this software without specific prior written permission.
     18   1.1    dyoung  *
     19   1.1    dyoung  * Alternatively, this software may be distributed under the terms of the
     20   1.1    dyoung  * GNU General Public License ("GPL") version 2 as published by the Free
     21   1.1    dyoung  * Software Foundation.
     22   1.1    dyoung  *
     23   1.1    dyoung  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     24   1.1    dyoung  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     25   1.1    dyoung  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     26   1.1    dyoung  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     27   1.1    dyoung  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     28   1.1    dyoung  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     29   1.1    dyoung  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     30   1.1    dyoung  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     31   1.1    dyoung  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     32   1.1    dyoung  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     33   1.1    dyoung  */
     34   1.1    dyoung 
     35   1.1    dyoung #include <sys/cdefs.h>
     36   1.3    dyoung #ifdef __FreeBSD__
     37  1.47     skrll __FBSDID("$FreeBSD: src/sys/net80211/ieee80211_input.c,v 1.81 2005/08/10 16:22:29 sam Exp $");
     38  1.40    dyoung #endif
     39  1.40    dyoung #ifdef __NetBSD__
     40  1.95      maxv __KERNEL_RCSID(0, "$NetBSD: ieee80211_input.c,v 1.95 2018/01/16 14:01:13 maxv Exp $");
     41   1.3    dyoung #endif
     42   1.1    dyoung 
     43  1.79     pooka #ifdef _KERNEL_OPT
     44   1.1    dyoung #include "opt_inet.h"
     45  1.79     pooka #endif
     46   1.1    dyoung 
     47   1.1    dyoung #include <sys/param.h>
     48  1.38     perry #include <sys/systm.h>
     49  1.85  christos #include <sys/mbuf.h>
     50   1.1    dyoung #include <sys/malloc.h>
     51  1.40    dyoung #include <sys/endian.h>
     52   1.1    dyoung #include <sys/kernel.h>
     53  1.74  christos 
     54   1.1    dyoung #include <sys/socket.h>
     55   1.1    dyoung #include <sys/sockio.h>
     56   1.1    dyoung #include <sys/endian.h>
     57   1.1    dyoung #include <sys/errno.h>
     58   1.1    dyoung #include <sys/proc.h>
     59   1.1    dyoung #include <sys/sysctl.h>
     60  1.87    nonaka #include <sys/cpu.h>
     61   1.1    dyoung 
     62   1.1    dyoung #include <net/if.h>
     63   1.1    dyoung #include <net/if_media.h>
     64   1.1    dyoung #include <net/if_arp.h>
     65   1.4    dyoung #include <net/if_ether.h>
     66   1.1    dyoung #include <net/if_llc.h>
     67   1.1    dyoung 
     68   1.1    dyoung #include <net80211/ieee80211_var.h>
     69   1.1    dyoung 
     70   1.1    dyoung #include <net/bpf.h>
     71   1.1    dyoung 
     72   1.1    dyoung #ifdef INET
     73  1.74  christos #include <netinet/in.h>
     74   1.4    dyoung #include <net/if_ether.h>
     75   1.4    dyoung #endif
     76   1.1    dyoung 
     77  1.31    dyoung const struct timeval ieee80211_merge_print_intvl = {.tv_sec = 1, .tv_usec = 0};
     78  1.31    dyoung 
     79  1.40    dyoung #ifdef IEEE80211_DEBUG
     80   1.5    dyoung 
     81  1.26   mycroft /*
     82  1.26   mycroft  * Decide if a received management frame should be
     83  1.26   mycroft  * printed when debugging is enabled.  This filters some
     84  1.26   mycroft  * of the less interesting frames that come frequently
     85  1.26   mycroft  * (e.g. beacons).
     86  1.26   mycroft  */
     87  1.26   mycroft static __inline int
     88  1.26   mycroft doprint(struct ieee80211com *ic, int subtype)
     89  1.26   mycroft {
     90  1.26   mycroft 	switch (subtype) {
     91  1.26   mycroft 	case IEEE80211_FC0_SUBTYPE_BEACON:
     92  1.40    dyoung 		return (ic->ic_flags & IEEE80211_F_SCAN);
     93  1.26   mycroft 	case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
     94  1.26   mycroft 		return (ic->ic_opmode == IEEE80211_M_IBSS);
     95  1.26   mycroft 	}
     96  1.26   mycroft 	return 1;
     97  1.26   mycroft }
     98  1.40    dyoung 
     99  1.40    dyoung /*
    100  1.40    dyoung  * Emit a debug message about discarding a frame or information
    101  1.40    dyoung  * element.  One format is for extracting the mac address from
    102  1.40    dyoung  * the frame header; the other is for when a header is not
    103  1.40    dyoung  * available or otherwise appropriate.
    104  1.40    dyoung  */
    105  1.40    dyoung #define	IEEE80211_DISCARD(_ic, _m, _wh, _type, _fmt, ...) do {		\
    106  1.40    dyoung 	if ((_ic)->ic_debug & (_m))					\
    107  1.40    dyoung 		ieee80211_discard_frame(_ic, _wh, _type, _fmt, __VA_ARGS__);\
    108  1.40    dyoung } while (0)
    109  1.40    dyoung #define	IEEE80211_DISCARD_IE(_ic, _m, _wh, _type, _fmt, ...) do {	\
    110  1.40    dyoung 	if ((_ic)->ic_debug & (_m))					\
    111  1.40    dyoung 		ieee80211_discard_ie(_ic, _wh, _type, _fmt, __VA_ARGS__);\
    112  1.40    dyoung } while (0)
    113  1.40    dyoung #define	IEEE80211_DISCARD_MAC(_ic, _m, _mac, _type, _fmt, ...) do {	\
    114  1.40    dyoung 	if ((_ic)->ic_debug & (_m))					\
    115  1.40    dyoung 		ieee80211_discard_mac(_ic, _mac, _type, _fmt, __VA_ARGS__);\
    116  1.40    dyoung } while (0)
    117  1.85  christos #define	IEEE80211_DEBUGVAR(a) a
    118  1.40    dyoung 
    119  1.40    dyoung static const u_int8_t *ieee80211_getbssid(struct ieee80211com *,
    120  1.40    dyoung 	const struct ieee80211_frame *);
    121  1.40    dyoung static void ieee80211_discard_frame(struct ieee80211com *,
    122  1.40    dyoung 	const struct ieee80211_frame *, const char *type, const char *fmt, ...);
    123  1.40    dyoung static void ieee80211_discard_ie(struct ieee80211com *,
    124  1.40    dyoung 	const struct ieee80211_frame *, const char *type, const char *fmt, ...);
    125  1.40    dyoung static void ieee80211_discard_mac(struct ieee80211com *,
    126  1.40    dyoung 	const u_int8_t mac[IEEE80211_ADDR_LEN], const char *type,
    127  1.40    dyoung 	const char *fmt, ...);
    128  1.40    dyoung #else
    129  1.40    dyoung #define	IEEE80211_DISCARD(_ic, _m, _wh, _type, _fmt, ...)
    130  1.40    dyoung #define	IEEE80211_DISCARD_IE(_ic, _m, _wh, _type, _fmt, ...)
    131  1.40    dyoung #define	IEEE80211_DISCARD_MAC(_ic, _m, _mac, _type, _fmt, ...)
    132  1.85  christos #define	IEEE80211_DEBUGVAR(a)
    133  1.40    dyoung #endif /* IEEE80211_DEBUG */
    134  1.40    dyoung 
    135  1.40    dyoung static struct mbuf *ieee80211_defrag(struct ieee80211com *,
    136  1.44    dyoung 	struct ieee80211_node *, struct mbuf *, int);
    137  1.44    dyoung static struct mbuf *ieee80211_decap(struct ieee80211com *, struct mbuf *, int);
    138  1.44    dyoung static void ieee80211_send_error(struct ieee80211com *, struct ieee80211_node *,
    139  1.92      maxv 	const u_int8_t *mac, int subtype, int arg);
    140  1.47     skrll static void ieee80211_deliver_data(struct ieee80211com *,
    141  1.47     skrll 	struct ieee80211_node *, struct mbuf *);
    142  1.57    dyoung #ifndef IEEE80211_NO_HOSTAP
    143  1.40    dyoung static void ieee80211_node_pwrsave(struct ieee80211_node *, int enable);
    144  1.40    dyoung static void ieee80211_recv_pspoll(struct ieee80211com *,
    145  1.40    dyoung 	struct ieee80211_node *, struct mbuf *);
    146  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
    147  1.56    dyoung static void ieee80211_update_adhoc_node(struct ieee80211com *,
    148  1.56    dyoung     struct ieee80211_node *, struct ieee80211_frame *,
    149  1.56    dyoung     struct ieee80211_scanparams *, int, u_int32_t);
    150  1.26   mycroft 
    151  1.93      maxv /* -------------------------------------------------------------------------- */
    152  1.93      maxv 
    153  1.93      maxv /*
    154  1.93      maxv  * Input code for a DATA frame.
    155  1.93      maxv  */
    156  1.93      maxv static int
    157  1.93      maxv ieee80211_input_data(struct ieee80211com *ic, struct mbuf **mp,
    158  1.93      maxv     struct ieee80211_node *ni)
    159  1.93      maxv {
    160  1.93      maxv 	struct ifnet *ifp = ic->ic_ifp;
    161  1.93      maxv 	struct ieee80211_key *key;
    162  1.93      maxv 	struct ieee80211_frame *wh;
    163  1.93      maxv 	u_int8_t dir, subtype;
    164  1.93      maxv 	struct ether_header *eh;
    165  1.93      maxv 	struct mbuf *m = *mp;
    166  1.93      maxv 	int hdrspace;
    167  1.93      maxv 
    168  1.93      maxv 	wh = mtod(m, struct ieee80211_frame *);
    169  1.93      maxv 	dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
    170  1.93      maxv 	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
    171  1.93      maxv 
    172  1.93      maxv 	hdrspace = ieee80211_hdrspace(ic, wh);
    173  1.93      maxv 
    174  1.93      maxv 	if (m->m_len < hdrspace &&
    175  1.93      maxv 	    (m = m_pullup(m, hdrspace)) == NULL) {
    176  1.93      maxv 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
    177  1.93      maxv 		    ni->ni_macaddr, NULL,
    178  1.93      maxv 		    "data too short: expecting %u", hdrspace);
    179  1.93      maxv 		ic->ic_stats.is_rx_tooshort++;
    180  1.94      maxv 		goto out;
    181  1.93      maxv 	}
    182  1.93      maxv 	wh = mtod(m, struct ieee80211_frame *);
    183  1.93      maxv 
    184  1.93      maxv 	switch (ic->ic_opmode) {
    185  1.93      maxv 	case IEEE80211_M_STA:
    186  1.93      maxv 		if (dir != IEEE80211_FC1_DIR_FROMDS) {
    187  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    188  1.93      maxv 			    wh, "data", "%s", "unknown dir 0x%x", dir);
    189  1.93      maxv 			ic->ic_stats.is_rx_wrongdir++;
    190  1.93      maxv 			goto out;
    191  1.93      maxv 		}
    192  1.93      maxv 		if ((ifp->if_flags & IFF_SIMPLEX) &&
    193  1.93      maxv 		    IEEE80211_IS_MULTICAST(wh->i_addr1) &&
    194  1.93      maxv 		    IEEE80211_ADDR_EQ(wh->i_addr3, ic->ic_myaddr)) {
    195  1.93      maxv 			/*
    196  1.93      maxv 			 * In IEEE802.11 network, multicast packet
    197  1.93      maxv 			 * sent from me is broadcast from AP.
    198  1.93      maxv 			 * It should be silently discarded for
    199  1.93      maxv 			 * SIMPLEX interface.
    200  1.93      maxv 			 */
    201  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    202  1.93      maxv 			    wh, NULL, "%s", "multicast echo");
    203  1.93      maxv 			ic->ic_stats.is_rx_mcastecho++;
    204  1.93      maxv 			goto out;
    205  1.93      maxv 		}
    206  1.93      maxv 		break;
    207  1.93      maxv 
    208  1.93      maxv 	case IEEE80211_M_IBSS:
    209  1.93      maxv 	case IEEE80211_M_AHDEMO:
    210  1.93      maxv 		if (dir != IEEE80211_FC1_DIR_NODS) {
    211  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    212  1.93      maxv 			    wh, "data", "%s", "unknown dir 0x%x", dir);
    213  1.93      maxv 			ic->ic_stats.is_rx_wrongdir++;
    214  1.93      maxv 			goto out;
    215  1.93      maxv 		}
    216  1.93      maxv 		/* XXX no power-save support */
    217  1.93      maxv 		break;
    218  1.93      maxv 
    219  1.93      maxv 	case IEEE80211_M_HOSTAP:
    220  1.93      maxv #ifndef IEEE80211_NO_HOSTAP
    221  1.93      maxv 		if (dir != IEEE80211_FC1_DIR_TODS) {
    222  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    223  1.93      maxv 			    wh, "data", "%s", "unknown dir 0x%x", dir);
    224  1.93      maxv 			ic->ic_stats.is_rx_wrongdir++;
    225  1.93      maxv 			goto out;
    226  1.93      maxv 		}
    227  1.93      maxv 		/* check if source STA is associated */
    228  1.93      maxv 		if (ni == ic->ic_bss) {
    229  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    230  1.93      maxv 			    wh, "data", "%s", "unknown src");
    231  1.93      maxv 			ieee80211_send_error(ic, ni, wh->i_addr2,
    232  1.93      maxv 			    IEEE80211_FC0_SUBTYPE_DEAUTH,
    233  1.93      maxv 			    IEEE80211_REASON_NOT_AUTHED);
    234  1.93      maxv 			ic->ic_stats.is_rx_notassoc++;
    235  1.93      maxv 			goto err;
    236  1.93      maxv 		}
    237  1.93      maxv 		if (ni->ni_associd == 0) {
    238  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    239  1.93      maxv 			    wh, "data", "%s", "unassoc src");
    240  1.93      maxv 			IEEE80211_SEND_MGMT(ic, ni,
    241  1.93      maxv 			    IEEE80211_FC0_SUBTYPE_DISASSOC,
    242  1.93      maxv 			    IEEE80211_REASON_NOT_ASSOCED);
    243  1.93      maxv 			ic->ic_stats.is_rx_notassoc++;
    244  1.93      maxv 			goto err;
    245  1.93      maxv 		}
    246  1.93      maxv 
    247  1.93      maxv 		/*
    248  1.93      maxv 		 * Check for power save state change.
    249  1.93      maxv 		 */
    250  1.93      maxv 		if (((wh->i_fc[1] & IEEE80211_FC1_PWR_MGT) ^
    251  1.93      maxv 		    (ni->ni_flags & IEEE80211_NODE_PWR_MGT)))
    252  1.93      maxv 			ieee80211_node_pwrsave(ni,
    253  1.93      maxv 				wh->i_fc[1] & IEEE80211_FC1_PWR_MGT);
    254  1.93      maxv #endif /* !IEEE80211_NO_HOSTAP */
    255  1.93      maxv 		break;
    256  1.93      maxv 
    257  1.93      maxv 	default:
    258  1.93      maxv 		/* XXX here to keep compiler happy */
    259  1.93      maxv 		goto out;
    260  1.93      maxv 	}
    261  1.93      maxv 
    262  1.93      maxv 	/*
    263  1.93      maxv 	 * Handle privacy requirements.  Note that we
    264  1.93      maxv 	 * must not be preempted from here until after
    265  1.93      maxv 	 * we (potentially) call ieee80211_crypto_demic;
    266  1.93      maxv 	 * otherwise we may violate assumptions in the
    267  1.93      maxv 	 * crypto cipher modules used to do delayed update
    268  1.93      maxv 	 * of replay sequence numbers.
    269  1.93      maxv 	 */
    270  1.93      maxv 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
    271  1.93      maxv 		if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
    272  1.93      maxv 			/*
    273  1.93      maxv 			 * Discard encrypted frames when privacy is off.
    274  1.93      maxv 			 */
    275  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    276  1.93      maxv 			    wh, "WEP", "%s", "PRIVACY off");
    277  1.93      maxv 			ic->ic_stats.is_rx_noprivacy++;
    278  1.93      maxv 			IEEE80211_NODE_STAT(ni, rx_noprivacy);
    279  1.93      maxv 			goto out;
    280  1.93      maxv 		}
    281  1.93      maxv 		key = ieee80211_crypto_decap(ic, ni, &m, hdrspace);
    282  1.93      maxv 		if (key == NULL) {
    283  1.93      maxv 			/* NB: stats+msgs handled in crypto_decap */
    284  1.93      maxv 			IEEE80211_NODE_STAT(ni, rx_wepfail);
    285  1.93      maxv 			goto out;
    286  1.93      maxv 		}
    287  1.93      maxv 		wh = mtod(m, struct ieee80211_frame *);
    288  1.93      maxv 		wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
    289  1.93      maxv 	} else {
    290  1.93      maxv 		key = NULL;
    291  1.93      maxv 	}
    292  1.93      maxv 
    293  1.93      maxv 	/*
    294  1.93      maxv 	 * Next up, any fragmentation.
    295  1.93      maxv 	 */
    296  1.93      maxv 	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
    297  1.93      maxv 		m = ieee80211_defrag(ic, ni, m, hdrspace);
    298  1.93      maxv 		if (m == NULL) {
    299  1.93      maxv 			/* Fragment dropped or frame not complete yet */
    300  1.93      maxv 			goto out;
    301  1.93      maxv 		}
    302  1.93      maxv 	}
    303  1.93      maxv 
    304  1.93      maxv 	/*
    305  1.94      maxv 	 * Next, strip any MSDU crypto bits.
    306  1.93      maxv 	 */
    307  1.93      maxv 	if (key != NULL && !ieee80211_crypto_demic(ic, key, m, 0)) {
    308  1.93      maxv 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    309  1.93      maxv 		    ni->ni_macaddr, "data", "%s", "demic error");
    310  1.93      maxv 		IEEE80211_NODE_STAT(ni, rx_demicfail);
    311  1.93      maxv 		goto out;
    312  1.93      maxv 	}
    313  1.93      maxv 
    314  1.93      maxv 	/* copy to listener after decrypt */
    315  1.93      maxv 	bpf_mtap3(ic->ic_rawbpf, m);
    316  1.93      maxv 
    317  1.93      maxv 	/*
    318  1.93      maxv 	 * Finally, strip the 802.11 header.
    319  1.93      maxv 	 */
    320  1.93      maxv 	m = ieee80211_decap(ic, m, hdrspace);
    321  1.93      maxv 	if (m == NULL) {
    322  1.93      maxv 		/* don't count Null data frames as errors */
    323  1.93      maxv 		if (subtype == IEEE80211_FC0_SUBTYPE_NODATA)
    324  1.93      maxv 			goto out;
    325  1.93      maxv 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    326  1.93      maxv 		    ni->ni_macaddr, "data", "%s", "decap error");
    327  1.93      maxv 		ic->ic_stats.is_rx_decap++;
    328  1.93      maxv 		IEEE80211_NODE_STAT(ni, rx_decap);
    329  1.93      maxv 		goto err;
    330  1.93      maxv 	}
    331  1.93      maxv 
    332  1.93      maxv 	eh = mtod(m, struct ether_header *);
    333  1.93      maxv 	if (!ieee80211_node_is_authorized(ni)) {
    334  1.93      maxv 		/*
    335  1.93      maxv 		 * Deny any non-PAE frames received prior to
    336  1.93      maxv 		 * authorization.  For open/shared-key
    337  1.93      maxv 		 * authentication the port is mark authorized
    338  1.93      maxv 		 * after authentication completes.  For 802.1x
    339  1.93      maxv 		 * the port is not marked authorized by the
    340  1.93      maxv 		 * authenticator until the handshake has completed.
    341  1.93      maxv 		 */
    342  1.93      maxv 		if (eh->ether_type != htons(ETHERTYPE_PAE)) {
    343  1.93      maxv 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    344  1.93      maxv 			    eh->ether_shost, "data",
    345  1.93      maxv 			    "unauthorized port: ether type 0x%x len %u",
    346  1.93      maxv 			    eh->ether_type, m->m_pkthdr.len);
    347  1.93      maxv 			ic->ic_stats.is_rx_unauth++;
    348  1.93      maxv 			IEEE80211_NODE_STAT(ni, rx_unauth);
    349  1.93      maxv 			goto err;
    350  1.93      maxv 		}
    351  1.93      maxv 	} else {
    352  1.93      maxv 		/*
    353  1.93      maxv 		 * When denying unencrypted frames, discard
    354  1.93      maxv 		 * any non-PAE frames received without encryption.
    355  1.93      maxv 		 */
    356  1.93      maxv 		if ((ic->ic_flags & IEEE80211_F_DROPUNENC) &&
    357  1.93      maxv 		    key == NULL &&
    358  1.93      maxv 		    eh->ether_type != htons(ETHERTYPE_PAE)) {
    359  1.93      maxv 			/*
    360  1.93      maxv 			 * Drop unencrypted frames.
    361  1.93      maxv 			 */
    362  1.93      maxv 			ic->ic_stats.is_rx_unencrypted++;
    363  1.93      maxv 			IEEE80211_NODE_STAT(ni, rx_unencrypted);
    364  1.93      maxv 			goto out;
    365  1.93      maxv 		}
    366  1.93      maxv 	}
    367  1.93      maxv 
    368  1.93      maxv 	ifp->if_ipackets++;
    369  1.93      maxv 	IEEE80211_NODE_STAT(ni, rx_data);
    370  1.93      maxv 	IEEE80211_NODE_STAT_ADD(ni, rx_bytes, m->m_pkthdr.len);
    371  1.93      maxv 
    372  1.93      maxv 	ieee80211_deliver_data(ic, ni, m);
    373  1.93      maxv 
    374  1.93      maxv 	*mp = NULL;
    375  1.93      maxv 	return 0;
    376  1.93      maxv 
    377  1.93      maxv err:
    378  1.93      maxv 	ifp->if_ierrors++;
    379  1.93      maxv out:
    380  1.93      maxv 	*mp = m;
    381  1.93      maxv 	return -1;
    382  1.93      maxv }
    383  1.93      maxv 
    384  1.93      maxv /*
    385  1.93      maxv  * Input code for a MANAGEMENT frame.
    386  1.93      maxv  */
    387  1.93      maxv static int
    388  1.93      maxv ieee80211_input_management(struct ieee80211com *ic, struct mbuf **mp,
    389  1.93      maxv     struct ieee80211_node *ni, int rssi, u_int32_t rstamp)
    390  1.93      maxv {
    391  1.93      maxv 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
    392  1.93      maxv 	struct ifnet *ifp = ic->ic_ifp;
    393  1.93      maxv 	struct ieee80211_key *key;
    394  1.93      maxv 	struct ieee80211_frame *wh;
    395  1.93      maxv 	u_int8_t dir, subtype;
    396  1.93      maxv 	struct mbuf *m = *mp;
    397  1.93      maxv 	int hdrspace;
    398  1.93      maxv 
    399  1.93      maxv 	wh = mtod(m, struct ieee80211_frame *);
    400  1.93      maxv 	dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
    401  1.93      maxv 	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
    402  1.93      maxv 
    403  1.93      maxv 	IEEE80211_NODE_STAT(ni, rx_mgmt);
    404  1.93      maxv 	if (dir != IEEE80211_FC1_DIR_NODS) {
    405  1.93      maxv 		IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    406  1.93      maxv 		    wh, "data", "%s", "unknown dir 0x%x", dir);
    407  1.93      maxv 		ic->ic_stats.is_rx_wrongdir++;
    408  1.93      maxv 		goto err;
    409  1.93      maxv 	}
    410  1.93      maxv 	if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) {
    411  1.93      maxv 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
    412  1.93      maxv 		    ni->ni_macaddr, "mgt", "too short: len %u",
    413  1.93      maxv 		    m->m_pkthdr.len);
    414  1.93      maxv 		ic->ic_stats.is_rx_tooshort++;
    415  1.93      maxv 		goto out;
    416  1.93      maxv 	}
    417  1.93      maxv #ifdef IEEE80211_DEBUG
    418  1.93      maxv 	if ((ieee80211_msg_debug(ic) && doprint(ic, subtype)) ||
    419  1.93      maxv 	    ieee80211_msg_dumppkts(ic)) {
    420  1.93      maxv 		if_printf(ic->ic_ifp, "received %s from %s rssi %d\n",
    421  1.93      maxv 		    ieee80211_mgt_subtype_name[subtype >>
    422  1.93      maxv 			IEEE80211_FC0_SUBTYPE_SHIFT],
    423  1.93      maxv 		    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
    424  1.93      maxv 		    rssi);
    425  1.93      maxv 	}
    426  1.93      maxv #endif
    427  1.93      maxv 
    428  1.93      maxv 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
    429  1.93      maxv 		if (subtype != IEEE80211_FC0_SUBTYPE_AUTH) {
    430  1.93      maxv 			/*
    431  1.93      maxv 			 * Only shared key auth frames with a challenge
    432  1.93      maxv 			 * should be encrypted, discard all others.
    433  1.93      maxv 			 */
    434  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    435  1.93      maxv 			    wh, ieee80211_mgt_subtype_name[subtype >>
    436  1.93      maxv 				IEEE80211_FC0_SUBTYPE_SHIFT],
    437  1.93      maxv 			    "%s", "WEP set but not permitted");
    438  1.93      maxv 			ic->ic_stats.is_rx_mgtdiscard++; /* XXX */
    439  1.93      maxv 			goto out;
    440  1.93      maxv 		}
    441  1.93      maxv 		if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
    442  1.93      maxv 			/*
    443  1.93      maxv 			 * Discard encrypted frames when privacy is off.
    444  1.93      maxv 			 */
    445  1.93      maxv 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
    446  1.93      maxv 			    wh, "mgt", "%s", "WEP set but PRIVACY off");
    447  1.93      maxv 			ic->ic_stats.is_rx_noprivacy++;
    448  1.93      maxv 			goto out;
    449  1.93      maxv 		}
    450  1.93      maxv 		hdrspace = ieee80211_hdrspace(ic, wh);
    451  1.93      maxv 		key = ieee80211_crypto_decap(ic, ni, &m, hdrspace);
    452  1.93      maxv 		if (key == NULL) {
    453  1.93      maxv 			/* NB: stats+msgs handled in crypto_decap */
    454  1.93      maxv 			goto out;
    455  1.93      maxv 		}
    456  1.93      maxv 		wh = mtod(m, struct ieee80211_frame *);
    457  1.93      maxv 		wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
    458  1.93      maxv 	}
    459  1.93      maxv 
    460  1.93      maxv 	bpf_mtap3(ic->ic_rawbpf, m);
    461  1.93      maxv 	(*ic->ic_recv_mgmt)(ic, m, ni, subtype, rssi, rstamp);
    462  1.93      maxv 	m_freem(m);
    463  1.93      maxv 
    464  1.93      maxv 	*mp = NULL;
    465  1.93      maxv 	return 0;
    466  1.93      maxv 
    467  1.93      maxv err:
    468  1.93      maxv 	ifp->if_ierrors++;
    469  1.93      maxv out:
    470  1.93      maxv 	*mp = m;
    471  1.93      maxv 	return -1;
    472  1.93      maxv }
    473  1.93      maxv 
    474  1.93      maxv /*
    475  1.93      maxv  * Input code for a CONTROL frame.
    476  1.93      maxv  */
    477  1.93      maxv static void
    478  1.93      maxv ieee80211_input_control(struct ieee80211com *ic, struct mbuf *m,
    479  1.93      maxv     struct ieee80211_node *ni)
    480  1.93      maxv {
    481  1.93      maxv 	IEEE80211_NODE_STAT(ni, rx_ctrl);
    482  1.93      maxv 	ic->ic_stats.is_rx_ctl++;
    483  1.93      maxv 
    484  1.93      maxv #ifndef IEEE80211_NO_HOSTAP
    485  1.93      maxv 	if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
    486  1.93      maxv 		struct ieee80211_frame *wh;
    487  1.93      maxv 		u_int8_t subtype;
    488  1.93      maxv 
    489  1.93      maxv 		wh = mtod(m, struct ieee80211_frame *);
    490  1.93      maxv 		subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
    491  1.93      maxv 
    492  1.93      maxv 		switch (subtype) {
    493  1.93      maxv 		case IEEE80211_FC0_SUBTYPE_PS_POLL:
    494  1.93      maxv 			ieee80211_recv_pspoll(ic, ni, m);
    495  1.93      maxv 			break;
    496  1.93      maxv 		}
    497  1.93      maxv 	}
    498  1.93      maxv #endif
    499  1.93      maxv }
    500  1.93      maxv 
    501  1.93      maxv /* -------------------------------------------------------------------------- */
    502  1.93      maxv 
    503   1.1    dyoung /*
    504   1.1    dyoung  * Process a received frame.  The node associated with the sender
    505   1.1    dyoung  * should be supplied.  If nothing was found in the node table then
    506   1.1    dyoung  * the caller is assumed to supply a reference to ic_bss instead.
    507   1.1    dyoung  * The RSSI and a timestamp are also supplied.  The RSSI data is used
    508   1.1    dyoung  * during AP scanning to select a AP to associate with; it can have
    509   1.1    dyoung  * any units so long as values have consistent units and higher values
    510   1.1    dyoung  * mean ``better signal''.  The receive timestamp is currently not used
    511   1.1    dyoung  * by the 802.11 layer.
    512   1.1    dyoung  */
    513  1.40    dyoung int
    514  1.40    dyoung ieee80211_input(struct ieee80211com *ic, struct mbuf *m,
    515  1.40    dyoung 	struct ieee80211_node *ni, int rssi, u_int32_t rstamp)
    516   1.1    dyoung {
    517  1.40    dyoung #define	SEQ_LEQ(a,b)	((int)((a)-(b)) <= 0)
    518  1.40    dyoung #define	HAS_SEQ(type)	((type & 0x4) == 0)
    519  1.40    dyoung 	struct ifnet *ifp = ic->ic_ifp;
    520   1.1    dyoung 	struct ieee80211_frame *wh;
    521  1.93      maxv 	u_int8_t dir, type;
    522   1.1    dyoung 	u_int16_t rxseq;
    523  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
    524  1.93      maxv 	int ret;
    525   1.1    dyoung 
    526  1.87    nonaka 	KASSERT(!cpu_intr_p());
    527  1.87    nonaka 
    528  1.17    dyoung 	IASSERT(ni != NULL, ("null node"));
    529  1.40    dyoung 	ni->ni_inact = ni->ni_inact_reload;
    530   1.1    dyoung 
    531  1.16    dyoung 	/* trim CRC here so WEP can find its own CRC at the end of packet. */
    532   1.1    dyoung 	if (m->m_flags & M_HASFCS) {
    533   1.1    dyoung 		m_adj(m, -IEEE80211_CRC_LEN);
    534   1.1    dyoung 		m->m_flags &= ~M_HASFCS;
    535   1.1    dyoung 	}
    536  1.40    dyoung 	type = -1;			/* undefined */
    537  1.92      maxv 
    538  1.16    dyoung 	/*
    539  1.16    dyoung 	 * In monitor mode, send everything directly to bpf.
    540  1.16    dyoung 	 * XXX may want to include the CRC
    541  1.16    dyoung 	 */
    542  1.40    dyoung 	if (ic->ic_opmode == IEEE80211_M_MONITOR)
    543  1.16    dyoung 		goto out;
    544   1.1    dyoung 
    545  1.40    dyoung 	if (m->m_pkthdr.len < sizeof(struct ieee80211_frame_min)) {
    546  1.40    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
    547  1.40    dyoung 		    ni->ni_macaddr, NULL,
    548  1.40    dyoung 		    "too short (1): len %u", m->m_pkthdr.len);
    549  1.40    dyoung 		ic->ic_stats.is_rx_tooshort++;
    550  1.40    dyoung 		goto out;
    551  1.40    dyoung 	}
    552  1.92      maxv 
    553  1.40    dyoung 	/*
    554  1.40    dyoung 	 * Bit of a cheat here, we use a pointer for a 3-address
    555  1.40    dyoung 	 * frame format but don't reference fields past outside
    556  1.40    dyoung 	 * ieee80211_frame_min w/o first validating the data is
    557  1.40    dyoung 	 * present.
    558  1.40    dyoung 	 */
    559   1.1    dyoung 	wh = mtod(m, struct ieee80211_frame *);
    560  1.40    dyoung 
    561   1.1    dyoung 	if ((wh->i_fc[0] & IEEE80211_FC0_VERSION_MASK) !=
    562   1.1    dyoung 	    IEEE80211_FC0_VERSION_0) {
    563  1.40    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_ANY,
    564  1.40    dyoung 		    ni->ni_macaddr, NULL, "wrong version %x", wh->i_fc[0]);
    565  1.16    dyoung 		ic->ic_stats.is_rx_badversion++;
    566   1.1    dyoung 		goto err;
    567   1.1    dyoung 	}
    568   1.1    dyoung 
    569   1.1    dyoung 	dir = wh->i_fc[1] & IEEE80211_FC1_DIR_MASK;
    570  1.16    dyoung 	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
    571  1.92      maxv 
    572  1.40    dyoung 	if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) {
    573  1.92      maxv 		u_int8_t *bssid;
    574  1.92      maxv 
    575  1.40    dyoung 		switch (ic->ic_opmode) {
    576  1.40    dyoung 		case IEEE80211_M_STA:
    577  1.40    dyoung 			bssid = wh->i_addr2;
    578  1.40    dyoung 			if (!IEEE80211_ADDR_EQ(bssid, ni->ni_bssid)) {
    579  1.40    dyoung 				/* not interested in */
    580  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    581  1.85  christos 				    bssid, NULL, "node %s, %s",
    582  1.85  christos 				    ether_snprintf(ebuf, sizeof(ebuf),
    583  1.85  christos 				    ni->ni_bssid), "not to bss");
    584  1.40    dyoung 				ic->ic_stats.is_rx_wrongbss++;
    585  1.40    dyoung 				goto out;
    586  1.40    dyoung 			}
    587  1.84   mlelstv 
    588  1.92      maxv 			/*
    589  1.92      maxv 			 * Filter out packets not directed to us in case the
    590  1.92      maxv 			 * device is in promiscuous mode
    591  1.84   mlelstv 			 */
    592  1.92      maxv 			if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
    593  1.92      maxv 			    !IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
    594  1.84   mlelstv 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    595  1.84   mlelstv 				    bssid, NULL, "not to cur sta: lladdr=%6D, addr1=%6D",
    596  1.84   mlelstv 				    ic->ic_myaddr, ":", wh->i_addr1, ":");
    597  1.84   mlelstv 				ic->ic_stats.is_rx_wrongbss++;
    598  1.84   mlelstv 				goto out;
    599  1.84   mlelstv 			}
    600  1.40    dyoung 			break;
    601  1.92      maxv 
    602  1.40    dyoung 		case IEEE80211_M_IBSS:
    603  1.40    dyoung 		case IEEE80211_M_AHDEMO:
    604  1.40    dyoung 		case IEEE80211_M_HOSTAP:
    605  1.40    dyoung 			if (dir != IEEE80211_FC1_DIR_NODS)
    606  1.40    dyoung 				bssid = wh->i_addr1;
    607  1.40    dyoung 			else if (type == IEEE80211_FC0_TYPE_CTL)
    608  1.40    dyoung 				bssid = wh->i_addr1;
    609  1.40    dyoung 			else {
    610  1.40    dyoung 				if (m->m_pkthdr.len < sizeof(struct ieee80211_frame)) {
    611  1.40    dyoung 					IEEE80211_DISCARD_MAC(ic,
    612  1.40    dyoung 					    IEEE80211_MSG_ANY, ni->ni_macaddr,
    613  1.40    dyoung 					    NULL, "too short (2): len %u",
    614  1.40    dyoung 					    m->m_pkthdr.len);
    615  1.40    dyoung 					ic->ic_stats.is_rx_tooshort++;
    616  1.40    dyoung 					goto out;
    617  1.40    dyoung 				}
    618  1.40    dyoung 				bssid = wh->i_addr3;
    619  1.40    dyoung 			}
    620  1.40    dyoung 			if (type != IEEE80211_FC0_TYPE_DATA)
    621  1.40    dyoung 				break;
    622  1.92      maxv 
    623  1.40    dyoung 			/*
    624  1.40    dyoung 			 * Data frame, validate the bssid.
    625  1.40    dyoung 			 */
    626  1.40    dyoung 			if (!IEEE80211_ADDR_EQ(bssid, ic->ic_bss->ni_bssid) &&
    627  1.40    dyoung 			    !IEEE80211_ADDR_EQ(bssid, ifp->if_broadcastaddr)) {
    628  1.40    dyoung 				/* not interested in */
    629  1.85  christos 				IEEE80211_DEBUGVAR(
    630  1.85  christos 				    char bbuf[3 * ETHER_ADDR_LEN]);
    631  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    632  1.85  christos 				    bssid, NULL, "bss %s, broadcast %s, %s",
    633  1.85  christos 				    ether_snprintf(ebuf, sizeof(ebuf),
    634  1.85  christos 				    ic->ic_bss->ni_bssid),
    635  1.85  christos 				    ether_snprintf(bbuf, sizeof(bbuf),
    636  1.85  christos 				    ifp->if_broadcastaddr), "not to bss");
    637  1.40    dyoung 				ic->ic_stats.is_rx_wrongbss++;
    638  1.40    dyoung 				goto out;
    639  1.40    dyoung 			}
    640  1.92      maxv 
    641  1.40    dyoung 			/*
    642  1.40    dyoung 			 * For adhoc mode we cons up a node when it doesn't
    643  1.92      maxv 			 * exist. This should probably be done after an ACL
    644  1.92      maxv 			 * check.
    645  1.40    dyoung 			 */
    646  1.40    dyoung 			if (ni == ic->ic_bss &&
    647  1.50    dyoung 			    ic->ic_opmode != IEEE80211_M_HOSTAP &&
    648  1.50    dyoung 			    !IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr)) {
    649  1.40    dyoung 				/*
    650  1.40    dyoung 				 * Fake up a node for this newly
    651  1.40    dyoung 				 * discovered member of the IBSS.
    652  1.40    dyoung 				 */
    653  1.40    dyoung 				ni = ieee80211_fakeup_adhoc_node(&ic->ic_sta,
    654  1.92      maxv 				    wh->i_addr2);
    655  1.40    dyoung 				if (ni == NULL) {
    656  1.40    dyoung 					/* NB: stat kept for alloc failure */
    657  1.40    dyoung 					goto err;
    658  1.40    dyoung 				}
    659  1.40    dyoung 			}
    660  1.40    dyoung 			break;
    661  1.92      maxv 
    662  1.40    dyoung 		default:
    663  1.40    dyoung 			goto out;
    664  1.40    dyoung 		}
    665  1.92      maxv 
    666   1.1    dyoung 		ni->ni_rssi = rssi;
    667   1.1    dyoung 		ni->ni_rstamp = rstamp;
    668  1.92      maxv 
    669  1.83   mlelstv 		if (HAS_SEQ(type) && (ic->ic_opmode != IEEE80211_M_STA ||
    670  1.83   mlelstv 		    !IEEE80211_IS_MULTICAST(wh->i_addr1))) {
    671  1.83   mlelstv 			u_int8_t tid, retry;
    672  1.83   mlelstv 			u_int16_t rxno, orxno;
    673  1.83   mlelstv 
    674  1.75  christos 			if (ieee80211_has_qos(wh)) {
    675  1.92      maxv 				struct ieee80211_qosframe *qosf;
    676  1.92      maxv 
    677  1.92      maxv 				/* XXX mbuf length check */
    678  1.92      maxv 				qosf = mtod(m, struct ieee80211_qosframe *);
    679  1.92      maxv 
    680  1.92      maxv 				tid = qosf->i_qos[0] & IEEE80211_QOS_TID;
    681  1.44    dyoung 				if (TID_TO_WME_AC(tid) >= WME_AC_VI)
    682  1.40    dyoung 					ic->ic_wme.wme_hipri_traffic++;
    683  1.40    dyoung 				tid++;
    684  1.92      maxv 			} else {
    685  1.40    dyoung 				tid = 0;
    686  1.92      maxv 			}
    687  1.92      maxv 
    688  1.40    dyoung 			rxseq = le16toh(*(u_int16_t *)wh->i_seq);
    689  1.83   mlelstv 			retry = wh->i_fc[1] & IEEE80211_FC1_RETRY;
    690  1.83   mlelstv 			rxno = rxseq >> IEEE80211_SEQ_SEQ_SHIFT;
    691  1.83   mlelstv 			orxno = ni->ni_rxseqs[tid] >> IEEE80211_SEQ_SEQ_SHIFT;
    692  1.92      maxv 
    693  1.83   mlelstv 			if (retry && (
    694  1.83   mlelstv 			    (orxno == 4095 && rxno == orxno) ||
    695  1.83   mlelstv 			    (orxno != 4095 &&
    696  1.83   mlelstv 			     SEQ_LEQ(rxseq, ni->ni_rxseqs[tid]))
    697  1.83   mlelstv 			    )) {
    698  1.40    dyoung 				/* duplicate, discard */
    699  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_INPUT,
    700  1.40    dyoung 				    bssid, "duplicate",
    701  1.40    dyoung 				    "seqno <%u,%u> fragno <%u,%u> tid %u",
    702  1.83   mlelstv 				    rxno,
    703  1.83   mlelstv 				    orxno,
    704  1.40    dyoung 				    rxseq & IEEE80211_SEQ_FRAG_MASK,
    705  1.40    dyoung 				    ni->ni_rxseqs[tid] &
    706  1.40    dyoung 					IEEE80211_SEQ_FRAG_MASK,
    707  1.40    dyoung 				    tid);
    708  1.40    dyoung 				ic->ic_stats.is_rx_dup++;
    709  1.40    dyoung 				IEEE80211_NODE_STAT(ni, rx_dup);
    710  1.40    dyoung 				goto out;
    711  1.40    dyoung 			}
    712  1.40    dyoung 			ni->ni_rxseqs[tid] = rxseq;
    713   1.5    dyoung 		}
    714   1.5    dyoung 	}
    715   1.5    dyoung 
    716  1.16    dyoung 	switch (type) {
    717   1.1    dyoung 	case IEEE80211_FC0_TYPE_DATA:
    718  1.93      maxv 		ret = ieee80211_input_data(ic, &m, ni);
    719  1.93      maxv 		if (ret == -1) {
    720  1.40    dyoung 			goto out;
    721  1.40    dyoung 		}
    722  1.40    dyoung 		return IEEE80211_FC0_TYPE_DATA;
    723   1.1    dyoung 
    724   1.1    dyoung 	case IEEE80211_FC0_TYPE_MGT:
    725  1.93      maxv 		ret = ieee80211_input_management(ic, &m, ni, rssi, rstamp);
    726  1.93      maxv 		if (ret == -1) {
    727   1.1    dyoung 			goto out;
    728  1.16    dyoung 		}
    729  1.93      maxv 		return IEEE80211_FC0_TYPE_MGT;
    730   1.1    dyoung 
    731   1.1    dyoung 	case IEEE80211_FC0_TYPE_CTL:
    732  1.93      maxv 		ieee80211_input_control(ic, m, ni);
    733   1.5    dyoung 		goto out;
    734  1.93      maxv 
    735   1.1    dyoung 	default:
    736  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
    737  1.40    dyoung 		    wh, NULL, "bad frame type 0x%x", type);
    738   1.1    dyoung 		/* should not come here */
    739   1.1    dyoung 		break;
    740   1.1    dyoung 	}
    741  1.92      maxv 
    742  1.40    dyoung err:
    743   1.1    dyoung 	ifp->if_ierrors++;
    744  1.92      maxv 
    745  1.40    dyoung out:
    746   1.1    dyoung 	if (m != NULL) {
    747  1.70     joerg 		bpf_mtap3(ic->ic_rawbpf, m);
    748   1.1    dyoung 		m_freem(m);
    749   1.1    dyoung 	}
    750  1.40    dyoung 	return type;
    751  1.40    dyoung #undef SEQ_LEQ
    752  1.40    dyoung }
    753  1.40    dyoung 
    754  1.40    dyoung /*
    755  1.92      maxv  * This function reassembles fragments.
    756  1.40    dyoung  */
    757  1.40    dyoung static struct mbuf *
    758  1.64  christos ieee80211_defrag(struct ieee80211com *ic, struct ieee80211_node *ni,
    759  1.44    dyoung 	struct mbuf *m, int hdrspace)
    760  1.40    dyoung {
    761  1.40    dyoung 	struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *);
    762  1.40    dyoung 	struct ieee80211_frame *lwh;
    763  1.40    dyoung 	u_int16_t rxseq;
    764  1.40    dyoung 	u_int8_t fragno;
    765  1.94      maxv 	const u_int8_t more_frag = wh->i_fc[1] & IEEE80211_FC1_MORE_FRAG;
    766  1.40    dyoung 	struct mbuf *mfrag;
    767  1.40    dyoung 
    768  1.40    dyoung 	IASSERT(!IEEE80211_IS_MULTICAST(wh->i_addr1), ("multicast fragm?"));
    769  1.40    dyoung 
    770  1.40    dyoung 	rxseq = le16toh(*(u_int16_t *)wh->i_seq);
    771  1.40    dyoung 	fragno = rxseq & IEEE80211_SEQ_FRAG_MASK;
    772  1.40    dyoung 
    773  1.40    dyoung 	/* Quick way out, if there's nothing to defragment */
    774  1.40    dyoung 	if (!more_frag && fragno == 0 && ni->ni_rxfrag[0] == NULL)
    775  1.40    dyoung 		return m;
    776  1.40    dyoung 
    777  1.40    dyoung 	/*
    778  1.40    dyoung 	 * Remove frag to insure it doesn't get reaped by timer.
    779  1.40    dyoung 	 */
    780  1.40    dyoung 	if (ni->ni_table == NULL) {
    781  1.40    dyoung 		/*
    782  1.40    dyoung 		 * Should never happen.  If the node is orphaned (not in
    783  1.40    dyoung 		 * the table) then input packets should not reach here.
    784  1.40    dyoung 		 * Otherwise, a concurrent request that yanks the table
    785  1.40    dyoung 		 * should be blocked by other interlocking and/or by first
    786  1.40    dyoung 		 * shutting the driver down.  Regardless, be defensive
    787  1.40    dyoung 		 * here and just bail
    788  1.40    dyoung 		 */
    789  1.40    dyoung 		/* XXX need msg+stat */
    790  1.40    dyoung 		m_freem(m);
    791  1.40    dyoung 		return NULL;
    792  1.40    dyoung 	}
    793  1.40    dyoung 	IEEE80211_NODE_LOCK(ni->ni_table);
    794  1.40    dyoung 	mfrag = ni->ni_rxfrag[0];
    795  1.40    dyoung 	ni->ni_rxfrag[0] = NULL;
    796  1.40    dyoung 	IEEE80211_NODE_UNLOCK(ni->ni_table);
    797  1.40    dyoung 
    798  1.40    dyoung 	/*
    799  1.40    dyoung 	 * Validate new fragment is in order and
    800  1.40    dyoung 	 * related to the previous ones.
    801  1.40    dyoung 	 */
    802  1.40    dyoung 	if (mfrag != NULL) {
    803  1.40    dyoung 		u_int16_t last_rxseq;
    804  1.40    dyoung 
    805  1.40    dyoung 		lwh = mtod(mfrag, struct ieee80211_frame *);
    806  1.40    dyoung 		last_rxseq = le16toh(*(u_int16_t *)lwh->i_seq);
    807  1.40    dyoung 		/* NB: check seq # and frag together */
    808  1.40    dyoung 		if (rxseq != last_rxseq+1 ||
    809  1.40    dyoung 		    !IEEE80211_ADDR_EQ(wh->i_addr1, lwh->i_addr1) ||
    810  1.40    dyoung 		    !IEEE80211_ADDR_EQ(wh->i_addr2, lwh->i_addr2)) {
    811  1.40    dyoung 			/*
    812  1.40    dyoung 			 * Unrelated fragment or no space for it,
    813  1.40    dyoung 			 * clear current fragments.
    814  1.40    dyoung 			 */
    815  1.40    dyoung 			m_freem(mfrag);
    816  1.40    dyoung 			mfrag = NULL;
    817  1.40    dyoung 		}
    818  1.40    dyoung 	}
    819  1.40    dyoung 
    820  1.94      maxv 	if (mfrag == NULL) {
    821  1.40    dyoung 		if (fragno != 0) {		/* !first fragment, discard */
    822  1.40    dyoung 			IEEE80211_NODE_STAT(ni, rx_defrag);
    823  1.40    dyoung 			m_freem(m);
    824  1.40    dyoung 			return NULL;
    825  1.40    dyoung 		}
    826  1.40    dyoung 		mfrag = m;
    827  1.94      maxv 	} else {
    828  1.94      maxv 		/* Strip header and concatenate */
    829  1.94      maxv 		m_adj(m, hdrspace);
    830  1.40    dyoung 		m_cat(mfrag, m);
    831  1.94      maxv 
    832  1.40    dyoung 		/* NB: m_cat doesn't update the packet header */
    833  1.40    dyoung 		mfrag->m_pkthdr.len += m->m_pkthdr.len;
    834  1.94      maxv 
    835  1.40    dyoung 		/* track last seqnum and fragno */
    836  1.40    dyoung 		lwh = mtod(mfrag, struct ieee80211_frame *);
    837  1.94      maxv 		*(u_int16_t *)lwh->i_seq = *(u_int16_t *)wh->i_seq;
    838  1.40    dyoung 	}
    839  1.94      maxv 
    840  1.94      maxv 	if (more_frag) {
    841  1.94      maxv 		/* more to come, save */
    842  1.40    dyoung 		ni->ni_rxfragstamp = ticks;
    843  1.40    dyoung 		ni->ni_rxfrag[0] = mfrag;
    844  1.40    dyoung 		mfrag = NULL;
    845  1.40    dyoung 	}
    846  1.94      maxv 
    847  1.40    dyoung 	return mfrag;
    848   1.1    dyoung }
    849   1.1    dyoung 
    850  1.47     skrll static void
    851  1.47     skrll ieee80211_deliver_data(struct ieee80211com *ic,
    852  1.47     skrll 	struct ieee80211_node *ni, struct mbuf *m)
    853  1.47     skrll {
    854  1.47     skrll 	struct ether_header *eh = mtod(m, struct ether_header *);
    855  1.47     skrll 	struct ifnet *ifp = ic->ic_ifp;
    856  1.68     joerg 	int error;
    857  1.47     skrll 
    858  1.47     skrll 	/* perform as a bridge within the AP */
    859  1.47     skrll 	if (ic->ic_opmode == IEEE80211_M_HOSTAP &&
    860  1.47     skrll 	    (ic->ic_flags & IEEE80211_F_NOBRIDGE) == 0) {
    861  1.47     skrll 		struct mbuf *m1 = NULL;
    862  1.47     skrll 
    863  1.47     skrll 		if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
    864  1.47     skrll 			m1 = m_copypacket(m, M_DONTWAIT);
    865  1.47     skrll 			if (m1 == NULL)
    866  1.47     skrll 				ifp->if_oerrors++;
    867  1.47     skrll 			else
    868  1.47     skrll 				m1->m_flags |= M_MCAST;
    869  1.47     skrll 		} else {
    870  1.47     skrll 			/*
    871  1.47     skrll 			 * Check if the destination is known; if so
    872  1.47     skrll 			 * and the port is authorized dispatch directly.
    873  1.47     skrll 			 */
    874  1.47     skrll 			struct ieee80211_node *sta =
    875  1.47     skrll 			    ieee80211_find_node(&ic->ic_sta, eh->ether_dhost);
    876  1.47     skrll 			if (sta != NULL) {
    877  1.47     skrll 				if (ieee80211_node_is_authorized(sta)) {
    878  1.47     skrll 					/*
    879  1.47     skrll 					 * Beware of sending to ourself; this
    880  1.47     skrll 					 * needs to happen via the normal
    881  1.47     skrll 					 * input path.
    882  1.47     skrll 					 */
    883  1.47     skrll 					if (sta != ic->ic_bss) {
    884  1.47     skrll 						m1 = m;
    885  1.47     skrll 						m = NULL;
    886  1.47     skrll 					}
    887  1.47     skrll 				} else {
    888  1.47     skrll 					ic->ic_stats.is_rx_unauth++;
    889  1.47     skrll 					IEEE80211_NODE_STAT(sta, rx_unauth);
    890  1.47     skrll 				}
    891  1.47     skrll 				ieee80211_free_node(sta);
    892  1.47     skrll 			}
    893  1.47     skrll 		}
    894  1.95      maxv 
    895  1.47     skrll 		if (m1 != NULL) {
    896  1.47     skrll 			int len;
    897  1.47     skrll #ifdef ALTQ
    898  1.47     skrll 			if (ALTQ_IS_ENABLED(&ifp->if_snd)) {
    899  1.81  knakahar 				altq_etherclassify(&ifp->if_snd, m1);
    900  1.47     skrll 			}
    901  1.47     skrll #endif
    902  1.47     skrll 			len = m1->m_pkthdr.len;
    903  1.82  knakahar 			IFQ_ENQUEUE(&ifp->if_snd, m1, error);
    904  1.68     joerg 			if (error) {
    905  1.88     ozaki 				ifp->if_oerrors++;
    906  1.95      maxv 				m_freem(m);
    907  1.68     joerg 				m = NULL;
    908  1.68     joerg 			}
    909  1.47     skrll 			ifp->if_obytes += len;
    910  1.47     skrll 		}
    911  1.47     skrll 	}
    912  1.95      maxv 
    913  1.47     skrll 	if (m != NULL) {
    914  1.89  knakahar 		if (ni->ni_vlan != 0)
    915  1.89  knakahar 			vlan_set_tag(m, ni->ni_vlan);
    916  1.80     ozaki 
    917  1.80     ozaki 		/*
    918  1.80     ozaki 		 * XXX once ieee80211_input (or rxintr itself) runs in softint
    919  1.80     ozaki 		 * we have to change here too to use if_input.
    920  1.80     ozaki 		 */
    921  1.80     ozaki 		KASSERT(ifp->if_percpuq);
    922  1.80     ozaki 		if_percpuq_enqueue(ifp->if_percpuq, m);
    923  1.47     skrll 	}
    924  1.95      maxv 
    925  1.47     skrll 	return;
    926  1.47     skrll }
    927  1.47     skrll 
    928  1.40    dyoung static struct mbuf *
    929  1.64  christos ieee80211_decap(struct ieee80211com *ic, struct mbuf *m, int hdrlen)
    930   1.1    dyoung {
    931  1.94      maxv 	struct ieee80211_qosframe_addr4 wh; /* Max size address frames */
    932   1.1    dyoung 	struct ether_header *eh;
    933   1.1    dyoung 	struct llc *llc;
    934   1.1    dyoung 
    935  1.44    dyoung 	if (m->m_len < hdrlen + sizeof(*llc) &&
    936  1.44    dyoung 	    (m = m_pullup(m, hdrlen + sizeof(*llc))) == NULL) {
    937  1.40    dyoung 		return NULL;
    938   1.1    dyoung 	}
    939  1.94      maxv 
    940  1.65  christos 	memcpy(&wh, mtod(m, void *), hdrlen);
    941  1.94      maxv 
    942  1.65  christos 	llc = (struct llc *)(mtod(m, char *) + hdrlen);
    943  1.94      maxv 	if (llc->llc_dsap == LLC_SNAP_LSAP &&
    944  1.94      maxv 	    llc->llc_ssap == LLC_SNAP_LSAP &&
    945  1.94      maxv 	    llc->llc_control == LLC_UI &&
    946  1.94      maxv 	    llc->llc_snap.org_code[0] == 0 &&
    947  1.94      maxv 	    llc->llc_snap.org_code[1] == 0 &&
    948  1.94      maxv 	    llc->llc_snap.org_code[2] == 0) {
    949  1.44    dyoung 		m_adj(m, hdrlen + sizeof(struct llc) - sizeof(*eh));
    950   1.1    dyoung 		llc = NULL;
    951   1.1    dyoung 	} else {
    952  1.94      maxv 		/* Keep the LLC after the Ethernet header. */
    953  1.44    dyoung 		m_adj(m, hdrlen - sizeof(*eh));
    954   1.1    dyoung 	}
    955  1.94      maxv 
    956   1.1    dyoung 	eh = mtod(m, struct ether_header *);
    957  1.94      maxv 
    958   1.1    dyoung 	switch (wh.i_fc[1] & IEEE80211_FC1_DIR_MASK) {
    959   1.1    dyoung 	case IEEE80211_FC1_DIR_NODS:
    960   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr1);
    961   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr2);
    962   1.1    dyoung 		break;
    963   1.1    dyoung 	case IEEE80211_FC1_DIR_TODS:
    964   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr3);
    965   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr2);
    966   1.1    dyoung 		break;
    967   1.1    dyoung 	case IEEE80211_FC1_DIR_FROMDS:
    968   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr1);
    969   1.1    dyoung 		IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr3);
    970   1.1    dyoung 		break;
    971   1.1    dyoung 	case IEEE80211_FC1_DIR_DSTODS:
    972  1.44    dyoung 		IEEE80211_ADDR_COPY(eh->ether_dhost, wh.i_addr3);
    973  1.44    dyoung 		IEEE80211_ADDR_COPY(eh->ether_shost, wh.i_addr4);
    974  1.44    dyoung 		break;
    975   1.1    dyoung 	}
    976  1.94      maxv 
    977   1.1    dyoung #ifdef ALIGNED_POINTER
    978  1.66  christos 	if (!ALIGNED_POINTER(mtod(m, char *) + sizeof(*eh), u_int32_t)) {
    979   1.1    dyoung 		struct mbuf *n, *n0, **np;
    980  1.65  christos 		char *newdata;
    981   1.1    dyoung 		int off, pktlen;
    982   1.1    dyoung 
    983   1.1    dyoung 		n0 = NULL;
    984   1.1    dyoung 		np = &n0;
    985   1.1    dyoung 		off = 0;
    986   1.1    dyoung 		pktlen = m->m_pkthdr.len;
    987   1.1    dyoung 		while (pktlen > off) {
    988   1.1    dyoung 			if (n0 == NULL) {
    989   1.1    dyoung 				MGETHDR(n, M_DONTWAIT, MT_DATA);
    990   1.1    dyoung 				if (n == NULL) {
    991   1.1    dyoung 					m_freem(m);
    992   1.1    dyoung 					return NULL;
    993   1.1    dyoung 				}
    994  1.45      yamt 				M_MOVE_PKTHDR(n, m);
    995   1.1    dyoung 				n->m_len = MHLEN;
    996   1.1    dyoung 			} else {
    997   1.1    dyoung 				MGET(n, M_DONTWAIT, MT_DATA);
    998   1.1    dyoung 				if (n == NULL) {
    999   1.1    dyoung 					m_freem(m);
   1000   1.1    dyoung 					m_freem(n0);
   1001   1.1    dyoung 					return NULL;
   1002   1.1    dyoung 				}
   1003   1.1    dyoung 				n->m_len = MLEN;
   1004   1.1    dyoung 			}
   1005   1.1    dyoung 			if (pktlen - off >= MINCLSIZE) {
   1006   1.1    dyoung 				MCLGET(n, M_DONTWAIT);
   1007   1.1    dyoung 				if (n->m_flags & M_EXT)
   1008   1.1    dyoung 					n->m_len = n->m_ext.ext_size;
   1009   1.1    dyoung 			}
   1010   1.1    dyoung 			if (n0 == NULL) {
   1011   1.1    dyoung 				newdata =
   1012  1.65  christos 				    (char *)ALIGN(n->m_data + sizeof(*eh)) -
   1013   1.1    dyoung 				    sizeof(*eh);
   1014   1.1    dyoung 				n->m_len -= newdata - n->m_data;
   1015   1.1    dyoung 				n->m_data = newdata;
   1016   1.1    dyoung 			}
   1017   1.1    dyoung 			if (n->m_len > pktlen - off)
   1018   1.1    dyoung 				n->m_len = pktlen - off;
   1019  1.65  christos 			m_copydata(m, off, n->m_len, mtod(n, void *));
   1020   1.1    dyoung 			off += n->m_len;
   1021   1.1    dyoung 			*np = n;
   1022   1.1    dyoung 			np = &n->m_next;
   1023   1.1    dyoung 		}
   1024   1.1    dyoung 		m_freem(m);
   1025   1.1    dyoung 		m = n0;
   1026   1.1    dyoung 	}
   1027   1.1    dyoung #endif /* ALIGNED_POINTER */
   1028  1.94      maxv 
   1029   1.1    dyoung 	if (llc != NULL) {
   1030   1.1    dyoung 		eh = mtod(m, struct ether_header *);
   1031   1.1    dyoung 		eh->ether_type = htons(m->m_pkthdr.len - sizeof(*eh));
   1032   1.1    dyoung 	}
   1033  1.94      maxv 
   1034   1.1    dyoung 	return m;
   1035   1.1    dyoung }
   1036   1.1    dyoung 
   1037   1.1    dyoung /*
   1038   1.1    dyoung  * Install received rate set information in the node's state block.
   1039   1.1    dyoung  */
   1040  1.47     skrll int
   1041  1.47     skrll ieee80211_setup_rates(struct ieee80211_node *ni,
   1042  1.47     skrll 	const u_int8_t *rates, const u_int8_t *xrates, int flags)
   1043   1.1    dyoung {
   1044  1.47     skrll 	struct ieee80211com *ic = ni->ni_ic;
   1045   1.1    dyoung 	struct ieee80211_rateset *rs = &ni->ni_rates;
   1046   1.1    dyoung 
   1047   1.1    dyoung 	memset(rs, 0, sizeof(*rs));
   1048   1.1    dyoung 	rs->rs_nrates = rates[1];
   1049   1.1    dyoung 	memcpy(rs->rs_rates, rates + 2, rs->rs_nrates);
   1050   1.1    dyoung 	if (xrates != NULL) {
   1051   1.1    dyoung 		u_int8_t nxrates;
   1052   1.1    dyoung 		/*
   1053   1.1    dyoung 		 * Tack on 11g extended supported rate element.
   1054   1.1    dyoung 		 */
   1055   1.1    dyoung 		nxrates = xrates[1];
   1056   1.1    dyoung 		if (rs->rs_nrates + nxrates > IEEE80211_RATE_MAXSIZE) {
   1057  1.85  christos 			IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   1058   1.1    dyoung 			nxrates = IEEE80211_RATE_MAXSIZE - rs->rs_nrates;
   1059  1.25   mycroft 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_XRATE,
   1060  1.40    dyoung 			     "[%s] extended rate set too large;"
   1061  1.40    dyoung 			     " only using %u of %u rates\n",
   1062  1.85  christos 			     ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
   1063  1.85  christos 			     nxrates, xrates[1]);
   1064  1.16    dyoung 			ic->ic_stats.is_rx_rstoobig++;
   1065   1.1    dyoung 		}
   1066   1.1    dyoung 		memcpy(rs->rs_rates + rs->rs_nrates, xrates+2, nxrates);
   1067   1.1    dyoung 		rs->rs_nrates += nxrates;
   1068   1.1    dyoung 	}
   1069  1.47     skrll 	return ieee80211_fix_rate(ni, flags);
   1070   1.1    dyoung }
   1071   1.1    dyoung 
   1072   1.7    dyoung static void
   1073   1.7    dyoung ieee80211_auth_open(struct ieee80211com *ic, struct ieee80211_frame *wh,
   1074  1.64  christos     struct ieee80211_node *ni, int rssi, u_int32_t rstamp,
   1075  1.63  christos     u_int16_t seq, u_int16_t status)
   1076   1.7    dyoung {
   1077  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   1078  1.40    dyoung 
   1079  1.44    dyoung 	if (ni->ni_authmode == IEEE80211_AUTH_SHARED) {
   1080  1.44    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1081  1.44    dyoung 		    ni->ni_macaddr, "open auth",
   1082  1.44    dyoung 		    "bad sta auth mode %u", ni->ni_authmode);
   1083  1.44    dyoung 		ic->ic_stats.is_rx_bad_auth++;	/* XXX */
   1084  1.44    dyoung 		if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   1085  1.44    dyoung 			/* XXX hack to workaround calling convention */
   1086  1.74  christos 			ieee80211_send_error(ic, ni, wh->i_addr2,
   1087  1.44    dyoung 			    IEEE80211_FC0_SUBTYPE_AUTH,
   1088  1.44    dyoung 			    (seq + 1) | (IEEE80211_STATUS_ALG<<16));
   1089  1.44    dyoung 		}
   1090  1.44    dyoung 		return;
   1091  1.44    dyoung 	}
   1092   1.7    dyoung 	switch (ic->ic_opmode) {
   1093   1.7    dyoung 	case IEEE80211_M_IBSS:
   1094   1.7    dyoung 	case IEEE80211_M_AHDEMO:
   1095  1.44    dyoung 	case IEEE80211_M_MONITOR:
   1096   1.7    dyoung 		/* should not come here */
   1097  1.44    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1098  1.44    dyoung 		    ni->ni_macaddr, "open auth",
   1099  1.44    dyoung 		    "bad operating mode %u", ic->ic_opmode);
   1100   1.7    dyoung 		break;
   1101   1.7    dyoung 
   1102   1.7    dyoung 	case IEEE80211_M_HOSTAP:
   1103  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   1104  1.11   mycroft 		if (ic->ic_state != IEEE80211_S_RUN ||
   1105  1.16    dyoung 		    seq != IEEE80211_AUTH_OPEN_REQUEST) {
   1106  1.16    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1107   1.7    dyoung 			return;
   1108  1.16    dyoung 		}
   1109  1.40    dyoung 		/* always accept open authentication requests */
   1110   1.7    dyoung 		if (ni == ic->ic_bss) {
   1111  1.40    dyoung 			ni = ieee80211_dup_bss(&ic->ic_sta, wh->i_addr2);
   1112  1.40    dyoung 			if (ni == NULL)
   1113   1.7    dyoung 				return;
   1114  1.44    dyoung 		} else if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0)
   1115  1.40    dyoung 			(void) ieee80211_ref_node(ni);
   1116  1.44    dyoung 		/*
   1117  1.78       snj 		 * Mark the node as referenced to reflect that its
   1118  1.44    dyoung 		 * reference count has been bumped to insure it remains
   1119  1.44    dyoung 		 * after the transaction completes.
   1120  1.44    dyoung 		 */
   1121  1.44    dyoung 		ni->ni_flags |= IEEE80211_NODE_AREF;
   1122  1.44    dyoung 
   1123   1.7    dyoung 		IEEE80211_SEND_MGMT(ic, ni,
   1124   1.7    dyoung 			IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
   1125  1.26   mycroft 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1126  1.40    dyoung 		    "[%s] station authenticated (open)\n",
   1127  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
   1128  1.44    dyoung 		/*
   1129  1.44    dyoung 		 * When 802.1x is not in use mark the port
   1130  1.44    dyoung 		 * authorized at this point so traffic can flow.
   1131  1.44    dyoung 		 */
   1132  1.44    dyoung 		if (ni->ni_authmode != IEEE80211_AUTH_8021X)
   1133  1.47     skrll 			ieee80211_node_authorize(ni);
   1134  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   1135   1.7    dyoung 		break;
   1136  1.26   mycroft 
   1137   1.7    dyoung 	case IEEE80211_M_STA:
   1138   1.7    dyoung 		if (ic->ic_state != IEEE80211_S_AUTH ||
   1139  1.16    dyoung 		    seq != IEEE80211_AUTH_OPEN_RESPONSE) {
   1140  1.16    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1141   1.7    dyoung 			return;
   1142  1.16    dyoung 		}
   1143   1.7    dyoung 		if (status != 0) {
   1144  1.85  christos 
   1145  1.26   mycroft 			IEEE80211_DPRINTF(ic,
   1146  1.26   mycroft 			    IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1147  1.40    dyoung 			    "[%s] open auth failed (reason %d)\n",
   1148  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
   1149  1.85  christos 			    status);
   1150  1.40    dyoung 			/* XXX can this happen? */
   1151   1.7    dyoung 			if (ni != ic->ic_bss)
   1152   1.7    dyoung 				ni->ni_fails++;
   1153  1.16    dyoung 			ic->ic_stats.is_rx_auth_fail++;
   1154  1.44    dyoung 			ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
   1155  1.44    dyoung 		} else
   1156  1.44    dyoung 			ieee80211_new_state(ic, IEEE80211_S_ASSOC,
   1157  1.44    dyoung 			    wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
   1158   1.7    dyoung 		break;
   1159   1.7    dyoung 	}
   1160   1.7    dyoung }
   1161   1.7    dyoung 
   1162  1.44    dyoung /*
   1163  1.44    dyoung  * Send a management frame error response to the specified
   1164  1.44    dyoung  * station.  If ni is associated with the station then use
   1165  1.44    dyoung  * it; otherwise allocate a temporary node suitable for
   1166  1.44    dyoung  * transmitting the frame and then free the reference so
   1167  1.44    dyoung  * it will go away as soon as the frame has been transmitted.
   1168  1.44    dyoung  */
   1169  1.44    dyoung static void
   1170  1.44    dyoung ieee80211_send_error(struct ieee80211com *ic, struct ieee80211_node *ni,
   1171  1.44    dyoung 	const u_int8_t *mac, int subtype, int arg)
   1172  1.44    dyoung {
   1173  1.44    dyoung 	int istmp;
   1174  1.44    dyoung 
   1175  1.44    dyoung 	if (ni == ic->ic_bss) {
   1176  1.47     skrll 		ni = ieee80211_tmp_node(ic, mac);
   1177  1.44    dyoung 		if (ni == NULL) {
   1178  1.44    dyoung 			/* XXX msg */
   1179  1.44    dyoung 			return;
   1180  1.44    dyoung 		}
   1181  1.44    dyoung 		istmp = 1;
   1182  1.44    dyoung 	} else
   1183  1.44    dyoung 		istmp = 0;
   1184  1.44    dyoung 	IEEE80211_SEND_MGMT(ic, ni, subtype, arg);
   1185  1.44    dyoung 	if (istmp)
   1186  1.44    dyoung 		ieee80211_free_node(ni);
   1187  1.44    dyoung }
   1188  1.44    dyoung 
   1189  1.40    dyoung static int
   1190  1.40    dyoung alloc_challenge(struct ieee80211com *ic, struct ieee80211_node *ni)
   1191  1.40    dyoung {
   1192  1.40    dyoung 	if (ni->ni_challenge == NULL)
   1193  1.67    cegger 		ni->ni_challenge = malloc(IEEE80211_CHALLENGE_LEN,
   1194  1.40    dyoung 		    M_DEVBUF, M_NOWAIT);
   1195  1.40    dyoung 	if (ni->ni_challenge == NULL) {
   1196  1.85  christos 		 IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   1197  1.85  christos 
   1198  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1199  1.40    dyoung 		    "[%s] shared key challenge alloc failed\n",
   1200  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
   1201  1.40    dyoung 		/* XXX statistic */
   1202  1.40    dyoung 	}
   1203  1.40    dyoung 	return (ni->ni_challenge != NULL);
   1204  1.40    dyoung }
   1205  1.40    dyoung 
   1206  1.40    dyoung /* XXX TODO: add statistics */
   1207   1.7    dyoung static void
   1208   1.7    dyoung ieee80211_auth_shared(struct ieee80211com *ic, struct ieee80211_frame *wh,
   1209   1.7    dyoung     u_int8_t *frm, u_int8_t *efrm, struct ieee80211_node *ni, int rssi,
   1210   1.7    dyoung     u_int32_t rstamp, u_int16_t seq, u_int16_t status)
   1211   1.7    dyoung {
   1212  1.40    dyoung 	u_int8_t *challenge;
   1213  1.41    dyoung 	int estatus;
   1214  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   1215   1.7    dyoung 
   1216  1.40    dyoung 	/*
   1217  1.40    dyoung 	 * NB: this can happen as we allow pre-shared key
   1218  1.40    dyoung 	 * authentication to be enabled w/o wep being turned
   1219  1.40    dyoung 	 * on so that configuration of these can be done
   1220  1.40    dyoung 	 * in any order.  It may be better to enforce the
   1221  1.40    dyoung 	 * ordering in which case this check would just be
   1222  1.40    dyoung 	 * for sanity/consistency.
   1223  1.40    dyoung 	 */
   1224  1.28   mycroft 	if ((ic->ic_flags & IEEE80211_F_PRIVACY) == 0) {
   1225  1.40    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1226  1.40    dyoung 		    ni->ni_macaddr, "shared key auth",
   1227  1.40    dyoung 		    "%s", " PRIVACY is disabled");
   1228  1.40    dyoung 		estatus = IEEE80211_STATUS_ALG;
   1229  1.40    dyoung 		goto bad;
   1230  1.40    dyoung 	}
   1231  1.40    dyoung 	/*
   1232  1.40    dyoung 	 * Pre-shared key authentication is evil; accept
   1233  1.40    dyoung 	 * it only if explicitly configured (it is supported
   1234  1.40    dyoung 	 * mainly for compatibility with clients like OS X).
   1235  1.40    dyoung 	 */
   1236  1.40    dyoung 	if (ni->ni_authmode != IEEE80211_AUTH_AUTO &&
   1237  1.40    dyoung 	    ni->ni_authmode != IEEE80211_AUTH_SHARED) {
   1238  1.40    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1239  1.40    dyoung 		    ni->ni_macaddr, "shared key auth",
   1240  1.40    dyoung 		    "bad sta auth mode %u", ni->ni_authmode);
   1241  1.40    dyoung 		ic->ic_stats.is_rx_bad_auth++;	/* XXX maybe a unique error? */
   1242  1.40    dyoung 		estatus = IEEE80211_STATUS_ALG;
   1243  1.40    dyoung 		goto bad;
   1244   1.7    dyoung 	}
   1245   1.7    dyoung 
   1246  1.40    dyoung 	challenge = NULL;
   1247   1.7    dyoung 	if (frm + 1 < efrm) {
   1248  1.40    dyoung 		if ((frm[1] + 2) > (efrm - frm)) {
   1249  1.40    dyoung 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1250  1.40    dyoung 			    ni->ni_macaddr, "shared key auth",
   1251  1.40    dyoung 			    "ie %d/%d too long",
   1252  1.40    dyoung 			    frm[0], (frm[1] + 2) - (efrm - frm));
   1253  1.16    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1254  1.40    dyoung 			estatus = IEEE80211_STATUS_CHALLENGE;
   1255  1.40    dyoung 			goto bad;
   1256   1.7    dyoung 		}
   1257   1.7    dyoung 		if (*frm == IEEE80211_ELEMID_CHALLENGE)
   1258   1.7    dyoung 			challenge = frm;
   1259   1.7    dyoung 		frm += frm[1] + 2;
   1260   1.7    dyoung 	}
   1261   1.7    dyoung 	switch (seq) {
   1262   1.7    dyoung 	case IEEE80211_AUTH_SHARED_CHALLENGE:
   1263   1.7    dyoung 	case IEEE80211_AUTH_SHARED_RESPONSE:
   1264   1.7    dyoung 		if (challenge == NULL) {
   1265  1.40    dyoung 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1266  1.40    dyoung 			    ni->ni_macaddr, "shared key auth",
   1267  1.40    dyoung 			    "%s", "no challenge");
   1268  1.16    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1269  1.40    dyoung 			estatus = IEEE80211_STATUS_CHALLENGE;
   1270  1.40    dyoung 			goto bad;
   1271   1.7    dyoung 		}
   1272   1.7    dyoung 		if (challenge[1] != IEEE80211_CHALLENGE_LEN) {
   1273  1.40    dyoung 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1274  1.40    dyoung 			    ni->ni_macaddr, "shared key auth",
   1275  1.40    dyoung 			    "bad challenge len %d", challenge[1]);
   1276  1.16    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1277  1.40    dyoung 			estatus = IEEE80211_STATUS_CHALLENGE;
   1278  1.40    dyoung 			goto bad;
   1279   1.7    dyoung 		}
   1280   1.7    dyoung 	default:
   1281   1.7    dyoung 		break;
   1282   1.7    dyoung 	}
   1283   1.7    dyoung 	switch (ic->ic_opmode) {
   1284   1.7    dyoung 	case IEEE80211_M_MONITOR:
   1285   1.7    dyoung 	case IEEE80211_M_AHDEMO:
   1286   1.7    dyoung 	case IEEE80211_M_IBSS:
   1287  1.40    dyoung 		IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1288  1.40    dyoung 		    ni->ni_macaddr, "shared key auth",
   1289  1.40    dyoung 		    "bad operating mode %u", ic->ic_opmode);
   1290   1.7    dyoung 		return;
   1291   1.7    dyoung 	case IEEE80211_M_HOSTAP:
   1292  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   1293  1.41    dyoung 	{
   1294  1.41    dyoung 		int allocbs;
   1295   1.7    dyoung 		if (ic->ic_state != IEEE80211_S_RUN) {
   1296  1.40    dyoung 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1297  1.40    dyoung 			    ni->ni_macaddr, "shared key auth",
   1298  1.40    dyoung 			    "bad state %u", ic->ic_state);
   1299  1.40    dyoung 			estatus = IEEE80211_STATUS_ALG;	/* XXX */
   1300  1.40    dyoung 			goto bad;
   1301   1.7    dyoung 		}
   1302   1.7    dyoung 		switch (seq) {
   1303   1.7    dyoung 		case IEEE80211_AUTH_SHARED_REQUEST:
   1304   1.7    dyoung 			if (ni == ic->ic_bss) {
   1305  1.40    dyoung 				ni = ieee80211_dup_bss(&ic->ic_sta, wh->i_addr2);
   1306  1.16    dyoung 				if (ni == NULL) {
   1307  1.40    dyoung 					/* NB: no way to return an error */
   1308   1.7    dyoung 					return;
   1309  1.16    dyoung 				}
   1310  1.40    dyoung 				allocbs = 1;
   1311  1.40    dyoung 			} else {
   1312  1.44    dyoung 				if ((ni->ni_flags & IEEE80211_NODE_AREF) == 0)
   1313  1.44    dyoung 					(void) ieee80211_ref_node(ni);
   1314  1.40    dyoung 				allocbs = 0;
   1315  1.40    dyoung 			}
   1316  1.85  christos 			__USE(allocbs);
   1317  1.44    dyoung 			/*
   1318  1.78       snj 			 * Mark the node as referenced to reflect that its
   1319  1.44    dyoung 			 * reference count has been bumped to insure it remains
   1320  1.44    dyoung 			 * after the transaction completes.
   1321  1.44    dyoung 			 */
   1322  1.44    dyoung 			ni->ni_flags |= IEEE80211_NODE_AREF;
   1323  1.40    dyoung 			ni->ni_rssi = rssi;
   1324  1.40    dyoung 			ni->ni_rstamp = rstamp;
   1325  1.40    dyoung 			if (!alloc_challenge(ic, ni)) {
   1326  1.40    dyoung 				/* NB: don't return error so they rexmit */
   1327  1.40    dyoung 				return;
   1328  1.40    dyoung 			}
   1329  1.40    dyoung 			get_random_bytes(ni->ni_challenge,
   1330  1.40    dyoung 				IEEE80211_CHALLENGE_LEN);
   1331  1.40    dyoung 			IEEE80211_DPRINTF(ic,
   1332  1.40    dyoung 				IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1333  1.40    dyoung 				"[%s] shared key %sauth request\n",
   1334  1.85  christos 				ether_snprintf(ebuf, sizeof(ebuf),
   1335  1.85  christos 				ni->ni_macaddr),
   1336  1.40    dyoung 				allocbs ? "" : "re");
   1337  1.40    dyoung 			break;
   1338  1.40    dyoung 		case IEEE80211_AUTH_SHARED_RESPONSE:
   1339  1.40    dyoung 			if (ni == ic->ic_bss) {
   1340  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1341  1.40    dyoung 				    ni->ni_macaddr, "shared key response",
   1342  1.40    dyoung 				    "%s", "unknown station");
   1343  1.40    dyoung 				/* NB: don't send a response */
   1344  1.40    dyoung 				return;
   1345  1.40    dyoung 			}
   1346   1.7    dyoung 			if (ni->ni_challenge == NULL) {
   1347  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1348  1.40    dyoung 				    ni->ni_macaddr, "shared key response",
   1349  1.40    dyoung 				    "%s", "no challenge recorded");
   1350  1.40    dyoung 				ic->ic_stats.is_rx_bad_auth++;
   1351  1.40    dyoung 				estatus = IEEE80211_STATUS_CHALLENGE;
   1352  1.40    dyoung 				goto bad;
   1353  1.40    dyoung 			}
   1354  1.40    dyoung 			if (memcmp(ni->ni_challenge, &challenge[2],
   1355  1.40    dyoung 			           challenge[1]) != 0) {
   1356  1.40    dyoung 				IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1357  1.40    dyoung 				    ni->ni_macaddr, "shared key response",
   1358  1.40    dyoung 				    "%s", "challenge mismatch");
   1359  1.40    dyoung 				ic->ic_stats.is_rx_auth_fail++;
   1360  1.40    dyoung 				estatus = IEEE80211_STATUS_CHALLENGE;
   1361  1.40    dyoung 				goto bad;
   1362  1.40    dyoung 			}
   1363  1.40    dyoung 			IEEE80211_DPRINTF(ic,
   1364  1.40    dyoung 			    IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1365  1.40    dyoung 			    "[%s] station authenticated (shared key)\n",
   1366  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
   1367  1.47     skrll 			ieee80211_node_authorize(ni);
   1368  1.40    dyoung 			break;
   1369  1.40    dyoung 		default:
   1370  1.40    dyoung 			IEEE80211_DISCARD_MAC(ic, IEEE80211_MSG_AUTH,
   1371  1.40    dyoung 			    ni->ni_macaddr, "shared key auth",
   1372  1.40    dyoung 			    "bad seq %d", seq);
   1373  1.40    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1374  1.40    dyoung 			estatus = IEEE80211_STATUS_SEQUENCE;
   1375  1.40    dyoung 			goto bad;
   1376  1.40    dyoung 		}
   1377  1.40    dyoung 		IEEE80211_SEND_MGMT(ic, ni,
   1378  1.40    dyoung 			IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
   1379  1.41    dyoung 	}
   1380  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   1381  1.40    dyoung 		break;
   1382  1.40    dyoung 
   1383  1.40    dyoung 	case IEEE80211_M_STA:
   1384  1.40    dyoung 		if (ic->ic_state != IEEE80211_S_AUTH)
   1385  1.40    dyoung 			return;
   1386  1.40    dyoung 		switch (seq) {
   1387  1.40    dyoung 		case IEEE80211_AUTH_SHARED_PASS:
   1388  1.40    dyoung 			if (ni->ni_challenge != NULL) {
   1389  1.67    cegger 				free(ni->ni_challenge, M_DEVBUF);
   1390  1.40    dyoung 				ni->ni_challenge = NULL;
   1391  1.40    dyoung 			}
   1392  1.40    dyoung 			if (status != 0) {
   1393  1.40    dyoung 				IEEE80211_DPRINTF(ic,
   1394  1.40    dyoung 				    IEEE80211_MSG_DEBUG | IEEE80211_MSG_AUTH,
   1395  1.40    dyoung 				    "[%s] shared key auth failed (reason %d)\n",
   1396  1.85  christos 				    ether_snprintf(ebuf, sizeof(ebuf),
   1397  1.85  christos 				    ieee80211_getbssid(ic, wh)),
   1398  1.40    dyoung 				    status);
   1399  1.40    dyoung 				/* XXX can this happen? */
   1400  1.40    dyoung 				if (ni != ic->ic_bss)
   1401  1.40    dyoung 					ni->ni_fails++;
   1402  1.40    dyoung 				ic->ic_stats.is_rx_auth_fail++;
   1403   1.7    dyoung 				return;
   1404   1.7    dyoung 			}
   1405  1.40    dyoung 			ieee80211_new_state(ic, IEEE80211_S_ASSOC,
   1406  1.40    dyoung 			    wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
   1407  1.40    dyoung 			break;
   1408  1.40    dyoung 		case IEEE80211_AUTH_SHARED_CHALLENGE:
   1409  1.40    dyoung 			if (!alloc_challenge(ic, ni))
   1410  1.40    dyoung 				return;
   1411  1.40    dyoung 			/* XXX could optimize by passing recvd challenge */
   1412  1.40    dyoung 			memcpy(ni->ni_challenge, &challenge[2], challenge[1]);
   1413  1.40    dyoung 			IEEE80211_SEND_MGMT(ic, ni,
   1414  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_AUTH, seq + 1);
   1415  1.40    dyoung 			break;
   1416  1.40    dyoung 		default:
   1417  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_AUTH,
   1418  1.40    dyoung 			    wh, "shared key auth", "bad seq %d", seq);
   1419  1.40    dyoung 			ic->ic_stats.is_rx_bad_auth++;
   1420  1.40    dyoung 			return;
   1421  1.40    dyoung 		}
   1422  1.40    dyoung 		break;
   1423  1.40    dyoung 	}
   1424  1.40    dyoung 	return;
   1425  1.40    dyoung bad:
   1426  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   1427  1.40    dyoung 	/*
   1428  1.40    dyoung 	 * Send an error response; but only when operating as an AP.
   1429  1.40    dyoung 	 */
   1430  1.40    dyoung 	if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   1431  1.40    dyoung 		/* XXX hack to workaround calling convention */
   1432  1.44    dyoung 		ieee80211_send_error(ic, ni, wh->i_addr2,
   1433  1.44    dyoung 		    IEEE80211_FC0_SUBTYPE_AUTH,
   1434  1.44    dyoung 		    (seq + 1) | (estatus<<16));
   1435  1.44    dyoung 	} else if (ic->ic_opmode == IEEE80211_M_STA) {
   1436  1.44    dyoung 		/*
   1437  1.44    dyoung 		 * Kick the state machine.  This short-circuits
   1438  1.44    dyoung 		 * using the mgt frame timeout to trigger the
   1439  1.44    dyoung 		 * state transition.
   1440  1.44    dyoung 		 */
   1441  1.44    dyoung 		if (ic->ic_state == IEEE80211_S_AUTH)
   1442  1.44    dyoung 			ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
   1443  1.40    dyoung 	}
   1444  1.41    dyoung #else
   1445  1.41    dyoung 	;
   1446  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   1447  1.40    dyoung }
   1448  1.40    dyoung 
   1449  1.40    dyoung /* Verify the existence and length of __elem or get out. */
   1450  1.40    dyoung #define IEEE80211_VERIFY_ELEMENT(__elem, __maxlen) do {			\
   1451  1.40    dyoung 	if ((__elem) == NULL) {						\
   1452  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID,		\
   1453  1.40    dyoung 		    wh, ieee80211_mgt_subtype_name[subtype >>		\
   1454  1.40    dyoung 			IEEE80211_FC0_SUBTYPE_SHIFT],			\
   1455  1.40    dyoung 		    "%s", "no " #__elem );				\
   1456  1.40    dyoung 		ic->ic_stats.is_rx_elem_missing++;			\
   1457  1.40    dyoung 		return;							\
   1458  1.40    dyoung 	}								\
   1459  1.40    dyoung 	if ((__elem)[1] > (__maxlen)) {					\
   1460  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID,		\
   1461  1.40    dyoung 		    wh, ieee80211_mgt_subtype_name[subtype >>		\
   1462  1.40    dyoung 			IEEE80211_FC0_SUBTYPE_SHIFT],			\
   1463  1.40    dyoung 		    "bad " #__elem " len %d", (__elem)[1]);		\
   1464  1.40    dyoung 		ic->ic_stats.is_rx_elem_toobig++;			\
   1465  1.40    dyoung 		return;							\
   1466  1.40    dyoung 	}								\
   1467  1.40    dyoung } while (0)
   1468  1.40    dyoung 
   1469  1.40    dyoung #define	IEEE80211_VERIFY_LENGTH(_len, _minlen) do {			\
   1470  1.40    dyoung 	if ((_len) < (_minlen)) {					\
   1471  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_ELEMID,		\
   1472  1.40    dyoung 		    wh, ieee80211_mgt_subtype_name[subtype >>		\
   1473  1.40    dyoung 			IEEE80211_FC0_SUBTYPE_SHIFT],			\
   1474  1.40    dyoung 		    "%s", "ie too short");				\
   1475  1.40    dyoung 		ic->ic_stats.is_rx_elem_toosmall++;			\
   1476  1.40    dyoung 		return;							\
   1477  1.40    dyoung 	}								\
   1478  1.40    dyoung } while (0)
   1479  1.40    dyoung 
   1480  1.40    dyoung #ifdef IEEE80211_DEBUG
   1481  1.40    dyoung static void
   1482  1.64  christos ieee80211_ssid_mismatch(struct ieee80211com *ic, const char *tag,
   1483  1.40    dyoung 	u_int8_t mac[IEEE80211_ADDR_LEN], u_int8_t *ssid)
   1484  1.40    dyoung {
   1485  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   1486  1.85  christos 
   1487  1.40    dyoung 	printf("[%s] discard %s frame, ssid mismatch: ",
   1488  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf), mac), tag);
   1489  1.40    dyoung 	ieee80211_print_essid(ssid + 2, ssid[1]);
   1490  1.40    dyoung 	printf("\n");
   1491  1.40    dyoung }
   1492  1.40    dyoung 
   1493  1.40    dyoung #define	IEEE80211_VERIFY_SSID(_ni, _ssid) do {				\
   1494  1.40    dyoung 	if ((_ssid)[1] != 0 &&						\
   1495  1.40    dyoung 	    ((_ssid)[1] != (_ni)->ni_esslen ||				\
   1496  1.40    dyoung 	    memcmp((_ssid) + 2, (_ni)->ni_essid, (_ssid)[1]) != 0)) {	\
   1497  1.40    dyoung 		if (ieee80211_msg_input(ic))				\
   1498  1.40    dyoung 			ieee80211_ssid_mismatch(ic, 			\
   1499  1.40    dyoung 			    ieee80211_mgt_subtype_name[subtype >>	\
   1500  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],		\
   1501  1.40    dyoung 				wh->i_addr2, _ssid);			\
   1502  1.40    dyoung 		ic->ic_stats.is_rx_ssidmismatch++;			\
   1503  1.40    dyoung 		return;							\
   1504  1.40    dyoung 	}								\
   1505  1.40    dyoung } while (0)
   1506  1.40    dyoung #else /* !IEEE80211_DEBUG */
   1507  1.40    dyoung #define	IEEE80211_VERIFY_SSID(_ni, _ssid) do {				\
   1508  1.40    dyoung 	if ((_ssid)[1] != 0 &&						\
   1509  1.40    dyoung 	    ((_ssid)[1] != (_ni)->ni_esslen ||				\
   1510  1.40    dyoung 	    memcmp((_ssid) + 2, (_ni)->ni_essid, (_ssid)[1]) != 0)) {	\
   1511  1.40    dyoung 		ic->ic_stats.is_rx_ssidmismatch++;			\
   1512  1.40    dyoung 		return;							\
   1513  1.40    dyoung 	}								\
   1514  1.40    dyoung } while (0)
   1515  1.40    dyoung #endif /* !IEEE80211_DEBUG */
   1516  1.40    dyoung 
   1517  1.76  christos /* unaligned little endian access */
   1518  1.40    dyoung #define LE_READ_2(p)					\
   1519  1.40    dyoung 	((u_int16_t)					\
   1520  1.40    dyoung 	 ((((const u_int8_t *)(p))[0]      ) |		\
   1521  1.40    dyoung 	  (((const u_int8_t *)(p))[1] <<  8)))
   1522  1.40    dyoung #define LE_READ_4(p)					\
   1523  1.40    dyoung 	((u_int32_t)					\
   1524  1.40    dyoung 	 ((((const u_int8_t *)(p))[0]      ) |		\
   1525  1.40    dyoung 	  (((const u_int8_t *)(p))[1] <<  8) |		\
   1526  1.40    dyoung 	  (((const u_int8_t *)(p))[2] << 16) |		\
   1527  1.40    dyoung 	  (((const u_int8_t *)(p))[3] << 24)))
   1528  1.40    dyoung 
   1529  1.62  christos static __inline int
   1530  1.40    dyoung iswpaoui(const u_int8_t *frm)
   1531  1.40    dyoung {
   1532  1.40    dyoung 	return frm[1] > 3 && LE_READ_4(frm+2) == ((WPA_OUI_TYPE<<24)|WPA_OUI);
   1533  1.40    dyoung }
   1534  1.40    dyoung 
   1535  1.62  christos static __inline int
   1536  1.40    dyoung iswmeoui(const u_int8_t *frm)
   1537  1.40    dyoung {
   1538  1.40    dyoung 	return frm[1] > 3 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI);
   1539  1.40    dyoung }
   1540  1.40    dyoung 
   1541  1.62  christos static __inline int
   1542  1.40    dyoung iswmeparam(const u_int8_t *frm)
   1543  1.40    dyoung {
   1544  1.40    dyoung 	return frm[1] > 5 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI) &&
   1545  1.40    dyoung 		frm[6] == WME_PARAM_OUI_SUBTYPE;
   1546  1.40    dyoung }
   1547  1.40    dyoung 
   1548  1.62  christos static __inline int
   1549  1.40    dyoung iswmeinfo(const u_int8_t *frm)
   1550  1.40    dyoung {
   1551  1.40    dyoung 	return frm[1] > 5 && LE_READ_4(frm+2) == ((WME_OUI_TYPE<<24)|WME_OUI) &&
   1552  1.40    dyoung 		frm[6] == WME_INFO_OUI_SUBTYPE;
   1553  1.40    dyoung }
   1554  1.40    dyoung 
   1555  1.40    dyoung /*
   1556  1.40    dyoung  * Convert a WPA cipher selector OUI to an internal
   1557  1.40    dyoung  * cipher algorithm.  Where appropriate we also
   1558  1.40    dyoung  * record any key length.
   1559  1.40    dyoung  */
   1560  1.40    dyoung static int
   1561  1.40    dyoung wpa_cipher(u_int8_t *sel, u_int8_t *keylen)
   1562  1.40    dyoung {
   1563  1.40    dyoung #define	WPA_SEL(x)	(((x)<<24)|WPA_OUI)
   1564  1.40    dyoung 	u_int32_t w = LE_READ_4(sel);
   1565  1.40    dyoung 
   1566  1.40    dyoung 	switch (w) {
   1567  1.40    dyoung 	case WPA_SEL(WPA_CSE_NULL):
   1568  1.40    dyoung 		return IEEE80211_CIPHER_NONE;
   1569  1.40    dyoung 	case WPA_SEL(WPA_CSE_WEP40):
   1570  1.40    dyoung 		if (keylen)
   1571  1.40    dyoung 			*keylen = 40 / NBBY;
   1572  1.40    dyoung 		return IEEE80211_CIPHER_WEP;
   1573  1.40    dyoung 	case WPA_SEL(WPA_CSE_WEP104):
   1574  1.40    dyoung 		if (keylen)
   1575  1.40    dyoung 			*keylen = 104 / NBBY;
   1576  1.40    dyoung 		return IEEE80211_CIPHER_WEP;
   1577  1.40    dyoung 	case WPA_SEL(WPA_CSE_TKIP):
   1578  1.40    dyoung 		return IEEE80211_CIPHER_TKIP;
   1579  1.40    dyoung 	case WPA_SEL(WPA_CSE_CCMP):
   1580  1.40    dyoung 		return IEEE80211_CIPHER_AES_CCM;
   1581  1.40    dyoung 	}
   1582  1.40    dyoung 	return 32;		/* NB: so 1<< is discarded */
   1583  1.40    dyoung #undef WPA_SEL
   1584  1.40    dyoung }
   1585  1.40    dyoung 
   1586  1.40    dyoung /*
   1587  1.40    dyoung  * Convert a WPA key management/authentication algorithm
   1588  1.40    dyoung  * to an internal code.
   1589  1.40    dyoung  */
   1590  1.40    dyoung static int
   1591  1.40    dyoung wpa_keymgmt(u_int8_t *sel)
   1592  1.40    dyoung {
   1593  1.40    dyoung #define	WPA_SEL(x)	(((x)<<24)|WPA_OUI)
   1594  1.40    dyoung 	u_int32_t w = LE_READ_4(sel);
   1595  1.40    dyoung 
   1596  1.40    dyoung 	switch (w) {
   1597  1.40    dyoung 	case WPA_SEL(WPA_ASE_8021X_UNSPEC):
   1598  1.40    dyoung 		return WPA_ASE_8021X_UNSPEC;
   1599  1.40    dyoung 	case WPA_SEL(WPA_ASE_8021X_PSK):
   1600  1.40    dyoung 		return WPA_ASE_8021X_PSK;
   1601  1.40    dyoung 	case WPA_SEL(WPA_ASE_NONE):
   1602  1.40    dyoung 		return WPA_ASE_NONE;
   1603  1.40    dyoung 	}
   1604  1.40    dyoung 	return 0;		/* NB: so is discarded */
   1605  1.40    dyoung #undef WPA_SEL
   1606  1.40    dyoung }
   1607  1.40    dyoung 
   1608  1.40    dyoung /*
   1609  1.40    dyoung  * Parse a WPA information element to collect parameters
   1610  1.40    dyoung  * and validate the parameters against what has been
   1611  1.40    dyoung  * configured for the system.
   1612  1.40    dyoung  */
   1613  1.40    dyoung static int
   1614  1.40    dyoung ieee80211_parse_wpa(struct ieee80211com *ic, u_int8_t *frm,
   1615  1.40    dyoung 	struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh)
   1616  1.40    dyoung {
   1617  1.40    dyoung 	u_int8_t len = frm[1];
   1618  1.40    dyoung 	u_int32_t w;
   1619  1.40    dyoung 	int n;
   1620  1.40    dyoung 
   1621  1.40    dyoung 	/*
   1622  1.40    dyoung 	 * Check the length once for fixed parts: OUI, type,
   1623  1.40    dyoung 	 * version, mcast cipher, and 2 selector counts.
   1624  1.40    dyoung 	 * Other, variable-length data, must be checked separately.
   1625  1.40    dyoung 	 */
   1626  1.47     skrll 	if ((ic->ic_flags & IEEE80211_F_WPA1) == 0) {
   1627  1.47     skrll 		IEEE80211_DISCARD_IE(ic,
   1628  1.47     skrll 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1629  1.47     skrll 		    wh, "WPA", "not WPA, flags 0x%x", ic->ic_flags);
   1630  1.47     skrll 		return IEEE80211_REASON_IE_INVALID;
   1631  1.47     skrll 	}
   1632  1.40    dyoung 	if (len < 14) {
   1633  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1634  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1635  1.40    dyoung 		    wh, "WPA", "too short, len %u", len);
   1636  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1637  1.40    dyoung 	}
   1638  1.40    dyoung 	frm += 6, len -= 4;		/* NB: len is payload only */
   1639  1.40    dyoung 	/* NB: iswapoui already validated the OUI and type */
   1640  1.40    dyoung 	w = LE_READ_2(frm);
   1641  1.40    dyoung 	if (w != WPA_VERSION) {
   1642  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1643  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1644  1.40    dyoung 		    wh, "WPA", "bad version %u", w);
   1645  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1646  1.40    dyoung 	}
   1647  1.40    dyoung 	frm += 2, len -= 2;
   1648  1.40    dyoung 
   1649  1.40    dyoung 	/* multicast/group cipher */
   1650  1.40    dyoung 	w = wpa_cipher(frm, &rsn->rsn_mcastkeylen);
   1651  1.40    dyoung 	if (w != rsn->rsn_mcastcipher) {
   1652  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1653  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1654  1.40    dyoung 		    wh, "WPA", "mcast cipher mismatch; got %u, expected %u",
   1655  1.40    dyoung 		    w, rsn->rsn_mcastcipher);
   1656  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1657  1.40    dyoung 	}
   1658  1.40    dyoung 	frm += 4, len -= 4;
   1659  1.40    dyoung 
   1660  1.40    dyoung 	/* unicast ciphers */
   1661  1.40    dyoung 	n = LE_READ_2(frm);
   1662  1.40    dyoung 	frm += 2, len -= 2;
   1663  1.40    dyoung 	if (len < n*4+2) {
   1664  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1665  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1666  1.40    dyoung 		    wh, "WPA", "ucast cipher data too short; len %u, n %u",
   1667  1.40    dyoung 		    len, n);
   1668  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1669  1.40    dyoung 	}
   1670  1.40    dyoung 	w = 0;
   1671  1.40    dyoung 	for (; n > 0; n--) {
   1672  1.40    dyoung 		w |= 1<<wpa_cipher(frm, &rsn->rsn_ucastkeylen);
   1673  1.40    dyoung 		frm += 4, len -= 4;
   1674  1.40    dyoung 	}
   1675  1.40    dyoung 	w &= rsn->rsn_ucastcipherset;
   1676  1.40    dyoung 	if (w == 0) {
   1677  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1678  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1679  1.40    dyoung 		    wh, "WPA", "%s", "ucast cipher set empty");
   1680  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1681  1.40    dyoung 	}
   1682  1.40    dyoung 	if (w & (1<<IEEE80211_CIPHER_TKIP))
   1683  1.40    dyoung 		rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP;
   1684  1.40    dyoung 	else
   1685  1.40    dyoung 		rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM;
   1686  1.40    dyoung 
   1687  1.40    dyoung 	/* key management algorithms */
   1688  1.40    dyoung 	n = LE_READ_2(frm);
   1689  1.40    dyoung 	frm += 2, len -= 2;
   1690  1.40    dyoung 	if (len < n*4) {
   1691  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1692  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1693  1.40    dyoung 		    wh, "WPA", "key mgmt alg data too short; len %u, n %u",
   1694  1.40    dyoung 		    len, n);
   1695  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1696  1.40    dyoung 	}
   1697  1.40    dyoung 	w = 0;
   1698  1.40    dyoung 	for (; n > 0; n--) {
   1699  1.40    dyoung 		w |= wpa_keymgmt(frm);
   1700  1.40    dyoung 		frm += 4, len -= 4;
   1701  1.40    dyoung 	}
   1702  1.40    dyoung 	w &= rsn->rsn_keymgmtset;
   1703  1.40    dyoung 	if (w == 0) {
   1704  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1705  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1706  1.40    dyoung 		    wh, "WPA", "%s", "no acceptable key mgmt alg");
   1707  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1708  1.40    dyoung 	}
   1709  1.40    dyoung 	if (w & WPA_ASE_8021X_UNSPEC)
   1710  1.40    dyoung 		rsn->rsn_keymgmt = WPA_ASE_8021X_UNSPEC;
   1711  1.40    dyoung 	else
   1712  1.40    dyoung 		rsn->rsn_keymgmt = WPA_ASE_8021X_PSK;
   1713  1.40    dyoung 
   1714  1.40    dyoung 	if (len > 2)		/* optional capabilities */
   1715  1.40    dyoung 		rsn->rsn_caps = LE_READ_2(frm);
   1716  1.40    dyoung 
   1717  1.40    dyoung 	return 0;
   1718  1.40    dyoung }
   1719  1.40    dyoung 
   1720  1.40    dyoung /*
   1721  1.40    dyoung  * Convert an RSN cipher selector OUI to an internal
   1722  1.40    dyoung  * cipher algorithm.  Where appropriate we also
   1723  1.40    dyoung  * record any key length.
   1724  1.40    dyoung  */
   1725  1.40    dyoung static int
   1726  1.40    dyoung rsn_cipher(u_int8_t *sel, u_int8_t *keylen)
   1727  1.40    dyoung {
   1728  1.40    dyoung #define	RSN_SEL(x)	(((x)<<24)|RSN_OUI)
   1729  1.40    dyoung 	u_int32_t w = LE_READ_4(sel);
   1730  1.40    dyoung 
   1731  1.40    dyoung 	switch (w) {
   1732  1.40    dyoung 	case RSN_SEL(RSN_CSE_NULL):
   1733  1.40    dyoung 		return IEEE80211_CIPHER_NONE;
   1734  1.40    dyoung 	case RSN_SEL(RSN_CSE_WEP40):
   1735  1.40    dyoung 		if (keylen)
   1736  1.40    dyoung 			*keylen = 40 / NBBY;
   1737  1.40    dyoung 		return IEEE80211_CIPHER_WEP;
   1738  1.40    dyoung 	case RSN_SEL(RSN_CSE_WEP104):
   1739  1.40    dyoung 		if (keylen)
   1740  1.40    dyoung 			*keylen = 104 / NBBY;
   1741  1.40    dyoung 		return IEEE80211_CIPHER_WEP;
   1742  1.40    dyoung 	case RSN_SEL(RSN_CSE_TKIP):
   1743  1.40    dyoung 		return IEEE80211_CIPHER_TKIP;
   1744  1.40    dyoung 	case RSN_SEL(RSN_CSE_CCMP):
   1745  1.40    dyoung 		return IEEE80211_CIPHER_AES_CCM;
   1746  1.40    dyoung 	case RSN_SEL(RSN_CSE_WRAP):
   1747  1.40    dyoung 		return IEEE80211_CIPHER_AES_OCB;
   1748  1.40    dyoung 	}
   1749  1.40    dyoung 	return 32;		/* NB: so 1<< is discarded */
   1750  1.40    dyoung #undef WPA_SEL
   1751  1.40    dyoung }
   1752  1.40    dyoung 
   1753  1.40    dyoung /*
   1754  1.40    dyoung  * Convert an RSN key management/authentication algorithm
   1755  1.40    dyoung  * to an internal code.
   1756  1.40    dyoung  */
   1757  1.40    dyoung static int
   1758  1.40    dyoung rsn_keymgmt(u_int8_t *sel)
   1759  1.40    dyoung {
   1760  1.40    dyoung #define	RSN_SEL(x)	(((x)<<24)|RSN_OUI)
   1761  1.40    dyoung 	u_int32_t w = LE_READ_4(sel);
   1762  1.40    dyoung 
   1763  1.40    dyoung 	switch (w) {
   1764  1.40    dyoung 	case RSN_SEL(RSN_ASE_8021X_UNSPEC):
   1765  1.40    dyoung 		return RSN_ASE_8021X_UNSPEC;
   1766  1.40    dyoung 	case RSN_SEL(RSN_ASE_8021X_PSK):
   1767  1.40    dyoung 		return RSN_ASE_8021X_PSK;
   1768  1.40    dyoung 	case RSN_SEL(RSN_ASE_NONE):
   1769  1.40    dyoung 		return RSN_ASE_NONE;
   1770  1.40    dyoung 	}
   1771  1.40    dyoung 	return 0;		/* NB: so is discarded */
   1772  1.40    dyoung #undef RSN_SEL
   1773  1.40    dyoung }
   1774  1.40    dyoung 
   1775  1.40    dyoung /*
   1776  1.40    dyoung  * Parse a WPA/RSN information element to collect parameters
   1777  1.40    dyoung  * and validate the parameters against what has been
   1778  1.40    dyoung  * configured for the system.
   1779  1.40    dyoung  */
   1780  1.40    dyoung static int
   1781  1.40    dyoung ieee80211_parse_rsn(struct ieee80211com *ic, u_int8_t *frm,
   1782  1.40    dyoung 	struct ieee80211_rsnparms *rsn, const struct ieee80211_frame *wh)
   1783  1.40    dyoung {
   1784  1.40    dyoung 	u_int8_t len = frm[1];
   1785  1.40    dyoung 	u_int32_t w;
   1786  1.40    dyoung 	int n;
   1787  1.40    dyoung 
   1788  1.40    dyoung 	/*
   1789  1.74  christos 	 * Check the length once for fixed parts:
   1790  1.40    dyoung 	 * version, mcast cipher, and 2 selector counts.
   1791  1.40    dyoung 	 * Other, variable-length data, must be checked separately.
   1792  1.40    dyoung 	 */
   1793  1.47     skrll 	if ((ic->ic_flags & IEEE80211_F_WPA2) == 0) {
   1794  1.47     skrll 		IEEE80211_DISCARD_IE(ic,
   1795  1.47     skrll 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1796  1.47     skrll 		    wh, "WPA", "not RSN, flags 0x%x", ic->ic_flags);
   1797  1.47     skrll 		return IEEE80211_REASON_IE_INVALID;
   1798  1.47     skrll 	}
   1799  1.40    dyoung 	if (len < 10) {
   1800  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1801  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1802  1.40    dyoung 		    wh, "RSN", "too short, len %u", len);
   1803  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1804  1.40    dyoung 	}
   1805  1.40    dyoung 	frm += 2;
   1806  1.40    dyoung 	w = LE_READ_2(frm);
   1807  1.40    dyoung 	if (w != RSN_VERSION) {
   1808  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1809  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1810  1.40    dyoung 		    wh, "RSN", "bad version %u", w);
   1811  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1812  1.40    dyoung 	}
   1813  1.40    dyoung 	frm += 2, len -= 2;
   1814  1.40    dyoung 
   1815  1.40    dyoung 	/* multicast/group cipher */
   1816  1.40    dyoung 	w = rsn_cipher(frm, &rsn->rsn_mcastkeylen);
   1817  1.40    dyoung 	if (w != rsn->rsn_mcastcipher) {
   1818  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1819  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1820  1.40    dyoung 		    wh, "RSN", "mcast cipher mismatch; got %u, expected %u",
   1821  1.40    dyoung 		    w, rsn->rsn_mcastcipher);
   1822  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1823  1.40    dyoung 	}
   1824  1.40    dyoung 	frm += 4, len -= 4;
   1825  1.40    dyoung 
   1826  1.40    dyoung 	/* unicast ciphers */
   1827  1.40    dyoung 	n = LE_READ_2(frm);
   1828  1.40    dyoung 	frm += 2, len -= 2;
   1829  1.40    dyoung 	if (len < n*4+2) {
   1830  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1831  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1832  1.40    dyoung 		    wh, "RSN", "ucast cipher data too short; len %u, n %u",
   1833  1.40    dyoung 		    len, n);
   1834  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1835  1.40    dyoung 	}
   1836  1.40    dyoung 	w = 0;
   1837  1.40    dyoung 	for (; n > 0; n--) {
   1838  1.40    dyoung 		w |= 1<<rsn_cipher(frm, &rsn->rsn_ucastkeylen);
   1839  1.40    dyoung 		frm += 4, len -= 4;
   1840  1.40    dyoung 	}
   1841  1.40    dyoung 	w &= rsn->rsn_ucastcipherset;
   1842  1.40    dyoung 	if (w == 0) {
   1843  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1844  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1845  1.40    dyoung 		    wh, "RSN", "%s", "ucast cipher set empty");
   1846  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1847  1.40    dyoung 	}
   1848  1.40    dyoung 	if (w & (1<<IEEE80211_CIPHER_TKIP))
   1849  1.40    dyoung 		rsn->rsn_ucastcipher = IEEE80211_CIPHER_TKIP;
   1850  1.40    dyoung 	else
   1851  1.40    dyoung 		rsn->rsn_ucastcipher = IEEE80211_CIPHER_AES_CCM;
   1852  1.40    dyoung 
   1853  1.40    dyoung 	/* key management algorithms */
   1854  1.40    dyoung 	n = LE_READ_2(frm);
   1855  1.40    dyoung 	frm += 2, len -= 2;
   1856  1.40    dyoung 	if (len < n*4) {
   1857  1.74  christos 		IEEE80211_DISCARD_IE(ic,
   1858  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1859  1.40    dyoung 		    wh, "RSN", "key mgmt alg data too short; len %u, n %u",
   1860  1.40    dyoung 		    len, n);
   1861  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1862  1.40    dyoung 	}
   1863  1.40    dyoung 	w = 0;
   1864  1.40    dyoung 	for (; n > 0; n--) {
   1865  1.40    dyoung 		w |= rsn_keymgmt(frm);
   1866  1.40    dyoung 		frm += 4, len -= 4;
   1867  1.40    dyoung 	}
   1868  1.40    dyoung 	w &= rsn->rsn_keymgmtset;
   1869  1.40    dyoung 	if (w == 0) {
   1870  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1871  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WPA,
   1872  1.40    dyoung 		    wh, "RSN", "%s", "no acceptable key mgmt alg");
   1873  1.40    dyoung 		return IEEE80211_REASON_IE_INVALID;
   1874  1.40    dyoung 	}
   1875  1.40    dyoung 	if (w & RSN_ASE_8021X_UNSPEC)
   1876  1.40    dyoung 		rsn->rsn_keymgmt = RSN_ASE_8021X_UNSPEC;
   1877  1.40    dyoung 	else
   1878  1.40    dyoung 		rsn->rsn_keymgmt = RSN_ASE_8021X_PSK;
   1879  1.40    dyoung 
   1880  1.40    dyoung 	/* optional RSN capabilities */
   1881  1.40    dyoung 	if (len > 2)
   1882  1.40    dyoung 		rsn->rsn_caps = LE_READ_2(frm);
   1883  1.40    dyoung 	/* XXXPMKID */
   1884  1.40    dyoung 
   1885  1.40    dyoung 	return 0;
   1886  1.40    dyoung }
   1887  1.40    dyoung 
   1888  1.40    dyoung static int
   1889  1.40    dyoung ieee80211_parse_wmeparams(struct ieee80211com *ic, u_int8_t *frm,
   1890  1.40    dyoung 	const struct ieee80211_frame *wh)
   1891  1.40    dyoung {
   1892  1.40    dyoung #define	MS(_v, _f)	(((_v) & _f) >> _f##_S)
   1893  1.40    dyoung 	struct ieee80211_wme_state *wme = &ic->ic_wme;
   1894  1.40    dyoung 	u_int len = frm[1], qosinfo;
   1895  1.40    dyoung 	int i;
   1896  1.40    dyoung 
   1897  1.40    dyoung 	if (len < sizeof(struct ieee80211_wme_param)-2) {
   1898  1.40    dyoung 		IEEE80211_DISCARD_IE(ic,
   1899  1.40    dyoung 		    IEEE80211_MSG_ELEMID | IEEE80211_MSG_WME,
   1900  1.40    dyoung 		    wh, "WME", "too short, len %u", len);
   1901  1.40    dyoung 		return -1;
   1902  1.40    dyoung 	}
   1903  1.72  christos 	qosinfo = frm[offsetof(struct ieee80211_wme_param, param_qosInfo)];
   1904  1.40    dyoung 	qosinfo &= WME_QOSINFO_COUNT;
   1905  1.40    dyoung 	/* XXX do proper check for wraparound */
   1906  1.40    dyoung 	if (qosinfo == wme->wme_wmeChanParams.cap_info)
   1907  1.40    dyoung 		return 0;
   1908  1.72  christos 	frm += offsetof(struct ieee80211_wme_param, params_acParams);
   1909  1.40    dyoung 	for (i = 0; i < WME_NUM_AC; i++) {
   1910  1.40    dyoung 		struct wmeParams *wmep =
   1911  1.40    dyoung 			&wme->wme_wmeChanParams.cap_wmeParams[i];
   1912  1.40    dyoung 		/* NB: ACI not used */
   1913  1.40    dyoung 		wmep->wmep_acm = MS(frm[0], WME_PARAM_ACM);
   1914  1.40    dyoung 		wmep->wmep_aifsn = MS(frm[0], WME_PARAM_AIFSN);
   1915  1.40    dyoung 		wmep->wmep_logcwmin = MS(frm[1], WME_PARAM_LOGCWMIN);
   1916  1.40    dyoung 		wmep->wmep_logcwmax = MS(frm[1], WME_PARAM_LOGCWMAX);
   1917  1.40    dyoung 		wmep->wmep_txopLimit = LE_READ_2(frm+2);
   1918  1.40    dyoung 		frm += 4;
   1919  1.40    dyoung 	}
   1920  1.40    dyoung 	wme->wme_wmeChanParams.cap_info = qosinfo;
   1921  1.40    dyoung 	return 1;
   1922  1.40    dyoung #undef MS
   1923  1.40    dyoung }
   1924  1.40    dyoung 
   1925  1.47     skrll void
   1926  1.40    dyoung ieee80211_saveie(u_int8_t **iep, const u_int8_t *ie)
   1927  1.40    dyoung {
   1928  1.40    dyoung 	u_int ielen = ie[1]+2;
   1929  1.40    dyoung 	/*
   1930  1.40    dyoung 	 * Record information element for later use.
   1931  1.40    dyoung 	 */
   1932  1.40    dyoung 	if (*iep == NULL || (*iep)[1] != ie[1]) {
   1933  1.40    dyoung 		if (*iep != NULL)
   1934  1.67    cegger 			free(*iep, M_DEVBUF);
   1935  1.58  christos 		*iep = malloc(ielen, M_DEVBUF, M_NOWAIT);
   1936  1.40    dyoung 	}
   1937  1.40    dyoung 	if (*iep != NULL)
   1938  1.40    dyoung 		memcpy(*iep, ie, ielen);
   1939  1.40    dyoung 	/* XXX note failure */
   1940  1.40    dyoung }
   1941  1.40    dyoung 
   1942  1.56    dyoung static void
   1943  1.56    dyoung ieee80211_update_adhoc_node(struct ieee80211com *ic, struct ieee80211_node *ni,
   1944  1.56    dyoung     struct ieee80211_frame *wh, struct ieee80211_scanparams *scan, int rssi,
   1945  1.56    dyoung     u_int32_t rstamp)
   1946  1.56    dyoung {
   1947  1.56    dyoung 	if (!IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr)) {
   1948  1.56    dyoung 		/*
   1949  1.56    dyoung 		 * Create a new entry in the neighbor table.
   1950  1.56    dyoung 		 * Records the TSF.
   1951  1.56    dyoung 		 */
   1952  1.56    dyoung 		if ((ni = ieee80211_add_neighbor(ic, wh, scan)) == NULL)
   1953  1.56    dyoung 			return;
   1954  1.56    dyoung 	} else if (ni->ni_capinfo == 0) {
   1955  1.56    dyoung 		/*
   1956  1.56    dyoung 		 * Initialize a node that was "faked up."  Records
   1957  1.56    dyoung 		 * the TSF.
   1958  1.56    dyoung 		 *
   1959  1.56    dyoung 		 * No need to check for a change of BSSID: ni could
   1960  1.56    dyoung 		 * not have been the IBSS (ic_bss)
   1961  1.56    dyoung 		 */
   1962  1.56    dyoung 		ieee80211_init_neighbor(ic, ni, wh, scan, 0);
   1963  1.56    dyoung 	} else {
   1964  1.56    dyoung 		/* Record TSF for potential resync. */
   1965  1.56    dyoung 		memcpy(ni->ni_tstamp.data, scan->tstamp, sizeof(ni->ni_tstamp));
   1966  1.56    dyoung 	}
   1967  1.56    dyoung 
   1968  1.56    dyoung 	ni->ni_rssi = rssi;
   1969  1.56    dyoung 	ni->ni_rstamp = rstamp;
   1970  1.56    dyoung 
   1971  1.56    dyoung 	/* Mark a neighbor's change of BSSID. */
   1972  1.56    dyoung 	if (IEEE80211_ADDR_EQ(wh->i_addr3, ni->ni_bssid))
   1973  1.56    dyoung 		return;
   1974  1.56    dyoung 
   1975  1.56    dyoung 	IEEE80211_ADDR_COPY(ni->ni_bssid, wh->i_addr3);
   1976  1.56    dyoung 
   1977  1.56    dyoung 	if (ni != ic->ic_bss)
   1978  1.56    dyoung 		return;
   1979  1.56    dyoung 	else if (ic->ic_flags & IEEE80211_F_DESBSSID) {
   1980  1.56    dyoung 		/*
   1981  1.56    dyoung 		 * Now, ni does not represent a network we
   1982  1.56    dyoung 		 * want to belong to, so start a scan.
   1983  1.56    dyoung 		 */
   1984  1.56    dyoung 		ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
   1985  1.56    dyoung 		return;
   1986  1.56    dyoung 	} else {
   1987  1.56    dyoung 		/*
   1988  1.56    dyoung 		 * A RUN->RUN transition lets the driver
   1989  1.56    dyoung 		 * reprogram its BSSID filter.
   1990  1.56    dyoung 		 *
   1991  1.56    dyoung 		 * No need to SCAN, we already belong to
   1992  1.56    dyoung 		 * an IBSS that meets our criteria: channel,
   1993  1.56    dyoung 		 * SSID, etc.  It could be harmful to scan,
   1994  1.56    dyoung 		 * too: if a scan does not detect nodes
   1995  1.56    dyoung 		 * belonging to my current IBSS, then we
   1996  1.56    dyoung 		 * will create a new IBSS at the end of
   1997  1.56    dyoung 		 * the scan, needlessly splitting the
   1998  1.56    dyoung 		 * network.
   1999  1.56    dyoung 		 */
   2000  1.56    dyoung 		ieee80211_new_state(ic, IEEE80211_S_RUN, 0);
   2001  1.56    dyoung 	}
   2002  1.56    dyoung }
   2003  1.56    dyoung 
   2004   1.1    dyoung void
   2005   1.1    dyoung ieee80211_recv_mgmt(struct ieee80211com *ic, struct mbuf *m0,
   2006   1.1    dyoung 	struct ieee80211_node *ni,
   2007   1.1    dyoung 	int subtype, int rssi, u_int32_t rstamp)
   2008   1.1    dyoung {
   2009  1.26   mycroft #define	ISPROBE(_st)	((_st) == IEEE80211_FC0_SUBTYPE_PROBE_RESP)
   2010  1.26   mycroft #define	ISREASSOC(_st)	((_st) == IEEE80211_FC0_SUBTYPE_REASSOC_RESP)
   2011   1.1    dyoung 	struct ieee80211_frame *wh;
   2012   1.1    dyoung 	u_int8_t *frm, *efrm;
   2013  1.40    dyoung 	u_int8_t *ssid, *rates, *xrates, *wpa, *wme;
   2014  1.40    dyoung 	int reassoc, resp, allocbs;
   2015  1.44    dyoung 	u_int8_t rate;
   2016  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   2017   1.1    dyoung 
   2018   1.1    dyoung 	wh = mtod(m0, struct ieee80211_frame *);
   2019   1.1    dyoung 	frm = (u_int8_t *)&wh[1];
   2020   1.1    dyoung 	efrm = mtod(m0, u_int8_t *) + m0->m_len;
   2021   1.1    dyoung 	switch (subtype) {
   2022   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
   2023   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_BEACON: {
   2024  1.47     skrll 		struct ieee80211_scanparams scan;
   2025   1.1    dyoung 
   2026  1.33   mycroft 		/*
   2027  1.40    dyoung 		 * We process beacon/probe response frames:
   2028  1.40    dyoung 		 *    o when scanning, or
   2029  1.40    dyoung 		 *    o station mode when associated (to collect state
   2030  1.40    dyoung 		 *      updates such as 802.11g slot time), or
   2031  1.40    dyoung 		 *    o adhoc mode (to discover neighbors)
   2032  1.40    dyoung 		 * Frames otherwise received are discarded.
   2033  1.74  christos 		 */
   2034  1.40    dyoung 		if (!((ic->ic_flags & IEEE80211_F_SCAN) ||
   2035  1.40    dyoung 		      (ic->ic_opmode == IEEE80211_M_STA && ni->ni_associd) ||
   2036  1.40    dyoung 		       ic->ic_opmode == IEEE80211_M_IBSS)) {
   2037  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2038  1.40    dyoung 			return;
   2039   1.1    dyoung 		}
   2040   1.1    dyoung 		/*
   2041   1.1    dyoung 		 * beacon/probe response frame format
   2042   1.1    dyoung 		 *	[8] time stamp
   2043   1.1    dyoung 		 *	[2] beacon interval
   2044   1.1    dyoung 		 *	[2] capability information
   2045   1.1    dyoung 		 *	[tlv] ssid
   2046   1.1    dyoung 		 *	[tlv] supported rates
   2047   1.1    dyoung 		 *	[tlv] country information
   2048   1.1    dyoung 		 *	[tlv] parameter set (FH/DS)
   2049   1.1    dyoung 		 *	[tlv] erp information
   2050   1.1    dyoung 		 *	[tlv] extended supported rates
   2051  1.40    dyoung 		 *	[tlv] WME
   2052  1.40    dyoung 		 *	[tlv] WPA or RSN
   2053   1.1    dyoung 		 */
   2054   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, 12);
   2055  1.47     skrll 		memset(&scan, 0, sizeof(scan));
   2056  1.47     skrll 		scan.tstamp  = frm;				frm += 8;
   2057  1.47     skrll 		scan.bintval = le16toh(*(u_int16_t *)frm);	frm += 2;
   2058  1.47     skrll 		scan.capinfo = le16toh(*(u_int16_t *)frm);	frm += 2;
   2059  1.47     skrll 		scan.bchan = ieee80211_chan2ieee(ic, ic->ic_curchan);
   2060  1.47     skrll 		scan.chan = scan.bchan;
   2061  1.47     skrll 
   2062   1.1    dyoung 		while (frm < efrm) {
   2063   1.1    dyoung 			switch (*frm) {
   2064   1.1    dyoung 			case IEEE80211_ELEMID_SSID:
   2065  1.47     skrll 				scan.ssid = frm;
   2066   1.1    dyoung 				break;
   2067   1.1    dyoung 			case IEEE80211_ELEMID_RATES:
   2068  1.47     skrll 				scan.rates = frm;
   2069   1.1    dyoung 				break;
   2070   1.1    dyoung 			case IEEE80211_ELEMID_COUNTRY:
   2071  1.47     skrll 				scan.country = frm;
   2072   1.1    dyoung 				break;
   2073   1.1    dyoung 			case IEEE80211_ELEMID_FHPARMS:
   2074   1.1    dyoung 				if (ic->ic_phytype == IEEE80211_T_FH) {
   2075  1.47     skrll 					scan.fhdwell = LE_READ_2(&frm[2]);
   2076  1.47     skrll 					scan.chan = IEEE80211_FH_CHAN(frm[4], frm[5]);
   2077  1.47     skrll 					scan.fhindex = frm[6];
   2078   1.1    dyoung 				}
   2079   1.1    dyoung 				break;
   2080   1.1    dyoung 			case IEEE80211_ELEMID_DSPARMS:
   2081   1.1    dyoung 				/*
   2082   1.1    dyoung 				 * XXX hack this since depending on phytype
   2083   1.1    dyoung 				 * is problematic for multi-mode devices.
   2084   1.1    dyoung 				 */
   2085   1.1    dyoung 				if (ic->ic_phytype != IEEE80211_T_FH)
   2086  1.47     skrll 					scan.chan = frm[2];
   2087   1.1    dyoung 				break;
   2088   1.1    dyoung 			case IEEE80211_ELEMID_TIM:
   2089  1.40    dyoung 				/* XXX ATIM? */
   2090  1.47     skrll 				scan.tim = frm;
   2091  1.47     skrll 				scan.timoff = frm - mtod(m0, u_int8_t *);
   2092   1.1    dyoung 				break;
   2093  1.22    dyoung 			case IEEE80211_ELEMID_IBSSPARMS:
   2094  1.22    dyoung 				break;
   2095   1.1    dyoung 			case IEEE80211_ELEMID_XRATES:
   2096  1.47     skrll 				scan.xrates = frm;
   2097   1.1    dyoung 				break;
   2098   1.1    dyoung 			case IEEE80211_ELEMID_ERP:
   2099   1.1    dyoung 				if (frm[1] != 1) {
   2100  1.40    dyoung 					IEEE80211_DISCARD_IE(ic,
   2101  1.40    dyoung 					    IEEE80211_MSG_ELEMID, wh, "ERP",
   2102  1.40    dyoung 					    "bad len %u", frm[1]);
   2103  1.16    dyoung 					ic->ic_stats.is_rx_elem_toobig++;
   2104   1.1    dyoung 					break;
   2105   1.1    dyoung 				}
   2106  1.47     skrll 				scan.erp = frm[2];
   2107   1.1    dyoung 				break;
   2108  1.40    dyoung 			case IEEE80211_ELEMID_RSN:
   2109  1.47     skrll 				scan.wpa = frm;
   2110  1.40    dyoung 				break;
   2111  1.40    dyoung 			case IEEE80211_ELEMID_VENDOR:
   2112  1.40    dyoung 				if (iswpaoui(frm))
   2113  1.47     skrll 					scan.wpa = frm;
   2114  1.40    dyoung 				else if (iswmeparam(frm) || iswmeinfo(frm))
   2115  1.47     skrll 					scan.wme = frm;
   2116  1.40    dyoung 				/* XXX Atheros OUI support */
   2117  1.40    dyoung 				break;
   2118   1.1    dyoung 			default:
   2119  1.40    dyoung 				IEEE80211_DISCARD_IE(ic, IEEE80211_MSG_ELEMID,
   2120  1.40    dyoung 				    wh, "unhandled",
   2121  1.40    dyoung 				    "id %u, len %u", *frm, frm[1]);
   2122  1.16    dyoung 				ic->ic_stats.is_rx_elem_unknown++;
   2123   1.1    dyoung 				break;
   2124   1.1    dyoung 			}
   2125   1.1    dyoung 			frm += frm[1] + 2;
   2126   1.1    dyoung 		}
   2127  1.47     skrll 		IEEE80211_VERIFY_ELEMENT(scan.rates, IEEE80211_RATE_MAXSIZE);
   2128  1.47     skrll 		IEEE80211_VERIFY_ELEMENT(scan.ssid, IEEE80211_NWID_LEN);
   2129   1.1    dyoung 		if (
   2130   1.1    dyoung #if IEEE80211_CHAN_MAX < 255
   2131  1.47     skrll 		    scan.chan > IEEE80211_CHAN_MAX ||
   2132   1.1    dyoung #endif
   2133  1.47     skrll 		    isclr(ic->ic_chan_active, scan.chan)) {
   2134  1.47     skrll 			IEEE80211_DISCARD(ic,
   2135  1.47     skrll 			    IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
   2136  1.40    dyoung 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2137  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2138  1.47     skrll 			    "invalid channel %u", scan.chan);
   2139  1.16    dyoung 			ic->ic_stats.is_rx_badchan++;
   2140   1.1    dyoung 			return;
   2141   1.1    dyoung 		}
   2142  1.47     skrll 		if (scan.chan != scan.bchan &&
   2143  1.47     skrll 		    ic->ic_phytype != IEEE80211_T_FH) {
   2144   1.1    dyoung 			/*
   2145   1.1    dyoung 			 * Frame was received on a channel different from the
   2146  1.19      onoe 			 * one indicated in the DS params element id;
   2147   1.1    dyoung 			 * silently discard it.
   2148   1.1    dyoung 			 *
   2149   1.1    dyoung 			 * NB: this can happen due to signal leakage.
   2150  1.19      onoe 			 *     But we should take it for FH phy because
   2151  1.19      onoe 			 *     the rssi value should be correct even for
   2152  1.19      onoe 			 *     different hop pattern in FH.
   2153   1.1    dyoung 			 */
   2154  1.47     skrll 			IEEE80211_DISCARD(ic,
   2155  1.47     skrll 			    IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
   2156  1.40    dyoung 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2157  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2158  1.47     skrll 			    "for off-channel %u", scan.chan);
   2159  1.16    dyoung 			ic->ic_stats.is_rx_chanmismatch++;
   2160   1.1    dyoung 			return;
   2161   1.1    dyoung 		}
   2162  1.47     skrll 		if (!(IEEE80211_BINTVAL_MIN <= scan.bintval &&
   2163  1.47     skrll 		      scan.bintval <= IEEE80211_BINTVAL_MAX)) {
   2164  1.47     skrll 			IEEE80211_DISCARD(ic,
   2165  1.47     skrll 			    IEEE80211_MSG_ELEMID | IEEE80211_MSG_INPUT,
   2166  1.47     skrll 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2167  1.47     skrll 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2168  1.47     skrll 			    "bogus beacon interval", scan.bintval);
   2169  1.47     skrll 			ic->ic_stats.is_rx_badbintval++;
   2170  1.47     skrll 			return;
   2171  1.47     skrll 		}
   2172   1.1    dyoung 
   2173  1.42    dyoung 		if (ni != ic->ic_bss) {
   2174  1.42    dyoung 			ni = ieee80211_refine_node_for_beacon(ic, ni,
   2175  1.47     skrll 					&ic->ic_channels[scan.chan], scan.ssid);
   2176  1.42    dyoung 		}
   2177   1.1    dyoung 		/*
   2178  1.40    dyoung 		 * Count frame now that we know it's to be processed.
   2179  1.40    dyoung 		 */
   2180  1.40    dyoung 		if (subtype == IEEE80211_FC0_SUBTYPE_BEACON) {
   2181  1.40    dyoung 			ic->ic_stats.is_rx_beacon++;		/* XXX remove */
   2182  1.40    dyoung 			IEEE80211_NODE_STAT(ni, rx_beacons);
   2183  1.40    dyoung 		} else
   2184  1.40    dyoung 			IEEE80211_NODE_STAT(ni, rx_proberesp);
   2185  1.40    dyoung 
   2186  1.40    dyoung 		/*
   2187  1.40    dyoung 		 * When operating in station mode, check for state updates.
   2188  1.40    dyoung 		 * Be careful to ignore beacons received while doing a
   2189  1.40    dyoung 		 * background scan.  We consider only 11g/WMM stuff right now.
   2190   1.1    dyoung 		 */
   2191  1.40    dyoung 		if (ic->ic_opmode == IEEE80211_M_STA &&
   2192  1.40    dyoung 		    ni->ni_associd != 0 &&
   2193  1.40    dyoung 		    ((ic->ic_flags & IEEE80211_F_SCAN) == 0 ||
   2194  1.40    dyoung 		     IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_bssid))) {
   2195  1.44    dyoung 			/* record tsf of last beacon */
   2196  1.47     skrll 			memcpy(ni->ni_tstamp.data, scan.tstamp,
   2197  1.44    dyoung 				sizeof(ni->ni_tstamp));
   2198  1.47     skrll 			if (ni->ni_erp != scan.erp) {
   2199  1.40    dyoung 				IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2200  1.40    dyoung 				    "[%s] erp change: was 0x%x, now 0x%x\n",
   2201  1.85  christos 				    ether_snprintf(ebuf, sizeof(ebuf),
   2202  1.85  christos 				    wh->i_addr2), ni->ni_erp, scan.erp);
   2203  1.44    dyoung 				if (ic->ic_curmode == IEEE80211_MODE_11G &&
   2204  1.44    dyoung 				    (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION))
   2205  1.40    dyoung 					ic->ic_flags |= IEEE80211_F_USEPROT;
   2206  1.40    dyoung 				else
   2207  1.40    dyoung 					ic->ic_flags &= ~IEEE80211_F_USEPROT;
   2208  1.47     skrll 				ni->ni_erp = scan.erp;
   2209  1.40    dyoung 				/* XXX statistic */
   2210  1.40    dyoung 			}
   2211  1.47     skrll 			if ((ni->ni_capinfo ^ scan.capinfo) & IEEE80211_CAPINFO_SHORT_SLOTTIME) {
   2212  1.40    dyoung 				IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2213  1.40    dyoung 				    "[%s] capabilities change: before 0x%x,"
   2214  1.40    dyoung 				     " now 0x%x\n",
   2215  1.85  christos 				     ether_snprintf(ebuf, sizeof(ebuf),
   2216  1.85  christos 				     wh->i_addr2),
   2217  1.47     skrll 				     ni->ni_capinfo, scan.capinfo);
   2218  1.40    dyoung 				/*
   2219  1.40    dyoung 				 * NB: we assume short preamble doesn't
   2220  1.40    dyoung 				 *     change dynamically
   2221  1.40    dyoung 				 */
   2222  1.40    dyoung 				ieee80211_set_shortslottime(ic,
   2223  1.40    dyoung 					ic->ic_curmode == IEEE80211_MODE_11A ||
   2224  1.40    dyoung 					(ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME));
   2225  1.47     skrll 				ni->ni_capinfo = scan.capinfo;
   2226  1.40    dyoung 				/* XXX statistic */
   2227   1.4    dyoung 			}
   2228  1.47     skrll 			if (scan.wme != NULL &&
   2229  1.44    dyoung 			    (ni->ni_flags & IEEE80211_NODE_QOS) &&
   2230  1.47     skrll 			    ieee80211_parse_wmeparams(ic, scan.wme, wh) > 0)
   2231  1.40    dyoung 				ieee80211_wme_updateparams(ic);
   2232  1.47     skrll 			if (scan.tim != NULL) {
   2233  1.44    dyoung 				struct ieee80211_tim_ie *ie =
   2234  1.47     skrll 				    (struct ieee80211_tim_ie *) scan.tim;
   2235  1.44    dyoung 
   2236  1.44    dyoung 				ni->ni_dtim_count = ie->tim_count;
   2237  1.44    dyoung 				ni->ni_dtim_period = ie->tim_period;
   2238  1.44    dyoung 			}
   2239  1.47     skrll 			if (ic->ic_flags & IEEE80211_F_SCAN)
   2240  1.47     skrll 				ieee80211_add_scan(ic, &scan, wh,
   2241  1.47     skrll 					subtype, rssi, rstamp);
   2242  1.57    dyoung 			ic->ic_bmiss_count = 0;
   2243  1.47     skrll 			return;
   2244   1.1    dyoung 		}
   2245  1.47     skrll 		/*
   2246  1.47     skrll 		 * If scanning, just pass information to the scan module.
   2247  1.47     skrll 		 */
   2248  1.47     skrll 		if (ic->ic_flags & IEEE80211_F_SCAN) {
   2249  1.60     tacha 			if (ic->ic_flags_ext & IEEE80211_FEXT_PROBECHAN) {
   2250  1.60     tacha 				/*
   2251  1.60     tacha 				 * Actively scanning a channel marked passive;
   2252  1.60     tacha 				 * send a probe request now that we know there
   2253  1.60     tacha 				 * is 802.11 traffic present.
   2254  1.60     tacha 				 *
   2255  1.60     tacha 				 * XXX check if the beacon we recv'd gives
   2256  1.60     tacha 				 * us what we need and suppress the probe req
   2257  1.60     tacha 				 */
   2258  1.60     tacha 				ieee80211_probe_curchan(ic, 1);
   2259  1.60     tacha 				ic->ic_flags_ext &= ~IEEE80211_FEXT_PROBECHAN;
   2260  1.60     tacha 			}
   2261  1.47     skrll 			ieee80211_add_scan(ic, &scan, wh,
   2262  1.47     skrll 				subtype, rssi, rstamp);
   2263  1.47     skrll 			return;
   2264  1.33   mycroft 		}
   2265  1.56    dyoung 		if (scan.capinfo & IEEE80211_CAPINFO_IBSS)
   2266  1.56    dyoung 			ieee80211_update_adhoc_node(ic, ni, wh, &scan, rssi,
   2267  1.56    dyoung 			    rstamp);
   2268   1.1    dyoung 		break;
   2269   1.1    dyoung 	}
   2270   1.1    dyoung 
   2271  1.44    dyoung 	case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
   2272  1.40    dyoung 		if (ic->ic_opmode == IEEE80211_M_STA ||
   2273  1.40    dyoung 		    ic->ic_state != IEEE80211_S_RUN) {
   2274  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2275   1.1    dyoung 			return;
   2276  1.40    dyoung 		}
   2277  1.40    dyoung 		if (IEEE80211_IS_MULTICAST(wh->i_addr2)) {
   2278  1.40    dyoung 			/* frame must be directed */
   2279  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;	/* XXX stat */
   2280   1.1    dyoung 			return;
   2281  1.40    dyoung 		}
   2282   1.1    dyoung 
   2283   1.1    dyoung 		/*
   2284   1.1    dyoung 		 * prreq frame format
   2285   1.1    dyoung 		 *	[tlv] ssid
   2286   1.1    dyoung 		 *	[tlv] supported rates
   2287   1.1    dyoung 		 *	[tlv] extended supported rates
   2288   1.1    dyoung 		 */
   2289   1.1    dyoung 		ssid = rates = xrates = NULL;
   2290   1.1    dyoung 		while (frm < efrm) {
   2291   1.1    dyoung 			switch (*frm) {
   2292   1.1    dyoung 			case IEEE80211_ELEMID_SSID:
   2293   1.1    dyoung 				ssid = frm;
   2294   1.1    dyoung 				break;
   2295   1.1    dyoung 			case IEEE80211_ELEMID_RATES:
   2296   1.1    dyoung 				rates = frm;
   2297   1.1    dyoung 				break;
   2298   1.1    dyoung 			case IEEE80211_ELEMID_XRATES:
   2299   1.1    dyoung 				xrates = frm;
   2300   1.1    dyoung 				break;
   2301   1.1    dyoung 			}
   2302   1.1    dyoung 			frm += frm[1] + 2;
   2303   1.1    dyoung 		}
   2304   1.1    dyoung 		IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
   2305   1.1    dyoung 		IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN);
   2306  1.40    dyoung 		IEEE80211_VERIFY_SSID(ic->ic_bss, ssid);
   2307  1.40    dyoung 		if ((ic->ic_flags & IEEE80211_F_HIDESSID) && ssid[1] == 0) {
   2308  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_INPUT,
   2309  1.40    dyoung 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2310  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2311  1.40    dyoung 			    "%s", "no ssid with ssid suppression enabled");
   2312  1.40    dyoung 			ic->ic_stats.is_rx_ssidmismatch++; /*XXX*/
   2313  1.40    dyoung 			return;
   2314  1.40    dyoung 		}
   2315   1.1    dyoung 
   2316   1.1    dyoung 		if (ni == ic->ic_bss) {
   2317  1.50    dyoung 			if (ic->ic_opmode != IEEE80211_M_IBSS)
   2318  1.50    dyoung 				ni = ieee80211_tmp_node(ic, wh->i_addr2);
   2319  1.50    dyoung 			else if (IEEE80211_ADDR_EQ(wh->i_addr2, ni->ni_macaddr))
   2320  1.50    dyoung 				;
   2321  1.50    dyoung 			else {
   2322  1.40    dyoung 				/*
   2323  1.40    dyoung 				 * XXX Cannot tell if the sender is operating
   2324  1.40    dyoung 				 * in ibss mode.  But we need a new node to
   2325  1.40    dyoung 				 * send the response so blindly add them to the
   2326  1.40    dyoung 				 * neighbor table.
   2327  1.40    dyoung 				 */
   2328  1.40    dyoung 				ni = ieee80211_fakeup_adhoc_node(&ic->ic_sta,
   2329  1.40    dyoung 					wh->i_addr2);
   2330  1.50    dyoung 			}
   2331  1.22    dyoung 			if (ni == NULL)
   2332   1.1    dyoung 				return;
   2333  1.40    dyoung 			allocbs = 1;
   2334  1.40    dyoung 		} else
   2335  1.40    dyoung 			allocbs = 0;
   2336  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2337  1.85  christos 		    "[%s] recv probe req\n", ether_snprintf(
   2338  1.85  christos 		    ebuf, sizeof(ebuf), wh->i_addr2));
   2339   1.1    dyoung 		ni->ni_rssi = rssi;
   2340   1.1    dyoung 		ni->ni_rstamp = rstamp;
   2341  1.47     skrll 		rate = ieee80211_setup_rates(ni, rates, xrates,
   2342  1.73  christos 			  IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE
   2343  1.73  christos 			| IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
   2344   1.1    dyoung 		if (rate & IEEE80211_RATE_BASIC) {
   2345  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_XRATE,
   2346  1.40    dyoung 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2347  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2348  1.40    dyoung 			    "%s", "recv'd rate set invalid");
   2349   1.1    dyoung 		} else {
   2350   1.1    dyoung 			IEEE80211_SEND_MGMT(ic, ni,
   2351   1.1    dyoung 				IEEE80211_FC0_SUBTYPE_PROBE_RESP, 0);
   2352   1.1    dyoung 		}
   2353  1.40    dyoung 		if (allocbs && ic->ic_opmode != IEEE80211_M_IBSS) {
   2354  1.40    dyoung 			/* reclaim immediately */
   2355  1.40    dyoung 			ieee80211_free_node(ni);
   2356  1.40    dyoung 		}
   2357   1.1    dyoung 		break;
   2358   1.1    dyoung 
   2359   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_AUTH: {
   2360   1.1    dyoung 		u_int16_t algo, seq, status;
   2361   1.1    dyoung 		/*
   2362   1.1    dyoung 		 * auth frame format
   2363   1.1    dyoung 		 *	[2] algorithm
   2364   1.1    dyoung 		 *	[2] sequence
   2365   1.1    dyoung 		 *	[2] status
   2366   1.1    dyoung 		 *	[tlv*] challenge
   2367   1.1    dyoung 		 */
   2368   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, 6);
   2369   1.1    dyoung 		algo   = le16toh(*(u_int16_t *)frm);
   2370   1.1    dyoung 		seq    = le16toh(*(u_int16_t *)(frm + 2));
   2371   1.1    dyoung 		status = le16toh(*(u_int16_t *)(frm + 4));
   2372  1.25   mycroft 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH,
   2373  1.40    dyoung 		    "[%s] recv auth frame with algorithm %d seq %d\n",
   2374  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2), algo, seq);
   2375  1.40    dyoung 		/*
   2376  1.40    dyoung 		 * Consult the ACL policy module if setup.
   2377  1.40    dyoung 		 */
   2378  1.40    dyoung 		if (ic->ic_acl != NULL &&
   2379  1.40    dyoung 		    !ic->ic_acl->iac_check(ic, wh->i_addr2)) {
   2380  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_ACL,
   2381  1.40    dyoung 			    wh, "auth", "%s", "disallowed by ACL");
   2382  1.40    dyoung 			ic->ic_stats.is_rx_acl++;
   2383  1.47     skrll 			if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   2384  1.47     skrll 				IEEE80211_SEND_MGMT(ic, ni,
   2385  1.47     skrll 				    IEEE80211_FC0_SUBTYPE_AUTH,
   2386  1.47     skrll 				    (seq+1) | (IEEE80211_STATUS_UNSPECIFIED<<16));
   2387  1.47     skrll 			}
   2388  1.40    dyoung 			return;
   2389  1.40    dyoung 		}
   2390  1.40    dyoung 		if (ic->ic_flags & IEEE80211_F_COUNTERM) {
   2391  1.40    dyoung 			IEEE80211_DISCARD(ic,
   2392  1.40    dyoung 			    IEEE80211_MSG_AUTH | IEEE80211_MSG_CRYPTO,
   2393  1.40    dyoung 			    wh, "auth", "%s", "TKIP countermeasures enabled");
   2394  1.40    dyoung 			ic->ic_stats.is_rx_auth_countermeasures++;
   2395  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   2396  1.40    dyoung 			if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   2397  1.40    dyoung 				IEEE80211_SEND_MGMT(ic, ni,
   2398  1.40    dyoung 					IEEE80211_FC0_SUBTYPE_AUTH,
   2399  1.40    dyoung 					IEEE80211_REASON_MIC_FAILURE);
   2400  1.40    dyoung 			}
   2401  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   2402  1.40    dyoung 			return;
   2403  1.40    dyoung 		}
   2404   1.7    dyoung 		if (algo == IEEE80211_AUTH_ALG_SHARED)
   2405   1.7    dyoung 			ieee80211_auth_shared(ic, wh, frm + 6, efrm, ni, rssi,
   2406   1.7    dyoung 			    rstamp, seq, status);
   2407   1.7    dyoung 		else if (algo == IEEE80211_AUTH_ALG_OPEN)
   2408   1.7    dyoung 			ieee80211_auth_open(ic, wh, ni, rssi, rstamp, seq,
   2409   1.7    dyoung 			    status);
   2410   1.7    dyoung 		else {
   2411  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
   2412  1.40    dyoung 			    wh, "auth", "unsupported alg %d", algo);
   2413  1.16    dyoung 			ic->ic_stats.is_rx_auth_unsupported++;
   2414  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   2415  1.40    dyoung 			if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
   2416  1.40    dyoung 				/* XXX not right */
   2417  1.40    dyoung 				IEEE80211_SEND_MGMT(ic, ni,
   2418  1.40    dyoung 					IEEE80211_FC0_SUBTYPE_AUTH,
   2419  1.40    dyoung 					(seq+1) | (IEEE80211_STATUS_ALG<<16));
   2420  1.40    dyoung 			}
   2421  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   2422   1.1    dyoung 			return;
   2423  1.74  christos 		}
   2424   1.1    dyoung 		break;
   2425   1.1    dyoung 	}
   2426   1.1    dyoung 
   2427   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
   2428   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_REASSOC_REQ: {
   2429  1.47     skrll 		u_int16_t capinfo, lintval;
   2430  1.40    dyoung 		struct ieee80211_rsnparms rsn;
   2431  1.40    dyoung 		u_int8_t reason;
   2432   1.1    dyoung 
   2433   1.1    dyoung 		if (ic->ic_opmode != IEEE80211_M_HOSTAP ||
   2434  1.40    dyoung 		    ic->ic_state != IEEE80211_S_RUN) {
   2435  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2436   1.1    dyoung 			return;
   2437  1.40    dyoung 		}
   2438   1.1    dyoung 
   2439   1.1    dyoung 		if (subtype == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) {
   2440   1.1    dyoung 			reassoc = 1;
   2441   1.1    dyoung 			resp = IEEE80211_FC0_SUBTYPE_REASSOC_RESP;
   2442   1.1    dyoung 		} else {
   2443   1.1    dyoung 			reassoc = 0;
   2444   1.1    dyoung 			resp = IEEE80211_FC0_SUBTYPE_ASSOC_RESP;
   2445   1.1    dyoung 		}
   2446   1.1    dyoung 		/*
   2447   1.1    dyoung 		 * asreq frame format
   2448   1.1    dyoung 		 *	[2] capability information
   2449   1.1    dyoung 		 *	[2] listen interval
   2450   1.1    dyoung 		 *	[6*] current AP address (reassoc only)
   2451   1.1    dyoung 		 *	[tlv] ssid
   2452   1.1    dyoung 		 *	[tlv] supported rates
   2453   1.1    dyoung 		 *	[tlv] extended supported rates
   2454  1.40    dyoung 		 *	[tlv] WPA or RSN
   2455   1.1    dyoung 		 */
   2456   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, (reassoc ? 10 : 4));
   2457   1.1    dyoung 		if (!IEEE80211_ADDR_EQ(wh->i_addr3, ic->ic_bss->ni_bssid)) {
   2458  1.40    dyoung 			IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
   2459  1.40    dyoung 			    wh, ieee80211_mgt_subtype_name[subtype >>
   2460  1.40    dyoung 				IEEE80211_FC0_SUBTYPE_SHIFT],
   2461  1.40    dyoung 			    "%s", "wrong bssid");
   2462  1.16    dyoung 			ic->ic_stats.is_rx_assoc_bss++;
   2463   1.1    dyoung 			return;
   2464   1.1    dyoung 		}
   2465   1.1    dyoung 		capinfo = le16toh(*(u_int16_t *)frm);	frm += 2;
   2466  1.47     skrll 		lintval = le16toh(*(u_int16_t *)frm);	frm += 2;
   2467   1.1    dyoung 		if (reassoc)
   2468   1.1    dyoung 			frm += 6;	/* ignore current AP info */
   2469  1.40    dyoung 		ssid = rates = xrates = wpa = wme = NULL;
   2470   1.1    dyoung 		while (frm < efrm) {
   2471   1.1    dyoung 			switch (*frm) {
   2472   1.1    dyoung 			case IEEE80211_ELEMID_SSID:
   2473   1.1    dyoung 				ssid = frm;
   2474   1.1    dyoung 				break;
   2475   1.1    dyoung 			case IEEE80211_ELEMID_RATES:
   2476   1.1    dyoung 				rates = frm;
   2477   1.1    dyoung 				break;
   2478   1.1    dyoung 			case IEEE80211_ELEMID_XRATES:
   2479   1.1    dyoung 				xrates = frm;
   2480   1.1    dyoung 				break;
   2481  1.40    dyoung 			/* XXX verify only one of RSN and WPA ie's? */
   2482  1.40    dyoung 			case IEEE80211_ELEMID_RSN:
   2483  1.40    dyoung 				wpa = frm;
   2484  1.40    dyoung 				break;
   2485  1.40    dyoung 			case IEEE80211_ELEMID_VENDOR:
   2486  1.47     skrll 				if (iswpaoui(frm))
   2487  1.47     skrll 					wpa = frm;
   2488  1.47     skrll 				else if (iswmeinfo(frm))
   2489  1.40    dyoung 					wme = frm;
   2490  1.40    dyoung 				/* XXX Atheros OUI support */
   2491  1.40    dyoung 				break;
   2492   1.1    dyoung 			}
   2493   1.1    dyoung 			frm += frm[1] + 2;
   2494   1.1    dyoung 		}
   2495   1.1    dyoung 		IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
   2496   1.1    dyoung 		IEEE80211_VERIFY_ELEMENT(ssid, IEEE80211_NWID_LEN);
   2497  1.40    dyoung 		IEEE80211_VERIFY_SSID(ic->ic_bss, ssid);
   2498  1.27   mycroft 
   2499  1.40    dyoung 		if (ni == ic->ic_bss) {
   2500  1.25   mycroft 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
   2501  1.40    dyoung 			    "[%s] deny %s request, sta not authenticated\n",
   2502  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2503  1.40    dyoung 			    reassoc ? "reassoc" : "assoc");
   2504  1.44    dyoung 			ieee80211_send_error(ic, ni, wh->i_addr2,
   2505  1.44    dyoung 			    IEEE80211_FC0_SUBTYPE_DEAUTH,
   2506  1.44    dyoung 			    IEEE80211_REASON_ASSOC_NOT_AUTHED);
   2507  1.16    dyoung 			ic->ic_stats.is_rx_assoc_notauth++;
   2508   1.1    dyoung 			return;
   2509   1.7    dyoung 		}
   2510  1.40    dyoung 		/* assert right associstion security credentials */
   2511  1.40    dyoung 		if (wpa == NULL && (ic->ic_flags & IEEE80211_F_WPA)) {
   2512  1.40    dyoung 			IEEE80211_DPRINTF(ic,
   2513  1.40    dyoung 			    IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA,
   2514  1.40    dyoung 			    "[%s] no WPA/RSN IE in association request\n",
   2515  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2));
   2516  1.40    dyoung 			IEEE80211_SEND_MGMT(ic, ni,
   2517  1.40    dyoung 			    IEEE80211_FC0_SUBTYPE_DEAUTH,
   2518  1.40    dyoung 			    IEEE80211_REASON_RSN_REQUIRED);
   2519  1.40    dyoung 			ieee80211_node_leave(ic, ni);
   2520  1.40    dyoung 			/* XXX distinguish WPA/RSN? */
   2521  1.40    dyoung 			ic->ic_stats.is_rx_assoc_badwpaie++;
   2522  1.74  christos 			return;
   2523  1.40    dyoung 		}
   2524  1.40    dyoung 		if (wpa != NULL) {
   2525  1.40    dyoung 			/*
   2526  1.40    dyoung 			 * Parse WPA information element.  Note that
   2527  1.40    dyoung 			 * we initialize the param block from the node
   2528  1.40    dyoung 			 * state so that information in the IE overrides
   2529  1.40    dyoung 			 * our defaults.  The resulting parameters are
   2530  1.40    dyoung 			 * installed below after the association is assured.
   2531  1.40    dyoung 			 */
   2532  1.40    dyoung 			rsn = ni->ni_rsn;
   2533  1.40    dyoung 			if (wpa[0] != IEEE80211_ELEMID_RSN)
   2534  1.40    dyoung 				reason = ieee80211_parse_wpa(ic, wpa, &rsn, wh);
   2535  1.40    dyoung 			else
   2536  1.40    dyoung 				reason = ieee80211_parse_rsn(ic, wpa, &rsn, wh);
   2537  1.40    dyoung 			if (reason != 0) {
   2538  1.40    dyoung 				IEEE80211_SEND_MGMT(ic, ni,
   2539  1.40    dyoung 				    IEEE80211_FC0_SUBTYPE_DEAUTH, reason);
   2540  1.40    dyoung 				ieee80211_node_leave(ic, ni);
   2541  1.40    dyoung 				/* XXX distinguish WPA/RSN? */
   2542  1.40    dyoung 				ic->ic_stats.is_rx_assoc_badwpaie++;
   2543  1.40    dyoung 				return;
   2544  1.40    dyoung 			}
   2545  1.40    dyoung 			IEEE80211_DPRINTF(ic,
   2546  1.40    dyoung 			    IEEE80211_MSG_ASSOC | IEEE80211_MSG_WPA,
   2547  1.40    dyoung 			    "[%s] %s ie: mc %u/%u uc %u/%u key %u caps 0x%x\n",
   2548  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2549  1.40    dyoung 			    wpa[0] != IEEE80211_ELEMID_RSN ?  "WPA" : "RSN",
   2550  1.40    dyoung 			    rsn.rsn_mcastcipher, rsn.rsn_mcastkeylen,
   2551  1.40    dyoung 			    rsn.rsn_ucastcipher, rsn.rsn_ucastkeylen,
   2552  1.40    dyoung 			    rsn.rsn_keymgmt, rsn.rsn_caps);
   2553  1.40    dyoung 		}
   2554   1.7    dyoung 		/* discard challenge after association */
   2555   1.7    dyoung 		if (ni->ni_challenge != NULL) {
   2556  1.67    cegger 			free(ni->ni_challenge, M_DEVBUF);
   2557   1.7    dyoung 			ni->ni_challenge = NULL;
   2558   1.1    dyoung 		}
   2559  1.44    dyoung 		/* NB: 802.11 spec says to ignore station's privacy bit */
   2560  1.44    dyoung 		if ((capinfo & IEEE80211_CAPINFO_ESS) == 0) {
   2561  1.25   mycroft 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
   2562  1.40    dyoung 			    "[%s] deny %s request, capability mismatch 0x%x\n",
   2563  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2564  1.40    dyoung 			    reassoc ? "reassoc" : "assoc", capinfo);
   2565   1.1    dyoung 			IEEE80211_SEND_MGMT(ic, ni, resp,
   2566   1.1    dyoung 				IEEE80211_STATUS_CAPINFO);
   2567  1.29   mycroft 			ieee80211_node_leave(ic, ni);
   2568  1.16    dyoung 			ic->ic_stats.is_rx_assoc_capmismatch++;
   2569   1.1    dyoung 			return;
   2570   1.1    dyoung 		}
   2571  1.47     skrll 		rate = ieee80211_setup_rates(ni, rates, xrates,
   2572  1.73  christos 				IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE |
   2573  1.73  christos 				IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
   2574  1.44    dyoung 		/*
   2575  1.44    dyoung 		 * If constrained to 11g-only stations reject an
   2576  1.44    dyoung 		 * 11b-only station.  We cheat a bit here by looking
   2577  1.44    dyoung 		 * at the max negotiated xmit rate and assuming anyone
   2578  1.44    dyoung 		 * with a best rate <24Mb/s is an 11b station.
   2579  1.44    dyoung 		 */
   2580  1.44    dyoung 		if ((rate & IEEE80211_RATE_BASIC) ||
   2581  1.44    dyoung 		    ((ic->ic_flags & IEEE80211_F_PUREG) && rate < 48)) {
   2582  1.25   mycroft 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_ANY,
   2583  1.40    dyoung 			    "[%s] deny %s request, rate set mismatch\n",
   2584  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2585  1.40    dyoung 			    reassoc ? "reassoc" : "assoc");
   2586   1.1    dyoung 			IEEE80211_SEND_MGMT(ic, ni, resp,
   2587   1.1    dyoung 				IEEE80211_STATUS_BASIC_RATE);
   2588  1.29   mycroft 			ieee80211_node_leave(ic, ni);
   2589  1.16    dyoung 			ic->ic_stats.is_rx_assoc_norate++;
   2590   1.1    dyoung 			return;
   2591   1.1    dyoung 		}
   2592   1.1    dyoung 		ni->ni_rssi = rssi;
   2593   1.1    dyoung 		ni->ni_rstamp = rstamp;
   2594  1.47     skrll 		ni->ni_intval = lintval;
   2595   1.1    dyoung 		ni->ni_capinfo = capinfo;
   2596   1.1    dyoung 		ni->ni_chan = ic->ic_bss->ni_chan;
   2597   1.1    dyoung 		ni->ni_fhdwell = ic->ic_bss->ni_fhdwell;
   2598   1.1    dyoung 		ni->ni_fhindex = ic->ic_bss->ni_fhindex;
   2599  1.40    dyoung 		if (wpa != NULL) {
   2600  1.40    dyoung 			/*
   2601  1.40    dyoung 			 * Record WPA/RSN parameters for station, mark
   2602  1.40    dyoung 			 * node as using WPA and record information element
   2603  1.40    dyoung 			 * for applications that require it.
   2604  1.40    dyoung 			 */
   2605  1.40    dyoung 			ni->ni_rsn = rsn;
   2606  1.40    dyoung 			ieee80211_saveie(&ni->ni_wpa_ie, wpa);
   2607  1.40    dyoung 		} else if (ni->ni_wpa_ie != NULL) {
   2608  1.40    dyoung 			/*
   2609  1.40    dyoung 			 * Flush any state from a previous association.
   2610  1.40    dyoung 			 */
   2611  1.67    cegger 			free(ni->ni_wpa_ie, M_DEVBUF);
   2612  1.40    dyoung 			ni->ni_wpa_ie = NULL;
   2613  1.40    dyoung 		}
   2614  1.40    dyoung 		if (wme != NULL) {
   2615  1.40    dyoung 			/*
   2616  1.40    dyoung 			 * Record WME parameters for station, mark node
   2617  1.40    dyoung 			 * as capable of QoS and record information
   2618  1.40    dyoung 			 * element for applications that require it.
   2619  1.40    dyoung 			 */
   2620  1.40    dyoung 			ieee80211_saveie(&ni->ni_wme_ie, wme);
   2621  1.40    dyoung 			ni->ni_flags |= IEEE80211_NODE_QOS;
   2622  1.40    dyoung 		} else if (ni->ni_wme_ie != NULL) {
   2623  1.40    dyoung 			/*
   2624  1.40    dyoung 			 * Flush any state from a previous association.
   2625  1.40    dyoung 			 */
   2626  1.67    cegger 			free(ni->ni_wme_ie, M_DEVBUF);
   2627  1.40    dyoung 			ni->ni_wme_ie = NULL;
   2628  1.40    dyoung 			ni->ni_flags &= ~IEEE80211_NODE_QOS;
   2629  1.40    dyoung 		}
   2630  1.29   mycroft 		ieee80211_node_join(ic, ni, resp);
   2631   1.1    dyoung 		break;
   2632   1.1    dyoung 	}
   2633   1.1    dyoung 
   2634   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_ASSOC_RESP:
   2635   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_REASSOC_RESP: {
   2636  1.40    dyoung 		u_int16_t capinfo, associd;
   2637   1.1    dyoung 		u_int16_t status;
   2638   1.1    dyoung 
   2639   1.1    dyoung 		if (ic->ic_opmode != IEEE80211_M_STA ||
   2640  1.26   mycroft 		    ic->ic_state != IEEE80211_S_ASSOC) {
   2641  1.26   mycroft 			ic->ic_stats.is_rx_mgtdiscard++;
   2642   1.1    dyoung 			return;
   2643  1.26   mycroft 		}
   2644   1.1    dyoung 
   2645   1.1    dyoung 		/*
   2646   1.1    dyoung 		 * asresp frame format
   2647   1.1    dyoung 		 *	[2] capability information
   2648   1.1    dyoung 		 *	[2] status
   2649   1.1    dyoung 		 *	[2] association ID
   2650   1.1    dyoung 		 *	[tlv] supported rates
   2651   1.1    dyoung 		 *	[tlv] extended supported rates
   2652  1.40    dyoung 		 *	[tlv] WME
   2653   1.1    dyoung 		 */
   2654   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, 6);
   2655   1.1    dyoung 		ni = ic->ic_bss;
   2656  1.40    dyoung 		capinfo = le16toh(*(u_int16_t *)frm);
   2657   1.1    dyoung 		frm += 2;
   2658   1.1    dyoung 		status = le16toh(*(u_int16_t *)frm);
   2659   1.1    dyoung 		frm += 2;
   2660   1.1    dyoung 		if (status != 0) {
   2661  1.26   mycroft 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2662  1.40    dyoung 			    "[%s] %sassoc failed (reason %d)\n",
   2663  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2664  1.40    dyoung 			    ISREASSOC(subtype) ?  "re" : "", status);
   2665  1.40    dyoung 			if (ni != ic->ic_bss)	/* XXX never true? */
   2666   1.1    dyoung 				ni->ni_fails++;
   2667  1.40    dyoung 			ic->ic_stats.is_rx_auth_fail++;	/* XXX */
   2668   1.1    dyoung 			return;
   2669   1.1    dyoung 		}
   2670  1.40    dyoung 		associd = le16toh(*(u_int16_t *)frm);
   2671   1.1    dyoung 		frm += 2;
   2672   1.1    dyoung 
   2673  1.40    dyoung 		rates = xrates = wpa = wme = NULL;
   2674   1.1    dyoung 		while (frm < efrm) {
   2675   1.1    dyoung 			switch (*frm) {
   2676   1.1    dyoung 			case IEEE80211_ELEMID_RATES:
   2677   1.1    dyoung 				rates = frm;
   2678   1.1    dyoung 				break;
   2679   1.1    dyoung 			case IEEE80211_ELEMID_XRATES:
   2680   1.1    dyoung 				xrates = frm;
   2681   1.1    dyoung 				break;
   2682  1.40    dyoung 			case IEEE80211_ELEMID_VENDOR:
   2683  1.40    dyoung 				if (iswmeoui(frm))
   2684  1.40    dyoung 					wme = frm;
   2685  1.40    dyoung 				/* XXX Atheros OUI support */
   2686  1.40    dyoung 				break;
   2687   1.1    dyoung 			}
   2688   1.1    dyoung 			frm += frm[1] + 2;
   2689   1.1    dyoung 		}
   2690   1.1    dyoung 
   2691   1.1    dyoung 		IEEE80211_VERIFY_ELEMENT(rates, IEEE80211_RATE_MAXSIZE);
   2692  1.47     skrll 		rate = ieee80211_setup_rates(ni, rates, xrates,
   2693  1.73  christos 				IEEE80211_R_DOSORT | IEEE80211_R_DOFRATE |
   2694  1.73  christos 				IEEE80211_R_DONEGO | IEEE80211_R_DODEL);
   2695  1.44    dyoung 		if (rate & IEEE80211_RATE_BASIC) {
   2696  1.40    dyoung 			IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2697  1.40    dyoung 			    "[%s] %sassoc failed (rate set mismatch)\n",
   2698  1.85  christos 			    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2699  1.40    dyoung 			    ISREASSOC(subtype) ?  "re" : "");
   2700  1.40    dyoung 			if (ni != ic->ic_bss)	/* XXX never true? */
   2701  1.40    dyoung 				ni->ni_fails++;
   2702  1.40    dyoung 			ic->ic_stats.is_rx_assoc_norate++;
   2703  1.44    dyoung 			ieee80211_new_state(ic, IEEE80211_S_SCAN, 0);
   2704  1.40    dyoung 			return;
   2705  1.40    dyoung 		}
   2706  1.40    dyoung 
   2707  1.40    dyoung 		ni->ni_capinfo = capinfo;
   2708  1.40    dyoung 		ni->ni_associd = associd;
   2709  1.40    dyoung 		if (wme != NULL &&
   2710  1.40    dyoung 		    ieee80211_parse_wmeparams(ic, wme, wh) >= 0) {
   2711  1.40    dyoung 			ni->ni_flags |= IEEE80211_NODE_QOS;
   2712  1.40    dyoung 			ieee80211_wme_updateparams(ic);
   2713  1.40    dyoung 		} else
   2714  1.40    dyoung 			ni->ni_flags &= ~IEEE80211_NODE_QOS;
   2715  1.40    dyoung 		/*
   2716  1.40    dyoung 		 * Configure state now that we are associated.
   2717  1.40    dyoung 		 *
   2718  1.40    dyoung 		 * XXX may need different/additional driver callbacks?
   2719  1.40    dyoung 		 */
   2720  1.40    dyoung 		if (ic->ic_curmode == IEEE80211_MODE_11A ||
   2721  1.40    dyoung 		    (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)) {
   2722  1.40    dyoung 			ic->ic_flags |= IEEE80211_F_SHPREAMBLE;
   2723  1.40    dyoung 			ic->ic_flags &= ~IEEE80211_F_USEBARKER;
   2724  1.40    dyoung 		} else {
   2725  1.40    dyoung 			ic->ic_flags &= ~IEEE80211_F_SHPREAMBLE;
   2726  1.40    dyoung 			ic->ic_flags |= IEEE80211_F_USEBARKER;
   2727  1.40    dyoung 		}
   2728  1.40    dyoung 		ieee80211_set_shortslottime(ic,
   2729  1.40    dyoung 			ic->ic_curmode == IEEE80211_MODE_11A ||
   2730  1.40    dyoung 			(ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_SLOTTIME));
   2731  1.40    dyoung 		/*
   2732  1.40    dyoung 		 * Honor ERP protection.
   2733  1.40    dyoung 		 *
   2734  1.40    dyoung 		 * NB: ni_erp should zero for non-11g operation.
   2735  1.40    dyoung 		 * XXX check ic_curmode anyway?
   2736  1.40    dyoung 		 */
   2737  1.44    dyoung 		if (ic->ic_curmode == IEEE80211_MODE_11G &&
   2738  1.44    dyoung 		    (ni->ni_erp & IEEE80211_ERP_USE_PROTECTION))
   2739  1.40    dyoung 			ic->ic_flags |= IEEE80211_F_USEPROT;
   2740  1.40    dyoung 		else
   2741  1.40    dyoung 			ic->ic_flags &= ~IEEE80211_F_USEPROT;
   2742  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2743  1.40    dyoung 		    "[%s] %sassoc success: %s preamble, %s slot time%s%s\n",
   2744  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2),
   2745  1.40    dyoung 		    ISREASSOC(subtype) ? "re" : "",
   2746  1.40    dyoung 		    ic->ic_flags&IEEE80211_F_SHPREAMBLE ? "short" : "long",
   2747  1.40    dyoung 		    ic->ic_flags&IEEE80211_F_SHSLOT ? "short" : "long",
   2748  1.40    dyoung 		    ic->ic_flags&IEEE80211_F_USEPROT ? ", protection" : "",
   2749  1.40    dyoung 		    ni->ni_flags & IEEE80211_NODE_QOS ? ", QoS" : ""
   2750  1.40    dyoung 		);
   2751  1.40    dyoung 		ieee80211_new_state(ic, IEEE80211_S_RUN, subtype);
   2752   1.1    dyoung 		break;
   2753   1.1    dyoung 	}
   2754   1.1    dyoung 
   2755   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_DEAUTH: {
   2756   1.1    dyoung 		u_int16_t reason;
   2757  1.40    dyoung 
   2758  1.40    dyoung 		if (ic->ic_state == IEEE80211_S_SCAN) {
   2759  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2760  1.40    dyoung 			return;
   2761  1.40    dyoung 		}
   2762   1.1    dyoung 		/*
   2763   1.1    dyoung 		 * deauth frame format
   2764   1.1    dyoung 		 *	[2] reason
   2765   1.1    dyoung 		 */
   2766   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, 2);
   2767   1.1    dyoung 		reason = le16toh(*(u_int16_t *)frm);
   2768  1.85  christos 		__USE(reason);
   2769  1.16    dyoung 		ic->ic_stats.is_rx_deauth++;
   2770  1.40    dyoung 		IEEE80211_NODE_STAT(ni, rx_deauth);
   2771  1.44    dyoung 
   2772  1.61    dyoung 		if (!IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
   2773  1.61    dyoung 			/* Not intended for this station. */
   2774  1.61    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2775  1.61    dyoung 			break;
   2776  1.61    dyoung 		}
   2777  1.44    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_AUTH,
   2778  1.44    dyoung 		    "[%s] recv deauthenticate (reason %d)\n",
   2779  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), reason);
   2780   1.1    dyoung 		switch (ic->ic_opmode) {
   2781   1.1    dyoung 		case IEEE80211_M_STA:
   2782   1.1    dyoung 			ieee80211_new_state(ic, IEEE80211_S_AUTH,
   2783   1.1    dyoung 			    wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
   2784   1.1    dyoung 			break;
   2785   1.1    dyoung 		case IEEE80211_M_HOSTAP:
   2786  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   2787  1.44    dyoung 			if (ni != ic->ic_bss)
   2788  1.29   mycroft 				ieee80211_node_leave(ic, ni);
   2789  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   2790   1.1    dyoung 			break;
   2791   1.1    dyoung 		default:
   2792  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2793   1.1    dyoung 			break;
   2794   1.1    dyoung 		}
   2795   1.1    dyoung 		break;
   2796   1.1    dyoung 	}
   2797   1.1    dyoung 
   2798   1.1    dyoung 	case IEEE80211_FC0_SUBTYPE_DISASSOC: {
   2799   1.1    dyoung 		u_int16_t reason;
   2800  1.40    dyoung 
   2801  1.40    dyoung 		if (ic->ic_state != IEEE80211_S_RUN &&
   2802  1.44    dyoung 		    ic->ic_state != IEEE80211_S_ASSOC &&
   2803  1.40    dyoung 		    ic->ic_state != IEEE80211_S_AUTH) {
   2804  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2805  1.40    dyoung 			return;
   2806  1.40    dyoung 		}
   2807   1.1    dyoung 		/*
   2808   1.1    dyoung 		 * disassoc frame format
   2809   1.1    dyoung 		 *	[2] reason
   2810   1.1    dyoung 		 */
   2811   1.1    dyoung 		IEEE80211_VERIFY_LENGTH(efrm - frm, 2);
   2812   1.1    dyoung 		reason = le16toh(*(u_int16_t *)frm);
   2813  1.85  christos 		__USE(reason);
   2814  1.16    dyoung 		ic->ic_stats.is_rx_disassoc++;
   2815  1.40    dyoung 		IEEE80211_NODE_STAT(ni, rx_disassoc);
   2816  1.44    dyoung 
   2817  1.61    dyoung 		if (!IEEE80211_ADDR_EQ(wh->i_addr1, ic->ic_myaddr)) {
   2818  1.61    dyoung 			/* Not intended for this station. */
   2819  1.61    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2820  1.61    dyoung 			break;
   2821  1.61    dyoung 		}
   2822  1.44    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_ASSOC,
   2823  1.47     skrll 		    "[%s] recv disassociate (reason %d)\n",
   2824  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), reason);
   2825   1.1    dyoung 		switch (ic->ic_opmode) {
   2826   1.1    dyoung 		case IEEE80211_M_STA:
   2827   1.1    dyoung 			ieee80211_new_state(ic, IEEE80211_S_ASSOC,
   2828   1.1    dyoung 			    wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK);
   2829   1.1    dyoung 			break;
   2830   1.1    dyoung 		case IEEE80211_M_HOSTAP:
   2831  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   2832  1.44    dyoung 			if (ni != ic->ic_bss)
   2833  1.29   mycroft 				ieee80211_node_leave(ic, ni);
   2834  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   2835   1.1    dyoung 			break;
   2836   1.1    dyoung 		default:
   2837  1.40    dyoung 			ic->ic_stats.is_rx_mgtdiscard++;
   2838   1.1    dyoung 			break;
   2839   1.1    dyoung 		}
   2840   1.1    dyoung 		break;
   2841   1.1    dyoung 	}
   2842   1.1    dyoung 	default:
   2843  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_ANY,
   2844  1.40    dyoung 		     wh, "mgt", "subtype 0x%x not handled", subtype);
   2845  1.16    dyoung 		ic->ic_stats.is_rx_badsubtype++;
   2846   1.1    dyoung 		break;
   2847   1.1    dyoung 	}
   2848  1.40    dyoung #undef ISREASSOC
   2849  1.40    dyoung #undef ISPROBE
   2850   1.5    dyoung }
   2851  1.40    dyoung #undef IEEE80211_VERIFY_LENGTH
   2852  1.40    dyoung #undef IEEE80211_VERIFY_ELEMENT
   2853   1.5    dyoung 
   2854  1.41    dyoung #ifndef IEEE80211_NO_HOSTAP
   2855  1.40    dyoung /*
   2856  1.40    dyoung  * Handle station power-save state change.
   2857  1.40    dyoung  */
   2858   1.5    dyoung static void
   2859  1.40    dyoung ieee80211_node_pwrsave(struct ieee80211_node *ni, int enable)
   2860   1.5    dyoung {
   2861  1.40    dyoung 	struct ieee80211com *ic = ni->ni_ic;
   2862   1.5    dyoung 	struct mbuf *m;
   2863  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   2864   1.5    dyoung 
   2865  1.40    dyoung 	if (enable) {
   2866  1.40    dyoung 		if ((ni->ni_flags & IEEE80211_NODE_PWR_MGT) == 0)
   2867  1.40    dyoung 			ic->ic_ps_sta++;
   2868  1.40    dyoung 		ni->ni_flags |= IEEE80211_NODE_PWR_MGT;
   2869  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2870  1.40    dyoung 		    "[%s] power save mode on, %u sta's in ps mode\n",
   2871  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
   2872  1.85  christos 		    ic->ic_ps_sta);
   2873   1.5    dyoung 		return;
   2874  1.40    dyoung 	}
   2875   1.5    dyoung 
   2876  1.40    dyoung 	if (ni->ni_flags & IEEE80211_NODE_PWR_MGT)
   2877  1.40    dyoung 		ic->ic_ps_sta--;
   2878  1.40    dyoung 	ni->ni_flags &= ~IEEE80211_NODE_PWR_MGT;
   2879  1.40    dyoung 	IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2880  1.40    dyoung 	    "[%s] power save mode off, %u sta's in ps mode\n",
   2881  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), ic->ic_ps_sta);
   2882  1.40    dyoung 	/* XXX if no stations in ps mode, flush mc frames */
   2883   1.5    dyoung 
   2884  1.40    dyoung 	/*
   2885  1.40    dyoung 	 * Flush queued unicast frames.
   2886  1.40    dyoung 	 */
   2887  1.40    dyoung 	if (IEEE80211_NODE_SAVEQ_QLEN(ni) == 0) {
   2888  1.44    dyoung 		if (ic->ic_set_tim != NULL)
   2889  1.47     skrll 			ic->ic_set_tim(ni, 0);		/* just in case */
   2890   1.5    dyoung 		return;
   2891   1.5    dyoung 	}
   2892  1.40    dyoung 	IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2893  1.40    dyoung 	    "[%s] flush ps queue, %u packets queued\n",
   2894  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr),
   2895  1.85  christos 	    IEEE80211_NODE_SAVEQ_QLEN(ni));
   2896  1.40    dyoung 	for (;;) {
   2897  1.40    dyoung 		int qlen;
   2898  1.40    dyoung 
   2899  1.40    dyoung 		IEEE80211_NODE_SAVEQ_DEQUEUE(ni, m, qlen);
   2900  1.40    dyoung 		if (m == NULL)
   2901  1.40    dyoung 			break;
   2902  1.74  christos 		/*
   2903  1.40    dyoung 		 * If this is the last packet, turn off the TIM bit.
   2904  1.40    dyoung 		 * If there are more packets, set the more packets bit
   2905  1.44    dyoung 		 * in the mbuf so ieee80211_encap will mark the 802.11
   2906  1.44    dyoung 		 * head to indicate more data frames will follow.
   2907  1.40    dyoung 		 */
   2908  1.44    dyoung 		if (qlen != 0)
   2909  1.44    dyoung 			m->m_flags |= M_MORE_DATA;
   2910  1.40    dyoung 		/* XXX need different driver interface */
   2911  1.40    dyoung 		/* XXX bypasses q max */
   2912  1.40    dyoung 		IF_ENQUEUE(&ic->ic_ifp->if_snd, m);
   2913  1.40    dyoung 	}
   2914  1.44    dyoung 	if (ic->ic_set_tim != NULL)
   2915  1.47     skrll 		ic->ic_set_tim(ni, 0);
   2916  1.40    dyoung }
   2917   1.5    dyoung 
   2918  1.40    dyoung /*
   2919  1.40    dyoung  * Process a received ps-poll frame.
   2920  1.40    dyoung  */
   2921  1.40    dyoung static void
   2922  1.40    dyoung ieee80211_recv_pspoll(struct ieee80211com *ic,
   2923  1.40    dyoung 	struct ieee80211_node *ni, struct mbuf *m0)
   2924  1.40    dyoung {
   2925  1.40    dyoung 	struct ieee80211_frame_min *wh;
   2926  1.40    dyoung 	struct mbuf *m;
   2927  1.40    dyoung 	u_int16_t aid;
   2928  1.40    dyoung 	int qlen;
   2929  1.85  christos 	IEEE80211_DEBUGVAR(char ebuf[3 * ETHER_ADDR_LEN]);
   2930  1.40    dyoung 
   2931  1.40    dyoung 	wh = mtod(m0, struct ieee80211_frame_min *);
   2932  1.40    dyoung 	if (ni->ni_associd == 0) {
   2933  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG,
   2934  1.40    dyoung 		    (struct ieee80211_frame *) wh, "ps-poll",
   2935  1.40    dyoung 		    "%s", "unassociated station");
   2936  1.40    dyoung 		ic->ic_stats.is_ps_unassoc++;
   2937  1.40    dyoung 		IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH,
   2938  1.40    dyoung 			IEEE80211_REASON_NOT_ASSOCED);
   2939   1.5    dyoung 		return;
   2940   1.5    dyoung 	}
   2941   1.5    dyoung 
   2942  1.40    dyoung 	aid = le16toh(*(u_int16_t *)wh->i_dur);
   2943   1.5    dyoung 	if (aid != ni->ni_associd) {
   2944  1.40    dyoung 		IEEE80211_DISCARD(ic, IEEE80211_MSG_POWER | IEEE80211_MSG_DEBUG,
   2945  1.40    dyoung 		    (struct ieee80211_frame *) wh, "ps-poll",
   2946  1.40    dyoung 		    "aid mismatch: sta aid 0x%x poll aid 0x%x",
   2947  1.40    dyoung 		    ni->ni_associd, aid);
   2948  1.40    dyoung 		ic->ic_stats.is_ps_badaid++;
   2949  1.40    dyoung 		IEEE80211_SEND_MGMT(ic, ni, IEEE80211_FC0_SUBTYPE_DEAUTH,
   2950  1.40    dyoung 			IEEE80211_REASON_NOT_ASSOCED);
   2951   1.5    dyoung 		return;
   2952   1.5    dyoung 	}
   2953   1.5    dyoung 
   2954   1.5    dyoung 	/* Okay, take the first queued packet and put it out... */
   2955  1.40    dyoung 	IEEE80211_NODE_SAVEQ_DEQUEUE(ni, m, qlen);
   2956   1.5    dyoung 	if (m == NULL) {
   2957  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2958  1.40    dyoung 		    "[%s] recv ps-poll, but queue empty\n",
   2959  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), wh->i_addr2));
   2960  1.47     skrll 		ieee80211_send_nulldata(ieee80211_ref_node(ni));
   2961  1.40    dyoung 		ic->ic_stats.is_ps_qempty++;	/* XXX node stat */
   2962  1.44    dyoung 		if (ic->ic_set_tim != NULL)
   2963  1.47     skrll 			ic->ic_set_tim(ni, 0);	/* just in case */
   2964   1.5    dyoung 		return;
   2965   1.5    dyoung 	}
   2966  1.74  christos 	/*
   2967  1.40    dyoung 	 * If there are more packets, set the more packets bit
   2968  1.40    dyoung 	 * in the packet dispatched to the station; otherwise
   2969  1.40    dyoung 	 * turn off the TIM bit.
   2970   1.5    dyoung 	 */
   2971  1.40    dyoung 	if (qlen != 0) {
   2972  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2973  1.40    dyoung 		    "[%s] recv ps-poll, send packet, %u still queued\n",
   2974  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr), qlen);
   2975  1.44    dyoung 		m->m_flags |= M_MORE_DATA;
   2976   1.5    dyoung 	} else {
   2977  1.40    dyoung 		IEEE80211_DPRINTF(ic, IEEE80211_MSG_POWER,
   2978  1.40    dyoung 		    "[%s] recv ps-poll, send packet, queue empty\n",
   2979  1.85  christos 		    ether_snprintf(ebuf, sizeof(ebuf), ni->ni_macaddr));
   2980  1.44    dyoung 		if (ic->ic_set_tim != NULL)
   2981  1.47     skrll 			ic->ic_set_tim(ni, 0);
   2982   1.5    dyoung 	}
   2983  1.40    dyoung 	m->m_flags |= M_PWR_SAV;		/* bypass PS handling */
   2984  1.40    dyoung 	IF_ENQUEUE(&ic->ic_ifp->if_snd, m);
   2985  1.40    dyoung }
   2986  1.41    dyoung #endif /* !IEEE80211_NO_HOSTAP */
   2987   1.5    dyoung 
   2988  1.40    dyoung #ifdef IEEE80211_DEBUG
   2989  1.40    dyoung /*
   2990  1.40    dyoung  * Debugging support.
   2991  1.40    dyoung  */
   2992   1.5    dyoung 
   2993  1.40    dyoung /*
   2994  1.40    dyoung  * Return the bssid of a frame.
   2995  1.40    dyoung  */
   2996  1.40    dyoung static const u_int8_t *
   2997  1.40    dyoung ieee80211_getbssid(struct ieee80211com *ic, const struct ieee80211_frame *wh)
   2998  1.40    dyoung {
   2999  1.40    dyoung 	if (ic->ic_opmode == IEEE80211_M_STA)
   3000  1.40    dyoung 		return wh->i_addr2;
   3001  1.40    dyoung 	if ((wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) != IEEE80211_FC1_DIR_NODS)
   3002  1.40    dyoung 		return wh->i_addr1;
   3003  1.40    dyoung 	if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) == IEEE80211_FC0_SUBTYPE_PS_POLL)
   3004  1.40    dyoung 		return wh->i_addr1;
   3005  1.40    dyoung 	return wh->i_addr3;
   3006   1.1    dyoung }
   3007  1.31    dyoung 
   3008  1.47     skrll void
   3009  1.47     skrll ieee80211_note(struct ieee80211com *ic, const char *fmt, ...)
   3010  1.47     skrll {
   3011  1.47     skrll 	char buf[128];		/* XXX */
   3012  1.47     skrll 	va_list ap;
   3013  1.47     skrll 
   3014  1.47     skrll 	va_start(ap, fmt);
   3015  1.47     skrll 	vsnprintf(buf, sizeof(buf), fmt, ap);
   3016  1.47     skrll 	va_end(ap);
   3017  1.47     skrll 
   3018  1.47     skrll 	if_printf(ic->ic_ifp, "%s", buf);	/* NB: no \n */
   3019  1.47     skrll }
   3020  1.47     skrll 
   3021  1.47     skrll void
   3022  1.47     skrll ieee80211_note_frame(struct ieee80211com *ic,
   3023  1.47     skrll 	const struct ieee80211_frame *wh,
   3024  1.47     skrll 	const char *fmt, ...)
   3025  1.47     skrll {
   3026  1.47     skrll 	char buf[128];		/* XXX */
   3027  1.47     skrll 	va_list ap;
   3028  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   3029  1.47     skrll 
   3030  1.47     skrll 	va_start(ap, fmt);
   3031  1.47     skrll 	vsnprintf(buf, sizeof(buf), fmt, ap);
   3032  1.47     skrll 	va_end(ap);
   3033  1.47     skrll 	if_printf(ic->ic_ifp, "[%s] %s\n",
   3034  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf),
   3035  1.85  christos 	    ieee80211_getbssid(ic, wh)), buf);
   3036  1.47     skrll }
   3037  1.47     skrll 
   3038  1.47     skrll void
   3039  1.47     skrll ieee80211_note_mac(struct ieee80211com *ic,
   3040  1.47     skrll 	const u_int8_t mac[IEEE80211_ADDR_LEN],
   3041  1.47     skrll 	const char *fmt, ...)
   3042  1.47     skrll {
   3043  1.47     skrll 	char buf[128];		/* XXX */
   3044  1.47     skrll 	va_list ap;
   3045  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   3046  1.47     skrll 
   3047  1.47     skrll 	va_start(ap, fmt);
   3048  1.47     skrll 	vsnprintf(buf, sizeof(buf), fmt, ap);
   3049  1.47     skrll 	va_end(ap);
   3050  1.85  christos 	if_printf(ic->ic_ifp, "[%s] %s\n", ether_snprintf(ebuf, sizeof(ebuf),
   3051  1.85  christos 	    mac), buf);
   3052  1.47     skrll }
   3053  1.47     skrll 
   3054  1.40    dyoung static void
   3055  1.40    dyoung ieee80211_discard_frame(struct ieee80211com *ic,
   3056  1.40    dyoung 	const struct ieee80211_frame *wh,
   3057  1.40    dyoung 	const char *type, const char *fmt, ...)
   3058  1.31    dyoung {
   3059  1.40    dyoung 	va_list ap;
   3060  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   3061  1.31    dyoung 
   3062  1.47     skrll 	printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
   3063  1.85  christos 		ether_snprintf(ebuf, sizeof(ebuf), ieee80211_getbssid(ic, wh)));
   3064  1.40    dyoung 	if (type != NULL)
   3065  1.47     skrll 		printf("%s frame, ", type);
   3066  1.40    dyoung 	else
   3067  1.47     skrll 		printf("frame, ");
   3068  1.40    dyoung 	va_start(ap, fmt);
   3069  1.40    dyoung 	vprintf(fmt, ap);
   3070  1.40    dyoung 	va_end(ap);
   3071  1.40    dyoung 	printf("\n");
   3072  1.31    dyoung }
   3073  1.31    dyoung 
   3074  1.40    dyoung static void
   3075  1.40    dyoung ieee80211_discard_ie(struct ieee80211com *ic,
   3076  1.40    dyoung 	const struct ieee80211_frame *wh,
   3077  1.40    dyoung 	const char *type, const char *fmt, ...)
   3078  1.31    dyoung {
   3079  1.40    dyoung 	va_list ap;
   3080  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   3081  1.31    dyoung 
   3082  1.47     skrll 	printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
   3083  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf), ieee80211_getbssid(ic, wh)));
   3084  1.40    dyoung 	if (type != NULL)
   3085  1.47     skrll 		printf("%s information element, ", type);
   3086  1.40    dyoung 	else
   3087  1.47     skrll 		printf("information element, ");
   3088  1.40    dyoung 	va_start(ap, fmt);
   3089  1.40    dyoung 	vprintf(fmt, ap);
   3090  1.40    dyoung 	va_end(ap);
   3091  1.40    dyoung 	printf("\n");
   3092  1.40    dyoung }
   3093  1.31    dyoung 
   3094  1.40    dyoung static void
   3095  1.40    dyoung ieee80211_discard_mac(struct ieee80211com *ic,
   3096  1.40    dyoung 	const u_int8_t mac[IEEE80211_ADDR_LEN],
   3097  1.40    dyoung 	const char *type, const char *fmt, ...)
   3098  1.40    dyoung {
   3099  1.40    dyoung 	va_list ap;
   3100  1.85  christos 	char ebuf[3 * ETHER_ADDR_LEN];
   3101  1.31    dyoung 
   3102  1.85  christos 	printf("[%s:%s] discard ", ic->ic_ifp->if_xname,
   3103  1.85  christos 	    ether_snprintf(ebuf, sizeof(ebuf), mac));
   3104  1.40    dyoung 	if (type != NULL)
   3105  1.47     skrll 		printf("%s frame, ", type);
   3106  1.40    dyoung 	else
   3107  1.47     skrll 		printf("frame, ");
   3108  1.40    dyoung 	va_start(ap, fmt);
   3109  1.40    dyoung 	vprintf(fmt, ap);
   3110  1.40    dyoung 	va_end(ap);
   3111  1.40    dyoung 	printf("\n");
   3112  1.31    dyoung }
   3113  1.40    dyoung #endif /* IEEE80211_DEBUG */
   3114