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