Home | History | Annotate | Line # | Download | only in net80211
ieee80211_output.c revision 1.1.1.4
      1      1.1  dyoung /*-
      2      1.1  dyoung  * Copyright (c) 2001 Atsushi Onoe
      3      1.1  dyoung  * Copyright (c) 2002, 2003 Sam Leffler, Errno Consulting
      4      1.1  dyoung  * All rights reserved.
      5      1.1  dyoung  *
      6      1.1  dyoung  * Redistribution and use in source and binary forms, with or without
      7      1.1  dyoung  * modification, are permitted provided that the following conditions
      8      1.1  dyoung  * are met:
      9      1.1  dyoung  * 1. Redistributions of source code must retain the above copyright
     10      1.1  dyoung  *    notice, this list of conditions and the following disclaimer.
     11      1.1  dyoung  * 2. Redistributions in binary form must reproduce the above copyright
     12      1.1  dyoung  *    notice, this list of conditions and the following disclaimer in the
     13      1.1  dyoung  *    documentation and/or other materials provided with the distribution.
     14      1.1  dyoung  * 3. The name of the author may not be used to endorse or promote products
     15      1.1  dyoung  *    derived from this software without specific prior written permission.
     16      1.1  dyoung  *
     17      1.1  dyoung  * Alternatively, this software may be distributed under the terms of the
     18      1.1  dyoung  * GNU General Public License ("GPL") version 2 as published by the Free
     19      1.1  dyoung  * Software Foundation.
     20      1.1  dyoung  *
     21      1.1  dyoung  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22      1.1  dyoung  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23      1.1  dyoung  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24      1.1  dyoung  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25      1.1  dyoung  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26      1.1  dyoung  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27      1.1  dyoung  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28      1.1  dyoung  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29      1.1  dyoung  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30      1.1  dyoung  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31      1.1  dyoung  */
     32      1.1  dyoung 
     33      1.1  dyoung #include <sys/cdefs.h>
     34  1.1.1.4  dyoung __FBSDID("$FreeBSD: src/sys/net80211/ieee80211_output.c,v 1.10 2004/04/02 23:25:39 sam Exp $");
     35      1.1  dyoung 
     36      1.1  dyoung #include "opt_inet.h"
     37      1.1  dyoung 
     38      1.1  dyoung #include <sys/param.h>
     39      1.1  dyoung #include <sys/systm.h>
     40      1.1  dyoung #include <sys/mbuf.h>
     41      1.1  dyoung #include <sys/malloc.h>
     42      1.1  dyoung #include <sys/kernel.h>
     43      1.1  dyoung #include <sys/socket.h>
     44      1.1  dyoung #include <sys/sockio.h>
     45      1.1  dyoung #include <sys/endian.h>
     46      1.1  dyoung #include <sys/errno.h>
     47      1.1  dyoung #include <sys/bus.h>
     48      1.1  dyoung #include <sys/proc.h>
     49      1.1  dyoung #include <sys/sysctl.h>
     50      1.1  dyoung 
     51      1.1  dyoung #include <machine/atomic.h>
     52      1.1  dyoung 
     53      1.1  dyoung #include <net/if.h>
     54      1.1  dyoung #include <net/if_dl.h>
     55      1.1  dyoung #include <net/if_media.h>
     56      1.1  dyoung #include <net/if_arp.h>
     57      1.1  dyoung #include <net/ethernet.h>
     58      1.1  dyoung #include <net/if_llc.h>
     59      1.1  dyoung 
     60      1.1  dyoung #include <net80211/ieee80211_var.h>
     61      1.1  dyoung 
     62      1.1  dyoung #include <net/bpf.h>
     63      1.1  dyoung 
     64      1.1  dyoung #ifdef INET
     65      1.1  dyoung #include <netinet/in.h>
     66      1.1  dyoung #include <netinet/if_ether.h>
     67      1.1  dyoung #endif
     68      1.1  dyoung 
     69      1.1  dyoung /*
     70      1.1  dyoung  * Send a management frame to the specified node.  The node pointer
     71      1.1  dyoung  * must have a reference as the pointer will be passed to the driver
     72      1.1  dyoung  * and potentially held for a long time.  If the frame is successfully
     73      1.1  dyoung  * dispatched to the driver, then it is responsible for freeing the
     74      1.1  dyoung  * reference (and potentially free'ing up any associated storage).
     75      1.1  dyoung  */
     76      1.1  dyoung static int
     77      1.1  dyoung ieee80211_mgmt_output(struct ifnet *ifp, struct ieee80211_node *ni,
     78      1.1  dyoung     struct mbuf *m, int type)
     79      1.1  dyoung {
     80      1.1  dyoung 	struct ieee80211com *ic = (void *)ifp;
     81      1.1  dyoung 	struct ieee80211_frame *wh;
     82      1.1  dyoung 
     83      1.1  dyoung 	KASSERT(ni != NULL, ("null node"));
     84      1.1  dyoung 	ni->ni_inact = 0;
     85      1.1  dyoung 
     86      1.1  dyoung 	/*
     87      1.1  dyoung 	 * Yech, hack alert!  We want to pass the node down to the
     88      1.1  dyoung 	 * driver's start routine.  If we don't do so then the start
     89      1.1  dyoung 	 * routine must immediately look it up again and that can
     90      1.1  dyoung 	 * cause a lock order reversal if, for example, this frame
     91      1.1  dyoung 	 * is being sent because the station is being timedout and
     92      1.1  dyoung 	 * the frame being sent is a DEAUTH message.  We could stick
     93      1.1  dyoung 	 * this in an m_tag and tack that on to the mbuf.  However
     94      1.1  dyoung 	 * that's rather expensive to do for every frame so instead
     95      1.1  dyoung 	 * we stuff it in the rcvif field since outbound frames do
     96      1.1  dyoung 	 * not (presently) use this.
     97      1.1  dyoung 	 */
     98      1.1  dyoung 	M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
     99      1.1  dyoung 	if (m == NULL)
    100      1.1  dyoung 		return ENOMEM;
    101      1.1  dyoung 	KASSERT(m->m_pkthdr.rcvif == NULL, ("rcvif not null"));
    102      1.1  dyoung 	m->m_pkthdr.rcvif = (void *)ni;
    103      1.1  dyoung 
    104      1.1  dyoung 	wh = mtod(m, struct ieee80211_frame *);
    105      1.1  dyoung 	wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_MGT | type;
    106      1.1  dyoung 	wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
    107      1.1  dyoung 	*(u_int16_t *)wh->i_dur = 0;
    108      1.1  dyoung 	*(u_int16_t *)wh->i_seq =
    109      1.1  dyoung 	    htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
    110      1.1  dyoung 	ni->ni_txseq++;
    111      1.1  dyoung 	IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_macaddr);
    112      1.1  dyoung 	IEEE80211_ADDR_COPY(wh->i_addr2, ic->ic_myaddr);
    113      1.1  dyoung 	IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid);
    114      1.1  dyoung 
    115      1.1  dyoung 	if (ifp->if_flags & IFF_DEBUG) {
    116      1.1  dyoung 		/* avoid to print too many frames */
    117      1.1  dyoung 		if (ic->ic_opmode == IEEE80211_M_IBSS ||
    118      1.1  dyoung #ifdef IEEE80211_DEBUG
    119      1.1  dyoung 		    ieee80211_debug > 1 ||
    120      1.1  dyoung #endif
    121      1.1  dyoung 		    (type & IEEE80211_FC0_SUBTYPE_MASK) !=
    122      1.1  dyoung 		    IEEE80211_FC0_SUBTYPE_PROBE_RESP)
    123      1.1  dyoung 			if_printf(ifp, "sending %s to %s on channel %u\n",
    124      1.1  dyoung 			    ieee80211_mgt_subtype_name[
    125      1.1  dyoung 			    (type & IEEE80211_FC0_SUBTYPE_MASK)
    126      1.1  dyoung 			    >> IEEE80211_FC0_SUBTYPE_SHIFT],
    127      1.1  dyoung 			    ether_sprintf(ni->ni_macaddr),
    128      1.1  dyoung 			    ieee80211_chan2ieee(ic, ni->ni_chan));
    129      1.1  dyoung 	}
    130      1.1  dyoung 
    131      1.1  dyoung 	IF_ENQUEUE(&ic->ic_mgtq, m);
    132      1.1  dyoung 	ifp->if_timer = 1;
    133      1.1  dyoung 	(*ifp->if_start)(ifp);
    134      1.1  dyoung 	return 0;
    135      1.1  dyoung }
    136      1.1  dyoung 
    137      1.1  dyoung /*
    138      1.1  dyoung  * Encapsulate an outbound data frame.  The mbuf chain is updated and
    139      1.1  dyoung  * a reference to the destination node is returned.  If an error is
    140      1.1  dyoung  * encountered NULL is returned and the node reference will also be NULL.
    141      1.1  dyoung  *
    142      1.1  dyoung  * NB: The caller is responsible for free'ing a returned node reference.
    143      1.1  dyoung  *     The convention is ic_bss is not reference counted; the caller must
    144      1.1  dyoung  *     maintain that.
    145      1.1  dyoung  */
    146      1.1  dyoung struct mbuf *
    147      1.1  dyoung ieee80211_encap(struct ifnet *ifp, struct mbuf *m, struct ieee80211_node **pni)
    148      1.1  dyoung {
    149      1.1  dyoung 	struct ieee80211com *ic = (void *)ifp;
    150      1.1  dyoung 	struct ether_header eh;
    151      1.1  dyoung 	struct ieee80211_frame *wh;
    152      1.1  dyoung 	struct ieee80211_node *ni = NULL;
    153      1.1  dyoung 	struct llc *llc;
    154      1.1  dyoung 
    155      1.1  dyoung 	if (m->m_len < sizeof(struct ether_header)) {
    156      1.1  dyoung 		m = m_pullup(m, sizeof(struct ether_header));
    157      1.1  dyoung 		if (m == NULL) {
    158  1.1.1.3  dyoung 			ic->ic_stats.is_tx_nombuf++;
    159      1.1  dyoung 			goto bad;
    160      1.1  dyoung 		}
    161      1.1  dyoung 	}
    162      1.1  dyoung 	memcpy(&eh, mtod(m, caddr_t), sizeof(struct ether_header));
    163      1.1  dyoung 
    164  1.1.1.4  dyoung 	ni = ieee80211_find_txnode(ic, eh.ether_dhost);
    165  1.1.1.4  dyoung 	if (ni == NULL) {
    166  1.1.1.4  dyoung 		IEEE80211_DPRINTF(("%s: no node for dst %s, discard frame\n",
    167  1.1.1.4  dyoung 			__func__, ether_sprintf(eh.ether_dhost)));
    168  1.1.1.4  dyoung 		ic->ic_stats.is_tx_nonode++;
    169  1.1.1.4  dyoung 		goto bad;
    170  1.1.1.4  dyoung 	}
    171      1.1  dyoung 	ni->ni_inact = 0;
    172      1.1  dyoung 
    173      1.1  dyoung 	m_adj(m, sizeof(struct ether_header) - sizeof(struct llc));
    174      1.1  dyoung 	llc = mtod(m, struct llc *);
    175      1.1  dyoung 	llc->llc_dsap = llc->llc_ssap = LLC_SNAP_LSAP;
    176      1.1  dyoung 	llc->llc_control = LLC_UI;
    177      1.1  dyoung 	llc->llc_snap.org_code[0] = 0;
    178      1.1  dyoung 	llc->llc_snap.org_code[1] = 0;
    179      1.1  dyoung 	llc->llc_snap.org_code[2] = 0;
    180      1.1  dyoung 	llc->llc_snap.ether_type = eh.ether_type;
    181      1.1  dyoung 	M_PREPEND(m, sizeof(struct ieee80211_frame), M_DONTWAIT);
    182  1.1.1.3  dyoung 	if (m == NULL) {
    183  1.1.1.3  dyoung 		ic->ic_stats.is_tx_nombuf++;
    184      1.1  dyoung 		goto bad;
    185  1.1.1.3  dyoung 	}
    186      1.1  dyoung 	wh = mtod(m, struct ieee80211_frame *);
    187      1.1  dyoung 	wh->i_fc[0] = IEEE80211_FC0_VERSION_0 | IEEE80211_FC0_TYPE_DATA;
    188      1.1  dyoung 	*(u_int16_t *)wh->i_dur = 0;
    189      1.1  dyoung 	*(u_int16_t *)wh->i_seq =
    190      1.1  dyoung 	    htole16(ni->ni_txseq << IEEE80211_SEQ_SEQ_SHIFT);
    191      1.1  dyoung 	ni->ni_txseq++;
    192      1.1  dyoung 	switch (ic->ic_opmode) {
    193      1.1  dyoung 	case IEEE80211_M_STA:
    194      1.1  dyoung 		wh->i_fc[1] = IEEE80211_FC1_DIR_TODS;
    195      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr1, ni->ni_bssid);
    196      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr2, eh.ether_shost);
    197      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_dhost);
    198      1.1  dyoung 		break;
    199      1.1  dyoung 	case IEEE80211_M_IBSS:
    200      1.1  dyoung 	case IEEE80211_M_AHDEMO:
    201      1.1  dyoung 		wh->i_fc[1] = IEEE80211_FC1_DIR_NODS;
    202      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost);
    203      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr2, eh.ether_shost);
    204      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr3, ni->ni_bssid);
    205      1.1  dyoung 		break;
    206      1.1  dyoung 	case IEEE80211_M_HOSTAP:
    207      1.1  dyoung 		wh->i_fc[1] = IEEE80211_FC1_DIR_FROMDS;
    208      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr1, eh.ether_dhost);
    209      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr2, ni->ni_bssid);
    210      1.1  dyoung 		IEEE80211_ADDR_COPY(wh->i_addr3, eh.ether_shost);
    211      1.1  dyoung 		break;
    212      1.1  dyoung 	case IEEE80211_M_MONITOR:
    213      1.1  dyoung 		goto bad;
    214      1.1  dyoung 	}
    215      1.1  dyoung 	*pni = ni;
    216      1.1  dyoung 	return m;
    217      1.1  dyoung bad:
    218      1.1  dyoung 	if (m != NULL)
    219      1.1  dyoung 		m_freem(m);
    220      1.1  dyoung 	if (ni && ni != ic->ic_bss)
    221      1.1  dyoung 		ieee80211_free_node(ic, ni);
    222      1.1  dyoung 	*pni = NULL;
    223      1.1  dyoung 	return NULL;
    224      1.1  dyoung }
    225      1.1  dyoung 
    226      1.1  dyoung /*
    227      1.1  dyoung  * Add a supported rates element id to a frame.
    228      1.1  dyoung  */
    229      1.1  dyoung u_int8_t *
    230      1.1  dyoung ieee80211_add_rates(u_int8_t *frm, const struct ieee80211_rateset *rs)
    231      1.1  dyoung {
    232      1.1  dyoung 	int nrates;
    233      1.1  dyoung 
    234      1.1  dyoung 	*frm++ = IEEE80211_ELEMID_RATES;
    235      1.1  dyoung 	nrates = rs->rs_nrates;
    236      1.1  dyoung 	if (nrates > IEEE80211_RATE_SIZE)
    237      1.1  dyoung 		nrates = IEEE80211_RATE_SIZE;
    238      1.1  dyoung 	*frm++ = nrates;
    239      1.1  dyoung 	memcpy(frm, rs->rs_rates, nrates);
    240      1.1  dyoung 	return frm + nrates;
    241      1.1  dyoung }
    242      1.1  dyoung 
    243      1.1  dyoung /*
    244      1.1  dyoung  * Add an extended supported rates element id to a frame.
    245      1.1  dyoung  */
    246      1.1  dyoung u_int8_t *
    247      1.1  dyoung ieee80211_add_xrates(u_int8_t *frm, const struct ieee80211_rateset *rs)
    248      1.1  dyoung {
    249      1.1  dyoung 	/*
    250      1.1  dyoung 	 * Add an extended supported rates element if operating in 11g mode.
    251      1.1  dyoung 	 */
    252      1.1  dyoung 	if (rs->rs_nrates > IEEE80211_RATE_SIZE) {
    253      1.1  dyoung 		int nrates = rs->rs_nrates - IEEE80211_RATE_SIZE;
    254      1.1  dyoung 		*frm++ = IEEE80211_ELEMID_XRATES;
    255      1.1  dyoung 		*frm++ = nrates;
    256      1.1  dyoung 		memcpy(frm, rs->rs_rates + IEEE80211_RATE_SIZE, nrates);
    257      1.1  dyoung 		frm += nrates;
    258      1.1  dyoung 	}
    259      1.1  dyoung 	return frm;
    260      1.1  dyoung }
    261      1.1  dyoung 
    262      1.1  dyoung /*
    263      1.1  dyoung  * Add an ssid elemet to a frame.
    264      1.1  dyoung  */
    265      1.1  dyoung static u_int8_t *
    266      1.1  dyoung ieee80211_add_ssid(u_int8_t *frm, const u_int8_t *ssid, u_int len)
    267      1.1  dyoung {
    268      1.1  dyoung 	*frm++ = IEEE80211_ELEMID_SSID;
    269      1.1  dyoung 	*frm++ = len;
    270      1.1  dyoung 	memcpy(frm, ssid, len);
    271      1.1  dyoung 	return frm + len;
    272      1.1  dyoung }
    273      1.1  dyoung 
    274      1.1  dyoung static struct mbuf *
    275      1.1  dyoung ieee80211_getmbuf(int flags, int type, u_int pktlen)
    276      1.1  dyoung {
    277      1.1  dyoung 	struct mbuf *m;
    278      1.1  dyoung 
    279  1.1.1.2  dyoung 	KASSERT(pktlen <= MCLBYTES, ("802.11 packet too large: %u", pktlen));
    280  1.1.1.2  dyoung 	if (pktlen <= MHLEN)
    281      1.1  dyoung 		MGETHDR(m, flags, type);
    282      1.1  dyoung 	else
    283      1.1  dyoung 		m = m_getcl(flags, type, M_PKTHDR);
    284      1.1  dyoung 	return m;
    285      1.1  dyoung }
    286      1.1  dyoung 
    287      1.1  dyoung /*
    288      1.1  dyoung  * Send a management frame.  The node is for the destination (or ic_bss
    289      1.1  dyoung  * when in station mode).  Nodes other than ic_bss have their reference
    290      1.1  dyoung  * count bumped to reflect our use for an indeterminant time.
    291      1.1  dyoung  */
    292      1.1  dyoung int
    293      1.1  dyoung ieee80211_send_mgmt(struct ieee80211com *ic, struct ieee80211_node *ni,
    294      1.1  dyoung 	int type, int arg)
    295      1.1  dyoung {
    296  1.1.1.3  dyoung #define	senderr(_x, _v)	do { ic->ic_stats._v++; ret = _x; goto bad; } while (0)
    297      1.1  dyoung 	struct ifnet *ifp = &ic->ic_if;
    298      1.1  dyoung 	struct mbuf *m;
    299      1.1  dyoung 	u_int8_t *frm;
    300      1.1  dyoung 	enum ieee80211_phymode mode;
    301      1.1  dyoung 	u_int16_t capinfo;
    302      1.1  dyoung 	int ret, timer;
    303      1.1  dyoung 
    304      1.1  dyoung 	KASSERT(ni != NULL, ("null node"));
    305      1.1  dyoung 
    306      1.1  dyoung 	/*
    307      1.1  dyoung 	 * Hold a reference on the node so it doesn't go away until after
    308      1.1  dyoung 	 * the xmit is complete all the way in the driver.  On error we
    309      1.1  dyoung 	 * will remove our reference.
    310      1.1  dyoung 	 */
    311      1.1  dyoung 	if (ni != ic->ic_bss)
    312      1.1  dyoung 		ieee80211_ref_node(ni);
    313      1.1  dyoung 	timer = 0;
    314      1.1  dyoung 	switch (type) {
    315      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
    316      1.1  dyoung 		/*
    317      1.1  dyoung 		 * prreq frame format
    318      1.1  dyoung 		 *	[tlv] ssid
    319      1.1  dyoung 		 *	[tlv] supported rates
    320      1.1  dyoung 		 *	[tlv] extended supported rates
    321      1.1  dyoung 		 */
    322      1.1  dyoung 		m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
    323      1.1  dyoung 			 2 + ic->ic_des_esslen
    324      1.1  dyoung 		       + 2 + IEEE80211_RATE_SIZE
    325      1.1  dyoung 		       + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
    326      1.1  dyoung 		if (m == NULL)
    327  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    328      1.1  dyoung 		m->m_data += sizeof(struct ieee80211_frame);
    329      1.1  dyoung 		frm = mtod(m, u_int8_t *);
    330      1.1  dyoung 		frm = ieee80211_add_ssid(frm, ic->ic_des_essid, ic->ic_des_esslen);
    331      1.1  dyoung 		mode = ieee80211_chan2mode(ic, ni->ni_chan);
    332      1.1  dyoung 		frm = ieee80211_add_rates(frm, &ic->ic_sup_rates[mode]);
    333      1.1  dyoung 		frm = ieee80211_add_xrates(frm, &ic->ic_sup_rates[mode]);
    334      1.1  dyoung 		m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
    335      1.1  dyoung 
    336      1.1  dyoung 		timer = IEEE80211_TRANS_WAIT;
    337      1.1  dyoung 		break;
    338      1.1  dyoung 
    339      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
    340      1.1  dyoung 		/*
    341      1.1  dyoung 		 * probe response frame format
    342      1.1  dyoung 		 *	[8] time stamp
    343      1.1  dyoung 		 *	[2] beacon interval
    344      1.1  dyoung 		 *	[2] cabability information
    345      1.1  dyoung 		 *	[tlv] ssid
    346      1.1  dyoung 		 *	[tlv] supported rates
    347  1.1.1.3  dyoung 		 *	[tlv] parameter set (FH/DS)
    348      1.1  dyoung 		 *	[tlv] parameter set (IBSS)
    349      1.1  dyoung 		 *	[tlv] extended supported rates
    350      1.1  dyoung 		 */
    351      1.1  dyoung 		m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
    352      1.1  dyoung 			 8 + 2 + 2 + 2
    353      1.1  dyoung 		       + 2 + ni->ni_esslen
    354      1.1  dyoung 		       + 2 + IEEE80211_RATE_SIZE
    355  1.1.1.3  dyoung 		       + (ic->ic_phytype == IEEE80211_T_FH ? 7 : 3)
    356      1.1  dyoung 		       + 6
    357      1.1  dyoung 		       + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
    358      1.1  dyoung 		if (m == NULL)
    359  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    360      1.1  dyoung 		m->m_data += sizeof(struct ieee80211_frame);
    361      1.1  dyoung 		frm = mtod(m, u_int8_t *);
    362      1.1  dyoung 
    363      1.1  dyoung 		memset(frm, 0, 8);	/* timestamp should be filled later */
    364      1.1  dyoung 		frm += 8;
    365      1.1  dyoung 		*(u_int16_t *)frm = htole16(ic->ic_bss->ni_intval);
    366      1.1  dyoung 		frm += 2;
    367      1.1  dyoung 		if (ic->ic_opmode == IEEE80211_M_IBSS)
    368      1.1  dyoung 			capinfo = IEEE80211_CAPINFO_IBSS;
    369      1.1  dyoung 		else
    370      1.1  dyoung 			capinfo = IEEE80211_CAPINFO_ESS;
    371      1.1  dyoung 		if (ic->ic_flags & IEEE80211_F_WEPON)
    372      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_PRIVACY;
    373  1.1.1.3  dyoung 		if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
    374  1.1.1.3  dyoung 		    IEEE80211_IS_CHAN_2GHZ(ni->ni_chan))
    375  1.1.1.3  dyoung 			capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
    376      1.1  dyoung 		*(u_int16_t *)frm = htole16(capinfo);
    377      1.1  dyoung 		frm += 2;
    378      1.1  dyoung 
    379      1.1  dyoung 		frm = ieee80211_add_ssid(frm, ic->ic_bss->ni_essid,
    380      1.1  dyoung 				ic->ic_bss->ni_esslen);
    381      1.1  dyoung 		frm = ieee80211_add_rates(frm, &ic->ic_bss->ni_rates);
    382      1.1  dyoung 
    383  1.1.1.3  dyoung 		if (ic->ic_phytype == IEEE80211_T_FH) {
    384  1.1.1.3  dyoung                         *frm++ = IEEE80211_ELEMID_FHPARMS;
    385  1.1.1.3  dyoung                         *frm++ = 5;
    386  1.1.1.3  dyoung                         *frm++ = ni->ni_fhdwell & 0x00ff;
    387  1.1.1.3  dyoung                         *frm++ = (ni->ni_fhdwell >> 8) & 0x00ff;
    388  1.1.1.3  dyoung                         *frm++ = IEEE80211_FH_CHANSET(
    389  1.1.1.3  dyoung 			    ieee80211_chan2ieee(ic, ni->ni_chan));
    390  1.1.1.3  dyoung                         *frm++ = IEEE80211_FH_CHANPAT(
    391  1.1.1.3  dyoung 			    ieee80211_chan2ieee(ic, ni->ni_chan));
    392  1.1.1.3  dyoung                         *frm++ = ni->ni_fhindex;
    393  1.1.1.3  dyoung 		} else {
    394  1.1.1.3  dyoung 			*frm++ = IEEE80211_ELEMID_DSPARMS;
    395  1.1.1.3  dyoung 			*frm++ = 1;
    396  1.1.1.3  dyoung 			*frm++ = ieee80211_chan2ieee(ic, ni->ni_chan);
    397  1.1.1.3  dyoung 		}
    398  1.1.1.3  dyoung 
    399      1.1  dyoung 		if (ic->ic_opmode == IEEE80211_M_IBSS) {
    400      1.1  dyoung 			*frm++ = IEEE80211_ELEMID_IBSSPARMS;
    401      1.1  dyoung 			*frm++ = 2;
    402      1.1  dyoung 			*frm++ = 0; *frm++ = 0;		/* TODO: ATIM window */
    403      1.1  dyoung 		} else {	/* IEEE80211_M_HOSTAP */
    404      1.1  dyoung 			/* TODO: TIM */
    405      1.1  dyoung 			*frm++ = IEEE80211_ELEMID_TIM;
    406      1.1  dyoung 			*frm++ = 4;	/* length */
    407      1.1  dyoung 			*frm++ = 0;	/* DTIM count */
    408      1.1  dyoung 			*frm++ = 1;	/* DTIM period */
    409      1.1  dyoung 			*frm++ = 0;	/* bitmap control */
    410      1.1  dyoung 			*frm++ = 0;	/* Partial Virtual Bitmap (variable length) */
    411      1.1  dyoung 		}
    412      1.1  dyoung 		frm = ieee80211_add_xrates(frm, &ic->ic_bss->ni_rates);
    413      1.1  dyoung 		m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
    414      1.1  dyoung 		break;
    415      1.1  dyoung 
    416      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_AUTH:
    417      1.1  dyoung 		MGETHDR(m, M_DONTWAIT, MT_DATA);
    418      1.1  dyoung 		if (m == NULL)
    419  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    420      1.1  dyoung 		MH_ALIGN(m, 2 * 3);
    421      1.1  dyoung 		m->m_pkthdr.len = m->m_len = 6;
    422      1.1  dyoung 		frm = mtod(m, u_int8_t *);
    423      1.1  dyoung 		/* TODO: shared key auth */
    424      1.1  dyoung 		((u_int16_t *)frm)[0] = htole16(IEEE80211_AUTH_ALG_OPEN);
    425      1.1  dyoung 		((u_int16_t *)frm)[1] = htole16(arg);	/* sequence number */
    426      1.1  dyoung 		((u_int16_t *)frm)[2] = 0;		/* status */
    427      1.1  dyoung 		if (ic->ic_opmode == IEEE80211_M_STA)
    428      1.1  dyoung 			timer = IEEE80211_TRANS_WAIT;
    429      1.1  dyoung 		break;
    430      1.1  dyoung 
    431      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_DEAUTH:
    432      1.1  dyoung 		if (ifp->if_flags & IFF_DEBUG)
    433      1.1  dyoung 			if_printf(ifp, "station %s deauthenticate (reason %d)\n",
    434      1.1  dyoung 			    ether_sprintf(ni->ni_macaddr), arg);
    435      1.1  dyoung 		MGETHDR(m, M_DONTWAIT, MT_DATA);
    436      1.1  dyoung 		if (m == NULL)
    437  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    438      1.1  dyoung 		MH_ALIGN(m, 2);
    439      1.1  dyoung 		m->m_pkthdr.len = m->m_len = 2;
    440      1.1  dyoung 		*mtod(m, u_int16_t *) = htole16(arg);	/* reason */
    441      1.1  dyoung 		break;
    442      1.1  dyoung 
    443      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
    444      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_REASSOC_REQ:
    445      1.1  dyoung 		/*
    446      1.1  dyoung 		 * asreq frame format
    447      1.1  dyoung 		 *	[2] capability information
    448      1.1  dyoung 		 *	[2] listen interval
    449      1.1  dyoung 		 *	[6*] current AP address (reassoc only)
    450      1.1  dyoung 		 *	[tlv] ssid
    451      1.1  dyoung 		 *	[tlv] supported rates
    452      1.1  dyoung 		 *	[tlv] extended supported rates
    453      1.1  dyoung 		 */
    454      1.1  dyoung 		m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
    455      1.1  dyoung 			 sizeof(capinfo)
    456      1.1  dyoung 		       + sizeof(u_int16_t)
    457      1.1  dyoung 		       + IEEE80211_ADDR_LEN
    458      1.1  dyoung 		       + 2 + ni->ni_esslen
    459      1.1  dyoung 		       + 2 + IEEE80211_RATE_SIZE
    460      1.1  dyoung 		       + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
    461      1.1  dyoung 		if (m == NULL)
    462  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    463      1.1  dyoung 		m->m_data += sizeof(struct ieee80211_frame);
    464      1.1  dyoung 		frm = mtod(m, u_int8_t *);
    465      1.1  dyoung 
    466      1.1  dyoung 		capinfo = 0;
    467      1.1  dyoung 		if (ic->ic_opmode == IEEE80211_M_IBSS)
    468      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_IBSS;
    469      1.1  dyoung 		else		/* IEEE80211_M_STA */
    470      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_ESS;
    471      1.1  dyoung 		if (ic->ic_flags & IEEE80211_F_WEPON)
    472      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_PRIVACY;
    473  1.1.1.3  dyoung 		/*
    474  1.1.1.3  dyoung 		 * NB: Some 11a AP's reject the request when
    475  1.1.1.3  dyoung 		 *     short premable is set.
    476  1.1.1.3  dyoung 		 */
    477  1.1.1.3  dyoung 		if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
    478  1.1.1.3  dyoung 		    IEEE80211_IS_CHAN_2GHZ(ni->ni_chan))
    479      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
    480      1.1  dyoung 		if (ic->ic_flags & IEEE80211_F_SHSLOT)
    481      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME;
    482      1.1  dyoung 		*(u_int16_t *)frm = htole16(capinfo);
    483      1.1  dyoung 		frm += 2;
    484      1.1  dyoung 
    485      1.1  dyoung 		*(u_int16_t *)frm = htole16(ic->ic_lintval);
    486      1.1  dyoung 		frm += 2;
    487      1.1  dyoung 
    488      1.1  dyoung 		if (type == IEEE80211_FC0_SUBTYPE_REASSOC_REQ) {
    489      1.1  dyoung 			IEEE80211_ADDR_COPY(frm, ic->ic_bss->ni_bssid);
    490      1.1  dyoung 			frm += IEEE80211_ADDR_LEN;
    491      1.1  dyoung 		}
    492      1.1  dyoung 
    493      1.1  dyoung 		frm = ieee80211_add_ssid(frm, ni->ni_essid, ni->ni_esslen);
    494      1.1  dyoung 		frm = ieee80211_add_rates(frm, &ni->ni_rates);
    495      1.1  dyoung 		frm = ieee80211_add_xrates(frm, &ni->ni_rates);
    496      1.1  dyoung 		m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
    497      1.1  dyoung 
    498      1.1  dyoung 		timer = IEEE80211_TRANS_WAIT;
    499      1.1  dyoung 		break;
    500      1.1  dyoung 
    501      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_ASSOC_RESP:
    502      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_REASSOC_RESP:
    503      1.1  dyoung 		/*
    504      1.1  dyoung 		 * asreq frame format
    505      1.1  dyoung 		 *	[2] capability information
    506      1.1  dyoung 		 *	[2] status
    507      1.1  dyoung 		 *	[2] association ID
    508      1.1  dyoung 		 *	[tlv] supported rates
    509      1.1  dyoung 		 *	[tlv] extended supported rates
    510      1.1  dyoung 		 */
    511      1.1  dyoung 		m = ieee80211_getmbuf(M_DONTWAIT, MT_DATA,
    512      1.1  dyoung 			 sizeof(capinfo)
    513      1.1  dyoung 		       + sizeof(u_int16_t)
    514      1.1  dyoung 		       + sizeof(u_int16_t)
    515      1.1  dyoung 		       + 2 + IEEE80211_RATE_SIZE
    516      1.1  dyoung 		       + 2 + (IEEE80211_RATE_MAXSIZE - IEEE80211_RATE_SIZE));
    517      1.1  dyoung 		if (m == NULL)
    518  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    519      1.1  dyoung 		m->m_data += sizeof(struct ieee80211_frame);
    520      1.1  dyoung 		frm = mtod(m, u_int8_t *);
    521      1.1  dyoung 
    522      1.1  dyoung 		capinfo = IEEE80211_CAPINFO_ESS;
    523      1.1  dyoung 		if (ic->ic_flags & IEEE80211_F_WEPON)
    524      1.1  dyoung 			capinfo |= IEEE80211_CAPINFO_PRIVACY;
    525  1.1.1.3  dyoung 		if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
    526  1.1.1.3  dyoung 		    IEEE80211_IS_CHAN_2GHZ(ni->ni_chan))
    527  1.1.1.3  dyoung 			capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
    528      1.1  dyoung 		*(u_int16_t *)frm = htole16(capinfo);
    529      1.1  dyoung 		frm += 2;
    530      1.1  dyoung 
    531      1.1  dyoung 		*(u_int16_t *)frm = htole16(arg);	/* status */
    532      1.1  dyoung 		frm += 2;
    533      1.1  dyoung 
    534      1.1  dyoung 		if (arg == IEEE80211_STATUS_SUCCESS)
    535      1.1  dyoung 			*(u_int16_t *)frm = htole16(ni->ni_associd);
    536      1.1  dyoung 		frm += 2;
    537      1.1  dyoung 
    538      1.1  dyoung 		frm = ieee80211_add_rates(frm, &ni->ni_rates);
    539      1.1  dyoung 		frm = ieee80211_add_xrates(frm, &ni->ni_rates);
    540      1.1  dyoung 		m->m_pkthdr.len = m->m_len = frm - mtod(m, u_int8_t *);
    541      1.1  dyoung 		break;
    542      1.1  dyoung 
    543      1.1  dyoung 	case IEEE80211_FC0_SUBTYPE_DISASSOC:
    544      1.1  dyoung 		if (ifp->if_flags & IFF_DEBUG)
    545      1.1  dyoung 			if_printf(ifp, "station %s disassociate (reason %d)\n",
    546      1.1  dyoung 			    ether_sprintf(ni->ni_macaddr), arg);
    547      1.1  dyoung 		MGETHDR(m, M_DONTWAIT, MT_DATA);
    548      1.1  dyoung 		if (m == NULL)
    549  1.1.1.3  dyoung 			senderr(ENOMEM, is_tx_nombuf);
    550      1.1  dyoung 		MH_ALIGN(m, 2);
    551      1.1  dyoung 		m->m_pkthdr.len = m->m_len = 2;
    552      1.1  dyoung 		*mtod(m, u_int16_t *) = htole16(arg);	/* reason */
    553      1.1  dyoung 		break;
    554      1.1  dyoung 
    555      1.1  dyoung 	default:
    556      1.1  dyoung 		IEEE80211_DPRINTF(("%s: invalid mgmt frame type %u\n",
    557      1.1  dyoung 			__func__, type));
    558  1.1.1.3  dyoung 		senderr(EINVAL, is_tx_unknownmgt);
    559      1.1  dyoung 		/* NOTREACHED */
    560      1.1  dyoung 	}
    561      1.1  dyoung 
    562      1.1  dyoung 	ret = ieee80211_mgmt_output(ifp, ni, m, type);
    563      1.1  dyoung 	if (ret == 0) {
    564      1.1  dyoung 		if (timer)
    565      1.1  dyoung 			ic->ic_mgt_timer = timer;
    566      1.1  dyoung 	} else {
    567      1.1  dyoung bad:
    568      1.1  dyoung 		if (ni != ic->ic_bss)		/* remove ref we added */
    569      1.1  dyoung 			ieee80211_free_node(ic, ni);
    570      1.1  dyoung 	}
    571      1.1  dyoung 	return ret;
    572      1.1  dyoung #undef senderr
    573      1.1  dyoung }
    574