xref: /freebsd/sys/net80211/ieee80211_proto.c (revision ddd5b8e9b4d8957fce018c520657cdfa4ecffad3)
1 /*-
2  * Copyright (c) 2001 Atsushi Onoe
3  * Copyright (c) 2002-2008 Sam Leffler, Errno Consulting
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25  */
26 
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29 
30 /*
31  * IEEE 802.11 protocol support.
32  */
33 
34 #include "opt_inet.h"
35 #include "opt_wlan.h"
36 
37 #include <sys/param.h>
38 #include <sys/kernel.h>
39 #include <sys/systm.h>
40 
41 #include <sys/socket.h>
42 #include <sys/sockio.h>
43 
44 #include <net/if.h>
45 #include <net/if_media.h>
46 #include <net/ethernet.h>		/* XXX for ether_sprintf */
47 
48 #include <net80211/ieee80211_var.h>
49 #include <net80211/ieee80211_adhoc.h>
50 #include <net80211/ieee80211_sta.h>
51 #include <net80211/ieee80211_hostap.h>
52 #include <net80211/ieee80211_wds.h>
53 #ifdef IEEE80211_SUPPORT_MESH
54 #include <net80211/ieee80211_mesh.h>
55 #endif
56 #include <net80211/ieee80211_monitor.h>
57 #include <net80211/ieee80211_input.h>
58 
59 /* XXX tunables */
60 #define	AGGRESSIVE_MODE_SWITCH_HYSTERESIS	3	/* pkts / 100ms */
61 #define	HIGH_PRI_SWITCH_THRESH			10	/* pkts / 100ms */
62 
63 const char *ieee80211_mgt_subtype_name[] = {
64 	"assoc_req",	"assoc_resp",	"reassoc_req",	"reassoc_resp",
65 	"probe_req",	"probe_resp",	"reserved#6",	"reserved#7",
66 	"beacon",	"atim",		"disassoc",	"auth",
67 	"deauth",	"action",	"action_noack",	"reserved#15"
68 };
69 const char *ieee80211_ctl_subtype_name[] = {
70 	"reserved#0",	"reserved#1",	"reserved#2",	"reserved#3",
71 	"reserved#3",	"reserved#5",	"reserved#6",	"reserved#7",
72 	"reserved#8",	"reserved#9",	"ps_poll",	"rts",
73 	"cts",		"ack",		"cf_end",	"cf_end_ack"
74 };
75 const char *ieee80211_opmode_name[IEEE80211_OPMODE_MAX] = {
76 	"IBSS",		/* IEEE80211_M_IBSS */
77 	"STA",		/* IEEE80211_M_STA */
78 	"WDS",		/* IEEE80211_M_WDS */
79 	"AHDEMO",	/* IEEE80211_M_AHDEMO */
80 	"HOSTAP",	/* IEEE80211_M_HOSTAP */
81 	"MONITOR",	/* IEEE80211_M_MONITOR */
82 	"MBSS"		/* IEEE80211_M_MBSS */
83 };
84 const char *ieee80211_state_name[IEEE80211_S_MAX] = {
85 	"INIT",		/* IEEE80211_S_INIT */
86 	"SCAN",		/* IEEE80211_S_SCAN */
87 	"AUTH",		/* IEEE80211_S_AUTH */
88 	"ASSOC",	/* IEEE80211_S_ASSOC */
89 	"CAC",		/* IEEE80211_S_CAC */
90 	"RUN",		/* IEEE80211_S_RUN */
91 	"CSA",		/* IEEE80211_S_CSA */
92 	"SLEEP",	/* IEEE80211_S_SLEEP */
93 };
94 const char *ieee80211_wme_acnames[] = {
95 	"WME_AC_BE",
96 	"WME_AC_BK",
97 	"WME_AC_VI",
98 	"WME_AC_VO",
99 	"WME_UPSD",
100 };
101 
102 static void beacon_miss(void *, int);
103 static void beacon_swmiss(void *, int);
104 static void parent_updown(void *, int);
105 static void update_mcast(void *, int);
106 static void update_promisc(void *, int);
107 static void update_channel(void *, int);
108 static void update_chw(void *, int);
109 static void ieee80211_newstate_cb(void *, int);
110 static int ieee80211_new_state_locked(struct ieee80211vap *,
111 	enum ieee80211_state, int);
112 
113 static int
114 null_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
115 	const struct ieee80211_bpf_params *params)
116 {
117 	struct ifnet *ifp = ni->ni_ic->ic_ifp;
118 
119 	if_printf(ifp, "missing ic_raw_xmit callback, drop frame\n");
120 	m_freem(m);
121 	return ENETDOWN;
122 }
123 
124 void
125 ieee80211_proto_attach(struct ieee80211com *ic)
126 {
127 	struct ifnet *ifp = ic->ic_ifp;
128 
129 	/* override the 802.3 setting */
130 	ifp->if_hdrlen = ic->ic_headroom
131 		+ sizeof(struct ieee80211_qosframe_addr4)
132 		+ IEEE80211_WEP_IVLEN + IEEE80211_WEP_KIDLEN
133 		+ IEEE80211_WEP_EXTIVLEN;
134 	/* XXX no way to recalculate on ifdetach */
135 	if (ALIGN(ifp->if_hdrlen) > max_linkhdr) {
136 		/* XXX sanity check... */
137 		max_linkhdr = ALIGN(ifp->if_hdrlen);
138 		max_hdr = max_linkhdr + max_protohdr;
139 		max_datalen = MHLEN - max_hdr;
140 	}
141 	ic->ic_protmode = IEEE80211_PROT_CTSONLY;
142 
143 	TASK_INIT(&ic->ic_parent_task, 0, parent_updown, ifp);
144 	TASK_INIT(&ic->ic_mcast_task, 0, update_mcast, ic);
145 	TASK_INIT(&ic->ic_promisc_task, 0, update_promisc, ic);
146 	TASK_INIT(&ic->ic_chan_task, 0, update_channel, ic);
147 	TASK_INIT(&ic->ic_bmiss_task, 0, beacon_miss, ic);
148 	TASK_INIT(&ic->ic_chw_task, 0, update_chw, ic);
149 
150 	ic->ic_wme.wme_hipri_switch_hysteresis =
151 		AGGRESSIVE_MODE_SWITCH_HYSTERESIS;
152 
153 	/* initialize management frame handlers */
154 	ic->ic_send_mgmt = ieee80211_send_mgmt;
155 	ic->ic_raw_xmit = null_raw_xmit;
156 
157 	ieee80211_adhoc_attach(ic);
158 	ieee80211_sta_attach(ic);
159 	ieee80211_wds_attach(ic);
160 	ieee80211_hostap_attach(ic);
161 #ifdef IEEE80211_SUPPORT_MESH
162 	ieee80211_mesh_attach(ic);
163 #endif
164 	ieee80211_monitor_attach(ic);
165 }
166 
167 void
168 ieee80211_proto_detach(struct ieee80211com *ic)
169 {
170 	ieee80211_monitor_detach(ic);
171 #ifdef IEEE80211_SUPPORT_MESH
172 	ieee80211_mesh_detach(ic);
173 #endif
174 	ieee80211_hostap_detach(ic);
175 	ieee80211_wds_detach(ic);
176 	ieee80211_adhoc_detach(ic);
177 	ieee80211_sta_detach(ic);
178 }
179 
180 static void
181 null_update_beacon(struct ieee80211vap *vap, int item)
182 {
183 }
184 
185 void
186 ieee80211_proto_vattach(struct ieee80211vap *vap)
187 {
188 	struct ieee80211com *ic = vap->iv_ic;
189 	struct ifnet *ifp = vap->iv_ifp;
190 	int i;
191 
192 	/* override the 802.3 setting */
193 	ifp->if_hdrlen = ic->ic_ifp->if_hdrlen;
194 
195 	vap->iv_rtsthreshold = IEEE80211_RTS_DEFAULT;
196 	vap->iv_fragthreshold = IEEE80211_FRAG_DEFAULT;
197 	vap->iv_bmiss_max = IEEE80211_BMISS_MAX;
198 	callout_init_mtx(&vap->iv_swbmiss, IEEE80211_LOCK_OBJ(ic), 0);
199 	callout_init(&vap->iv_mgtsend, CALLOUT_MPSAFE);
200 	TASK_INIT(&vap->iv_nstate_task, 0, ieee80211_newstate_cb, vap);
201 	TASK_INIT(&vap->iv_swbmiss_task, 0, beacon_swmiss, vap);
202 	/*
203 	 * Install default tx rate handling: no fixed rate, lowest
204 	 * supported rate for mgmt and multicast frames.  Default
205 	 * max retry count.  These settings can be changed by the
206 	 * driver and/or user applications.
207 	 */
208 	for (i = IEEE80211_MODE_11A; i < IEEE80211_MODE_MAX; i++) {
209 		const struct ieee80211_rateset *rs = &ic->ic_sup_rates[i];
210 
211 		vap->iv_txparms[i].ucastrate = IEEE80211_FIXED_RATE_NONE;
212 
213 		/*
214 		 * Setting the management rate to MCS 0 assumes that the
215 		 * BSS Basic rate set is empty and the BSS Basic MCS set
216 		 * is not.
217 		 *
218 		 * Since we're not checking this, default to the lowest
219 		 * defined rate for this mode.
220 		 *
221 		 * At least one 11n AP (DLINK DIR-825) is reported to drop
222 		 * some MCS management traffic (eg BA response frames.)
223 		 *
224 		 * See also: 9.6.0 of the 802.11n-2009 specification.
225 		 */
226 #ifdef	NOTYET
227 		if (i == IEEE80211_MODE_11NA || i == IEEE80211_MODE_11NG) {
228 			vap->iv_txparms[i].mgmtrate = 0 | IEEE80211_RATE_MCS;
229 			vap->iv_txparms[i].mcastrate = 0 | IEEE80211_RATE_MCS;
230 		} else {
231 			vap->iv_txparms[i].mgmtrate =
232 			    rs->rs_rates[0] & IEEE80211_RATE_VAL;
233 			vap->iv_txparms[i].mcastrate =
234 			    rs->rs_rates[0] & IEEE80211_RATE_VAL;
235 		}
236 #endif
237 		vap->iv_txparms[i].mgmtrate = rs->rs_rates[0] & IEEE80211_RATE_VAL;
238 		vap->iv_txparms[i].mcastrate = rs->rs_rates[0] & IEEE80211_RATE_VAL;
239 		vap->iv_txparms[i].maxretry = IEEE80211_TXMAX_DEFAULT;
240 	}
241 	vap->iv_roaming = IEEE80211_ROAMING_AUTO;
242 
243 	vap->iv_update_beacon = null_update_beacon;
244 	vap->iv_deliver_data = ieee80211_deliver_data;
245 
246 	/* attach support for operating mode */
247 	ic->ic_vattach[vap->iv_opmode](vap);
248 }
249 
250 void
251 ieee80211_proto_vdetach(struct ieee80211vap *vap)
252 {
253 #define	FREEAPPIE(ie) do { \
254 	if (ie != NULL) \
255 		free(ie, M_80211_NODE_IE); \
256 } while (0)
257 	/*
258 	 * Detach operating mode module.
259 	 */
260 	if (vap->iv_opdetach != NULL)
261 		vap->iv_opdetach(vap);
262 	/*
263 	 * This should not be needed as we detach when reseting
264 	 * the state but be conservative here since the
265 	 * authenticator may do things like spawn kernel threads.
266 	 */
267 	if (vap->iv_auth->ia_detach != NULL)
268 		vap->iv_auth->ia_detach(vap);
269 	/*
270 	 * Detach any ACL'ator.
271 	 */
272 	if (vap->iv_acl != NULL)
273 		vap->iv_acl->iac_detach(vap);
274 
275 	FREEAPPIE(vap->iv_appie_beacon);
276 	FREEAPPIE(vap->iv_appie_probereq);
277 	FREEAPPIE(vap->iv_appie_proberesp);
278 	FREEAPPIE(vap->iv_appie_assocreq);
279 	FREEAPPIE(vap->iv_appie_assocresp);
280 	FREEAPPIE(vap->iv_appie_wpa);
281 #undef FREEAPPIE
282 }
283 
284 /*
285  * Simple-minded authenticator module support.
286  */
287 
288 #define	IEEE80211_AUTH_MAX	(IEEE80211_AUTH_WPA+1)
289 /* XXX well-known names */
290 static const char *auth_modnames[IEEE80211_AUTH_MAX] = {
291 	"wlan_internal",	/* IEEE80211_AUTH_NONE */
292 	"wlan_internal",	/* IEEE80211_AUTH_OPEN */
293 	"wlan_internal",	/* IEEE80211_AUTH_SHARED */
294 	"wlan_xauth",		/* IEEE80211_AUTH_8021X	 */
295 	"wlan_internal",	/* IEEE80211_AUTH_AUTO */
296 	"wlan_xauth",		/* IEEE80211_AUTH_WPA */
297 };
298 static const struct ieee80211_authenticator *authenticators[IEEE80211_AUTH_MAX];
299 
300 static const struct ieee80211_authenticator auth_internal = {
301 	.ia_name		= "wlan_internal",
302 	.ia_attach		= NULL,
303 	.ia_detach		= NULL,
304 	.ia_node_join		= NULL,
305 	.ia_node_leave		= NULL,
306 };
307 
308 /*
309  * Setup internal authenticators once; they are never unregistered.
310  */
311 static void
312 ieee80211_auth_setup(void)
313 {
314 	ieee80211_authenticator_register(IEEE80211_AUTH_OPEN, &auth_internal);
315 	ieee80211_authenticator_register(IEEE80211_AUTH_SHARED, &auth_internal);
316 	ieee80211_authenticator_register(IEEE80211_AUTH_AUTO, &auth_internal);
317 }
318 SYSINIT(wlan_auth, SI_SUB_DRIVERS, SI_ORDER_FIRST, ieee80211_auth_setup, NULL);
319 
320 const struct ieee80211_authenticator *
321 ieee80211_authenticator_get(int auth)
322 {
323 	if (auth >= IEEE80211_AUTH_MAX)
324 		return NULL;
325 	if (authenticators[auth] == NULL)
326 		ieee80211_load_module(auth_modnames[auth]);
327 	return authenticators[auth];
328 }
329 
330 void
331 ieee80211_authenticator_register(int type,
332 	const struct ieee80211_authenticator *auth)
333 {
334 	if (type >= IEEE80211_AUTH_MAX)
335 		return;
336 	authenticators[type] = auth;
337 }
338 
339 void
340 ieee80211_authenticator_unregister(int type)
341 {
342 
343 	if (type >= IEEE80211_AUTH_MAX)
344 		return;
345 	authenticators[type] = NULL;
346 }
347 
348 /*
349  * Very simple-minded ACL module support.
350  */
351 /* XXX just one for now */
352 static	const struct ieee80211_aclator *acl = NULL;
353 
354 void
355 ieee80211_aclator_register(const struct ieee80211_aclator *iac)
356 {
357 	printf("wlan: %s acl policy registered\n", iac->iac_name);
358 	acl = iac;
359 }
360 
361 void
362 ieee80211_aclator_unregister(const struct ieee80211_aclator *iac)
363 {
364 	if (acl == iac)
365 		acl = NULL;
366 	printf("wlan: %s acl policy unregistered\n", iac->iac_name);
367 }
368 
369 const struct ieee80211_aclator *
370 ieee80211_aclator_get(const char *name)
371 {
372 	if (acl == NULL)
373 		ieee80211_load_module("wlan_acl");
374 	return acl != NULL && strcmp(acl->iac_name, name) == 0 ? acl : NULL;
375 }
376 
377 void
378 ieee80211_print_essid(const uint8_t *essid, int len)
379 {
380 	const uint8_t *p;
381 	int i;
382 
383 	if (len > IEEE80211_NWID_LEN)
384 		len = IEEE80211_NWID_LEN;
385 	/* determine printable or not */
386 	for (i = 0, p = essid; i < len; i++, p++) {
387 		if (*p < ' ' || *p > 0x7e)
388 			break;
389 	}
390 	if (i == len) {
391 		printf("\"");
392 		for (i = 0, p = essid; i < len; i++, p++)
393 			printf("%c", *p);
394 		printf("\"");
395 	} else {
396 		printf("0x");
397 		for (i = 0, p = essid; i < len; i++, p++)
398 			printf("%02x", *p);
399 	}
400 }
401 
402 void
403 ieee80211_dump_pkt(struct ieee80211com *ic,
404 	const uint8_t *buf, int len, int rate, int rssi)
405 {
406 	const struct ieee80211_frame *wh;
407 	int i;
408 
409 	wh = (const struct ieee80211_frame *)buf;
410 	switch (wh->i_fc[1] & IEEE80211_FC1_DIR_MASK) {
411 	case IEEE80211_FC1_DIR_NODS:
412 		printf("NODS %s", ether_sprintf(wh->i_addr2));
413 		printf("->%s", ether_sprintf(wh->i_addr1));
414 		printf("(%s)", ether_sprintf(wh->i_addr3));
415 		break;
416 	case IEEE80211_FC1_DIR_TODS:
417 		printf("TODS %s", ether_sprintf(wh->i_addr2));
418 		printf("->%s", ether_sprintf(wh->i_addr3));
419 		printf("(%s)", ether_sprintf(wh->i_addr1));
420 		break;
421 	case IEEE80211_FC1_DIR_FROMDS:
422 		printf("FRDS %s", ether_sprintf(wh->i_addr3));
423 		printf("->%s", ether_sprintf(wh->i_addr1));
424 		printf("(%s)", ether_sprintf(wh->i_addr2));
425 		break;
426 	case IEEE80211_FC1_DIR_DSTODS:
427 		printf("DSDS %s", ether_sprintf((const uint8_t *)&wh[1]));
428 		printf("->%s", ether_sprintf(wh->i_addr3));
429 		printf("(%s", ether_sprintf(wh->i_addr2));
430 		printf("->%s)", ether_sprintf(wh->i_addr1));
431 		break;
432 	}
433 	switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) {
434 	case IEEE80211_FC0_TYPE_DATA:
435 		printf(" data");
436 		break;
437 	case IEEE80211_FC0_TYPE_MGT:
438 		printf(" %s", ieee80211_mgt_subtype_name[
439 		    (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK)
440 		    >> IEEE80211_FC0_SUBTYPE_SHIFT]);
441 		break;
442 	default:
443 		printf(" type#%d", wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK);
444 		break;
445 	}
446 	if (IEEE80211_QOS_HAS_SEQ(wh)) {
447 		const struct ieee80211_qosframe *qwh =
448 			(const struct ieee80211_qosframe *)buf;
449 		printf(" QoS [TID %u%s]", qwh->i_qos[0] & IEEE80211_QOS_TID,
450 			qwh->i_qos[0] & IEEE80211_QOS_ACKPOLICY ? " ACM" : "");
451 	}
452 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
453 		int off;
454 
455 		off = ieee80211_anyhdrspace(ic, wh);
456 		printf(" WEP [IV %.02x %.02x %.02x",
457 			buf[off+0], buf[off+1], buf[off+2]);
458 		if (buf[off+IEEE80211_WEP_IVLEN] & IEEE80211_WEP_EXTIV)
459 			printf(" %.02x %.02x %.02x",
460 				buf[off+4], buf[off+5], buf[off+6]);
461 		printf(" KID %u]", buf[off+IEEE80211_WEP_IVLEN] >> 6);
462 	}
463 	if (rate >= 0)
464 		printf(" %dM", rate / 2);
465 	if (rssi >= 0)
466 		printf(" +%d", rssi);
467 	printf("\n");
468 	if (len > 0) {
469 		for (i = 0; i < len; i++) {
470 			if ((i & 1) == 0)
471 				printf(" ");
472 			printf("%02x", buf[i]);
473 		}
474 		printf("\n");
475 	}
476 }
477 
478 static __inline int
479 findrix(const struct ieee80211_rateset *rs, int r)
480 {
481 	int i;
482 
483 	for (i = 0; i < rs->rs_nrates; i++)
484 		if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == r)
485 			return i;
486 	return -1;
487 }
488 
489 int
490 ieee80211_fix_rate(struct ieee80211_node *ni,
491 	struct ieee80211_rateset *nrs, int flags)
492 {
493 #define	RV(v)	((v) & IEEE80211_RATE_VAL)
494 	struct ieee80211vap *vap = ni->ni_vap;
495 	struct ieee80211com *ic = ni->ni_ic;
496 	int i, j, rix, error;
497 	int okrate, badrate, fixedrate, ucastrate;
498 	const struct ieee80211_rateset *srs;
499 	uint8_t r;
500 
501 	error = 0;
502 	okrate = badrate = 0;
503 	ucastrate = vap->iv_txparms[ieee80211_chan2mode(ni->ni_chan)].ucastrate;
504 	if (ucastrate != IEEE80211_FIXED_RATE_NONE) {
505 		/*
506 		 * Workaround awkwardness with fixed rate.  We are called
507 		 * to check both the legacy rate set and the HT rate set
508 		 * but we must apply any legacy fixed rate check only to the
509 		 * legacy rate set and vice versa.  We cannot tell what type
510 		 * of rate set we've been given (legacy or HT) but we can
511 		 * distinguish the fixed rate type (MCS have 0x80 set).
512 		 * So to deal with this the caller communicates whether to
513 		 * check MCS or legacy rate using the flags and we use the
514 		 * type of any fixed rate to avoid applying an MCS to a
515 		 * legacy rate and vice versa.
516 		 */
517 		if (ucastrate & 0x80) {
518 			if (flags & IEEE80211_F_DOFRATE)
519 				flags &= ~IEEE80211_F_DOFRATE;
520 		} else if ((ucastrate & 0x80) == 0) {
521 			if (flags & IEEE80211_F_DOFMCS)
522 				flags &= ~IEEE80211_F_DOFMCS;
523 		}
524 		/* NB: required to make MCS match below work */
525 		ucastrate &= IEEE80211_RATE_VAL;
526 	}
527 	fixedrate = IEEE80211_FIXED_RATE_NONE;
528 	/*
529 	 * XXX we are called to process both MCS and legacy rates;
530 	 * we must use the appropriate basic rate set or chaos will
531 	 * ensue; for now callers that want MCS must supply
532 	 * IEEE80211_F_DOBRS; at some point we'll need to split this
533 	 * function so there are two variants, one for MCS and one
534 	 * for legacy rates.
535 	 */
536 	if (flags & IEEE80211_F_DOBRS)
537 		srs = (const struct ieee80211_rateset *)
538 		    ieee80211_get_suphtrates(ic, ni->ni_chan);
539 	else
540 		srs = ieee80211_get_suprates(ic, ni->ni_chan);
541 	for (i = 0; i < nrs->rs_nrates; ) {
542 		if (flags & IEEE80211_F_DOSORT) {
543 			/*
544 			 * Sort rates.
545 			 */
546 			for (j = i + 1; j < nrs->rs_nrates; j++) {
547 				if (RV(nrs->rs_rates[i]) > RV(nrs->rs_rates[j])) {
548 					r = nrs->rs_rates[i];
549 					nrs->rs_rates[i] = nrs->rs_rates[j];
550 					nrs->rs_rates[j] = r;
551 				}
552 			}
553 		}
554 		r = nrs->rs_rates[i] & IEEE80211_RATE_VAL;
555 		badrate = r;
556 		/*
557 		 * Check for fixed rate.
558 		 */
559 		if (r == ucastrate)
560 			fixedrate = r;
561 		/*
562 		 * Check against supported rates.
563 		 */
564 		rix = findrix(srs, r);
565 		if (flags & IEEE80211_F_DONEGO) {
566 			if (rix < 0) {
567 				/*
568 				 * A rate in the node's rate set is not
569 				 * supported.  If this is a basic rate and we
570 				 * are operating as a STA then this is an error.
571 				 * Otherwise we just discard/ignore the rate.
572 				 */
573 				if ((flags & IEEE80211_F_JOIN) &&
574 				    (nrs->rs_rates[i] & IEEE80211_RATE_BASIC))
575 					error++;
576 			} else if ((flags & IEEE80211_F_JOIN) == 0) {
577 				/*
578 				 * Overwrite with the supported rate
579 				 * value so any basic rate bit is set.
580 				 */
581 				nrs->rs_rates[i] = srs->rs_rates[rix];
582 			}
583 		}
584 		if ((flags & IEEE80211_F_DODEL) && rix < 0) {
585 			/*
586 			 * Delete unacceptable rates.
587 			 */
588 			nrs->rs_nrates--;
589 			for (j = i; j < nrs->rs_nrates; j++)
590 				nrs->rs_rates[j] = nrs->rs_rates[j + 1];
591 			nrs->rs_rates[j] = 0;
592 			continue;
593 		}
594 		if (rix >= 0)
595 			okrate = nrs->rs_rates[i];
596 		i++;
597 	}
598 	if (okrate == 0 || error != 0 ||
599 	    ((flags & (IEEE80211_F_DOFRATE|IEEE80211_F_DOFMCS)) &&
600 	     fixedrate != ucastrate)) {
601 		IEEE80211_NOTE(vap, IEEE80211_MSG_XRATE | IEEE80211_MSG_11N, ni,
602 		    "%s: flags 0x%x okrate %d error %d fixedrate 0x%x "
603 		    "ucastrate %x\n", __func__, fixedrate, ucastrate, flags);
604 		return badrate | IEEE80211_RATE_BASIC;
605 	} else
606 		return RV(okrate);
607 #undef RV
608 }
609 
610 /*
611  * Reset 11g-related state.
612  */
613 void
614 ieee80211_reset_erp(struct ieee80211com *ic)
615 {
616 	ic->ic_flags &= ~IEEE80211_F_USEPROT;
617 	ic->ic_nonerpsta = 0;
618 	ic->ic_longslotsta = 0;
619 	/*
620 	 * Short slot time is enabled only when operating in 11g
621 	 * and not in an IBSS.  We must also honor whether or not
622 	 * the driver is capable of doing it.
623 	 */
624 	ieee80211_set_shortslottime(ic,
625 		IEEE80211_IS_CHAN_A(ic->ic_curchan) ||
626 		IEEE80211_IS_CHAN_HT(ic->ic_curchan) ||
627 		(IEEE80211_IS_CHAN_ANYG(ic->ic_curchan) &&
628 		ic->ic_opmode == IEEE80211_M_HOSTAP &&
629 		(ic->ic_caps & IEEE80211_C_SHSLOT)));
630 	/*
631 	 * Set short preamble and ERP barker-preamble flags.
632 	 */
633 	if (IEEE80211_IS_CHAN_A(ic->ic_curchan) ||
634 	    (ic->ic_caps & IEEE80211_C_SHPREAMBLE)) {
635 		ic->ic_flags |= IEEE80211_F_SHPREAMBLE;
636 		ic->ic_flags &= ~IEEE80211_F_USEBARKER;
637 	} else {
638 		ic->ic_flags &= ~IEEE80211_F_SHPREAMBLE;
639 		ic->ic_flags |= IEEE80211_F_USEBARKER;
640 	}
641 }
642 
643 /*
644  * Set the short slot time state and notify the driver.
645  */
646 void
647 ieee80211_set_shortslottime(struct ieee80211com *ic, int onoff)
648 {
649 	if (onoff)
650 		ic->ic_flags |= IEEE80211_F_SHSLOT;
651 	else
652 		ic->ic_flags &= ~IEEE80211_F_SHSLOT;
653 	/* notify driver */
654 	if (ic->ic_updateslot != NULL)
655 		ic->ic_updateslot(ic->ic_ifp);
656 }
657 
658 /*
659  * Check if the specified rate set supports ERP.
660  * NB: the rate set is assumed to be sorted.
661  */
662 int
663 ieee80211_iserp_rateset(const struct ieee80211_rateset *rs)
664 {
665 #define N(a)	(sizeof(a) / sizeof(a[0]))
666 	static const int rates[] = { 2, 4, 11, 22, 12, 24, 48 };
667 	int i, j;
668 
669 	if (rs->rs_nrates < N(rates))
670 		return 0;
671 	for (i = 0; i < N(rates); i++) {
672 		for (j = 0; j < rs->rs_nrates; j++) {
673 			int r = rs->rs_rates[j] & IEEE80211_RATE_VAL;
674 			if (rates[i] == r)
675 				goto next;
676 			if (r > rates[i])
677 				return 0;
678 		}
679 		return 0;
680 	next:
681 		;
682 	}
683 	return 1;
684 #undef N
685 }
686 
687 /*
688  * Mark the basic rates for the rate table based on the
689  * operating mode.  For real 11g we mark all the 11b rates
690  * and 6, 12, and 24 OFDM.  For 11b compatibility we mark only
691  * 11b rates.  There's also a pseudo 11a-mode used to mark only
692  * the basic OFDM rates.
693  */
694 static void
695 setbasicrates(struct ieee80211_rateset *rs,
696     enum ieee80211_phymode mode, int add)
697 {
698 	static const struct ieee80211_rateset basic[IEEE80211_MODE_MAX] = {
699 	    [IEEE80211_MODE_11A]	= { 3, { 12, 24, 48 } },
700 	    [IEEE80211_MODE_11B]	= { 2, { 2, 4 } },
701 					    /* NB: mixed b/g */
702 	    [IEEE80211_MODE_11G]	= { 4, { 2, 4, 11, 22 } },
703 	    [IEEE80211_MODE_TURBO_A]	= { 3, { 12, 24, 48 } },
704 	    [IEEE80211_MODE_TURBO_G]	= { 4, { 2, 4, 11, 22 } },
705 	    [IEEE80211_MODE_STURBO_A]	= { 3, { 12, 24, 48 } },
706 	    [IEEE80211_MODE_HALF]	= { 3, { 6, 12, 24 } },
707 	    [IEEE80211_MODE_QUARTER]	= { 3, { 3, 6, 12 } },
708 	    [IEEE80211_MODE_11NA]	= { 3, { 12, 24, 48 } },
709 					    /* NB: mixed b/g */
710 	    [IEEE80211_MODE_11NG]	= { 4, { 2, 4, 11, 22 } },
711 	};
712 	int i, j;
713 
714 	for (i = 0; i < rs->rs_nrates; i++) {
715 		if (!add)
716 			rs->rs_rates[i] &= IEEE80211_RATE_VAL;
717 		for (j = 0; j < basic[mode].rs_nrates; j++)
718 			if (basic[mode].rs_rates[j] == rs->rs_rates[i]) {
719 				rs->rs_rates[i] |= IEEE80211_RATE_BASIC;
720 				break;
721 			}
722 	}
723 }
724 
725 /*
726  * Set the basic rates in a rate set.
727  */
728 void
729 ieee80211_setbasicrates(struct ieee80211_rateset *rs,
730     enum ieee80211_phymode mode)
731 {
732 	setbasicrates(rs, mode, 0);
733 }
734 
735 /*
736  * Add basic rates to a rate set.
737  */
738 void
739 ieee80211_addbasicrates(struct ieee80211_rateset *rs,
740     enum ieee80211_phymode mode)
741 {
742 	setbasicrates(rs, mode, 1);
743 }
744 
745 /*
746  * WME protocol support.
747  *
748  * The default 11a/b/g/n parameters come from the WiFi Alliance WMM
749  * System Interopability Test Plan (v1.4, Appendix F) and the 802.11n
750  * Draft 2.0 Test Plan (Appendix D).
751  *
752  * Static/Dynamic Turbo mode settings come from Atheros.
753  */
754 typedef struct phyParamType {
755 	uint8_t		aifsn;
756 	uint8_t		logcwmin;
757 	uint8_t		logcwmax;
758 	uint16_t	txopLimit;
759 	uint8_t 	acm;
760 } paramType;
761 
762 static const struct phyParamType phyParamForAC_BE[IEEE80211_MODE_MAX] = {
763 	[IEEE80211_MODE_AUTO]	= { 3, 4,  6,  0, 0 },
764 	[IEEE80211_MODE_11A]	= { 3, 4,  6,  0, 0 },
765 	[IEEE80211_MODE_11B]	= { 3, 4,  6,  0, 0 },
766 	[IEEE80211_MODE_11G]	= { 3, 4,  6,  0, 0 },
767 	[IEEE80211_MODE_FH]	= { 3, 4,  6,  0, 0 },
768 	[IEEE80211_MODE_TURBO_A]= { 2, 3,  5,  0, 0 },
769 	[IEEE80211_MODE_TURBO_G]= { 2, 3,  5,  0, 0 },
770 	[IEEE80211_MODE_STURBO_A]={ 2, 3,  5,  0, 0 },
771 	[IEEE80211_MODE_HALF]	= { 3, 4,  6,  0, 0 },
772 	[IEEE80211_MODE_QUARTER]= { 3, 4,  6,  0, 0 },
773 	[IEEE80211_MODE_11NA]	= { 3, 4,  6,  0, 0 },
774 	[IEEE80211_MODE_11NG]	= { 3, 4,  6,  0, 0 },
775 };
776 static const struct phyParamType phyParamForAC_BK[IEEE80211_MODE_MAX] = {
777 	[IEEE80211_MODE_AUTO]	= { 7, 4, 10,  0, 0 },
778 	[IEEE80211_MODE_11A]	= { 7, 4, 10,  0, 0 },
779 	[IEEE80211_MODE_11B]	= { 7, 4, 10,  0, 0 },
780 	[IEEE80211_MODE_11G]	= { 7, 4, 10,  0, 0 },
781 	[IEEE80211_MODE_FH]	= { 7, 4, 10,  0, 0 },
782 	[IEEE80211_MODE_TURBO_A]= { 7, 3, 10,  0, 0 },
783 	[IEEE80211_MODE_TURBO_G]= { 7, 3, 10,  0, 0 },
784 	[IEEE80211_MODE_STURBO_A]={ 7, 3, 10,  0, 0 },
785 	[IEEE80211_MODE_HALF]	= { 7, 4, 10,  0, 0 },
786 	[IEEE80211_MODE_QUARTER]= { 7, 4, 10,  0, 0 },
787 	[IEEE80211_MODE_11NA]	= { 7, 4, 10,  0, 0 },
788 	[IEEE80211_MODE_11NG]	= { 7, 4, 10,  0, 0 },
789 };
790 static const struct phyParamType phyParamForAC_VI[IEEE80211_MODE_MAX] = {
791 	[IEEE80211_MODE_AUTO]	= { 1, 3, 4,  94, 0 },
792 	[IEEE80211_MODE_11A]	= { 1, 3, 4,  94, 0 },
793 	[IEEE80211_MODE_11B]	= { 1, 3, 4, 188, 0 },
794 	[IEEE80211_MODE_11G]	= { 1, 3, 4,  94, 0 },
795 	[IEEE80211_MODE_FH]	= { 1, 3, 4, 188, 0 },
796 	[IEEE80211_MODE_TURBO_A]= { 1, 2, 3,  94, 0 },
797 	[IEEE80211_MODE_TURBO_G]= { 1, 2, 3,  94, 0 },
798 	[IEEE80211_MODE_STURBO_A]={ 1, 2, 3,  94, 0 },
799 	[IEEE80211_MODE_HALF]	= { 1, 3, 4,  94, 0 },
800 	[IEEE80211_MODE_QUARTER]= { 1, 3, 4,  94, 0 },
801 	[IEEE80211_MODE_11NA]	= { 1, 3, 4,  94, 0 },
802 	[IEEE80211_MODE_11NG]	= { 1, 3, 4,  94, 0 },
803 };
804 static const struct phyParamType phyParamForAC_VO[IEEE80211_MODE_MAX] = {
805 	[IEEE80211_MODE_AUTO]	= { 1, 2, 3,  47, 0 },
806 	[IEEE80211_MODE_11A]	= { 1, 2, 3,  47, 0 },
807 	[IEEE80211_MODE_11B]	= { 1, 2, 3, 102, 0 },
808 	[IEEE80211_MODE_11G]	= { 1, 2, 3,  47, 0 },
809 	[IEEE80211_MODE_FH]	= { 1, 2, 3, 102, 0 },
810 	[IEEE80211_MODE_TURBO_A]= { 1, 2, 2,  47, 0 },
811 	[IEEE80211_MODE_TURBO_G]= { 1, 2, 2,  47, 0 },
812 	[IEEE80211_MODE_STURBO_A]={ 1, 2, 2,  47, 0 },
813 	[IEEE80211_MODE_HALF]	= { 1, 2, 3,  47, 0 },
814 	[IEEE80211_MODE_QUARTER]= { 1, 2, 3,  47, 0 },
815 	[IEEE80211_MODE_11NA]	= { 1, 2, 3,  47, 0 },
816 	[IEEE80211_MODE_11NG]	= { 1, 2, 3,  47, 0 },
817 };
818 
819 static const struct phyParamType bssPhyParamForAC_BE[IEEE80211_MODE_MAX] = {
820 	[IEEE80211_MODE_AUTO]	= { 3, 4, 10,  0, 0 },
821 	[IEEE80211_MODE_11A]	= { 3, 4, 10,  0, 0 },
822 	[IEEE80211_MODE_11B]	= { 3, 4, 10,  0, 0 },
823 	[IEEE80211_MODE_11G]	= { 3, 4, 10,  0, 0 },
824 	[IEEE80211_MODE_FH]	= { 3, 4, 10,  0, 0 },
825 	[IEEE80211_MODE_TURBO_A]= { 2, 3, 10,  0, 0 },
826 	[IEEE80211_MODE_TURBO_G]= { 2, 3, 10,  0, 0 },
827 	[IEEE80211_MODE_STURBO_A]={ 2, 3, 10,  0, 0 },
828 	[IEEE80211_MODE_HALF]	= { 3, 4, 10,  0, 0 },
829 	[IEEE80211_MODE_QUARTER]= { 3, 4, 10,  0, 0 },
830 	[IEEE80211_MODE_11NA]	= { 3, 4, 10,  0, 0 },
831 	[IEEE80211_MODE_11NG]	= { 3, 4, 10,  0, 0 },
832 };
833 static const struct phyParamType bssPhyParamForAC_VI[IEEE80211_MODE_MAX] = {
834 	[IEEE80211_MODE_AUTO]	= { 2, 3, 4,  94, 0 },
835 	[IEEE80211_MODE_11A]	= { 2, 3, 4,  94, 0 },
836 	[IEEE80211_MODE_11B]	= { 2, 3, 4, 188, 0 },
837 	[IEEE80211_MODE_11G]	= { 2, 3, 4,  94, 0 },
838 	[IEEE80211_MODE_FH]	= { 2, 3, 4, 188, 0 },
839 	[IEEE80211_MODE_TURBO_A]= { 2, 2, 3,  94, 0 },
840 	[IEEE80211_MODE_TURBO_G]= { 2, 2, 3,  94, 0 },
841 	[IEEE80211_MODE_STURBO_A]={ 2, 2, 3,  94, 0 },
842 	[IEEE80211_MODE_HALF]	= { 2, 3, 4,  94, 0 },
843 	[IEEE80211_MODE_QUARTER]= { 2, 3, 4,  94, 0 },
844 	[IEEE80211_MODE_11NA]	= { 2, 3, 4,  94, 0 },
845 	[IEEE80211_MODE_11NG]	= { 2, 3, 4,  94, 0 },
846 };
847 static const struct phyParamType bssPhyParamForAC_VO[IEEE80211_MODE_MAX] = {
848 	[IEEE80211_MODE_AUTO]	= { 2, 2, 3,  47, 0 },
849 	[IEEE80211_MODE_11A]	= { 2, 2, 3,  47, 0 },
850 	[IEEE80211_MODE_11B]	= { 2, 2, 3, 102, 0 },
851 	[IEEE80211_MODE_11G]	= { 2, 2, 3,  47, 0 },
852 	[IEEE80211_MODE_FH]	= { 2, 2, 3, 102, 0 },
853 	[IEEE80211_MODE_TURBO_A]= { 1, 2, 2,  47, 0 },
854 	[IEEE80211_MODE_TURBO_G]= { 1, 2, 2,  47, 0 },
855 	[IEEE80211_MODE_STURBO_A]={ 1, 2, 2,  47, 0 },
856 	[IEEE80211_MODE_HALF]	= { 2, 2, 3,  47, 0 },
857 	[IEEE80211_MODE_QUARTER]= { 2, 2, 3,  47, 0 },
858 	[IEEE80211_MODE_11NA]	= { 2, 2, 3,  47, 0 },
859 	[IEEE80211_MODE_11NG]	= { 2, 2, 3,  47, 0 },
860 };
861 
862 static void
863 _setifsparams(struct wmeParams *wmep, const paramType *phy)
864 {
865 	wmep->wmep_aifsn = phy->aifsn;
866 	wmep->wmep_logcwmin = phy->logcwmin;
867 	wmep->wmep_logcwmax = phy->logcwmax;
868 	wmep->wmep_txopLimit = phy->txopLimit;
869 }
870 
871 static void
872 setwmeparams(struct ieee80211vap *vap, const char *type, int ac,
873 	struct wmeParams *wmep, const paramType *phy)
874 {
875 	wmep->wmep_acm = phy->acm;
876 	_setifsparams(wmep, phy);
877 
878 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_WME,
879 	    "set %s (%s) [acm %u aifsn %u logcwmin %u logcwmax %u txop %u]\n",
880 	    ieee80211_wme_acnames[ac], type,
881 	    wmep->wmep_acm, wmep->wmep_aifsn, wmep->wmep_logcwmin,
882 	    wmep->wmep_logcwmax, wmep->wmep_txopLimit);
883 }
884 
885 static void
886 ieee80211_wme_initparams_locked(struct ieee80211vap *vap)
887 {
888 	struct ieee80211com *ic = vap->iv_ic;
889 	struct ieee80211_wme_state *wme = &ic->ic_wme;
890 	const paramType *pPhyParam, *pBssPhyParam;
891 	struct wmeParams *wmep;
892 	enum ieee80211_phymode mode;
893 	int i;
894 
895 	IEEE80211_LOCK_ASSERT(ic);
896 
897 	if ((ic->ic_caps & IEEE80211_C_WME) == 0 || ic->ic_nrunning > 1)
898 		return;
899 
900 	/*
901 	 * Clear the wme cap_info field so a qoscount from a previous
902 	 * vap doesn't confuse later code which only parses the beacon
903 	 * field and updates hardware when said field changes.
904 	 * Otherwise the hardware is programmed with defaults, not what
905 	 * the beacon actually announces.
906 	 */
907 	wme->wme_wmeChanParams.cap_info = 0;
908 
909 	/*
910 	 * Select mode; we can be called early in which case we
911 	 * always use auto mode.  We know we'll be called when
912 	 * entering the RUN state with bsschan setup properly
913 	 * so state will eventually get set correctly
914 	 */
915 	if (ic->ic_bsschan != IEEE80211_CHAN_ANYC)
916 		mode = ieee80211_chan2mode(ic->ic_bsschan);
917 	else
918 		mode = IEEE80211_MODE_AUTO;
919 	for (i = 0; i < WME_NUM_AC; i++) {
920 		switch (i) {
921 		case WME_AC_BK:
922 			pPhyParam = &phyParamForAC_BK[mode];
923 			pBssPhyParam = &phyParamForAC_BK[mode];
924 			break;
925 		case WME_AC_VI:
926 			pPhyParam = &phyParamForAC_VI[mode];
927 			pBssPhyParam = &bssPhyParamForAC_VI[mode];
928 			break;
929 		case WME_AC_VO:
930 			pPhyParam = &phyParamForAC_VO[mode];
931 			pBssPhyParam = &bssPhyParamForAC_VO[mode];
932 			break;
933 		case WME_AC_BE:
934 		default:
935 			pPhyParam = &phyParamForAC_BE[mode];
936 			pBssPhyParam = &bssPhyParamForAC_BE[mode];
937 			break;
938 		}
939 		wmep = &wme->wme_wmeChanParams.cap_wmeParams[i];
940 		if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
941 			setwmeparams(vap, "chan", i, wmep, pPhyParam);
942 		} else {
943 			setwmeparams(vap, "chan", i, wmep, pBssPhyParam);
944 		}
945 		wmep = &wme->wme_wmeBssChanParams.cap_wmeParams[i];
946 		setwmeparams(vap, "bss ", i, wmep, pBssPhyParam);
947 	}
948 	/* NB: check ic_bss to avoid NULL deref on initial attach */
949 	if (vap->iv_bss != NULL) {
950 		/*
951 		 * Calculate agressive mode switching threshold based
952 		 * on beacon interval.  This doesn't need locking since
953 		 * we're only called before entering the RUN state at
954 		 * which point we start sending beacon frames.
955 		 */
956 		wme->wme_hipri_switch_thresh =
957 			(HIGH_PRI_SWITCH_THRESH * vap->iv_bss->ni_intval) / 100;
958 		wme->wme_flags &= ~WME_F_AGGRMODE;
959 		ieee80211_wme_updateparams(vap);
960 	}
961 }
962 
963 void
964 ieee80211_wme_initparams(struct ieee80211vap *vap)
965 {
966 	struct ieee80211com *ic = vap->iv_ic;
967 
968 	IEEE80211_LOCK(ic);
969 	ieee80211_wme_initparams_locked(vap);
970 	IEEE80211_UNLOCK(ic);
971 }
972 
973 /*
974  * Update WME parameters for ourself and the BSS.
975  */
976 void
977 ieee80211_wme_updateparams_locked(struct ieee80211vap *vap)
978 {
979 	static const paramType aggrParam[IEEE80211_MODE_MAX] = {
980 	    [IEEE80211_MODE_AUTO]	= { 2, 4, 10, 64, 0 },
981 	    [IEEE80211_MODE_11A]	= { 2, 4, 10, 64, 0 },
982 	    [IEEE80211_MODE_11B]	= { 2, 5, 10, 64, 0 },
983 	    [IEEE80211_MODE_11G]	= { 2, 4, 10, 64, 0 },
984 	    [IEEE80211_MODE_FH]		= { 2, 5, 10, 64, 0 },
985 	    [IEEE80211_MODE_TURBO_A]	= { 1, 3, 10, 64, 0 },
986 	    [IEEE80211_MODE_TURBO_G]	= { 1, 3, 10, 64, 0 },
987 	    [IEEE80211_MODE_STURBO_A]	= { 1, 3, 10, 64, 0 },
988 	    [IEEE80211_MODE_HALF]	= { 2, 4, 10, 64, 0 },
989 	    [IEEE80211_MODE_QUARTER]	= { 2, 4, 10, 64, 0 },
990 	    [IEEE80211_MODE_11NA]	= { 2, 4, 10, 64, 0 },	/* XXXcheck*/
991 	    [IEEE80211_MODE_11NG]	= { 2, 4, 10, 64, 0 },	/* XXXcheck*/
992 	};
993 	struct ieee80211com *ic = vap->iv_ic;
994 	struct ieee80211_wme_state *wme = &ic->ic_wme;
995 	const struct wmeParams *wmep;
996 	struct wmeParams *chanp, *bssp;
997 	enum ieee80211_phymode mode;
998 	int i;
999 	int do_aggrmode = 0;
1000 
1001        	/*
1002 	 * Set up the channel access parameters for the physical
1003 	 * device.  First populate the configured settings.
1004 	 */
1005 	for (i = 0; i < WME_NUM_AC; i++) {
1006 		chanp = &wme->wme_chanParams.cap_wmeParams[i];
1007 		wmep = &wme->wme_wmeChanParams.cap_wmeParams[i];
1008 		chanp->wmep_aifsn = wmep->wmep_aifsn;
1009 		chanp->wmep_logcwmin = wmep->wmep_logcwmin;
1010 		chanp->wmep_logcwmax = wmep->wmep_logcwmax;
1011 		chanp->wmep_txopLimit = wmep->wmep_txopLimit;
1012 
1013 		chanp = &wme->wme_bssChanParams.cap_wmeParams[i];
1014 		wmep = &wme->wme_wmeBssChanParams.cap_wmeParams[i];
1015 		chanp->wmep_aifsn = wmep->wmep_aifsn;
1016 		chanp->wmep_logcwmin = wmep->wmep_logcwmin;
1017 		chanp->wmep_logcwmax = wmep->wmep_logcwmax;
1018 		chanp->wmep_txopLimit = wmep->wmep_txopLimit;
1019 	}
1020 
1021 	/*
1022 	 * Select mode; we can be called early in which case we
1023 	 * always use auto mode.  We know we'll be called when
1024 	 * entering the RUN state with bsschan setup properly
1025 	 * so state will eventually get set correctly
1026 	 */
1027 	if (ic->ic_bsschan != IEEE80211_CHAN_ANYC)
1028 		mode = ieee80211_chan2mode(ic->ic_bsschan);
1029 	else
1030 		mode = IEEE80211_MODE_AUTO;
1031 
1032 	/*
1033 	 * This implements agressive mode as found in certain
1034 	 * vendors' AP's.  When there is significant high
1035 	 * priority (VI/VO) traffic in the BSS throttle back BE
1036 	 * traffic by using conservative parameters.  Otherwise
1037 	 * BE uses agressive params to optimize performance of
1038 	 * legacy/non-QoS traffic.
1039 	 */
1040 
1041 	/* Hostap? Only if aggressive mode is enabled */
1042         if (vap->iv_opmode == IEEE80211_M_HOSTAP &&
1043 	     (wme->wme_flags & WME_F_AGGRMODE) != 0)
1044 		do_aggrmode = 1;
1045 
1046 	/*
1047 	 * Station? Only if we're in a non-QoS BSS.
1048 	 */
1049 	else if ((vap->iv_opmode == IEEE80211_M_STA &&
1050 	     (vap->iv_bss->ni_flags & IEEE80211_NODE_QOS) == 0))
1051 		do_aggrmode = 1;
1052 
1053 	/*
1054 	 * IBSS? Only if we we have WME enabled.
1055 	 */
1056 	else if ((vap->iv_opmode == IEEE80211_M_IBSS) &&
1057 	    (vap->iv_flags & IEEE80211_F_WME))
1058 		do_aggrmode = 1;
1059 
1060 	/*
1061 	 * If WME is disabled on this VAP, default to aggressive mode
1062 	 * regardless of the configuration.
1063 	 */
1064 	if ((vap->iv_flags & IEEE80211_F_WME) == 0)
1065 		do_aggrmode = 1;
1066 
1067 	/* XXX WDS? */
1068 
1069 	/* XXX MBSS? */
1070 
1071 	if (do_aggrmode) {
1072 		chanp = &wme->wme_chanParams.cap_wmeParams[WME_AC_BE];
1073 		bssp = &wme->wme_bssChanParams.cap_wmeParams[WME_AC_BE];
1074 
1075 		chanp->wmep_aifsn = bssp->wmep_aifsn = aggrParam[mode].aifsn;
1076 		chanp->wmep_logcwmin = bssp->wmep_logcwmin =
1077 		    aggrParam[mode].logcwmin;
1078 		chanp->wmep_logcwmax = bssp->wmep_logcwmax =
1079 		    aggrParam[mode].logcwmax;
1080 		chanp->wmep_txopLimit = bssp->wmep_txopLimit =
1081 		    (vap->iv_flags & IEEE80211_F_BURST) ?
1082 			aggrParam[mode].txopLimit : 0;
1083 		IEEE80211_DPRINTF(vap, IEEE80211_MSG_WME,
1084 		    "update %s (chan+bss) [acm %u aifsn %u logcwmin %u "
1085 		    "logcwmax %u txop %u]\n", ieee80211_wme_acnames[WME_AC_BE],
1086 		    chanp->wmep_acm, chanp->wmep_aifsn, chanp->wmep_logcwmin,
1087 		    chanp->wmep_logcwmax, chanp->wmep_txopLimit);
1088 	}
1089 
1090 
1091 	/*
1092 	 * Change the contention window based on the number of associated
1093 	 * stations.  If the number of associated stations is 1 and
1094 	 * aggressive mode is enabled, lower the contention window even
1095 	 * further.
1096 	 */
1097 	if (vap->iv_opmode == IEEE80211_M_HOSTAP &&
1098 	    ic->ic_sta_assoc < 2 && (wme->wme_flags & WME_F_AGGRMODE) != 0) {
1099 		static const uint8_t logCwMin[IEEE80211_MODE_MAX] = {
1100 		    [IEEE80211_MODE_AUTO]	= 3,
1101 		    [IEEE80211_MODE_11A]	= 3,
1102 		    [IEEE80211_MODE_11B]	= 4,
1103 		    [IEEE80211_MODE_11G]	= 3,
1104 		    [IEEE80211_MODE_FH]		= 4,
1105 		    [IEEE80211_MODE_TURBO_A]	= 3,
1106 		    [IEEE80211_MODE_TURBO_G]	= 3,
1107 		    [IEEE80211_MODE_STURBO_A]	= 3,
1108 		    [IEEE80211_MODE_HALF]	= 3,
1109 		    [IEEE80211_MODE_QUARTER]	= 3,
1110 		    [IEEE80211_MODE_11NA]	= 3,
1111 		    [IEEE80211_MODE_11NG]	= 3,
1112 		};
1113 		chanp = &wme->wme_chanParams.cap_wmeParams[WME_AC_BE];
1114 		bssp = &wme->wme_bssChanParams.cap_wmeParams[WME_AC_BE];
1115 
1116 		chanp->wmep_logcwmin = bssp->wmep_logcwmin = logCwMin[mode];
1117 		IEEE80211_DPRINTF(vap, IEEE80211_MSG_WME,
1118 		    "update %s (chan+bss) logcwmin %u\n",
1119 		    ieee80211_wme_acnames[WME_AC_BE], chanp->wmep_logcwmin);
1120 	}
1121 
1122 	/*
1123 	 * Arrange for the beacon update.
1124 	 *
1125 	 * XXX what about MBSS, WDS?
1126 	 */
1127 	if (vap->iv_opmode == IEEE80211_M_HOSTAP
1128 	    || vap->iv_opmode == IEEE80211_M_IBSS) {
1129 		/*
1130 		 * Arrange for a beacon update and bump the parameter
1131 		 * set number so associated stations load the new values.
1132 		 */
1133 		wme->wme_bssChanParams.cap_info =
1134 			(wme->wme_bssChanParams.cap_info+1) & WME_QOSINFO_COUNT;
1135 		ieee80211_beacon_notify(vap, IEEE80211_BEACON_WME);
1136 	}
1137 
1138 	wme->wme_update(ic);
1139 
1140 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_WME,
1141 	    "%s: WME params updated, cap_info 0x%x\n", __func__,
1142 	    vap->iv_opmode == IEEE80211_M_STA ?
1143 		wme->wme_wmeChanParams.cap_info :
1144 		wme->wme_bssChanParams.cap_info);
1145 }
1146 
1147 void
1148 ieee80211_wme_updateparams(struct ieee80211vap *vap)
1149 {
1150 	struct ieee80211com *ic = vap->iv_ic;
1151 
1152 	if (ic->ic_caps & IEEE80211_C_WME) {
1153 		IEEE80211_LOCK(ic);
1154 		ieee80211_wme_updateparams_locked(vap);
1155 		IEEE80211_UNLOCK(ic);
1156 	}
1157 }
1158 
1159 static void
1160 parent_updown(void *arg, int npending)
1161 {
1162 	struct ifnet *parent = arg;
1163 
1164 	parent->if_ioctl(parent, SIOCSIFFLAGS, NULL);
1165 }
1166 
1167 static void
1168 update_mcast(void *arg, int npending)
1169 {
1170 	struct ieee80211com *ic = arg;
1171 	struct ifnet *parent = ic->ic_ifp;
1172 
1173 	ic->ic_update_mcast(parent);
1174 }
1175 
1176 static void
1177 update_promisc(void *arg, int npending)
1178 {
1179 	struct ieee80211com *ic = arg;
1180 	struct ifnet *parent = ic->ic_ifp;
1181 
1182 	ic->ic_update_promisc(parent);
1183 }
1184 
1185 static void
1186 update_channel(void *arg, int npending)
1187 {
1188 	struct ieee80211com *ic = arg;
1189 
1190 	ic->ic_set_channel(ic);
1191 	ieee80211_radiotap_chan_change(ic);
1192 }
1193 
1194 static void
1195 update_chw(void *arg, int npending)
1196 {
1197 	struct ieee80211com *ic = arg;
1198 
1199 	/*
1200 	 * XXX should we defer the channel width _config_ update until now?
1201 	 */
1202 	ic->ic_update_chw(ic);
1203 }
1204 
1205 /*
1206  * Block until the parent is in a known state.  This is
1207  * used after any operations that dispatch a task (e.g.
1208  * to auto-configure the parent device up/down).
1209  */
1210 void
1211 ieee80211_waitfor_parent(struct ieee80211com *ic)
1212 {
1213 	taskqueue_block(ic->ic_tq);
1214 	ieee80211_draintask(ic, &ic->ic_parent_task);
1215 	ieee80211_draintask(ic, &ic->ic_mcast_task);
1216 	ieee80211_draintask(ic, &ic->ic_promisc_task);
1217 	ieee80211_draintask(ic, &ic->ic_chan_task);
1218 	ieee80211_draintask(ic, &ic->ic_bmiss_task);
1219 	ieee80211_draintask(ic, &ic->ic_chw_task);
1220 	taskqueue_unblock(ic->ic_tq);
1221 }
1222 
1223 /*
1224  * Start a vap running.  If this is the first vap to be
1225  * set running on the underlying device then we
1226  * automatically bring the device up.
1227  */
1228 void
1229 ieee80211_start_locked(struct ieee80211vap *vap)
1230 {
1231 	struct ifnet *ifp = vap->iv_ifp;
1232 	struct ieee80211com *ic = vap->iv_ic;
1233 	struct ifnet *parent = ic->ic_ifp;
1234 
1235 	IEEE80211_LOCK_ASSERT(ic);
1236 
1237 	IEEE80211_DPRINTF(vap,
1238 		IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG,
1239 		"start running, %d vaps running\n", ic->ic_nrunning);
1240 
1241 	if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) {
1242 		/*
1243 		 * Mark us running.  Note that it's ok to do this first;
1244 		 * if we need to bring the parent device up we defer that
1245 		 * to avoid dropping the com lock.  We expect the device
1246 		 * to respond to being marked up by calling back into us
1247 		 * through ieee80211_start_all at which point we'll come
1248 		 * back in here and complete the work.
1249 		 */
1250 		ifp->if_drv_flags |= IFF_DRV_RUNNING;
1251 		/*
1252 		 * We are not running; if this we are the first vap
1253 		 * to be brought up auto-up the parent if necessary.
1254 		 */
1255 		if (ic->ic_nrunning++ == 0 &&
1256 		    (parent->if_drv_flags & IFF_DRV_RUNNING) == 0) {
1257 			IEEE80211_DPRINTF(vap,
1258 			    IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG,
1259 			    "%s: up parent %s\n", __func__, parent->if_xname);
1260 			parent->if_flags |= IFF_UP;
1261 			ieee80211_runtask(ic, &ic->ic_parent_task);
1262 			return;
1263 		}
1264 	}
1265 	/*
1266 	 * If the parent is up and running, then kick the
1267 	 * 802.11 state machine as appropriate.
1268 	 */
1269 	if ((parent->if_drv_flags & IFF_DRV_RUNNING) &&
1270 	    vap->iv_roaming != IEEE80211_ROAMING_MANUAL) {
1271 		if (vap->iv_opmode == IEEE80211_M_STA) {
1272 #if 0
1273 			/* XXX bypasses scan too easily; disable for now */
1274 			/*
1275 			 * Try to be intelligent about clocking the state
1276 			 * machine.  If we're currently in RUN state then
1277 			 * we should be able to apply any new state/parameters
1278 			 * simply by re-associating.  Otherwise we need to
1279 			 * re-scan to select an appropriate ap.
1280 			 */
1281 			if (vap->iv_state >= IEEE80211_S_RUN)
1282 				ieee80211_new_state_locked(vap,
1283 				    IEEE80211_S_ASSOC, 1);
1284 			else
1285 #endif
1286 				ieee80211_new_state_locked(vap,
1287 				    IEEE80211_S_SCAN, 0);
1288 		} else {
1289 			/*
1290 			 * For monitor+wds mode there's nothing to do but
1291 			 * start running.  Otherwise if this is the first
1292 			 * vap to be brought up, start a scan which may be
1293 			 * preempted if the station is locked to a particular
1294 			 * channel.
1295 			 */
1296 			vap->iv_flags_ext |= IEEE80211_FEXT_REINIT;
1297 			if (vap->iv_opmode == IEEE80211_M_MONITOR ||
1298 			    vap->iv_opmode == IEEE80211_M_WDS)
1299 				ieee80211_new_state_locked(vap,
1300 				    IEEE80211_S_RUN, -1);
1301 			else
1302 				ieee80211_new_state_locked(vap,
1303 				    IEEE80211_S_SCAN, 0);
1304 		}
1305 	}
1306 }
1307 
1308 /*
1309  * Start a single vap.
1310  */
1311 void
1312 ieee80211_init(void *arg)
1313 {
1314 	struct ieee80211vap *vap = arg;
1315 
1316 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG,
1317 	    "%s\n", __func__);
1318 
1319 	IEEE80211_LOCK(vap->iv_ic);
1320 	ieee80211_start_locked(vap);
1321 	IEEE80211_UNLOCK(vap->iv_ic);
1322 }
1323 
1324 /*
1325  * Start all runnable vap's on a device.
1326  */
1327 void
1328 ieee80211_start_all(struct ieee80211com *ic)
1329 {
1330 	struct ieee80211vap *vap;
1331 
1332 	IEEE80211_LOCK(ic);
1333 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1334 		struct ifnet *ifp = vap->iv_ifp;
1335 		if (IFNET_IS_UP_RUNNING(ifp))	/* NB: avoid recursion */
1336 			ieee80211_start_locked(vap);
1337 	}
1338 	IEEE80211_UNLOCK(ic);
1339 }
1340 
1341 /*
1342  * Stop a vap.  We force it down using the state machine
1343  * then mark it's ifnet not running.  If this is the last
1344  * vap running on the underlying device then we close it
1345  * too to insure it will be properly initialized when the
1346  * next vap is brought up.
1347  */
1348 void
1349 ieee80211_stop_locked(struct ieee80211vap *vap)
1350 {
1351 	struct ieee80211com *ic = vap->iv_ic;
1352 	struct ifnet *ifp = vap->iv_ifp;
1353 	struct ifnet *parent = ic->ic_ifp;
1354 
1355 	IEEE80211_LOCK_ASSERT(ic);
1356 
1357 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG,
1358 	    "stop running, %d vaps running\n", ic->ic_nrunning);
1359 
1360 	ieee80211_new_state_locked(vap, IEEE80211_S_INIT, -1);
1361 	if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1362 		ifp->if_drv_flags &= ~IFF_DRV_RUNNING;	/* mark us stopped */
1363 		if (--ic->ic_nrunning == 0 &&
1364 		    (parent->if_drv_flags & IFF_DRV_RUNNING)) {
1365 			IEEE80211_DPRINTF(vap,
1366 			    IEEE80211_MSG_STATE | IEEE80211_MSG_DEBUG,
1367 			    "down parent %s\n", parent->if_xname);
1368 			parent->if_flags &= ~IFF_UP;
1369 			ieee80211_runtask(ic, &ic->ic_parent_task);
1370 		}
1371 	}
1372 }
1373 
1374 void
1375 ieee80211_stop(struct ieee80211vap *vap)
1376 {
1377 	struct ieee80211com *ic = vap->iv_ic;
1378 
1379 	IEEE80211_LOCK(ic);
1380 	ieee80211_stop_locked(vap);
1381 	IEEE80211_UNLOCK(ic);
1382 }
1383 
1384 /*
1385  * Stop all vap's running on a device.
1386  */
1387 void
1388 ieee80211_stop_all(struct ieee80211com *ic)
1389 {
1390 	struct ieee80211vap *vap;
1391 
1392 	IEEE80211_LOCK(ic);
1393 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1394 		struct ifnet *ifp = vap->iv_ifp;
1395 		if (IFNET_IS_UP_RUNNING(ifp))	/* NB: avoid recursion */
1396 			ieee80211_stop_locked(vap);
1397 	}
1398 	IEEE80211_UNLOCK(ic);
1399 
1400 	ieee80211_waitfor_parent(ic);
1401 }
1402 
1403 /*
1404  * Stop all vap's running on a device and arrange
1405  * for those that were running to be resumed.
1406  */
1407 void
1408 ieee80211_suspend_all(struct ieee80211com *ic)
1409 {
1410 	struct ieee80211vap *vap;
1411 
1412 	IEEE80211_LOCK(ic);
1413 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1414 		struct ifnet *ifp = vap->iv_ifp;
1415 		if (IFNET_IS_UP_RUNNING(ifp)) {	/* NB: avoid recursion */
1416 			vap->iv_flags_ext |= IEEE80211_FEXT_RESUME;
1417 			ieee80211_stop_locked(vap);
1418 		}
1419 	}
1420 	IEEE80211_UNLOCK(ic);
1421 
1422 	ieee80211_waitfor_parent(ic);
1423 }
1424 
1425 /*
1426  * Start all vap's marked for resume.
1427  */
1428 void
1429 ieee80211_resume_all(struct ieee80211com *ic)
1430 {
1431 	struct ieee80211vap *vap;
1432 
1433 	IEEE80211_LOCK(ic);
1434 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1435 		struct ifnet *ifp = vap->iv_ifp;
1436 		if (!IFNET_IS_UP_RUNNING(ifp) &&
1437 		    (vap->iv_flags_ext & IEEE80211_FEXT_RESUME)) {
1438 			vap->iv_flags_ext &= ~IEEE80211_FEXT_RESUME;
1439 			ieee80211_start_locked(vap);
1440 		}
1441 	}
1442 	IEEE80211_UNLOCK(ic);
1443 }
1444 
1445 void
1446 ieee80211_beacon_miss(struct ieee80211com *ic)
1447 {
1448 	IEEE80211_LOCK(ic);
1449 	if ((ic->ic_flags & IEEE80211_F_SCAN) == 0) {
1450 		/* Process in a taskq, the handler may reenter the driver */
1451 		ieee80211_runtask(ic, &ic->ic_bmiss_task);
1452 	}
1453 	IEEE80211_UNLOCK(ic);
1454 }
1455 
1456 static void
1457 beacon_miss(void *arg, int npending)
1458 {
1459 	struct ieee80211com *ic = arg;
1460 	struct ieee80211vap *vap;
1461 
1462 	IEEE80211_LOCK(ic);
1463 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1464 		/*
1465 		 * We only pass events through for sta vap's in RUN state;
1466 		 * may be too restrictive but for now this saves all the
1467 		 * handlers duplicating these checks.
1468 		 */
1469 		if (vap->iv_opmode == IEEE80211_M_STA &&
1470 		    vap->iv_state >= IEEE80211_S_RUN &&
1471 		    vap->iv_bmiss != NULL)
1472 			vap->iv_bmiss(vap);
1473 	}
1474 	IEEE80211_UNLOCK(ic);
1475 }
1476 
1477 static void
1478 beacon_swmiss(void *arg, int npending)
1479 {
1480 	struct ieee80211vap *vap = arg;
1481 	struct ieee80211com *ic = vap->iv_ic;
1482 
1483 	IEEE80211_LOCK(ic);
1484 	if (vap->iv_state == IEEE80211_S_RUN) {
1485 		/* XXX Call multiple times if npending > zero? */
1486 		vap->iv_bmiss(vap);
1487 	}
1488 	IEEE80211_UNLOCK(ic);
1489 }
1490 
1491 /*
1492  * Software beacon miss handling.  Check if any beacons
1493  * were received in the last period.  If not post a
1494  * beacon miss; otherwise reset the counter.
1495  */
1496 void
1497 ieee80211_swbmiss(void *arg)
1498 {
1499 	struct ieee80211vap *vap = arg;
1500 	struct ieee80211com *ic = vap->iv_ic;
1501 
1502 	IEEE80211_LOCK_ASSERT(ic);
1503 
1504 	/* XXX sleep state? */
1505 	KASSERT(vap->iv_state == IEEE80211_S_RUN,
1506 	    ("wrong state %d", vap->iv_state));
1507 
1508 	if (ic->ic_flags & IEEE80211_F_SCAN) {
1509 		/*
1510 		 * If scanning just ignore and reset state.  If we get a
1511 		 * bmiss after coming out of scan because we haven't had
1512 		 * time to receive a beacon then we should probe the AP
1513 		 * before posting a real bmiss (unless iv_bmiss_max has
1514 		 * been artifiically lowered).  A cleaner solution might
1515 		 * be to disable the timer on scan start/end but to handle
1516 		 * case of multiple sta vap's we'd need to disable the
1517 		 * timers of all affected vap's.
1518 		 */
1519 		vap->iv_swbmiss_count = 0;
1520 	} else if (vap->iv_swbmiss_count == 0) {
1521 		if (vap->iv_bmiss != NULL)
1522 			ieee80211_runtask(ic, &vap->iv_swbmiss_task);
1523 	} else
1524 		vap->iv_swbmiss_count = 0;
1525 	callout_reset(&vap->iv_swbmiss, vap->iv_swbmiss_period,
1526 		ieee80211_swbmiss, vap);
1527 }
1528 
1529 /*
1530  * Start an 802.11h channel switch.  We record the parameters,
1531  * mark the operation pending, notify each vap through the
1532  * beacon update mechanism so it can update the beacon frame
1533  * contents, and then switch vap's to CSA state to block outbound
1534  * traffic.  Devices that handle CSA directly can use the state
1535  * switch to do the right thing so long as they call
1536  * ieee80211_csa_completeswitch when it's time to complete the
1537  * channel change.  Devices that depend on the net80211 layer can
1538  * use ieee80211_beacon_update to handle the countdown and the
1539  * channel switch.
1540  */
1541 void
1542 ieee80211_csa_startswitch(struct ieee80211com *ic,
1543 	struct ieee80211_channel *c, int mode, int count)
1544 {
1545 	struct ieee80211vap *vap;
1546 
1547 	IEEE80211_LOCK_ASSERT(ic);
1548 
1549 	ic->ic_csa_newchan = c;
1550 	ic->ic_csa_mode = mode;
1551 	ic->ic_csa_count = count;
1552 	ic->ic_flags |= IEEE80211_F_CSAPENDING;
1553 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1554 		if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
1555 		    vap->iv_opmode == IEEE80211_M_IBSS ||
1556 		    vap->iv_opmode == IEEE80211_M_MBSS)
1557 			ieee80211_beacon_notify(vap, IEEE80211_BEACON_CSA);
1558 		/* switch to CSA state to block outbound traffic */
1559 		if (vap->iv_state == IEEE80211_S_RUN)
1560 			ieee80211_new_state_locked(vap, IEEE80211_S_CSA, 0);
1561 	}
1562 	ieee80211_notify_csa(ic, c, mode, count);
1563 }
1564 
1565 /*
1566  * Complete the channel switch by transitioning all CSA VAPs to RUN.
1567  * This is called by both the completion and cancellation functions
1568  * so each VAP is placed back in the RUN state and can thus transmit.
1569  */
1570 static void
1571 csa_completeswitch(struct ieee80211com *ic)
1572 {
1573 	struct ieee80211vap *vap;
1574 
1575 	ic->ic_csa_newchan = NULL;
1576 	ic->ic_flags &= ~IEEE80211_F_CSAPENDING;
1577 
1578 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
1579 		if (vap->iv_state == IEEE80211_S_CSA)
1580 			ieee80211_new_state_locked(vap, IEEE80211_S_RUN, 0);
1581 }
1582 
1583 /*
1584  * Complete an 802.11h channel switch started by ieee80211_csa_startswitch.
1585  * We clear state and move all vap's in CSA state to RUN state
1586  * so they can again transmit.
1587  *
1588  * Although this may not be completely correct, update the BSS channel
1589  * for each VAP to the newly configured channel. The setcurchan sets
1590  * the current operating channel for the interface (so the radio does
1591  * switch over) but the VAP BSS isn't updated, leading to incorrectly
1592  * reported information via ioctl.
1593  */
1594 void
1595 ieee80211_csa_completeswitch(struct ieee80211com *ic)
1596 {
1597 	struct ieee80211vap *vap;
1598 
1599 	IEEE80211_LOCK_ASSERT(ic);
1600 
1601 	KASSERT(ic->ic_flags & IEEE80211_F_CSAPENDING, ("csa not pending"));
1602 
1603 	ieee80211_setcurchan(ic, ic->ic_csa_newchan);
1604 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
1605 		if (vap->iv_state == IEEE80211_S_CSA)
1606 			vap->iv_bss->ni_chan = ic->ic_curchan;
1607 
1608 	csa_completeswitch(ic);
1609 }
1610 
1611 /*
1612  * Cancel an 802.11h channel switch started by ieee80211_csa_startswitch.
1613  * We clear state and move all vap's in CSA state to RUN state
1614  * so they can again transmit.
1615  */
1616 void
1617 ieee80211_csa_cancelswitch(struct ieee80211com *ic)
1618 {
1619 	IEEE80211_LOCK_ASSERT(ic);
1620 
1621 	csa_completeswitch(ic);
1622 }
1623 
1624 /*
1625  * Complete a DFS CAC started by ieee80211_dfs_cac_start.
1626  * We clear state and move all vap's in CAC state to RUN state.
1627  */
1628 void
1629 ieee80211_cac_completeswitch(struct ieee80211vap *vap0)
1630 {
1631 	struct ieee80211com *ic = vap0->iv_ic;
1632 	struct ieee80211vap *vap;
1633 
1634 	IEEE80211_LOCK(ic);
1635 	/*
1636 	 * Complete CAC state change for lead vap first; then
1637 	 * clock all the other vap's waiting.
1638 	 */
1639 	KASSERT(vap0->iv_state == IEEE80211_S_CAC,
1640 	    ("wrong state %d", vap0->iv_state));
1641 	ieee80211_new_state_locked(vap0, IEEE80211_S_RUN, 0);
1642 
1643 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
1644 		if (vap->iv_state == IEEE80211_S_CAC)
1645 			ieee80211_new_state_locked(vap, IEEE80211_S_RUN, 0);
1646 	IEEE80211_UNLOCK(ic);
1647 }
1648 
1649 /*
1650  * Force all vap's other than the specified vap to the INIT state
1651  * and mark them as waiting for a scan to complete.  These vaps
1652  * will be brought up when the scan completes and the scanning vap
1653  * reaches RUN state by wakeupwaiting.
1654  */
1655 static void
1656 markwaiting(struct ieee80211vap *vap0)
1657 {
1658 	struct ieee80211com *ic = vap0->iv_ic;
1659 	struct ieee80211vap *vap;
1660 
1661 	IEEE80211_LOCK_ASSERT(ic);
1662 
1663 	/*
1664 	 * A vap list entry can not disappear since we are running on the
1665 	 * taskqueue and a vap destroy will queue and drain another state
1666 	 * change task.
1667 	 */
1668 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1669 		if (vap == vap0)
1670 			continue;
1671 		if (vap->iv_state != IEEE80211_S_INIT) {
1672 			/* NB: iv_newstate may drop the lock */
1673 			vap->iv_newstate(vap, IEEE80211_S_INIT, 0);
1674 			IEEE80211_LOCK_ASSERT(ic);
1675 			vap->iv_flags_ext |= IEEE80211_FEXT_SCANWAIT;
1676 		}
1677 	}
1678 }
1679 
1680 /*
1681  * Wakeup all vap's waiting for a scan to complete.  This is the
1682  * companion to markwaiting (above) and is used to coordinate
1683  * multiple vaps scanning.
1684  * This is called from the state taskqueue.
1685  */
1686 static void
1687 wakeupwaiting(struct ieee80211vap *vap0)
1688 {
1689 	struct ieee80211com *ic = vap0->iv_ic;
1690 	struct ieee80211vap *vap;
1691 
1692 	IEEE80211_LOCK_ASSERT(ic);
1693 
1694 	/*
1695 	 * A vap list entry can not disappear since we are running on the
1696 	 * taskqueue and a vap destroy will queue and drain another state
1697 	 * change task.
1698 	 */
1699 	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
1700 		if (vap == vap0)
1701 			continue;
1702 		if (vap->iv_flags_ext & IEEE80211_FEXT_SCANWAIT) {
1703 			vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANWAIT;
1704 			/* NB: sta's cannot go INIT->RUN */
1705 			/* NB: iv_newstate may drop the lock */
1706 			vap->iv_newstate(vap,
1707 			    vap->iv_opmode == IEEE80211_M_STA ?
1708 			        IEEE80211_S_SCAN : IEEE80211_S_RUN, 0);
1709 			IEEE80211_LOCK_ASSERT(ic);
1710 		}
1711 	}
1712 }
1713 
1714 /*
1715  * Handle post state change work common to all operating modes.
1716  */
1717 static void
1718 ieee80211_newstate_cb(void *xvap, int npending)
1719 {
1720 	struct ieee80211vap *vap = xvap;
1721 	struct ieee80211com *ic = vap->iv_ic;
1722 	enum ieee80211_state nstate, ostate;
1723 	int arg, rc;
1724 
1725 	IEEE80211_LOCK(ic);
1726 	nstate = vap->iv_nstate;
1727 	arg = vap->iv_nstate_arg;
1728 
1729 	if (vap->iv_flags_ext & IEEE80211_FEXT_REINIT) {
1730 		/*
1731 		 * We have been requested to drop back to the INIT before
1732 		 * proceeding to the new state.
1733 		 */
1734 		IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1735 		    "%s: %s -> %s arg %d\n", __func__,
1736 		    ieee80211_state_name[vap->iv_state],
1737 		    ieee80211_state_name[IEEE80211_S_INIT], arg);
1738 		vap->iv_newstate(vap, IEEE80211_S_INIT, arg);
1739 		IEEE80211_LOCK_ASSERT(ic);
1740 		vap->iv_flags_ext &= ~IEEE80211_FEXT_REINIT;
1741 	}
1742 
1743 	ostate = vap->iv_state;
1744 	if (nstate == IEEE80211_S_SCAN && ostate != IEEE80211_S_INIT) {
1745 		/*
1746 		 * SCAN was forced; e.g. on beacon miss.  Force other running
1747 		 * vap's to INIT state and mark them as waiting for the scan to
1748 		 * complete.  This insures they don't interfere with our
1749 		 * scanning.  Since we are single threaded the vaps can not
1750 		 * transition again while we are executing.
1751 		 *
1752 		 * XXX not always right, assumes ap follows sta
1753 		 */
1754 		markwaiting(vap);
1755 	}
1756 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1757 	    "%s: %s -> %s arg %d\n", __func__,
1758 	    ieee80211_state_name[ostate], ieee80211_state_name[nstate], arg);
1759 
1760 	rc = vap->iv_newstate(vap, nstate, arg);
1761 	IEEE80211_LOCK_ASSERT(ic);
1762 	vap->iv_flags_ext &= ~IEEE80211_FEXT_STATEWAIT;
1763 	if (rc != 0) {
1764 		/* State transition failed */
1765 		KASSERT(rc != EINPROGRESS, ("iv_newstate was deferred"));
1766 		KASSERT(nstate != IEEE80211_S_INIT,
1767 		    ("INIT state change failed"));
1768 		IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1769 		    "%s: %s returned error %d\n", __func__,
1770 		    ieee80211_state_name[nstate], rc);
1771 		goto done;
1772 	}
1773 
1774 	/* No actual transition, skip post processing */
1775 	if (ostate == nstate)
1776 		goto done;
1777 
1778 	if (nstate == IEEE80211_S_RUN) {
1779 		/*
1780 		 * OACTIVE may be set on the vap if the upper layer
1781 		 * tried to transmit (e.g. IPv6 NDP) before we reach
1782 		 * RUN state.  Clear it and restart xmit.
1783 		 *
1784 		 * Note this can also happen as a result of SLEEP->RUN
1785 		 * (i.e. coming out of power save mode).
1786 		 */
1787 		IF_LOCK(&vap->iv_ifp->if_snd);
1788 		vap->iv_ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1789 		IF_UNLOCK(&vap->iv_ifp->if_snd);
1790 
1791 		/*
1792 		 * XXX Kick-start a VAP queue - this should be a method,
1793 		 * not if_start()!
1794 		 */
1795 		if_start(vap->iv_ifp);
1796 
1797 		/* bring up any vaps waiting on us */
1798 		wakeupwaiting(vap);
1799 	} else if (nstate == IEEE80211_S_INIT) {
1800 		/*
1801 		 * Flush the scan cache if we did the last scan (XXX?)
1802 		 * and flush any frames on send queues from this vap.
1803 		 * Note the mgt q is used only for legacy drivers and
1804 		 * will go away shortly.
1805 		 */
1806 		ieee80211_scan_flush(vap);
1807 
1808 		/* XXX NB: cast for altq */
1809 		ieee80211_flush_ifq((struct ifqueue *)&ic->ic_ifp->if_snd, vap);
1810 	}
1811 done:
1812 	IEEE80211_UNLOCK(ic);
1813 }
1814 
1815 /*
1816  * Public interface for initiating a state machine change.
1817  * This routine single-threads the request and coordinates
1818  * the scheduling of multiple vaps for the purpose of selecting
1819  * an operating channel.  Specifically the following scenarios
1820  * are handled:
1821  * o only one vap can be selecting a channel so on transition to
1822  *   SCAN state if another vap is already scanning then
1823  *   mark the caller for later processing and return without
1824  *   doing anything (XXX? expectations by caller of synchronous operation)
1825  * o only one vap can be doing CAC of a channel so on transition to
1826  *   CAC state if another vap is already scanning for radar then
1827  *   mark the caller for later processing and return without
1828  *   doing anything (XXX? expectations by caller of synchronous operation)
1829  * o if another vap is already running when a request is made
1830  *   to SCAN then an operating channel has been chosen; bypass
1831  *   the scan and just join the channel
1832  *
1833  * Note that the state change call is done through the iv_newstate
1834  * method pointer so any driver routine gets invoked.  The driver
1835  * will normally call back into operating mode-specific
1836  * ieee80211_newstate routines (below) unless it needs to completely
1837  * bypass the state machine (e.g. because the firmware has it's
1838  * own idea how things should work).  Bypassing the net80211 layer
1839  * is usually a mistake and indicates lack of proper integration
1840  * with the net80211 layer.
1841  */
1842 static int
1843 ieee80211_new_state_locked(struct ieee80211vap *vap,
1844 	enum ieee80211_state nstate, int arg)
1845 {
1846 	struct ieee80211com *ic = vap->iv_ic;
1847 	struct ieee80211vap *vp;
1848 	enum ieee80211_state ostate;
1849 	int nrunning, nscanning;
1850 
1851 	IEEE80211_LOCK_ASSERT(ic);
1852 
1853 	if (vap->iv_flags_ext & IEEE80211_FEXT_STATEWAIT) {
1854 		if (vap->iv_nstate == IEEE80211_S_INIT) {
1855 			/*
1856 			 * XXX The vap is being stopped, do no allow any other
1857 			 * state changes until this is completed.
1858 			 */
1859 			return -1;
1860 		} else if (vap->iv_state != vap->iv_nstate) {
1861 #if 0
1862 			/* Warn if the previous state hasn't completed. */
1863 			IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1864 			    "%s: pending %s -> %s transition lost\n", __func__,
1865 			    ieee80211_state_name[vap->iv_state],
1866 			    ieee80211_state_name[vap->iv_nstate]);
1867 #else
1868 			/* XXX temporarily enable to identify issues */
1869 			if_printf(vap->iv_ifp,
1870 			    "%s: pending %s -> %s transition lost\n",
1871 			    __func__, ieee80211_state_name[vap->iv_state],
1872 			    ieee80211_state_name[vap->iv_nstate]);
1873 #endif
1874 		}
1875 	}
1876 
1877 	nrunning = nscanning = 0;
1878 	/* XXX can track this state instead of calculating */
1879 	TAILQ_FOREACH(vp, &ic->ic_vaps, iv_next) {
1880 		if (vp != vap) {
1881 			if (vp->iv_state >= IEEE80211_S_RUN)
1882 				nrunning++;
1883 			/* XXX doesn't handle bg scan */
1884 			/* NB: CAC+AUTH+ASSOC treated like SCAN */
1885 			else if (vp->iv_state > IEEE80211_S_INIT)
1886 				nscanning++;
1887 		}
1888 	}
1889 	ostate = vap->iv_state;
1890 	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1891 	    "%s: %s -> %s (nrunning %d nscanning %d)\n", __func__,
1892 	    ieee80211_state_name[ostate], ieee80211_state_name[nstate],
1893 	    nrunning, nscanning);
1894 	switch (nstate) {
1895 	case IEEE80211_S_SCAN:
1896 		if (ostate == IEEE80211_S_INIT) {
1897 			/*
1898 			 * INIT -> SCAN happens on initial bringup.
1899 			 */
1900 			KASSERT(!(nscanning && nrunning),
1901 			    ("%d scanning and %d running", nscanning, nrunning));
1902 			if (nscanning) {
1903 				/*
1904 				 * Someone is scanning, defer our state
1905 				 * change until the work has completed.
1906 				 */
1907 				IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1908 				    "%s: defer %s -> %s\n",
1909 				    __func__, ieee80211_state_name[ostate],
1910 				    ieee80211_state_name[nstate]);
1911 				vap->iv_flags_ext |= IEEE80211_FEXT_SCANWAIT;
1912 				return 0;
1913 			}
1914 			if (nrunning) {
1915 				/*
1916 				 * Someone is operating; just join the channel
1917 				 * they have chosen.
1918 				 */
1919 				/* XXX kill arg? */
1920 				/* XXX check each opmode, adhoc? */
1921 				if (vap->iv_opmode == IEEE80211_M_STA)
1922 					nstate = IEEE80211_S_SCAN;
1923 				else
1924 					nstate = IEEE80211_S_RUN;
1925 #ifdef IEEE80211_DEBUG
1926 				if (nstate != IEEE80211_S_SCAN) {
1927 					IEEE80211_DPRINTF(vap,
1928 					    IEEE80211_MSG_STATE,
1929 					    "%s: override, now %s -> %s\n",
1930 					    __func__,
1931 					    ieee80211_state_name[ostate],
1932 					    ieee80211_state_name[nstate]);
1933 				}
1934 #endif
1935 			}
1936 		}
1937 		break;
1938 	case IEEE80211_S_RUN:
1939 		if (vap->iv_opmode == IEEE80211_M_WDS &&
1940 		    (vap->iv_flags_ext & IEEE80211_FEXT_WDSLEGACY) &&
1941 		    nscanning) {
1942 			/*
1943 			 * Legacy WDS with someone else scanning; don't
1944 			 * go online until that completes as we should
1945 			 * follow the other vap to the channel they choose.
1946 			 */
1947 			IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1948 			     "%s: defer %s -> %s (legacy WDS)\n", __func__,
1949 			     ieee80211_state_name[ostate],
1950 			     ieee80211_state_name[nstate]);
1951 			vap->iv_flags_ext |= IEEE80211_FEXT_SCANWAIT;
1952 			return 0;
1953 		}
1954 		if (vap->iv_opmode == IEEE80211_M_HOSTAP &&
1955 		    IEEE80211_IS_CHAN_DFS(ic->ic_bsschan) &&
1956 		    (vap->iv_flags_ext & IEEE80211_FEXT_DFS) &&
1957 		    !IEEE80211_IS_CHAN_CACDONE(ic->ic_bsschan)) {
1958 			/*
1959 			 * This is a DFS channel, transition to CAC state
1960 			 * instead of RUN.  This allows us to initiate
1961 			 * Channel Availability Check (CAC) as specified
1962 			 * by 11h/DFS.
1963 			 */
1964 			nstate = IEEE80211_S_CAC;
1965 			IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
1966 			     "%s: override %s -> %s (DFS)\n", __func__,
1967 			     ieee80211_state_name[ostate],
1968 			     ieee80211_state_name[nstate]);
1969 		}
1970 		break;
1971 	case IEEE80211_S_INIT:
1972 		/* cancel any scan in progress */
1973 		ieee80211_cancel_scan(vap);
1974 		if (ostate == IEEE80211_S_INIT ) {
1975 			/* XXX don't believe this */
1976 			/* INIT -> INIT. nothing to do */
1977 			vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANWAIT;
1978 		}
1979 		/* fall thru... */
1980 	default:
1981 		break;
1982 	}
1983 	/* defer the state change to a thread */
1984 	vap->iv_nstate = nstate;
1985 	vap->iv_nstate_arg = arg;
1986 	vap->iv_flags_ext |= IEEE80211_FEXT_STATEWAIT;
1987 	ieee80211_runtask(ic, &vap->iv_nstate_task);
1988 	return EINPROGRESS;
1989 }
1990 
1991 int
1992 ieee80211_new_state(struct ieee80211vap *vap,
1993 	enum ieee80211_state nstate, int arg)
1994 {
1995 	struct ieee80211com *ic = vap->iv_ic;
1996 	int rc;
1997 
1998 	IEEE80211_LOCK(ic);
1999 	rc = ieee80211_new_state_locked(vap, nstate, arg);
2000 	IEEE80211_UNLOCK(ic);
2001 	return rc;
2002 }
2003