ieee80211.c revision 193292
1/*-
2 * Copyright (c) 2001 Atsushi Onoe
3 * Copyright (c) 2002-2009 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: head/sys/net80211/ieee80211.c 193292 2009-06-02 00:33:28Z sam $");
29
30/*
31 * IEEE 802.11 generic handler
32 */
33#include "opt_wlan.h"
34
35#include <sys/param.h>
36#include <sys/systm.h>
37#include <sys/kernel.h>
38
39#include <sys/socket.h>
40
41#include <net/if.h>
42#include <net/if_dl.h>
43#include <net/if_media.h>
44#include <net/if_types.h>
45#include <net/ethernet.h>
46
47#include <net80211/ieee80211_var.h>
48#include <net80211/ieee80211_regdomain.h>
49#ifdef IEEE80211_SUPPORT_SUPERG
50#include <net80211/ieee80211_superg.h>
51#endif
52
53#include <net/bpf.h>
54
55const char *ieee80211_phymode_name[IEEE80211_MODE_MAX] = {
56	[IEEE80211_MODE_AUTO]	  = "auto",
57	[IEEE80211_MODE_11A]	  = "11a",
58	[IEEE80211_MODE_11B]	  = "11b",
59	[IEEE80211_MODE_11G]	  = "11g",
60	[IEEE80211_MODE_FH]	  = "FH",
61	[IEEE80211_MODE_TURBO_A]  = "turboA",
62	[IEEE80211_MODE_TURBO_G]  = "turboG",
63	[IEEE80211_MODE_STURBO_A] = "sturboA",
64	[IEEE80211_MODE_HALF]	  = "half",
65	[IEEE80211_MODE_QUARTER]  = "quarter",
66	[IEEE80211_MODE_11NA]	  = "11na",
67	[IEEE80211_MODE_11NG]	  = "11ng",
68};
69/* map ieee80211_opmode to the corresponding capability bit */
70const int ieee80211_opcap[IEEE80211_OPMODE_MAX] = {
71	[IEEE80211_M_IBSS]	= IEEE80211_C_IBSS,
72	[IEEE80211_M_WDS]	= IEEE80211_C_WDS,
73	[IEEE80211_M_STA]	= IEEE80211_C_STA,
74	[IEEE80211_M_AHDEMO]	= IEEE80211_C_AHDEMO,
75	[IEEE80211_M_HOSTAP]	= IEEE80211_C_HOSTAP,
76	[IEEE80211_M_MONITOR]	= IEEE80211_C_MONITOR,
77};
78
79static const uint8_t ieee80211broadcastaddr[IEEE80211_ADDR_LEN] =
80	{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
81
82static	void ieee80211_syncflag_locked(struct ieee80211com *ic, int flag);
83static	void ieee80211_syncflag_ext_locked(struct ieee80211com *ic, int flag);
84static	int ieee80211_media_setup(struct ieee80211com *ic,
85		struct ifmedia *media, int caps, int addsta,
86		ifm_change_cb_t media_change, ifm_stat_cb_t media_stat);
87static	void ieee80211com_media_status(struct ifnet *, struct ifmediareq *);
88static	int ieee80211com_media_change(struct ifnet *);
89static	int media_status(enum ieee80211_opmode,
90		const struct ieee80211_channel *);
91
92MALLOC_DEFINE(M_80211_VAP, "80211vap", "802.11 vap state");
93
94/*
95 * Default supported rates for 802.11 operation (in IEEE .5Mb units).
96 */
97#define	B(r)	((r) | IEEE80211_RATE_BASIC)
98static const struct ieee80211_rateset ieee80211_rateset_11a =
99	{ 8, { B(12), 18, B(24), 36, B(48), 72, 96, 108 } };
100static const struct ieee80211_rateset ieee80211_rateset_half =
101	{ 8, { B(6), 9, B(12), 18, B(24), 36, 48, 54 } };
102static const struct ieee80211_rateset ieee80211_rateset_quarter =
103	{ 8, { B(3), 4, B(6), 9, B(12), 18, 24, 27 } };
104static const struct ieee80211_rateset ieee80211_rateset_11b =
105	{ 4, { B(2), B(4), B(11), B(22) } };
106/* NB: OFDM rates are handled specially based on mode */
107static const struct ieee80211_rateset ieee80211_rateset_11g =
108	{ 12, { B(2), B(4), B(11), B(22), 12, 18, 24, 36, 48, 72, 96, 108 } };
109#undef B
110
111/*
112 * Fill in 802.11 available channel set, mark
113 * all available channels as active, and pick
114 * a default channel if not already specified.
115 */
116static void
117ieee80211_chan_init(struct ieee80211com *ic)
118{
119#define	DEFAULTRATES(m, def) do { \
120	if (ic->ic_sup_rates[m].rs_nrates == 0) \
121		ic->ic_sup_rates[m] = def; \
122} while (0)
123	struct ieee80211_channel *c;
124	int i;
125
126	KASSERT(0 < ic->ic_nchans && ic->ic_nchans <= IEEE80211_CHAN_MAX,
127		("invalid number of channels specified: %u", ic->ic_nchans));
128	memset(ic->ic_chan_avail, 0, sizeof(ic->ic_chan_avail));
129	memset(ic->ic_modecaps, 0, sizeof(ic->ic_modecaps));
130	setbit(ic->ic_modecaps, IEEE80211_MODE_AUTO);
131	for (i = 0; i < ic->ic_nchans; i++) {
132		c = &ic->ic_channels[i];
133		KASSERT(c->ic_flags != 0, ("channel with no flags"));
134		/*
135		 * Help drivers that work only with frequencies by filling
136		 * in IEEE channel #'s if not already calculated.  Note this
137		 * mimics similar work done in ieee80211_setregdomain when
138		 * changing regulatory state.
139		 */
140		if (c->ic_ieee == 0)
141			c->ic_ieee = ieee80211_mhz2ieee(c->ic_freq,c->ic_flags);
142		if (IEEE80211_IS_CHAN_HT40(c) && c->ic_extieee == 0)
143			c->ic_extieee = ieee80211_mhz2ieee(c->ic_freq +
144			    (IEEE80211_IS_CHAN_HT40U(c) ? 20 : -20),
145			    c->ic_flags);
146		/* default max tx power to max regulatory */
147		if (c->ic_maxpower == 0)
148			c->ic_maxpower = 2*c->ic_maxregpower;
149		setbit(ic->ic_chan_avail, c->ic_ieee);
150		/*
151		 * Identify mode capabilities.
152		 */
153		if (IEEE80211_IS_CHAN_A(c))
154			setbit(ic->ic_modecaps, IEEE80211_MODE_11A);
155		if (IEEE80211_IS_CHAN_B(c))
156			setbit(ic->ic_modecaps, IEEE80211_MODE_11B);
157		if (IEEE80211_IS_CHAN_ANYG(c))
158			setbit(ic->ic_modecaps, IEEE80211_MODE_11G);
159		if (IEEE80211_IS_CHAN_FHSS(c))
160			setbit(ic->ic_modecaps, IEEE80211_MODE_FH);
161		if (IEEE80211_IS_CHAN_108A(c))
162			setbit(ic->ic_modecaps, IEEE80211_MODE_TURBO_A);
163		if (IEEE80211_IS_CHAN_108G(c))
164			setbit(ic->ic_modecaps, IEEE80211_MODE_TURBO_G);
165		if (IEEE80211_IS_CHAN_ST(c))
166			setbit(ic->ic_modecaps, IEEE80211_MODE_STURBO_A);
167		if (IEEE80211_IS_CHAN_HALF(c))
168			setbit(ic->ic_modecaps, IEEE80211_MODE_HALF);
169		if (IEEE80211_IS_CHAN_QUARTER(c))
170			setbit(ic->ic_modecaps, IEEE80211_MODE_QUARTER);
171		if (IEEE80211_IS_CHAN_HTA(c))
172			setbit(ic->ic_modecaps, IEEE80211_MODE_11NA);
173		if (IEEE80211_IS_CHAN_HTG(c))
174			setbit(ic->ic_modecaps, IEEE80211_MODE_11NG);
175	}
176	/* initialize candidate channels to all available */
177	memcpy(ic->ic_chan_active, ic->ic_chan_avail,
178		sizeof(ic->ic_chan_avail));
179
180	/* sort channel table to allow lookup optimizations */
181	ieee80211_sort_channels(ic->ic_channels, ic->ic_nchans);
182
183	/* invalidate any previous state */
184	ic->ic_bsschan = IEEE80211_CHAN_ANYC;
185	ic->ic_prevchan = NULL;
186	ic->ic_csa_newchan = NULL;
187	/* arbitrarily pick the first channel */
188	ic->ic_curchan = &ic->ic_channels[0];
189	ic->ic_rt = ieee80211_get_ratetable(ic->ic_curchan);
190
191	/* fillin well-known rate sets if driver has not specified */
192	DEFAULTRATES(IEEE80211_MODE_11B,	 ieee80211_rateset_11b);
193	DEFAULTRATES(IEEE80211_MODE_11G,	 ieee80211_rateset_11g);
194	DEFAULTRATES(IEEE80211_MODE_11A,	 ieee80211_rateset_11a);
195	DEFAULTRATES(IEEE80211_MODE_TURBO_A,	 ieee80211_rateset_11a);
196	DEFAULTRATES(IEEE80211_MODE_TURBO_G,	 ieee80211_rateset_11g);
197	DEFAULTRATES(IEEE80211_MODE_STURBO_A,	 ieee80211_rateset_11a);
198	DEFAULTRATES(IEEE80211_MODE_HALF,	 ieee80211_rateset_half);
199	DEFAULTRATES(IEEE80211_MODE_QUARTER,	 ieee80211_rateset_quarter);
200	DEFAULTRATES(IEEE80211_MODE_11NA,	 ieee80211_rateset_11a);
201	DEFAULTRATES(IEEE80211_MODE_11NG,	 ieee80211_rateset_11g);
202
203	/*
204	 * Set auto mode to reset active channel state and any desired channel.
205	 */
206	(void) ieee80211_setmode(ic, IEEE80211_MODE_AUTO);
207#undef DEFAULTRATES
208}
209
210static void
211null_update_mcast(struct ifnet *ifp)
212{
213	if_printf(ifp, "need multicast update callback\n");
214}
215
216static void
217null_update_promisc(struct ifnet *ifp)
218{
219	if_printf(ifp, "need promiscuous mode update callback\n");
220}
221
222static int
223null_output(struct ifnet *ifp, struct mbuf *m,
224	struct sockaddr *dst, struct route *ro)
225{
226	if_printf(ifp, "discard raw packet\n");
227	m_freem(m);
228	return EIO;
229}
230
231static void
232null_input(struct ifnet *ifp, struct mbuf *m)
233{
234	if_printf(ifp, "if_input should not be called\n");
235	m_freem(m);
236}
237
238/*
239 * Attach/setup the common net80211 state.  Called by
240 * the driver on attach to prior to creating any vap's.
241 */
242void
243ieee80211_ifattach(struct ieee80211com *ic,
244	const uint8_t macaddr[IEEE80211_ADDR_LEN])
245{
246	struct ifnet *ifp = ic->ic_ifp;
247	struct sockaddr_dl *sdl;
248	struct ifaddr *ifa;
249
250	KASSERT(ifp->if_type == IFT_IEEE80211, ("if_type %d", ifp->if_type));
251
252	IEEE80211_LOCK_INIT(ic, ifp->if_xname);
253	TAILQ_INIT(&ic->ic_vaps);
254
255	/* Create a taskqueue for all state changes */
256	ic->ic_tq = taskqueue_create("ic_taskq", M_WAITOK | M_ZERO,
257	    taskqueue_thread_enqueue, &ic->ic_tq);
258	taskqueue_start_threads(&ic->ic_tq, 1, PI_NET, "%s taskq",
259	    ifp->if_xname);
260	/*
261	 * Fill in 802.11 available channel set, mark all
262	 * available channels as active, and pick a default
263	 * channel if not already specified.
264	 */
265	ieee80211_media_init(ic);
266
267	ic->ic_update_mcast = null_update_mcast;
268	ic->ic_update_promisc = null_update_promisc;
269
270	ic->ic_bintval = IEEE80211_BINTVAL_DEFAULT;
271	ic->ic_lintval = ic->ic_bintval;
272	ic->ic_txpowlimit = IEEE80211_TXPOWER_MAX;
273
274	ieee80211_crypto_attach(ic);
275	ieee80211_node_attach(ic);
276	ieee80211_power_attach(ic);
277	ieee80211_proto_attach(ic);
278#ifdef IEEE80211_SUPPORT_SUPERG
279	ieee80211_superg_attach(ic);
280#endif
281	ieee80211_ht_attach(ic);
282	ieee80211_scan_attach(ic);
283	ieee80211_regdomain_attach(ic);
284
285	ieee80211_sysctl_attach(ic);
286
287	ifp->if_addrlen = IEEE80211_ADDR_LEN;
288	ifp->if_hdrlen = 0;
289	if_attach(ifp);
290	ifp->if_mtu = IEEE80211_MTU_MAX;
291	ifp->if_broadcastaddr = ieee80211broadcastaddr;
292	ifp->if_output = null_output;
293	ifp->if_input = null_input;	/* just in case */
294	ifp->if_resolvemulti = NULL;	/* NB: callers check */
295
296	ifa = ifaddr_byindex(ifp->if_index);
297	KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
298	sdl = (struct sockaddr_dl *)ifa->ifa_addr;
299	sdl->sdl_type = IFT_ETHER;		/* XXX IFT_IEEE80211? */
300	sdl->sdl_alen = IEEE80211_ADDR_LEN;
301	IEEE80211_ADDR_COPY(LLADDR(sdl), macaddr);
302}
303
304/*
305 * Detach net80211 state on device detach.  Tear down
306 * all vap's and reclaim all common state prior to the
307 * device state going away.  Note we may call back into
308 * driver; it must be prepared for this.
309 */
310void
311ieee80211_ifdetach(struct ieee80211com *ic)
312{
313	struct ifnet *ifp = ic->ic_ifp;
314	struct ieee80211vap *vap;
315
316	while ((vap = TAILQ_FIRST(&ic->ic_vaps)) != NULL)
317		ieee80211_vap_destroy(vap);
318	ieee80211_waitfor_parent(ic);
319
320	ieee80211_sysctl_detach(ic);
321	ieee80211_regdomain_detach(ic);
322	ieee80211_scan_detach(ic);
323#ifdef IEEE80211_SUPPORT_SUPERG
324	ieee80211_superg_detach(ic);
325#endif
326	ieee80211_ht_detach(ic);
327	/* NB: must be called before ieee80211_node_detach */
328	ieee80211_proto_detach(ic);
329	ieee80211_crypto_detach(ic);
330	ieee80211_power_detach(ic);
331	ieee80211_node_detach(ic);
332	ifmedia_removeall(&ic->ic_media);
333
334	taskqueue_free(ic->ic_tq);
335	IEEE80211_LOCK_DESTROY(ic);
336	if_detach(ifp);
337}
338
339/*
340 * Default reset method for use with the ioctl support.  This
341 * method is invoked after any state change in the 802.11
342 * layer that should be propagated to the hardware but not
343 * require re-initialization of the 802.11 state machine (e.g
344 * rescanning for an ap).  We always return ENETRESET which
345 * should cause the driver to re-initialize the device. Drivers
346 * can override this method to implement more optimized support.
347 */
348static int
349default_reset(struct ieee80211vap *vap, u_long cmd)
350{
351	return ENETRESET;
352}
353
354/*
355 * Prepare a vap for use.  Drivers use this call to
356 * setup net80211 state in new vap's prior attaching
357 * them with ieee80211_vap_attach (below).
358 */
359int
360ieee80211_vap_setup(struct ieee80211com *ic, struct ieee80211vap *vap,
361	const char name[IFNAMSIZ], int unit, int opmode, int flags,
362	const uint8_t bssid[IEEE80211_ADDR_LEN],
363	const uint8_t macaddr[IEEE80211_ADDR_LEN])
364{
365	struct ifnet *ifp;
366
367	ifp = if_alloc(IFT_ETHER);
368	if (ifp == NULL) {
369		if_printf(ic->ic_ifp, "%s: unable to allocate ifnet\n",
370		    __func__);
371		return ENOMEM;
372	}
373	if_initname(ifp, name, unit);
374	ifp->if_softc = vap;			/* back pointer */
375	ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST;
376	ifp->if_start = ieee80211_start;
377	ifp->if_ioctl = ieee80211_ioctl;
378	ifp->if_watchdog = NULL;		/* NB: no watchdog routine */
379	ifp->if_init = ieee80211_init;
380	/* NB: input+output filled in by ether_ifattach */
381	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
382	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
383	IFQ_SET_READY(&ifp->if_snd);
384
385	vap->iv_ifp = ifp;
386	vap->iv_ic = ic;
387	vap->iv_flags = ic->ic_flags;		/* propagate common flags */
388	vap->iv_flags_ext = ic->ic_flags_ext;
389	vap->iv_flags_ven = ic->ic_flags_ven;
390	vap->iv_caps = ic->ic_caps &~ IEEE80211_C_OPMODE;
391	vap->iv_htcaps = ic->ic_htcaps;
392	vap->iv_opmode = opmode;
393	vap->iv_caps |= ieee80211_opcap[opmode];
394	switch (opmode) {
395	case IEEE80211_M_WDS:
396		/*
397		 * WDS links must specify the bssid of the far end.
398		 * For legacy operation this is a static relationship.
399		 * For non-legacy operation the station must associate
400		 * and be authorized to pass traffic.  Plumbing the
401		 * vap to the proper node happens when the vap
402		 * transitions to RUN state.
403		 */
404		IEEE80211_ADDR_COPY(vap->iv_des_bssid, bssid);
405		vap->iv_flags |= IEEE80211_F_DESBSSID;
406		if (flags & IEEE80211_CLONE_WDSLEGACY)
407			vap->iv_flags_ext |= IEEE80211_FEXT_WDSLEGACY;
408		break;
409#ifdef IEEE80211_SUPPORT_TDMA
410	case IEEE80211_M_AHDEMO:
411		if (flags & IEEE80211_CLONE_TDMA) {
412			/* NB: checked before clone operation allowed */
413			KASSERT(ic->ic_caps & IEEE80211_C_TDMA,
414			    ("not TDMA capable, ic_caps 0x%x", ic->ic_caps));
415			/*
416			 * Propagate TDMA capability to mark vap; this
417			 * cannot be removed and is used to distinguish
418			 * regular ahdemo operation from ahdemo+tdma.
419			 */
420			vap->iv_caps |= IEEE80211_C_TDMA;
421		}
422		break;
423#endif
424	}
425	/* auto-enable s/w beacon miss support */
426	if (flags & IEEE80211_CLONE_NOBEACONS)
427		vap->iv_flags_ext |= IEEE80211_FEXT_SWBMISS;
428	/*
429	 * Enable various functionality by default if we're
430	 * capable; the driver can override us if it knows better.
431	 */
432	if (vap->iv_caps & IEEE80211_C_WME)
433		vap->iv_flags |= IEEE80211_F_WME;
434	if (vap->iv_caps & IEEE80211_C_BURST)
435		vap->iv_flags |= IEEE80211_F_BURST;
436	/* NB: bg scanning only makes sense for station mode right now */
437	if (vap->iv_opmode == IEEE80211_M_STA &&
438	    (vap->iv_caps & IEEE80211_C_BGSCAN))
439		vap->iv_flags |= IEEE80211_F_BGSCAN;
440	vap->iv_flags |= IEEE80211_F_DOTH;	/* XXX no cap, just ena */
441	/* NB: DFS support only makes sense for ap mode right now */
442	if (vap->iv_opmode == IEEE80211_M_HOSTAP &&
443	    (vap->iv_caps & IEEE80211_C_DFS))
444		vap->iv_flags_ext |= IEEE80211_FEXT_DFS;
445
446	vap->iv_des_chan = IEEE80211_CHAN_ANYC;		/* any channel is ok */
447	vap->iv_bmissthreshold = IEEE80211_HWBMISS_DEFAULT;
448	vap->iv_dtim_period = IEEE80211_DTIM_DEFAULT;
449	/*
450	 * Install a default reset method for the ioctl support;
451	 * the driver can override this.
452	 */
453	vap->iv_reset = default_reset;
454
455	IEEE80211_ADDR_COPY(vap->iv_myaddr, macaddr);
456
457	ieee80211_sysctl_vattach(vap);
458	ieee80211_crypto_vattach(vap);
459	ieee80211_node_vattach(vap);
460	ieee80211_power_vattach(vap);
461	ieee80211_proto_vattach(vap);
462#ifdef IEEE80211_SUPPORT_SUPERG
463	ieee80211_superg_vattach(vap);
464#endif
465	ieee80211_ht_vattach(vap);
466	ieee80211_scan_vattach(vap);
467	ieee80211_regdomain_vattach(vap);
468	ieee80211_radiotap_vattach(vap);
469
470	return 0;
471}
472
473/*
474 * Activate a vap.  State should have been prepared with a
475 * call to ieee80211_vap_setup and by the driver.  On return
476 * from this call the vap is ready for use.
477 */
478int
479ieee80211_vap_attach(struct ieee80211vap *vap,
480	ifm_change_cb_t media_change, ifm_stat_cb_t media_stat)
481{
482	struct ifnet *ifp = vap->iv_ifp;
483	struct ieee80211com *ic = vap->iv_ic;
484	struct ifmediareq imr;
485	int maxrate;
486
487	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE,
488	    "%s: %s parent %s flags 0x%x flags_ext 0x%x\n",
489	    __func__, ieee80211_opmode_name[vap->iv_opmode],
490	    ic->ic_ifp->if_xname, vap->iv_flags, vap->iv_flags_ext);
491
492	/*
493	 * Do late attach work that cannot happen until after
494	 * the driver has had a chance to override defaults.
495	 */
496	ieee80211_node_latevattach(vap);
497	ieee80211_power_latevattach(vap);
498
499	maxrate = ieee80211_media_setup(ic, &vap->iv_media, vap->iv_caps,
500	    vap->iv_opmode == IEEE80211_M_STA, media_change, media_stat);
501	ieee80211_media_status(ifp, &imr);
502	/* NB: strip explicit mode; we're actually in autoselect */
503	ifmedia_set(&vap->iv_media,
504	    imr.ifm_active &~ (IFM_MMASK | IFM_IEEE80211_TURBO));
505	if (maxrate)
506		ifp->if_baudrate = IF_Mbps(maxrate);
507
508	ether_ifattach(ifp, vap->iv_myaddr);
509	/* hook output method setup by ether_ifattach */
510	vap->iv_output = ifp->if_output;
511	ifp->if_output = ieee80211_output;
512	/* NB: if_mtu set by ether_ifattach to ETHERMTU */
513
514	IEEE80211_LOCK(ic);
515	TAILQ_INSERT_TAIL(&ic->ic_vaps, vap, iv_next);
516	ieee80211_syncflag_locked(ic, IEEE80211_F_WME);
517#ifdef IEEE80211_SUPPORT_SUPERG
518	ieee80211_syncflag_locked(ic, IEEE80211_F_TURBOP);
519#endif
520	ieee80211_syncflag_locked(ic, IEEE80211_F_PCF);
521	ieee80211_syncflag_locked(ic, IEEE80211_F_BURST);
522	ieee80211_syncflag_ext_locked(ic, IEEE80211_FEXT_HT);
523	ieee80211_syncflag_ext_locked(ic, IEEE80211_FEXT_USEHT40);
524	ieee80211_syncifflag_locked(ic, IFF_PROMISC);
525	ieee80211_syncifflag_locked(ic, IFF_ALLMULTI);
526	IEEE80211_UNLOCK(ic);
527
528	return 1;
529}
530
531/*
532 * Tear down vap state and reclaim the ifnet.
533 * The driver is assumed to have prepared for
534 * this; e.g. by turning off interrupts for the
535 * underlying device.
536 */
537void
538ieee80211_vap_detach(struct ieee80211vap *vap)
539{
540	struct ieee80211com *ic = vap->iv_ic;
541	struct ifnet *ifp = vap->iv_ifp;
542
543	IEEE80211_DPRINTF(vap, IEEE80211_MSG_STATE, "%s: %s parent %s\n",
544	    __func__, ieee80211_opmode_name[vap->iv_opmode],
545	    ic->ic_ifp->if_xname);
546
547	IEEE80211_LOCK(ic);
548	/* block traffic from above */
549	ifp->if_drv_flags |= IFF_DRV_OACTIVE;
550	/*
551	 * Evil hack.  Clear the backpointer from the ifnet to the
552	 * vap so any requests from above will return an error or
553	 * be ignored.  In particular this short-circuits requests
554	 * by the bridge to turn off promiscuous mode as a result
555	 * of calling ether_ifdetach.
556	 */
557	ifp->if_softc = NULL;
558	/*
559	 * Stop the vap before detaching the ifnet.  Ideally we'd
560	 * do this in the other order so the ifnet is inaccessible
561	 * while we cleanup internal state but that is hard.
562	 */
563	ieee80211_stop_locked(vap);
564	IEEE80211_UNLOCK(ic);
565
566	/*
567	 * Flush any deferred vap tasks.
568	 * NB: must be before ether_ifdetach() and removal from ic_vaps list
569	 */
570	ieee80211_draintask(ic, &vap->iv_nstate_task);
571	ieee80211_draintask(ic, &vap->iv_swbmiss_task);
572
573	IEEE80211_LOCK(ic);
574	KASSERT(vap->iv_state == IEEE80211_S_INIT , ("vap still running"));
575	TAILQ_REMOVE(&ic->ic_vaps, vap, iv_next);
576	ieee80211_syncflag_locked(ic, IEEE80211_F_WME);
577#ifdef IEEE80211_SUPPORT_SUPERG
578	ieee80211_syncflag_locked(ic, IEEE80211_F_TURBOP);
579#endif
580	ieee80211_syncflag_locked(ic, IEEE80211_F_PCF);
581	ieee80211_syncflag_locked(ic, IEEE80211_F_BURST);
582	ieee80211_syncflag_ext_locked(ic, IEEE80211_FEXT_HT);
583	ieee80211_syncflag_ext_locked(ic, IEEE80211_FEXT_USEHT40);
584	/* NB: this handles the bpfdetach done below */
585	ieee80211_syncflag_ext_locked(ic, IEEE80211_FEXT_BPF);
586	ieee80211_syncifflag_locked(ic, IFF_PROMISC);
587	ieee80211_syncifflag_locked(ic, IFF_ALLMULTI);
588	IEEE80211_UNLOCK(ic);
589
590	/* XXX can't hold com lock */
591	/* NB: bpfdetach is called by ether_ifdetach and claims all taps */
592	ether_ifdetach(ifp);
593
594	ifmedia_removeall(&vap->iv_media);
595
596	ieee80211_radiotap_vdetach(vap);
597	ieee80211_regdomain_vdetach(vap);
598	ieee80211_scan_vdetach(vap);
599#ifdef IEEE80211_SUPPORT_SUPERG
600	ieee80211_superg_vdetach(vap);
601#endif
602	ieee80211_ht_vdetach(vap);
603	/* NB: must be before ieee80211_node_vdetach */
604	ieee80211_proto_vdetach(vap);
605	ieee80211_crypto_vdetach(vap);
606	ieee80211_power_vdetach(vap);
607	ieee80211_node_vdetach(vap);
608	ieee80211_sysctl_vdetach(vap);
609
610	if_free(ifp);
611}
612
613/*
614 * Synchronize flag bit state in the parent ifnet structure
615 * according to the state of all vap ifnet's.  This is used,
616 * for example, to handle IFF_PROMISC and IFF_ALLMULTI.
617 */
618void
619ieee80211_syncifflag_locked(struct ieee80211com *ic, int flag)
620{
621	struct ifnet *ifp = ic->ic_ifp;
622	struct ieee80211vap *vap;
623	int bit, oflags;
624
625	IEEE80211_LOCK_ASSERT(ic);
626
627	bit = 0;
628	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
629		if (vap->iv_ifp->if_flags & flag) {
630			/*
631			 * XXX the bridge sets PROMISC but we don't want to
632			 * enable it on the device, discard here so all the
633			 * drivers don't need to special-case it
634			 */
635			if (flag == IFF_PROMISC &&
636			    vap->iv_opmode == IEEE80211_M_HOSTAP)
637				continue;
638			bit = 1;
639			break;
640		}
641	oflags = ifp->if_flags;
642	if (bit)
643		ifp->if_flags |= flag;
644	else
645		ifp->if_flags &= ~flag;
646	if ((ifp->if_flags ^ oflags) & flag) {
647		/* XXX should we return 1/0 and let caller do this? */
648		if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
649			if (flag == IFF_PROMISC)
650				ieee80211_runtask(ic, &ic->ic_promisc_task);
651			else if (flag == IFF_ALLMULTI)
652				ieee80211_runtask(ic, &ic->ic_mcast_task);
653		}
654	}
655}
656
657/*
658 * Synchronize flag bit state in the com structure
659 * according to the state of all vap's.  This is used,
660 * for example, to handle state changes via ioctls.
661 */
662static void
663ieee80211_syncflag_locked(struct ieee80211com *ic, int flag)
664{
665	struct ieee80211vap *vap;
666	int bit;
667
668	IEEE80211_LOCK_ASSERT(ic);
669
670	bit = 0;
671	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
672		if (vap->iv_flags & flag) {
673			bit = 1;
674			break;
675		}
676	if (bit)
677		ic->ic_flags |= flag;
678	else
679		ic->ic_flags &= ~flag;
680}
681
682void
683ieee80211_syncflag(struct ieee80211vap *vap, int flag)
684{
685	struct ieee80211com *ic = vap->iv_ic;
686
687	IEEE80211_LOCK(ic);
688	if (flag < 0) {
689		flag = -flag;
690		vap->iv_flags &= ~flag;
691	} else
692		vap->iv_flags |= flag;
693	ieee80211_syncflag_locked(ic, flag);
694	IEEE80211_UNLOCK(ic);
695}
696
697/*
698 * Synchronize flag bit state in the com structure
699 * according to the state of all vap's.  This is used,
700 * for example, to handle state changes via ioctls.
701 */
702static void
703ieee80211_syncflag_ext_locked(struct ieee80211com *ic, int flag)
704{
705	struct ieee80211vap *vap;
706	int bit;
707
708	IEEE80211_LOCK_ASSERT(ic);
709
710	bit = 0;
711	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
712		if (vap->iv_flags_ext & flag) {
713			bit = 1;
714			break;
715		}
716	if (bit)
717		ic->ic_flags_ext |= flag;
718	else
719		ic->ic_flags_ext &= ~flag;
720}
721
722void
723ieee80211_syncflag_ext(struct ieee80211vap *vap, int flag)
724{
725	struct ieee80211com *ic = vap->iv_ic;
726
727	IEEE80211_LOCK(ic);
728	if (flag < 0) {
729		flag = -flag;
730		vap->iv_flags_ext &= ~flag;
731	} else
732		vap->iv_flags_ext |= flag;
733	ieee80211_syncflag_ext_locked(ic, flag);
734	IEEE80211_UNLOCK(ic);
735}
736
737static __inline int
738mapgsm(u_int freq, u_int flags)
739{
740	freq *= 10;
741	if (flags & IEEE80211_CHAN_QUARTER)
742		freq += 5;
743	else if (flags & IEEE80211_CHAN_HALF)
744		freq += 10;
745	else
746		freq += 20;
747	/* NB: there is no 907/20 wide but leave room */
748	return (freq - 906*10) / 5;
749}
750
751static __inline int
752mappsb(u_int freq, u_int flags)
753{
754	return 37 + ((freq * 10) + ((freq % 5) == 2 ? 5 : 0) - 49400) / 5;
755}
756
757/*
758 * Convert MHz frequency to IEEE channel number.
759 */
760int
761ieee80211_mhz2ieee(u_int freq, u_int flags)
762{
763#define	IS_FREQ_IN_PSB(_freq) ((_freq) > 4940 && (_freq) < 4990)
764	if (flags & IEEE80211_CHAN_GSM)
765		return mapgsm(freq, flags);
766	if (flags & IEEE80211_CHAN_2GHZ) {	/* 2GHz band */
767		if (freq == 2484)
768			return 14;
769		if (freq < 2484)
770			return ((int) freq - 2407) / 5;
771		else
772			return 15 + ((freq - 2512) / 20);
773	} else if (flags & IEEE80211_CHAN_5GHZ) {	/* 5Ghz band */
774		if (freq <= 5000) {
775			/* XXX check regdomain? */
776			if (IS_FREQ_IN_PSB(freq))
777				return mappsb(freq, flags);
778			return (freq - 4000) / 5;
779		} else
780			return (freq - 5000) / 5;
781	} else {				/* either, guess */
782		if (freq == 2484)
783			return 14;
784		if (freq < 2484) {
785			if (907 <= freq && freq <= 922)
786				return mapgsm(freq, flags);
787			return ((int) freq - 2407) / 5;
788		}
789		if (freq < 5000) {
790			if (IS_FREQ_IN_PSB(freq))
791				return mappsb(freq, flags);
792			else if (freq > 4900)
793				return (freq - 4000) / 5;
794			else
795				return 15 + ((freq - 2512) / 20);
796		}
797		return (freq - 5000) / 5;
798	}
799#undef IS_FREQ_IN_PSB
800}
801
802/*
803 * Convert channel to IEEE channel number.
804 */
805int
806ieee80211_chan2ieee(struct ieee80211com *ic, const struct ieee80211_channel *c)
807{
808	if (c == NULL) {
809		if_printf(ic->ic_ifp, "invalid channel (NULL)\n");
810		return 0;		/* XXX */
811	}
812	return (c == IEEE80211_CHAN_ANYC ?  IEEE80211_CHAN_ANY : c->ic_ieee);
813}
814
815/*
816 * Convert IEEE channel number to MHz frequency.
817 */
818u_int
819ieee80211_ieee2mhz(u_int chan, u_int flags)
820{
821	if (flags & IEEE80211_CHAN_GSM)
822		return 907 + 5 * (chan / 10);
823	if (flags & IEEE80211_CHAN_2GHZ) {	/* 2GHz band */
824		if (chan == 14)
825			return 2484;
826		if (chan < 14)
827			return 2407 + chan*5;
828		else
829			return 2512 + ((chan-15)*20);
830	} else if (flags & IEEE80211_CHAN_5GHZ) {/* 5Ghz band */
831		if (flags & (IEEE80211_CHAN_HALF|IEEE80211_CHAN_QUARTER)) {
832			chan -= 37;
833			return 4940 + chan*5 + (chan % 5 ? 2 : 0);
834		}
835		return 5000 + (chan*5);
836	} else {				/* either, guess */
837		/* XXX can't distinguish PSB+GSM channels */
838		if (chan == 14)
839			return 2484;
840		if (chan < 14)			/* 0-13 */
841			return 2407 + chan*5;
842		if (chan < 27)			/* 15-26 */
843			return 2512 + ((chan-15)*20);
844		return 5000 + (chan*5);
845	}
846}
847
848/*
849 * Locate a channel given a frequency+flags.  We cache
850 * the previous lookup to optimize switching between two
851 * channels--as happens with dynamic turbo.
852 */
853struct ieee80211_channel *
854ieee80211_find_channel(struct ieee80211com *ic, int freq, int flags)
855{
856	struct ieee80211_channel *c;
857	int i;
858
859	flags &= IEEE80211_CHAN_ALLTURBO;
860	c = ic->ic_prevchan;
861	if (c != NULL && c->ic_freq == freq &&
862	    (c->ic_flags & IEEE80211_CHAN_ALLTURBO) == flags)
863		return c;
864	/* brute force search */
865	for (i = 0; i < ic->ic_nchans; i++) {
866		c = &ic->ic_channels[i];
867		if (c->ic_freq == freq &&
868		    (c->ic_flags & IEEE80211_CHAN_ALLTURBO) == flags)
869			return c;
870	}
871	return NULL;
872}
873
874/*
875 * Locate a channel given a channel number+flags.  We cache
876 * the previous lookup to optimize switching between two
877 * channels--as happens with dynamic turbo.
878 */
879struct ieee80211_channel *
880ieee80211_find_channel_byieee(struct ieee80211com *ic, int ieee, int flags)
881{
882	struct ieee80211_channel *c;
883	int i;
884
885	flags &= IEEE80211_CHAN_ALLTURBO;
886	c = ic->ic_prevchan;
887	if (c != NULL && c->ic_ieee == ieee &&
888	    (c->ic_flags & IEEE80211_CHAN_ALLTURBO) == flags)
889		return c;
890	/* brute force search */
891	for (i = 0; i < ic->ic_nchans; i++) {
892		c = &ic->ic_channels[i];
893		if (c->ic_ieee == ieee &&
894		    (c->ic_flags & IEEE80211_CHAN_ALLTURBO) == flags)
895			return c;
896	}
897	return NULL;
898}
899
900static void
901addmedia(struct ifmedia *media, int caps, int addsta, int mode, int mword)
902{
903#define	ADD(_ic, _s, _o) \
904	ifmedia_add(media, \
905		IFM_MAKEWORD(IFM_IEEE80211, (_s), (_o), 0), 0, NULL)
906	static const u_int mopts[IEEE80211_MODE_MAX] = {
907	    [IEEE80211_MODE_AUTO]	= IFM_AUTO,
908	    [IEEE80211_MODE_11A]	= IFM_IEEE80211_11A,
909	    [IEEE80211_MODE_11B]	= IFM_IEEE80211_11B,
910	    [IEEE80211_MODE_11G]	= IFM_IEEE80211_11G,
911	    [IEEE80211_MODE_FH]		= IFM_IEEE80211_FH,
912	    [IEEE80211_MODE_TURBO_A]	= IFM_IEEE80211_11A|IFM_IEEE80211_TURBO,
913	    [IEEE80211_MODE_TURBO_G]	= IFM_IEEE80211_11G|IFM_IEEE80211_TURBO,
914	    [IEEE80211_MODE_STURBO_A]	= IFM_IEEE80211_11A|IFM_IEEE80211_TURBO,
915	    [IEEE80211_MODE_HALF]	= IFM_IEEE80211_11A,	/* XXX */
916	    [IEEE80211_MODE_QUARTER]	= IFM_IEEE80211_11A,	/* XXX */
917	    [IEEE80211_MODE_11NA]	= IFM_IEEE80211_11NA,
918	    [IEEE80211_MODE_11NG]	= IFM_IEEE80211_11NG,
919	};
920	u_int mopt;
921
922	mopt = mopts[mode];
923	if (addsta)
924		ADD(ic, mword, mopt);	/* STA mode has no cap */
925	if (caps & IEEE80211_C_IBSS)
926		ADD(media, mword, mopt | IFM_IEEE80211_ADHOC);
927	if (caps & IEEE80211_C_HOSTAP)
928		ADD(media, mword, mopt | IFM_IEEE80211_HOSTAP);
929	if (caps & IEEE80211_C_AHDEMO)
930		ADD(media, mword, mopt | IFM_IEEE80211_ADHOC | IFM_FLAG0);
931	if (caps & IEEE80211_C_MONITOR)
932		ADD(media, mword, mopt | IFM_IEEE80211_MONITOR);
933	if (caps & IEEE80211_C_WDS)
934		ADD(media, mword, mopt | IFM_IEEE80211_WDS);
935#undef ADD
936}
937
938/*
939 * Setup the media data structures according to the channel and
940 * rate tables.
941 */
942static int
943ieee80211_media_setup(struct ieee80211com *ic,
944	struct ifmedia *media, int caps, int addsta,
945	ifm_change_cb_t media_change, ifm_stat_cb_t media_stat)
946{
947	int i, j, mode, rate, maxrate, mword, r;
948	const struct ieee80211_rateset *rs;
949	struct ieee80211_rateset allrates;
950
951	/*
952	 * Fill in media characteristics.
953	 */
954	ifmedia_init(media, 0, media_change, media_stat);
955	maxrate = 0;
956	/*
957	 * Add media for legacy operating modes.
958	 */
959	memset(&allrates, 0, sizeof(allrates));
960	for (mode = IEEE80211_MODE_AUTO; mode < IEEE80211_MODE_11NA; mode++) {
961		if (isclr(ic->ic_modecaps, mode))
962			continue;
963		addmedia(media, caps, addsta, mode, IFM_AUTO);
964		if (mode == IEEE80211_MODE_AUTO)
965			continue;
966		rs = &ic->ic_sup_rates[mode];
967		for (i = 0; i < rs->rs_nrates; i++) {
968			rate = rs->rs_rates[i];
969			mword = ieee80211_rate2media(ic, rate, mode);
970			if (mword == 0)
971				continue;
972			addmedia(media, caps, addsta, mode, mword);
973			/*
974			 * Add legacy rate to the collection of all rates.
975			 */
976			r = rate & IEEE80211_RATE_VAL;
977			for (j = 0; j < allrates.rs_nrates; j++)
978				if (allrates.rs_rates[j] == r)
979					break;
980			if (j == allrates.rs_nrates) {
981				/* unique, add to the set */
982				allrates.rs_rates[j] = r;
983				allrates.rs_nrates++;
984			}
985			rate = (rate & IEEE80211_RATE_VAL) / 2;
986			if (rate > maxrate)
987				maxrate = rate;
988		}
989	}
990	for (i = 0; i < allrates.rs_nrates; i++) {
991		mword = ieee80211_rate2media(ic, allrates.rs_rates[i],
992				IEEE80211_MODE_AUTO);
993		if (mword == 0)
994			continue;
995		/* NB: remove media options from mword */
996		addmedia(media, caps, addsta,
997		    IEEE80211_MODE_AUTO, IFM_SUBTYPE(mword));
998	}
999	/*
1000	 * Add HT/11n media.  Note that we do not have enough
1001	 * bits in the media subtype to express the MCS so we
1002	 * use a "placeholder" media subtype and any fixed MCS
1003	 * must be specified with a different mechanism.
1004	 */
1005	for (; mode <= IEEE80211_MODE_11NG; mode++) {
1006		if (isclr(ic->ic_modecaps, mode))
1007			continue;
1008		addmedia(media, caps, addsta, mode, IFM_AUTO);
1009		addmedia(media, caps, addsta, mode, IFM_IEEE80211_MCS);
1010	}
1011	if (isset(ic->ic_modecaps, IEEE80211_MODE_11NA) ||
1012	    isset(ic->ic_modecaps, IEEE80211_MODE_11NG)) {
1013		addmedia(media, caps, addsta,
1014		    IEEE80211_MODE_AUTO, IFM_IEEE80211_MCS);
1015		/* XXX could walk htrates */
1016		/* XXX known array size */
1017		if (ieee80211_htrates[15].ht40_rate_400ns > maxrate)
1018			maxrate = ieee80211_htrates[15].ht40_rate_400ns;
1019	}
1020	return maxrate;
1021}
1022
1023void
1024ieee80211_media_init(struct ieee80211com *ic)
1025{
1026	struct ifnet *ifp = ic->ic_ifp;
1027	int maxrate;
1028
1029	/* NB: this works because the structure is initialized to zero */
1030	if (!LIST_EMPTY(&ic->ic_media.ifm_list)) {
1031		/*
1032		 * We are re-initializing the channel list; clear
1033		 * the existing media state as the media routines
1034		 * don't suppress duplicates.
1035		 */
1036		ifmedia_removeall(&ic->ic_media);
1037	}
1038	ieee80211_chan_init(ic);
1039
1040	/*
1041	 * Recalculate media settings in case new channel list changes
1042	 * the set of available modes.
1043	 */
1044	maxrate = ieee80211_media_setup(ic, &ic->ic_media, ic->ic_caps, 1,
1045		ieee80211com_media_change, ieee80211com_media_status);
1046	/* NB: strip explicit mode; we're actually in autoselect */
1047	ifmedia_set(&ic->ic_media,
1048	    media_status(ic->ic_opmode, ic->ic_curchan) &~
1049		(IFM_MMASK | IFM_IEEE80211_TURBO));
1050	if (maxrate)
1051		ifp->if_baudrate = IF_Mbps(maxrate);
1052
1053	/* XXX need to propagate new media settings to vap's */
1054}
1055
1056/* XXX inline or eliminate? */
1057const struct ieee80211_rateset *
1058ieee80211_get_suprates(struct ieee80211com *ic, const struct ieee80211_channel *c)
1059{
1060	/* XXX does this work for 11ng basic rates? */
1061	return &ic->ic_sup_rates[ieee80211_chan2mode(c)];
1062}
1063
1064void
1065ieee80211_announce(struct ieee80211com *ic)
1066{
1067	struct ifnet *ifp = ic->ic_ifp;
1068	int i, mode, rate, mword;
1069	const struct ieee80211_rateset *rs;
1070
1071	/* NB: skip AUTO since it has no rates */
1072	for (mode = IEEE80211_MODE_AUTO+1; mode < IEEE80211_MODE_11NA; mode++) {
1073		if (isclr(ic->ic_modecaps, mode))
1074			continue;
1075		if_printf(ifp, "%s rates: ", ieee80211_phymode_name[mode]);
1076		rs = &ic->ic_sup_rates[mode];
1077		for (i = 0; i < rs->rs_nrates; i++) {
1078			mword = ieee80211_rate2media(ic, rs->rs_rates[i], mode);
1079			if (mword == 0)
1080				continue;
1081			rate = ieee80211_media2rate(mword);
1082			printf("%s%d%sMbps", (i != 0 ? " " : ""),
1083			    rate / 2, ((rate & 0x1) != 0 ? ".5" : ""));
1084		}
1085		printf("\n");
1086	}
1087	ieee80211_ht_announce(ic);
1088}
1089
1090void
1091ieee80211_announce_channels(struct ieee80211com *ic)
1092{
1093	const struct ieee80211_channel *c;
1094	char type;
1095	int i, cw;
1096
1097	printf("Chan  Freq  CW  RegPwr  MinPwr  MaxPwr\n");
1098	for (i = 0; i < ic->ic_nchans; i++) {
1099		c = &ic->ic_channels[i];
1100		if (IEEE80211_IS_CHAN_ST(c))
1101			type = 'S';
1102		else if (IEEE80211_IS_CHAN_108A(c))
1103			type = 'T';
1104		else if (IEEE80211_IS_CHAN_108G(c))
1105			type = 'G';
1106		else if (IEEE80211_IS_CHAN_HT(c))
1107			type = 'n';
1108		else if (IEEE80211_IS_CHAN_A(c))
1109			type = 'a';
1110		else if (IEEE80211_IS_CHAN_ANYG(c))
1111			type = 'g';
1112		else if (IEEE80211_IS_CHAN_B(c))
1113			type = 'b';
1114		else
1115			type = 'f';
1116		if (IEEE80211_IS_CHAN_HT40(c) || IEEE80211_IS_CHAN_TURBO(c))
1117			cw = 40;
1118		else if (IEEE80211_IS_CHAN_HALF(c))
1119			cw = 10;
1120		else if (IEEE80211_IS_CHAN_QUARTER(c))
1121			cw = 5;
1122		else
1123			cw = 20;
1124		printf("%4d  %4d%c %2d%c %6d  %4d.%d  %4d.%d\n"
1125			, c->ic_ieee, c->ic_freq, type
1126			, cw
1127			, IEEE80211_IS_CHAN_HT40U(c) ? '+' :
1128			  IEEE80211_IS_CHAN_HT40D(c) ? '-' : ' '
1129			, c->ic_maxregpower
1130			, c->ic_minpower / 2, c->ic_minpower & 1 ? 5 : 0
1131			, c->ic_maxpower / 2, c->ic_maxpower & 1 ? 5 : 0
1132		);
1133	}
1134}
1135
1136static int
1137media2mode(const struct ifmedia_entry *ime, uint32_t flags, uint16_t *mode)
1138{
1139	switch (IFM_MODE(ime->ifm_media)) {
1140	case IFM_IEEE80211_11A:
1141		*mode = IEEE80211_MODE_11A;
1142		break;
1143	case IFM_IEEE80211_11B:
1144		*mode = IEEE80211_MODE_11B;
1145		break;
1146	case IFM_IEEE80211_11G:
1147		*mode = IEEE80211_MODE_11G;
1148		break;
1149	case IFM_IEEE80211_FH:
1150		*mode = IEEE80211_MODE_FH;
1151		break;
1152	case IFM_IEEE80211_11NA:
1153		*mode = IEEE80211_MODE_11NA;
1154		break;
1155	case IFM_IEEE80211_11NG:
1156		*mode = IEEE80211_MODE_11NG;
1157		break;
1158	case IFM_AUTO:
1159		*mode = IEEE80211_MODE_AUTO;
1160		break;
1161	default:
1162		return 0;
1163	}
1164	/*
1165	 * Turbo mode is an ``option''.
1166	 * XXX does not apply to AUTO
1167	 */
1168	if (ime->ifm_media & IFM_IEEE80211_TURBO) {
1169		if (*mode == IEEE80211_MODE_11A) {
1170			if (flags & IEEE80211_F_TURBOP)
1171				*mode = IEEE80211_MODE_TURBO_A;
1172			else
1173				*mode = IEEE80211_MODE_STURBO_A;
1174		} else if (*mode == IEEE80211_MODE_11G)
1175			*mode = IEEE80211_MODE_TURBO_G;
1176		else
1177			return 0;
1178	}
1179	/* XXX HT40 +/- */
1180	return 1;
1181}
1182
1183/*
1184 * Handle a media change request on the underlying interface.
1185 */
1186int
1187ieee80211com_media_change(struct ifnet *ifp)
1188{
1189	return EINVAL;
1190}
1191
1192/*
1193 * Handle a media change request on the vap interface.
1194 */
1195int
1196ieee80211_media_change(struct ifnet *ifp)
1197{
1198	struct ieee80211vap *vap = ifp->if_softc;
1199	struct ifmedia_entry *ime = vap->iv_media.ifm_cur;
1200	uint16_t newmode;
1201
1202	if (!media2mode(ime, vap->iv_flags, &newmode))
1203		return EINVAL;
1204	if (vap->iv_des_mode != newmode) {
1205		vap->iv_des_mode = newmode;
1206		return ENETRESET;
1207	}
1208	return 0;
1209}
1210
1211/*
1212 * Common code to calculate the media status word
1213 * from the operating mode and channel state.
1214 */
1215static int
1216media_status(enum ieee80211_opmode opmode, const struct ieee80211_channel *chan)
1217{
1218	int status;
1219
1220	status = IFM_IEEE80211;
1221	switch (opmode) {
1222	case IEEE80211_M_STA:
1223		break;
1224	case IEEE80211_M_IBSS:
1225		status |= IFM_IEEE80211_ADHOC;
1226		break;
1227	case IEEE80211_M_HOSTAP:
1228		status |= IFM_IEEE80211_HOSTAP;
1229		break;
1230	case IEEE80211_M_MONITOR:
1231		status |= IFM_IEEE80211_MONITOR;
1232		break;
1233	case IEEE80211_M_AHDEMO:
1234		status |= IFM_IEEE80211_ADHOC | IFM_FLAG0;
1235		break;
1236	case IEEE80211_M_WDS:
1237		status |= IFM_IEEE80211_WDS;
1238		break;
1239	}
1240	if (IEEE80211_IS_CHAN_HTA(chan)) {
1241		status |= IFM_IEEE80211_11NA;
1242	} else if (IEEE80211_IS_CHAN_HTG(chan)) {
1243		status |= IFM_IEEE80211_11NG;
1244	} else if (IEEE80211_IS_CHAN_A(chan)) {
1245		status |= IFM_IEEE80211_11A;
1246	} else if (IEEE80211_IS_CHAN_B(chan)) {
1247		status |= IFM_IEEE80211_11B;
1248	} else if (IEEE80211_IS_CHAN_ANYG(chan)) {
1249		status |= IFM_IEEE80211_11G;
1250	} else if (IEEE80211_IS_CHAN_FHSS(chan)) {
1251		status |= IFM_IEEE80211_FH;
1252	}
1253	/* XXX else complain? */
1254
1255	if (IEEE80211_IS_CHAN_TURBO(chan))
1256		status |= IFM_IEEE80211_TURBO;
1257#if 0
1258	if (IEEE80211_IS_CHAN_HT20(chan))
1259		status |= IFM_IEEE80211_HT20;
1260	if (IEEE80211_IS_CHAN_HT40(chan))
1261		status |= IFM_IEEE80211_HT40;
1262#endif
1263	return status;
1264}
1265
1266static void
1267ieee80211com_media_status(struct ifnet *ifp, struct ifmediareq *imr)
1268{
1269	struct ieee80211com *ic = ifp->if_l2com;
1270	struct ieee80211vap *vap;
1271
1272	imr->ifm_status = IFM_AVALID;
1273	TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next)
1274		if (vap->iv_ifp->if_flags & IFF_UP) {
1275			imr->ifm_status |= IFM_ACTIVE;
1276			break;
1277		}
1278	imr->ifm_active = media_status(ic->ic_opmode, ic->ic_curchan);
1279	if (imr->ifm_status & IFM_ACTIVE)
1280		imr->ifm_current = imr->ifm_active;
1281}
1282
1283void
1284ieee80211_media_status(struct ifnet *ifp, struct ifmediareq *imr)
1285{
1286	struct ieee80211vap *vap = ifp->if_softc;
1287	struct ieee80211com *ic = vap->iv_ic;
1288	enum ieee80211_phymode mode;
1289
1290	imr->ifm_status = IFM_AVALID;
1291	/*
1292	 * NB: use the current channel's mode to lock down a xmit
1293	 * rate only when running; otherwise we may have a mismatch
1294	 * in which case the rate will not be convertible.
1295	 */
1296	if (vap->iv_state == IEEE80211_S_RUN) {
1297		imr->ifm_status |= IFM_ACTIVE;
1298		mode = ieee80211_chan2mode(ic->ic_curchan);
1299	} else
1300		mode = IEEE80211_MODE_AUTO;
1301	imr->ifm_active = media_status(vap->iv_opmode, ic->ic_curchan);
1302	/*
1303	 * Calculate a current rate if possible.
1304	 */
1305	if (vap->iv_txparms[mode].ucastrate != IEEE80211_FIXED_RATE_NONE) {
1306		/*
1307		 * A fixed rate is set, report that.
1308		 */
1309		imr->ifm_active |= ieee80211_rate2media(ic,
1310			vap->iv_txparms[mode].ucastrate, mode);
1311	} else if (vap->iv_opmode == IEEE80211_M_STA) {
1312		/*
1313		 * In station mode report the current transmit rate.
1314		 */
1315		imr->ifm_active |= ieee80211_rate2media(ic,
1316			vap->iv_bss->ni_txrate, mode);
1317	} else
1318		imr->ifm_active |= IFM_AUTO;
1319	if (imr->ifm_status & IFM_ACTIVE)
1320		imr->ifm_current = imr->ifm_active;
1321}
1322
1323/*
1324 * Set the current phy mode and recalculate the active channel
1325 * set based on the available channels for this mode.  Also
1326 * select a new default/current channel if the current one is
1327 * inappropriate for this mode.
1328 */
1329int
1330ieee80211_setmode(struct ieee80211com *ic, enum ieee80211_phymode mode)
1331{
1332	/*
1333	 * Adjust basic rates in 11b/11g supported rate set.
1334	 * Note that if operating on a hal/quarter rate channel
1335	 * this is a noop as those rates sets are different
1336	 * and used instead.
1337	 */
1338	if (mode == IEEE80211_MODE_11G || mode == IEEE80211_MODE_11B)
1339		ieee80211_setbasicrates(&ic->ic_sup_rates[mode], mode);
1340
1341	ic->ic_curmode = mode;
1342	ieee80211_reset_erp(ic);	/* reset ERP state */
1343
1344	return 0;
1345}
1346
1347/*
1348 * Return the phy mode for with the specified channel.
1349 */
1350enum ieee80211_phymode
1351ieee80211_chan2mode(const struct ieee80211_channel *chan)
1352{
1353
1354	if (IEEE80211_IS_CHAN_HTA(chan))
1355		return IEEE80211_MODE_11NA;
1356	else if (IEEE80211_IS_CHAN_HTG(chan))
1357		return IEEE80211_MODE_11NG;
1358	else if (IEEE80211_IS_CHAN_108G(chan))
1359		return IEEE80211_MODE_TURBO_G;
1360	else if (IEEE80211_IS_CHAN_ST(chan))
1361		return IEEE80211_MODE_STURBO_A;
1362	else if (IEEE80211_IS_CHAN_TURBO(chan))
1363		return IEEE80211_MODE_TURBO_A;
1364	else if (IEEE80211_IS_CHAN_HALF(chan))
1365		return IEEE80211_MODE_HALF;
1366	else if (IEEE80211_IS_CHAN_QUARTER(chan))
1367		return IEEE80211_MODE_QUARTER;
1368	else if (IEEE80211_IS_CHAN_A(chan))
1369		return IEEE80211_MODE_11A;
1370	else if (IEEE80211_IS_CHAN_ANYG(chan))
1371		return IEEE80211_MODE_11G;
1372	else if (IEEE80211_IS_CHAN_B(chan))
1373		return IEEE80211_MODE_11B;
1374	else if (IEEE80211_IS_CHAN_FHSS(chan))
1375		return IEEE80211_MODE_FH;
1376
1377	/* NB: should not get here */
1378	printf("%s: cannot map channel to mode; freq %u flags 0x%x\n",
1379		__func__, chan->ic_freq, chan->ic_flags);
1380	return IEEE80211_MODE_11B;
1381}
1382
1383struct ratemedia {
1384	u_int	match;	/* rate + mode */
1385	u_int	media;	/* if_media rate */
1386};
1387
1388static int
1389findmedia(const struct ratemedia rates[], int n, u_int match)
1390{
1391	int i;
1392
1393	for (i = 0; i < n; i++)
1394		if (rates[i].match == match)
1395			return rates[i].media;
1396	return IFM_AUTO;
1397}
1398
1399/*
1400 * Convert IEEE80211 rate value to ifmedia subtype.
1401 * Rate is either a legacy rate in units of 0.5Mbps
1402 * or an MCS index.
1403 */
1404int
1405ieee80211_rate2media(struct ieee80211com *ic, int rate, enum ieee80211_phymode mode)
1406{
1407#define	N(a)	(sizeof(a) / sizeof(a[0]))
1408	static const struct ratemedia rates[] = {
1409		{   2 | IFM_IEEE80211_FH, IFM_IEEE80211_FH1 },
1410		{   4 | IFM_IEEE80211_FH, IFM_IEEE80211_FH2 },
1411		{   2 | IFM_IEEE80211_11B, IFM_IEEE80211_DS1 },
1412		{   4 | IFM_IEEE80211_11B, IFM_IEEE80211_DS2 },
1413		{  11 | IFM_IEEE80211_11B, IFM_IEEE80211_DS5 },
1414		{  22 | IFM_IEEE80211_11B, IFM_IEEE80211_DS11 },
1415		{  44 | IFM_IEEE80211_11B, IFM_IEEE80211_DS22 },
1416		{  12 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM6 },
1417		{  18 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM9 },
1418		{  24 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM12 },
1419		{  36 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM18 },
1420		{  48 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM24 },
1421		{  72 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM36 },
1422		{  96 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM48 },
1423		{ 108 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM54 },
1424		{   2 | IFM_IEEE80211_11G, IFM_IEEE80211_DS1 },
1425		{   4 | IFM_IEEE80211_11G, IFM_IEEE80211_DS2 },
1426		{  11 | IFM_IEEE80211_11G, IFM_IEEE80211_DS5 },
1427		{  22 | IFM_IEEE80211_11G, IFM_IEEE80211_DS11 },
1428		{  12 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM6 },
1429		{  18 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM9 },
1430		{  24 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM12 },
1431		{  36 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM18 },
1432		{  48 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM24 },
1433		{  72 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM36 },
1434		{  96 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM48 },
1435		{ 108 | IFM_IEEE80211_11G, IFM_IEEE80211_OFDM54 },
1436		{   6 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM3 },
1437		{   9 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM4 },
1438		{  54 | IFM_IEEE80211_11A, IFM_IEEE80211_OFDM27 },
1439		/* NB: OFDM72 doesn't realy exist so we don't handle it */
1440	};
1441	static const struct ratemedia htrates[] = {
1442		{   0, IFM_IEEE80211_MCS },
1443		{   1, IFM_IEEE80211_MCS },
1444		{   2, IFM_IEEE80211_MCS },
1445		{   3, IFM_IEEE80211_MCS },
1446		{   4, IFM_IEEE80211_MCS },
1447		{   5, IFM_IEEE80211_MCS },
1448		{   6, IFM_IEEE80211_MCS },
1449		{   7, IFM_IEEE80211_MCS },
1450		{   8, IFM_IEEE80211_MCS },
1451		{   9, IFM_IEEE80211_MCS },
1452		{  10, IFM_IEEE80211_MCS },
1453		{  11, IFM_IEEE80211_MCS },
1454		{  12, IFM_IEEE80211_MCS },
1455		{  13, IFM_IEEE80211_MCS },
1456		{  14, IFM_IEEE80211_MCS },
1457		{  15, IFM_IEEE80211_MCS },
1458	};
1459	int m;
1460
1461	/*
1462	 * Check 11n rates first for match as an MCS.
1463	 */
1464	if (mode == IEEE80211_MODE_11NA) {
1465		if (rate & IEEE80211_RATE_MCS) {
1466			rate &= ~IEEE80211_RATE_MCS;
1467			m = findmedia(htrates, N(htrates), rate);
1468			if (m != IFM_AUTO)
1469				return m | IFM_IEEE80211_11NA;
1470		}
1471	} else if (mode == IEEE80211_MODE_11NG) {
1472		/* NB: 12 is ambiguous, it will be treated as an MCS */
1473		if (rate & IEEE80211_RATE_MCS) {
1474			rate &= ~IEEE80211_RATE_MCS;
1475			m = findmedia(htrates, N(htrates), rate);
1476			if (m != IFM_AUTO)
1477				return m | IFM_IEEE80211_11NG;
1478		}
1479	}
1480	rate &= IEEE80211_RATE_VAL;
1481	switch (mode) {
1482	case IEEE80211_MODE_11A:
1483	case IEEE80211_MODE_HALF:		/* XXX good 'nuf */
1484	case IEEE80211_MODE_QUARTER:
1485	case IEEE80211_MODE_11NA:
1486	case IEEE80211_MODE_TURBO_A:
1487	case IEEE80211_MODE_STURBO_A:
1488		return findmedia(rates, N(rates), rate | IFM_IEEE80211_11A);
1489	case IEEE80211_MODE_11B:
1490		return findmedia(rates, N(rates), rate | IFM_IEEE80211_11B);
1491	case IEEE80211_MODE_FH:
1492		return findmedia(rates, N(rates), rate | IFM_IEEE80211_FH);
1493	case IEEE80211_MODE_AUTO:
1494		/* NB: ic may be NULL for some drivers */
1495		if (ic != NULL && ic->ic_phytype == IEEE80211_T_FH)
1496			return findmedia(rates, N(rates),
1497			    rate | IFM_IEEE80211_FH);
1498		/* NB: hack, 11g matches both 11b+11a rates */
1499		/* fall thru... */
1500	case IEEE80211_MODE_11G:
1501	case IEEE80211_MODE_11NG:
1502	case IEEE80211_MODE_TURBO_G:
1503		return findmedia(rates, N(rates), rate | IFM_IEEE80211_11G);
1504	}
1505	return IFM_AUTO;
1506#undef N
1507}
1508
1509int
1510ieee80211_media2rate(int mword)
1511{
1512#define	N(a)	(sizeof(a) / sizeof(a[0]))
1513	static const int ieeerates[] = {
1514		-1,		/* IFM_AUTO */
1515		0,		/* IFM_MANUAL */
1516		0,		/* IFM_NONE */
1517		2,		/* IFM_IEEE80211_FH1 */
1518		4,		/* IFM_IEEE80211_FH2 */
1519		2,		/* IFM_IEEE80211_DS1 */
1520		4,		/* IFM_IEEE80211_DS2 */
1521		11,		/* IFM_IEEE80211_DS5 */
1522		22,		/* IFM_IEEE80211_DS11 */
1523		44,		/* IFM_IEEE80211_DS22 */
1524		12,		/* IFM_IEEE80211_OFDM6 */
1525		18,		/* IFM_IEEE80211_OFDM9 */
1526		24,		/* IFM_IEEE80211_OFDM12 */
1527		36,		/* IFM_IEEE80211_OFDM18 */
1528		48,		/* IFM_IEEE80211_OFDM24 */
1529		72,		/* IFM_IEEE80211_OFDM36 */
1530		96,		/* IFM_IEEE80211_OFDM48 */
1531		108,		/* IFM_IEEE80211_OFDM54 */
1532		144,		/* IFM_IEEE80211_OFDM72 */
1533		0,		/* IFM_IEEE80211_DS354k */
1534		0,		/* IFM_IEEE80211_DS512k */
1535		6,		/* IFM_IEEE80211_OFDM3 */
1536		9,		/* IFM_IEEE80211_OFDM4 */
1537		54,		/* IFM_IEEE80211_OFDM27 */
1538		-1,		/* IFM_IEEE80211_MCS */
1539	};
1540	return IFM_SUBTYPE(mword) < N(ieeerates) ?
1541		ieeerates[IFM_SUBTYPE(mword)] : 0;
1542#undef N
1543}
1544