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