merge
[dragonfly.git] / sys / netproto / 802_11 / wlan / ieee80211_ioctl.c
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  * $FreeBSD: head/sys/net80211/ieee80211_ioctl.c 202935 2010-01-24 16:17:58Z syrinx $
27  */
28
29 /*
30  * IEEE 802.11 ioctl support (DragonFlyBSD-specific)
31  */
32
33 #include "opt_inet.h"
34 #include "opt_ipx.h"
35 #include "opt_wlan.h"
36
37 #include <sys/endian.h>
38 #include <sys/param.h>
39 #include <sys/kernel.h>
40 #include <sys/priv.h>
41 #include <sys/socket.h>
42 #include <sys/sockio.h>
43 #include <sys/systm.h>
44  
45 #include <net/if.h>
46 #include <net/if_var.h>
47 #include <net/if_dl.h>
48 #include <net/if_media.h>
49 #include <net/ethernet.h>
50 #include <net/route.h>
51
52 #ifdef INET
53 #include <netinet/in.h>
54 #include <netinet/if_ether.h>
55 #endif
56
57 #ifdef IPX
58 #include <netproto/ipx/ipx.h>
59 #include <netproto/ipx/ipx_if.h>
60 #endif
61
62 #include <netproto/802_11/ieee80211_var.h>
63 #include <netproto/802_11/ieee80211_ioctl.h>
64 #include <netproto/802_11/ieee80211_regdomain.h>
65 #include <netproto/802_11/ieee80211_input.h>
66
67 #define IS_UP_AUTO(_vap) \
68         (IFNET_IS_UP_RUNNING((_vap)->iv_ifp) && \
69          (_vap)->iv_roaming == IEEE80211_ROAMING_AUTO)
70
71 static const uint8_t zerobssid[IEEE80211_ADDR_LEN];
72 static struct ieee80211_channel *findchannel(struct ieee80211com *,
73                 int ieee, int mode);
74
75 static __noinline int
76 ieee80211_ioctl_getkey(struct ieee80211vap *vap, struct ieee80211req *ireq)
77 {
78         struct ieee80211com *ic = vap->iv_ic;
79         struct ieee80211_node *ni;
80         struct ieee80211req_key ik;
81         struct ieee80211_key *wk;
82         const struct ieee80211_cipher *cip;
83         u_int kid;
84         int error;
85
86         if (ireq->i_len != sizeof(ik))
87                 return EINVAL;
88         error = copyin(ireq->i_data, &ik, sizeof(ik));
89         if (error)
90                 return error;
91         kid = ik.ik_keyix;
92         if (kid == IEEE80211_KEYIX_NONE) {
93                 ni = ieee80211_find_vap_node(&ic->ic_sta, vap, ik.ik_macaddr);
94                 if (ni == NULL)
95                         return ENOENT;
96                 wk = &ni->ni_ucastkey;
97         } else {
98                 if (kid >= IEEE80211_WEP_NKID)
99                         return EINVAL;
100                 wk = &vap->iv_nw_keys[kid];
101                 IEEE80211_ADDR_COPY(&ik.ik_macaddr, vap->iv_bss->ni_macaddr);
102                 ni = NULL;
103         }
104         cip = wk->wk_cipher;
105         ik.ik_type = cip->ic_cipher;
106         ik.ik_keylen = wk->wk_keylen;
107         ik.ik_flags = wk->wk_flags & (IEEE80211_KEY_XMIT | IEEE80211_KEY_RECV);
108         if (wk->wk_keyix == vap->iv_def_txkey)
109                 ik.ik_flags |= IEEE80211_KEY_DEFAULT;
110         if (priv_check(curthread, PRIV_NET80211_GETKEY) == 0) {
111                 /* NB: only root can read key data */
112                 ik.ik_keyrsc = wk->wk_keyrsc[IEEE80211_NONQOS_TID];
113                 ik.ik_keytsc = wk->wk_keytsc;
114                 memcpy(ik.ik_keydata, wk->wk_key, wk->wk_keylen);
115                 if (cip->ic_cipher == IEEE80211_CIPHER_TKIP) {
116                         memcpy(ik.ik_keydata+wk->wk_keylen,
117                                 wk->wk_key + IEEE80211_KEYBUF_SIZE,
118                                 IEEE80211_MICBUF_SIZE);
119                         ik.ik_keylen += IEEE80211_MICBUF_SIZE;
120                 }
121         } else {
122                 ik.ik_keyrsc = 0;
123                 ik.ik_keytsc = 0;
124                 memset(ik.ik_keydata, 0, sizeof(ik.ik_keydata));
125         }
126         if (ni != NULL)
127                 ieee80211_free_node(ni);
128         return copyout(&ik, ireq->i_data, sizeof(ik));
129 }
130
131 static __noinline int
132 ieee80211_ioctl_getchanlist(struct ieee80211vap *vap, struct ieee80211req *ireq)
133 {
134         struct ieee80211com *ic = vap->iv_ic;
135
136         if (sizeof(ic->ic_chan_active) < ireq->i_len)
137                 ireq->i_len = sizeof(ic->ic_chan_active);
138         return copyout(&ic->ic_chan_active, ireq->i_data, ireq->i_len);
139 }
140
141 static __noinline int
142 ieee80211_ioctl_getchaninfo(struct ieee80211vap *vap, struct ieee80211req *ireq)
143 {
144         struct ieee80211com *ic = vap->iv_ic;
145         int space;
146
147         space = __offsetof(struct ieee80211req_chaninfo,
148                         ic_chans[ic->ic_nchans]);
149         if (space > ireq->i_len)
150                 space = ireq->i_len;
151         /* XXX assumes compatible layout */
152         return copyout(&ic->ic_nchans, ireq->i_data, space);
153 }
154
155 static __noinline int
156 ieee80211_ioctl_getwpaie(struct ieee80211vap *vap,
157         struct ieee80211req *ireq, int req)
158 {
159         struct ieee80211_node *ni;
160         struct ieee80211req_wpaie2 wpaie;
161         int error;
162
163         if (ireq->i_len < IEEE80211_ADDR_LEN)
164                 return EINVAL;
165         error = copyin(ireq->i_data, wpaie.wpa_macaddr, IEEE80211_ADDR_LEN);
166         if (error != 0)
167                 return error;
168         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, wpaie.wpa_macaddr);
169         if (ni == NULL)
170                 return ENOENT;
171         memset(wpaie.wpa_ie, 0, sizeof(wpaie.wpa_ie));
172         if (ni->ni_ies.wpa_ie != NULL) {
173                 int ielen = ni->ni_ies.wpa_ie[1] + 2;
174                 if (ielen > sizeof(wpaie.wpa_ie))
175                         ielen = sizeof(wpaie.wpa_ie);
176                 memcpy(wpaie.wpa_ie, ni->ni_ies.wpa_ie, ielen);
177         }
178         if (req == IEEE80211_IOC_WPAIE2) {
179                 memset(wpaie.rsn_ie, 0, sizeof(wpaie.rsn_ie));
180                 if (ni->ni_ies.rsn_ie != NULL) {
181                         int ielen = ni->ni_ies.rsn_ie[1] + 2;
182                         if (ielen > sizeof(wpaie.rsn_ie))
183                                 ielen = sizeof(wpaie.rsn_ie);
184                         memcpy(wpaie.rsn_ie, ni->ni_ies.rsn_ie, ielen);
185                 }
186                 if (ireq->i_len > sizeof(struct ieee80211req_wpaie2))
187                         ireq->i_len = sizeof(struct ieee80211req_wpaie2);
188         } else {
189                 /* compatibility op, may overwrite wpa ie */
190                 /* XXX check ic_flags? */
191                 if (ni->ni_ies.rsn_ie != NULL) {
192                         int ielen = ni->ni_ies.rsn_ie[1] + 2;
193                         if (ielen > sizeof(wpaie.wpa_ie))
194                                 ielen = sizeof(wpaie.wpa_ie);
195                         memcpy(wpaie.wpa_ie, ni->ni_ies.rsn_ie, ielen);
196                 }
197                 if (ireq->i_len > sizeof(struct ieee80211req_wpaie))
198                         ireq->i_len = sizeof(struct ieee80211req_wpaie);
199         }
200         ieee80211_free_node(ni);
201         return copyout(&wpaie, ireq->i_data, ireq->i_len);
202 }
203
204 static __noinline int
205 ieee80211_ioctl_getstastats(struct ieee80211vap *vap, struct ieee80211req *ireq)
206 {
207         struct ieee80211_node *ni;
208         uint8_t macaddr[IEEE80211_ADDR_LEN];
209         const int off = __offsetof(struct ieee80211req_sta_stats, is_stats);
210         int error;
211
212         if (ireq->i_len < off)
213                 return EINVAL;
214         error = copyin(ireq->i_data, macaddr, IEEE80211_ADDR_LEN);
215         if (error != 0)
216                 return error;
217         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, macaddr);
218         if (ni == NULL)
219                 return ENOENT;
220         if (ireq->i_len > sizeof(struct ieee80211req_sta_stats))
221                 ireq->i_len = sizeof(struct ieee80211req_sta_stats);
222         /* NB: copy out only the statistics */
223         error = copyout(&ni->ni_stats, (uint8_t *) ireq->i_data + off,
224                         ireq->i_len - off);
225         ieee80211_free_node(ni);
226         return error;
227 }
228
229 struct scanreq {
230         struct ieee80211req_scan_result *sr;
231         size_t space;
232 };
233
234 static size_t
235 scan_space(const struct ieee80211_scan_entry *se, int *ielen)
236 {
237         size_t len;
238
239         *ielen = se->se_ies.len;
240         /*
241          * NB: ie's can be no more than 255 bytes and the max 802.11
242          * packet is <3Kbytes so we are sure this doesn't overflow
243          * 16-bits; if this is a concern we can drop the ie's.
244          */
245         len = sizeof(struct ieee80211req_scan_result) + se->se_ssid[1] +
246             se->se_meshid[1] + *ielen;
247         return roundup(len, sizeof(uint32_t));
248 }
249
250 static void
251 get_scan_space(void *arg, const struct ieee80211_scan_entry *se)
252 {
253         struct scanreq *req = arg;
254         int ielen;
255
256         req->space += scan_space(se, &ielen);
257 }
258
259 static __noinline void
260 get_scan_result(void *arg, const struct ieee80211_scan_entry *se)
261 {
262         struct scanreq *req = arg;
263         struct ieee80211req_scan_result *sr;
264         int ielen, len, nr, nxr;
265         uint8_t *cp;
266
267         len = scan_space(se, &ielen);
268         if (len > req->space)
269                 return;
270
271         sr = req->sr;
272         KASSERT(len <= 65535 && ielen <= 65535,
273             ("len %u ssid %u ie %u", len, se->se_ssid[1], ielen));
274         sr->isr_len = len;
275         sr->isr_ie_off = sizeof(struct ieee80211req_scan_result);
276         sr->isr_ie_len = ielen;
277         sr->isr_freq = se->se_chan->ic_freq;
278         sr->isr_flags = se->se_chan->ic_flags;
279         sr->isr_rssi = se->se_rssi;
280         sr->isr_noise = se->se_noise;
281         sr->isr_intval = se->se_intval;
282         sr->isr_capinfo = se->se_capinfo;
283         sr->isr_erp = se->se_erp;
284         IEEE80211_ADDR_COPY(sr->isr_bssid, se->se_bssid);
285         nr = min(se->se_rates[1], IEEE80211_RATE_MAXSIZE);
286         memcpy(sr->isr_rates, se->se_rates+2, nr);
287         nxr = min(se->se_xrates[1], IEEE80211_RATE_MAXSIZE - nr);
288         memcpy(sr->isr_rates+nr, se->se_xrates+2, nxr);
289         sr->isr_nrates = nr + nxr;
290
291         /* copy SSID */
292         sr->isr_ssid_len = se->se_ssid[1];
293         cp = ((uint8_t *)sr) + sr->isr_ie_off;
294         memcpy(cp, se->se_ssid+2, sr->isr_ssid_len);
295
296         /* copy mesh id */
297         cp += sr->isr_ssid_len;
298         sr->isr_meshid_len = se->se_meshid[1];
299         memcpy(cp, se->se_meshid+2, sr->isr_meshid_len);
300         cp += sr->isr_meshid_len;
301
302         if (ielen)
303                 memcpy(cp, se->se_ies.data, ielen);
304
305         req->space -= len;
306         req->sr = (struct ieee80211req_scan_result *)(((uint8_t *)sr) + len);
307 }
308
309 static __noinline int
310 ieee80211_ioctl_getscanresults(struct ieee80211vap *vap,
311         struct ieee80211req *ireq)
312 {
313         struct scanreq req;
314         int error;
315
316         if (ireq->i_len < sizeof(struct scanreq))
317                 return EFAULT;
318
319         error = 0;
320         req.space = 0;
321         ieee80211_scan_iterate(vap, get_scan_space, &req);
322         if (req.space > ireq->i_len)
323                 req.space = ireq->i_len;
324         if (req.space > 0) {
325                 size_t space;
326                 void *p;
327
328                 space = req.space;
329                 /* XXX M_WAITOK after driver lock released */
330                 p = kmalloc(space, M_TEMP, M_INTWAIT | M_ZERO);
331                 if (p == NULL)
332                         return ENOMEM;
333                 req.sr = p;
334                 ieee80211_scan_iterate(vap, get_scan_result, &req);
335                 ireq->i_len = space - req.space;
336                 error = copyout(p, ireq->i_data, ireq->i_len);
337                 kfree(p, M_TEMP);
338         } else
339                 ireq->i_len = 0;
340
341         return error;
342 }
343
344 struct stainforeq {
345         struct ieee80211vap *vap;
346         struct ieee80211req_sta_info *si;
347         size_t  space;
348 };
349
350 static size_t
351 sta_space(const struct ieee80211_node *ni, size_t *ielen)
352 {
353         *ielen = ni->ni_ies.len;
354         return roundup(sizeof(struct ieee80211req_sta_info) + *ielen,
355                       sizeof(uint32_t));
356 }
357
358 static void
359 get_sta_space(void *arg, struct ieee80211_node *ni)
360 {
361         struct stainforeq *req = arg;
362         size_t ielen;
363
364         if (req->vap != ni->ni_vap)
365                 return;
366         if (ni->ni_vap->iv_opmode == IEEE80211_M_HOSTAP &&
367             ni->ni_associd == 0)        /* only associated stations */
368                 return;
369         req->space += sta_space(ni, &ielen);
370 }
371
372 static __noinline void
373 get_sta_info(void *arg, struct ieee80211_node *ni)
374 {
375         struct stainforeq *req = arg;
376         struct ieee80211vap *vap = ni->ni_vap;
377         struct ieee80211req_sta_info *si;
378         size_t ielen, len;
379         uint8_t *cp;
380
381         if (req->vap != ni->ni_vap)
382                 return;
383         if (vap->iv_opmode == IEEE80211_M_HOSTAP &&
384             ni->ni_associd == 0)        /* only associated stations */
385                 return;
386         if (ni->ni_chan == IEEE80211_CHAN_ANYC) /* XXX bogus entry */
387                 return;
388         len = sta_space(ni, &ielen);
389         if (len > req->space)
390                 return;
391         si = req->si;
392         si->isi_len = len;
393         si->isi_ie_off = sizeof(struct ieee80211req_sta_info);
394         si->isi_ie_len = ielen;
395         si->isi_freq = ni->ni_chan->ic_freq;
396         si->isi_flags = ni->ni_chan->ic_flags;
397         si->isi_state = ni->ni_flags;
398         si->isi_authmode = ni->ni_authmode;
399         vap->iv_ic->ic_node_getsignal(ni, &si->isi_rssi, &si->isi_noise);
400         vap->iv_ic->ic_node_getmimoinfo(ni, &si->isi_mimo);
401         si->isi_capinfo = ni->ni_capinfo;
402         si->isi_erp = ni->ni_erp;
403         IEEE80211_ADDR_COPY(si->isi_macaddr, ni->ni_macaddr);
404         si->isi_nrates = ni->ni_rates.rs_nrates;
405         if (si->isi_nrates > 15)
406                 si->isi_nrates = 15;
407         memcpy(si->isi_rates, ni->ni_rates.rs_rates, si->isi_nrates);
408         si->isi_txrate = ni->ni_txrate;
409         if (si->isi_txrate & IEEE80211_RATE_MCS) {
410                 const struct ieee80211_mcs_rates *mcs =
411                     &ieee80211_htrates[ni->ni_txrate &~ IEEE80211_RATE_MCS];
412                 if (IEEE80211_IS_CHAN_HT40(ni->ni_chan)) {
413                         if (ni->ni_flags & IEEE80211_NODE_SGI40)
414                                 si->isi_txmbps = mcs->ht40_rate_800ns;
415                         else
416                                 si->isi_txmbps = mcs->ht40_rate_400ns;
417                 } else {
418                         if (ni->ni_flags & IEEE80211_NODE_SGI20)
419                                 si->isi_txmbps = mcs->ht20_rate_800ns;
420                         else
421                                 si->isi_txmbps = mcs->ht20_rate_400ns;
422                 }
423         } else
424                 si->isi_txmbps = si->isi_txrate;
425         si->isi_associd = ni->ni_associd;
426         si->isi_txpower = ni->ni_txpower;
427         si->isi_vlan = ni->ni_vlan;
428         if (ni->ni_flags & IEEE80211_NODE_QOS) {
429                 memcpy(si->isi_txseqs, ni->ni_txseqs, sizeof(ni->ni_txseqs));
430                 memcpy(si->isi_rxseqs, ni->ni_rxseqs, sizeof(ni->ni_rxseqs));
431         } else {
432                 si->isi_txseqs[0] = ni->ni_txseqs[IEEE80211_NONQOS_TID];
433                 si->isi_rxseqs[0] = ni->ni_rxseqs[IEEE80211_NONQOS_TID];
434         }
435         /* NB: leave all cases in case we relax ni_associd == 0 check */
436         if (ieee80211_node_is_authorized(ni))
437                 si->isi_inact = vap->iv_inact_run;
438         else if (ni->ni_associd != 0 ||
439             (vap->iv_opmode == IEEE80211_M_WDS &&
440              (vap->iv_flags_ext & IEEE80211_FEXT_WDSLEGACY)))
441                 si->isi_inact = vap->iv_inact_auth;
442         else
443                 si->isi_inact = vap->iv_inact_init;
444         si->isi_inact = (si->isi_inact - ni->ni_inact) * IEEE80211_INACT_WAIT;
445         si->isi_localid = ni->ni_mllid;
446         si->isi_peerid = ni->ni_mlpid;
447         si->isi_peerstate = ni->ni_mlstate;
448
449         if (ielen) {
450                 cp = ((uint8_t *)si) + si->isi_ie_off;
451                 memcpy(cp, ni->ni_ies.data, ielen);
452         }
453
454         req->si = (struct ieee80211req_sta_info *)(((uint8_t *)si) + len);
455         req->space -= len;
456 }
457
458 static __noinline int
459 getstainfo_common(struct ieee80211vap *vap, struct ieee80211req *ireq,
460         struct ieee80211_node *ni, int off)
461 {
462         struct ieee80211com *ic = vap->iv_ic;
463         struct stainforeq req;
464         size_t space;
465         void *p;
466         int error;
467
468         error = 0;
469         req.space = 0;
470         req.vap = vap;
471         if (ni == NULL)
472                 ieee80211_iterate_nodes(&ic->ic_sta, get_sta_space, &req);
473         else
474                 get_sta_space(&req, ni);
475         if (req.space > ireq->i_len)
476                 req.space = ireq->i_len;
477         if (req.space > 0) {
478                 space = req.space;
479                 /* XXX M_WAITOK after driver lock released */
480                 p = kmalloc(space, M_TEMP, M_INTWAIT | M_ZERO);
481                 if (p == NULL) {
482                         error = ENOMEM;
483                         goto bad;
484                 }
485                 req.si = p;
486                 if (ni == NULL)
487                         ieee80211_iterate_nodes(&ic->ic_sta, get_sta_info, &req);
488                 else
489                         get_sta_info(&req, ni);
490                 ireq->i_len = space - req.space;
491                 error = copyout(p, (uint8_t *) ireq->i_data+off, ireq->i_len);
492                 kfree(p, M_TEMP);
493         } else
494                 ireq->i_len = 0;
495 bad:
496         if (ni != NULL)
497                 ieee80211_free_node(ni);
498         return error;
499 }
500
501 static __noinline int
502 ieee80211_ioctl_getstainfo(struct ieee80211vap *vap, struct ieee80211req *ireq)
503 {
504         uint8_t macaddr[IEEE80211_ADDR_LEN];
505         const int off = __offsetof(struct ieee80211req_sta_req, info);
506         struct ieee80211_node *ni;
507         int error;
508
509         if (ireq->i_len < sizeof(struct ieee80211req_sta_req))
510                 return EFAULT;
511         error = copyin(ireq->i_data, macaddr, IEEE80211_ADDR_LEN);
512         if (error != 0)
513                 return error;
514         if (IEEE80211_ADDR_EQ(macaddr, vap->iv_ifp->if_broadcastaddr)) {
515                 ni = NULL;
516         } else {
517                 ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, macaddr);
518                 if (ni == NULL)
519                         return ENOENT;
520         }
521         return getstainfo_common(vap, ireq, ni, off);
522 }
523
524 static __noinline int
525 ieee80211_ioctl_getstatxpow(struct ieee80211vap *vap, struct ieee80211req *ireq)
526 {
527         struct ieee80211_node *ni;
528         struct ieee80211req_sta_txpow txpow;
529         int error;
530
531         if (ireq->i_len != sizeof(txpow))
532                 return EINVAL;
533         error = copyin(ireq->i_data, &txpow, sizeof(txpow));
534         if (error != 0)
535                 return error;
536         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, txpow.it_macaddr);
537         if (ni == NULL)
538                 return ENOENT;
539         txpow.it_txpow = ni->ni_txpower;
540         error = copyout(&txpow, ireq->i_data, sizeof(txpow));
541         ieee80211_free_node(ni);
542         return error;
543 }
544
545 static __noinline int
546 ieee80211_ioctl_getwmeparam(struct ieee80211vap *vap, struct ieee80211req *ireq)
547 {
548         struct ieee80211com *ic = vap->iv_ic;
549         struct ieee80211_wme_state *wme = &ic->ic_wme;
550         struct wmeParams *wmep;
551         int ac;
552
553         if ((ic->ic_caps & IEEE80211_C_WME) == 0)
554                 return EINVAL;
555
556         ac = (ireq->i_len & IEEE80211_WMEPARAM_VAL);
557         if (ac >= WME_NUM_AC)
558                 ac = WME_AC_BE;
559         if (ireq->i_len & IEEE80211_WMEPARAM_BSS)
560                 wmep = &wme->wme_wmeBssChanParams.cap_wmeParams[ac];
561         else
562                 wmep = &wme->wme_wmeChanParams.cap_wmeParams[ac];
563         switch (ireq->i_type) {
564         case IEEE80211_IOC_WME_CWMIN:           /* WME: CWmin */
565                 ireq->i_val = wmep->wmep_logcwmin;
566                 break;
567         case IEEE80211_IOC_WME_CWMAX:           /* WME: CWmax */
568                 ireq->i_val = wmep->wmep_logcwmax;
569                 break;
570         case IEEE80211_IOC_WME_AIFS:            /* WME: AIFS */
571                 ireq->i_val = wmep->wmep_aifsn;
572                 break;
573         case IEEE80211_IOC_WME_TXOPLIMIT:       /* WME: txops limit */
574                 ireq->i_val = wmep->wmep_txopLimit;
575                 break;
576         case IEEE80211_IOC_WME_ACM:             /* WME: ACM (bss only) */
577                 wmep = &wme->wme_wmeBssChanParams.cap_wmeParams[ac];
578                 ireq->i_val = wmep->wmep_acm;
579                 break;
580         case IEEE80211_IOC_WME_ACKPOLICY:       /* WME: ACK policy (!bss only)*/
581                 wmep = &wme->wme_wmeChanParams.cap_wmeParams[ac];
582                 ireq->i_val = !wmep->wmep_noackPolicy;
583                 break;
584         }
585         return 0;
586 }
587
588 static __noinline int
589 ieee80211_ioctl_getmaccmd(struct ieee80211vap *vap, struct ieee80211req *ireq)
590 {
591         const struct ieee80211_aclator *acl = vap->iv_acl;
592
593         return (acl == NULL ? EINVAL : acl->iac_getioctl(vap, ireq));
594 }
595
596 static __noinline int
597 ieee80211_ioctl_getcurchan(struct ieee80211vap *vap, struct ieee80211req *ireq)
598 {
599         struct ieee80211com *ic = vap->iv_ic;
600         struct ieee80211_channel *c;
601
602         if (ireq->i_len != sizeof(struct ieee80211_channel))
603                 return EINVAL;
604         /*
605          * vap's may have different operating channels when HT is
606          * in use.  When in RUN state report the vap-specific channel.
607          * Otherwise return curchan.
608          */
609         if (vap->iv_state == IEEE80211_S_RUN)
610                 c = vap->iv_bss->ni_chan;
611         else
612                 c = ic->ic_curchan;
613         return copyout(c, ireq->i_data, sizeof(*c));
614 }
615
616 static int
617 getappie(const struct ieee80211_appie *aie, struct ieee80211req *ireq)
618 {
619         if (aie == NULL)
620                 return EINVAL;
621         /* NB: truncate, caller can check length */
622         if (ireq->i_len > aie->ie_len)
623                 ireq->i_len = aie->ie_len;
624         return copyout(aie->ie_data, ireq->i_data, ireq->i_len);
625 }
626
627 static int
628 ieee80211_ioctl_getappie(struct ieee80211vap *vap, struct ieee80211req *ireq)
629 {
630         uint8_t fc0;
631
632         fc0 = ireq->i_val & 0xff;
633         if ((fc0 & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT)
634                 return EINVAL;
635         /* NB: could check iv_opmode and reject but hardly worth the effort */
636         switch (fc0 & IEEE80211_FC0_SUBTYPE_MASK) {
637         case IEEE80211_FC0_SUBTYPE_BEACON:
638                 return getappie(vap->iv_appie_beacon, ireq);
639         case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
640                 return getappie(vap->iv_appie_proberesp, ireq);
641         case IEEE80211_FC0_SUBTYPE_ASSOC_RESP:
642                 return getappie(vap->iv_appie_assocresp, ireq);
643         case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
644                 return getappie(vap->iv_appie_probereq, ireq);
645         case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
646                 return getappie(vap->iv_appie_assocreq, ireq);
647         case IEEE80211_FC0_SUBTYPE_BEACON|IEEE80211_FC0_SUBTYPE_PROBE_RESP:
648                 return getappie(vap->iv_appie_wpa, ireq);
649         }
650         return EINVAL;
651 }
652
653 static __noinline int
654 ieee80211_ioctl_getregdomain(struct ieee80211vap *vap,
655         const struct ieee80211req *ireq)
656 {
657         struct ieee80211com *ic = vap->iv_ic;
658
659         if (ireq->i_len != sizeof(ic->ic_regdomain))
660                 return EINVAL;
661         return copyout(&ic->ic_regdomain, ireq->i_data,
662             sizeof(ic->ic_regdomain));
663 }
664
665 static __noinline int
666 ieee80211_ioctl_getroam(struct ieee80211vap *vap,
667         const struct ieee80211req *ireq)
668 {
669         size_t len = ireq->i_len;
670         /* NB: accept short requests for backwards compat */
671         if (len > sizeof(vap->iv_roamparms))
672                 len = sizeof(vap->iv_roamparms);
673         return copyout(vap->iv_roamparms, ireq->i_data, len);
674 }
675
676 static __noinline int
677 ieee80211_ioctl_gettxparams(struct ieee80211vap *vap,
678         const struct ieee80211req *ireq)
679 {
680         size_t len = ireq->i_len;
681         /* NB: accept short requests for backwards compat */
682         if (len > sizeof(vap->iv_txparms))
683                 len = sizeof(vap->iv_txparms);
684         return copyout(vap->iv_txparms, ireq->i_data, len);
685 }
686
687 static __noinline int
688 ieee80211_ioctl_getdevcaps(struct ieee80211com *ic,
689         const struct ieee80211req *ireq)
690 {
691         struct ieee80211_devcaps_req *dc;
692         struct ieee80211req_chaninfo *ci;
693         int maxchans, error;
694
695         maxchans = 1 + ((ireq->i_len - sizeof(struct ieee80211_devcaps_req)) /
696             sizeof(struct ieee80211_channel));
697         /* NB: require 1 so we know ic_nchans is accessible */
698         if (maxchans < 1)
699                 return EINVAL;
700         /* constrain max request size, 2K channels is ~24Kbytes */
701         if (maxchans > 2048)
702                 maxchans = 2048;
703         dc = (struct ieee80211_devcaps_req *)
704             kmalloc(IEEE80211_DEVCAPS_SIZE(maxchans), M_TEMP,
705                 M_INTWAIT | M_ZERO);
706         if (dc == NULL)
707                 return ENOMEM;
708         dc->dc_drivercaps = ic->ic_caps;
709         dc->dc_cryptocaps = ic->ic_cryptocaps;
710         dc->dc_htcaps = ic->ic_htcaps;
711         ci = &dc->dc_chaninfo;
712         ic->ic_getradiocaps(ic, maxchans, &ci->ic_nchans, ci->ic_chans);
713         KASSERT(ci->ic_nchans <= maxchans,
714             ("nchans %d maxchans %d", ci->ic_nchans, maxchans));
715         ieee80211_sort_channels(ci->ic_chans, ci->ic_nchans);
716         error = copyout(dc, ireq->i_data, IEEE80211_DEVCAPS_SPACE(dc));
717         kfree(dc, M_TEMP);
718         return error;
719 }
720
721 static __noinline int
722 ieee80211_ioctl_getstavlan(struct ieee80211vap *vap, struct ieee80211req *ireq)
723 {
724         struct ieee80211_node *ni;
725         struct ieee80211req_sta_vlan vlan;
726         int error;
727
728         if (ireq->i_len != sizeof(vlan))
729                 return EINVAL;
730         error = copyin(ireq->i_data, &vlan, sizeof(vlan));
731         if (error != 0)
732                 return error;
733         if (!IEEE80211_ADDR_EQ(vlan.sv_macaddr, zerobssid)) {
734                 ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap,
735                     vlan.sv_macaddr);
736                 if (ni == NULL)
737                         return ENOENT;
738         } else
739                 ni = ieee80211_ref_node(vap->iv_bss);
740         vlan.sv_vlan = ni->ni_vlan;
741         error = copyout(&vlan, ireq->i_data, sizeof(vlan));
742         ieee80211_free_node(ni);
743         return error;
744 }
745
746 /*
747  * Dummy ioctl get handler so the linker set is defined.
748  */
749 static int
750 dummy_ioctl_get(struct ieee80211vap *vap, struct ieee80211req *ireq)
751 {
752         return ENOSYS;
753 }
754 IEEE80211_IOCTL_GET(dummy, dummy_ioctl_get);
755
756 static int
757 ieee80211_ioctl_getdefault(struct ieee80211vap *vap, struct ieee80211req *ireq)
758 {
759         ieee80211_ioctl_getfunc * const *get;
760         int error;
761
762         SET_FOREACH(get, ieee80211_ioctl_getset) {
763                 error = (*get)(vap, ireq);
764                 if (error != ENOSYS)
765                         return error;
766         }
767         return EINVAL;
768 }
769
770 /*
771  * When building the kernel with -O2 on the i386 architecture, gcc
772  * seems to want to inline this function into ieee80211_ioctl()
773  * (which is the only routine that calls it). When this happens,
774  * ieee80211_ioctl() ends up consuming an additional 2K of stack
775  * space. (Exactly why it needs so much is unclear.) The problem
776  * is that it's possible for ieee80211_ioctl() to invoke other
777  * routines (including driver init functions) which could then find
778  * themselves perilously close to exhausting the stack.
779  *
780  * To avoid this, we deliberately prevent gcc from inlining this
781  * routine. Another way to avoid this is to use less agressive
782  * optimization when compiling this file (i.e. -O instead of -O2)
783  * but special-casing the compilation of this one module in the
784  * build system would be awkward.
785  */
786 static __noinline int
787 ieee80211_ioctl_get80211(struct ieee80211vap *vap, u_long cmd,
788     struct ieee80211req *ireq)
789 {
790 #define MS(_v, _f)      (((_v) & _f) >> _f##_S)
791         struct ieee80211com *ic = vap->iv_ic;
792         u_int kid, len;
793         uint8_t tmpkey[IEEE80211_KEYBUF_SIZE];
794         char tmpssid[IEEE80211_NWID_LEN];
795         int error = 0;
796
797         switch (ireq->i_type) {
798         case IEEE80211_IOC_SSID:
799                 switch (vap->iv_state) {
800                 case IEEE80211_S_INIT:
801                 case IEEE80211_S_SCAN:
802                         ireq->i_len = vap->iv_des_ssid[0].len;
803                         memcpy(tmpssid, vap->iv_des_ssid[0].ssid, ireq->i_len);
804                         break;
805                 default:
806                         ireq->i_len = vap->iv_bss->ni_esslen;
807                         memcpy(tmpssid, vap->iv_bss->ni_essid, ireq->i_len);
808                         break;
809                 }
810                 error = copyout(tmpssid, ireq->i_data, ireq->i_len);
811                 break;
812         case IEEE80211_IOC_NUMSSIDS:
813                 ireq->i_val = 1;
814                 break;
815         case IEEE80211_IOC_WEP:
816                 if ((vap->iv_flags & IEEE80211_F_PRIVACY) == 0)
817                         ireq->i_val = IEEE80211_WEP_OFF;
818                 else if (vap->iv_flags & IEEE80211_F_DROPUNENC)
819                         ireq->i_val = IEEE80211_WEP_ON;
820                 else
821                         ireq->i_val = IEEE80211_WEP_MIXED;
822                 break;
823         case IEEE80211_IOC_WEPKEY:
824                 kid = (u_int) ireq->i_val;
825                 if (kid >= IEEE80211_WEP_NKID)
826                         return EINVAL;
827                 len = (u_int) vap->iv_nw_keys[kid].wk_keylen;
828                 /* NB: only root can read WEP keys */
829                 if (priv_check(curthread, PRIV_NET80211_GETKEY) == 0) {
830                         bcopy(vap->iv_nw_keys[kid].wk_key, tmpkey, len);
831                 } else {
832                         bzero(tmpkey, len);
833                 }
834                 ireq->i_len = len;
835                 error = copyout(tmpkey, ireq->i_data, len);
836                 break;
837         case IEEE80211_IOC_NUMWEPKEYS:
838                 ireq->i_val = IEEE80211_WEP_NKID;
839                 break;
840         case IEEE80211_IOC_WEPTXKEY:
841                 ireq->i_val = vap->iv_def_txkey;
842                 break;
843         case IEEE80211_IOC_AUTHMODE:
844                 if (vap->iv_flags & IEEE80211_F_WPA)
845                         ireq->i_val = IEEE80211_AUTH_WPA;
846                 else
847                         ireq->i_val = vap->iv_bss->ni_authmode;
848                 break;
849         case IEEE80211_IOC_CHANNEL:
850                 ireq->i_val = ieee80211_chan2ieee(ic, ic->ic_curchan);
851                 break;
852         case IEEE80211_IOC_POWERSAVE:
853                 if (vap->iv_flags & IEEE80211_F_PMGTON)
854                         ireq->i_val = IEEE80211_POWERSAVE_ON;
855                 else
856                         ireq->i_val = IEEE80211_POWERSAVE_OFF;
857                 break;
858         case IEEE80211_IOC_POWERSAVESLEEP:
859                 ireq->i_val = ic->ic_lintval;
860                 break;
861         case IEEE80211_IOC_RTSTHRESHOLD:
862                 ireq->i_val = vap->iv_rtsthreshold;
863                 break;
864         case IEEE80211_IOC_PROTMODE:
865                 ireq->i_val = ic->ic_protmode;
866                 break;
867         case IEEE80211_IOC_TXPOWER:
868                 /*
869                  * Tx power limit is the min of max regulatory
870                  * power, any user-set limit, and the max the
871                  * radio can do.
872                  */
873                 ireq->i_val = 2*ic->ic_curchan->ic_maxregpower;
874                 if (ireq->i_val > ic->ic_txpowlimit)
875                         ireq->i_val = ic->ic_txpowlimit;
876                 if (ireq->i_val > ic->ic_curchan->ic_maxpower)
877                         ireq->i_val = ic->ic_curchan->ic_maxpower;
878                 break;
879         case IEEE80211_IOC_WPA:
880                 switch (vap->iv_flags & IEEE80211_F_WPA) {
881                 case IEEE80211_F_WPA1:
882                         ireq->i_val = 1;
883                         break;
884                 case IEEE80211_F_WPA2:
885                         ireq->i_val = 2;
886                         break;
887                 case IEEE80211_F_WPA1 | IEEE80211_F_WPA2:
888                         ireq->i_val = 3;
889                         break;
890                 default:
891                         ireq->i_val = 0;
892                         break;
893                 }
894                 break;
895         case IEEE80211_IOC_CHANLIST:
896                 error = ieee80211_ioctl_getchanlist(vap, ireq);
897                 break;
898         case IEEE80211_IOC_ROAMING:
899                 ireq->i_val = vap->iv_roaming;
900                 break;
901         case IEEE80211_IOC_PRIVACY:
902                 ireq->i_val = (vap->iv_flags & IEEE80211_F_PRIVACY) != 0;
903                 break;
904         case IEEE80211_IOC_DROPUNENCRYPTED:
905                 ireq->i_val = (vap->iv_flags & IEEE80211_F_DROPUNENC) != 0;
906                 break;
907         case IEEE80211_IOC_COUNTERMEASURES:
908                 ireq->i_val = (vap->iv_flags & IEEE80211_F_COUNTERM) != 0;
909                 break;
910         case IEEE80211_IOC_WME:
911                 ireq->i_val = (vap->iv_flags & IEEE80211_F_WME) != 0;
912                 break;
913         case IEEE80211_IOC_HIDESSID:
914                 ireq->i_val = (vap->iv_flags & IEEE80211_F_HIDESSID) != 0;
915                 break;
916         case IEEE80211_IOC_APBRIDGE:
917                 ireq->i_val = (vap->iv_flags & IEEE80211_F_NOBRIDGE) == 0;
918                 break;
919         case IEEE80211_IOC_WPAKEY:
920                 error = ieee80211_ioctl_getkey(vap, ireq);
921                 break;
922         case IEEE80211_IOC_CHANINFO:
923                 error = ieee80211_ioctl_getchaninfo(vap, ireq);
924                 break;
925         case IEEE80211_IOC_BSSID:
926                 if (ireq->i_len != IEEE80211_ADDR_LEN)
927                         return EINVAL;
928                 if (vap->iv_state == IEEE80211_S_RUN) {
929                         error = copyout(vap->iv_opmode == IEEE80211_M_WDS ?
930                             vap->iv_bss->ni_macaddr : vap->iv_bss->ni_bssid,
931                             ireq->i_data, ireq->i_len);
932                 } else
933                         error = copyout(vap->iv_des_bssid, ireq->i_data,
934                             ireq->i_len);
935                 break;
936         case IEEE80211_IOC_WPAIE:
937                 error = ieee80211_ioctl_getwpaie(vap, ireq, ireq->i_type);
938                 break;
939         case IEEE80211_IOC_WPAIE2:
940                 error = ieee80211_ioctl_getwpaie(vap, ireq, ireq->i_type);
941                 break;
942         case IEEE80211_IOC_SCAN_RESULTS:
943                 error = ieee80211_ioctl_getscanresults(vap, ireq);
944                 break;
945         case IEEE80211_IOC_STA_STATS:
946                 error = ieee80211_ioctl_getstastats(vap, ireq);
947                 break;
948         case IEEE80211_IOC_TXPOWMAX:
949                 ireq->i_val = vap->iv_bss->ni_txpower;
950                 break;
951         case IEEE80211_IOC_STA_TXPOW:
952                 error = ieee80211_ioctl_getstatxpow(vap, ireq);
953                 break;
954         case IEEE80211_IOC_STA_INFO:
955                 error = ieee80211_ioctl_getstainfo(vap, ireq);
956                 break;
957         case IEEE80211_IOC_WME_CWMIN:           /* WME: CWmin */
958         case IEEE80211_IOC_WME_CWMAX:           /* WME: CWmax */
959         case IEEE80211_IOC_WME_AIFS:            /* WME: AIFS */
960         case IEEE80211_IOC_WME_TXOPLIMIT:       /* WME: txops limit */
961         case IEEE80211_IOC_WME_ACM:             /* WME: ACM (bss only) */
962         case IEEE80211_IOC_WME_ACKPOLICY:       /* WME: ACK policy (bss only) */
963                 error = ieee80211_ioctl_getwmeparam(vap, ireq);
964                 break;
965         case IEEE80211_IOC_DTIM_PERIOD:
966                 ireq->i_val = vap->iv_dtim_period;
967                 break;
968         case IEEE80211_IOC_BEACON_INTERVAL:
969                 /* NB: get from ic_bss for station mode */
970                 ireq->i_val = vap->iv_bss->ni_intval;
971                 break;
972         case IEEE80211_IOC_PUREG:
973                 ireq->i_val = (vap->iv_flags & IEEE80211_F_PUREG) != 0;
974                 break;
975         case IEEE80211_IOC_BGSCAN:
976                 ireq->i_val = (vap->iv_flags & IEEE80211_F_BGSCAN) != 0;
977                 break;
978         case IEEE80211_IOC_BGSCAN_IDLE:
979                 ireq->i_val = vap->iv_bgscanidle*hz/1000;       /* ms */
980                 break;
981         case IEEE80211_IOC_BGSCAN_INTERVAL:
982                 ireq->i_val = vap->iv_bgscanintvl/hz;           /* seconds */
983                 break;
984         case IEEE80211_IOC_SCANVALID:
985                 ireq->i_val = vap->iv_scanvalid/hz;             /* seconds */
986                 break;
987         case IEEE80211_IOC_FRAGTHRESHOLD:
988                 ireq->i_val = vap->iv_fragthreshold;
989                 break;
990         case IEEE80211_IOC_MACCMD:
991                 error = ieee80211_ioctl_getmaccmd(vap, ireq);
992                 break;
993         case IEEE80211_IOC_BURST:
994                 ireq->i_val = (vap->iv_flags & IEEE80211_F_BURST) != 0;
995                 break;
996         case IEEE80211_IOC_BMISSTHRESHOLD:
997                 ireq->i_val = vap->iv_bmissthreshold;
998                 break;
999         case IEEE80211_IOC_CURCHAN:
1000                 error = ieee80211_ioctl_getcurchan(vap, ireq);
1001                 break;
1002         case IEEE80211_IOC_SHORTGI:
1003                 ireq->i_val = 0;
1004                 if (vap->iv_flags_ht & IEEE80211_FHT_SHORTGI20)
1005                         ireq->i_val |= IEEE80211_HTCAP_SHORTGI20;
1006                 if (vap->iv_flags_ht & IEEE80211_FHT_SHORTGI40)
1007                         ireq->i_val |= IEEE80211_HTCAP_SHORTGI40;
1008                 break;
1009         case IEEE80211_IOC_AMPDU:
1010                 ireq->i_val = 0;
1011                 if (vap->iv_flags_ht & IEEE80211_FHT_AMPDU_TX)
1012                         ireq->i_val |= 1;
1013                 if (vap->iv_flags_ht & IEEE80211_FHT_AMPDU_RX)
1014                         ireq->i_val |= 2;
1015                 break;
1016         case IEEE80211_IOC_AMPDU_LIMIT:
1017                 if (vap->iv_opmode == IEEE80211_M_HOSTAP)
1018                         ireq->i_val = vap->iv_ampdu_rxmax;
1019                 else if (vap->iv_state == IEEE80211_S_RUN)
1020                         ireq->i_val = MS(vap->iv_bss->ni_htparam,
1021                             IEEE80211_HTCAP_MAXRXAMPDU);
1022                 else
1023                         ireq->i_val = vap->iv_ampdu_limit;
1024                 break;
1025         case IEEE80211_IOC_AMPDU_DENSITY:
1026                 if (vap->iv_opmode == IEEE80211_M_STA &&
1027                     vap->iv_state == IEEE80211_S_RUN)
1028                         ireq->i_val = MS(vap->iv_bss->ni_htparam,
1029                             IEEE80211_HTCAP_MPDUDENSITY);
1030                 else
1031                         ireq->i_val = vap->iv_ampdu_density;
1032                 break;
1033         case IEEE80211_IOC_AMSDU:
1034                 ireq->i_val = 0;
1035                 if (vap->iv_flags_ht & IEEE80211_FHT_AMSDU_TX)
1036                         ireq->i_val |= 1;
1037                 if (vap->iv_flags_ht & IEEE80211_FHT_AMSDU_RX)
1038                         ireq->i_val |= 2;
1039                 break;
1040         case IEEE80211_IOC_AMSDU_LIMIT:
1041                 ireq->i_val = vap->iv_amsdu_limit;      /* XXX truncation? */
1042                 break;
1043         case IEEE80211_IOC_PUREN:
1044                 ireq->i_val = (vap->iv_flags_ht & IEEE80211_FHT_PUREN) != 0;
1045                 break;
1046         case IEEE80211_IOC_DOTH:
1047                 ireq->i_val = (vap->iv_flags & IEEE80211_F_DOTH) != 0;
1048                 break;
1049         case IEEE80211_IOC_REGDOMAIN:
1050                 error = ieee80211_ioctl_getregdomain(vap, ireq);
1051                 break;
1052         case IEEE80211_IOC_ROAM:
1053                 error = ieee80211_ioctl_getroam(vap, ireq);
1054                 break;
1055         case IEEE80211_IOC_TXPARAMS:
1056                 error = ieee80211_ioctl_gettxparams(vap, ireq);
1057                 break;
1058         case IEEE80211_IOC_HTCOMPAT:
1059                 ireq->i_val = (vap->iv_flags_ht & IEEE80211_FHT_HTCOMPAT) != 0;
1060                 break;
1061         case IEEE80211_IOC_DWDS:
1062                 ireq->i_val = (vap->iv_flags & IEEE80211_F_DWDS) != 0;
1063                 break;
1064         case IEEE80211_IOC_INACTIVITY:
1065                 ireq->i_val = (vap->iv_flags_ext & IEEE80211_FEXT_INACT) != 0;
1066                 break;
1067         case IEEE80211_IOC_APPIE:
1068                 error = ieee80211_ioctl_getappie(vap, ireq);
1069                 break;
1070         case IEEE80211_IOC_WPS:
1071                 ireq->i_val = (vap->iv_flags_ext & IEEE80211_FEXT_WPS) != 0;
1072                 break;
1073         case IEEE80211_IOC_TSN:
1074                 ireq->i_val = (vap->iv_flags_ext & IEEE80211_FEXT_TSN) != 0;
1075                 break;
1076         case IEEE80211_IOC_DFS:
1077                 ireq->i_val = (vap->iv_flags_ext & IEEE80211_FEXT_DFS) != 0;
1078                 break;
1079         case IEEE80211_IOC_DOTD:
1080                 ireq->i_val = (vap->iv_flags_ext & IEEE80211_FEXT_DOTD) != 0;
1081                 break;
1082         case IEEE80211_IOC_DEVCAPS:
1083                 error = ieee80211_ioctl_getdevcaps(ic, ireq);
1084                 break;
1085         case IEEE80211_IOC_HTPROTMODE:
1086                 ireq->i_val = ic->ic_htprotmode;
1087                 break;
1088         case IEEE80211_IOC_HTCONF:
1089                 if (vap->iv_flags_ht & IEEE80211_FHT_HT) {
1090                         ireq->i_val = 1;
1091                         if (vap->iv_flags_ht & IEEE80211_FHT_USEHT40)
1092                                 ireq->i_val |= 2;
1093                 } else
1094                         ireq->i_val = 0;
1095                 break;
1096         case IEEE80211_IOC_STA_VLAN:
1097                 error = ieee80211_ioctl_getstavlan(vap, ireq);
1098                 break;
1099         case IEEE80211_IOC_SMPS:
1100                 if (vap->iv_opmode == IEEE80211_M_STA &&
1101                     vap->iv_state == IEEE80211_S_RUN) {
1102                         if (vap->iv_bss->ni_flags & IEEE80211_NODE_MIMO_RTS)
1103                                 ireq->i_val = IEEE80211_HTCAP_SMPS_DYNAMIC;
1104                         else if (vap->iv_bss->ni_flags & IEEE80211_NODE_MIMO_PS)
1105                                 ireq->i_val = IEEE80211_HTCAP_SMPS_ENA;
1106                         else
1107                                 ireq->i_val = IEEE80211_HTCAP_SMPS_OFF;
1108                 } else
1109                         ireq->i_val = vap->iv_htcaps & IEEE80211_HTCAP_SMPS;
1110                 break;
1111         case IEEE80211_IOC_RIFS:
1112                 if (vap->iv_opmode == IEEE80211_M_STA &&
1113                     vap->iv_state == IEEE80211_S_RUN)
1114                         ireq->i_val =
1115                             (vap->iv_bss->ni_flags & IEEE80211_NODE_RIFS) != 0;
1116                 else
1117                         ireq->i_val =
1118                             (vap->iv_flags_ht & IEEE80211_FHT_RIFS) != 0;
1119                 break;
1120         default:
1121                 error = ieee80211_ioctl_getdefault(vap, ireq);
1122                 break;
1123         }
1124         return error;
1125 #undef MS
1126 }
1127
1128 static __noinline int
1129 ieee80211_ioctl_setkey(struct ieee80211vap *vap, struct ieee80211req *ireq)
1130 {
1131         struct ieee80211req_key ik;
1132         struct ieee80211_node *ni;
1133         struct ieee80211_key *wk;
1134         uint16_t kid;
1135         int error, i;
1136
1137         if (ireq->i_len != sizeof(ik))
1138                 return EINVAL;
1139         error = copyin(ireq->i_data, &ik, sizeof(ik));
1140         if (error)
1141                 return error;
1142         /* NB: cipher support is verified by ieee80211_crypt_newkey */
1143         /* NB: this also checks ik->ik_keylen > sizeof(wk->wk_key) */
1144         if (ik.ik_keylen > sizeof(ik.ik_keydata))
1145                 return E2BIG;
1146         kid = ik.ik_keyix;
1147         if (kid == IEEE80211_KEYIX_NONE) {
1148                 /* XXX unicast keys currently must be tx/rx */
1149                 if (ik.ik_flags != (IEEE80211_KEY_XMIT | IEEE80211_KEY_RECV))
1150                         return EINVAL;
1151                 if (vap->iv_opmode == IEEE80211_M_STA) {
1152                         ni = ieee80211_ref_node(vap->iv_bss);
1153                         if (!IEEE80211_ADDR_EQ(ik.ik_macaddr, ni->ni_bssid)) {
1154                                 ieee80211_free_node(ni);
1155                                 return EADDRNOTAVAIL;
1156                         }
1157                 } else {
1158                         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap,
1159                                 ik.ik_macaddr);
1160                         if (ni == NULL)
1161                                 return ENOENT;
1162                 }
1163                 wk = &ni->ni_ucastkey;
1164         } else {
1165                 if (kid >= IEEE80211_WEP_NKID)
1166                         return EINVAL;
1167                 wk = &vap->iv_nw_keys[kid];
1168                 /*
1169                  * Global slots start off w/o any assigned key index.
1170                  * Force one here for consistency with IEEE80211_IOC_WEPKEY.
1171                  */
1172                 if (wk->wk_keyix == IEEE80211_KEYIX_NONE)
1173                         wk->wk_keyix = kid;
1174                 ni = NULL;
1175         }
1176         error = 0;
1177         ieee80211_key_update_begin(vap);
1178         if (ieee80211_crypto_newkey(vap, ik.ik_type, ik.ik_flags, wk)) {
1179                 wk->wk_keylen = ik.ik_keylen;
1180                 /* NB: MIC presence is implied by cipher type */
1181                 if (wk->wk_keylen > IEEE80211_KEYBUF_SIZE)
1182                         wk->wk_keylen = IEEE80211_KEYBUF_SIZE;
1183                 for (i = 0; i < IEEE80211_TID_SIZE; i++)
1184                         wk->wk_keyrsc[i] = ik.ik_keyrsc;
1185                 wk->wk_keytsc = 0;                      /* new key, reset */
1186                 memset(wk->wk_key, 0, sizeof(wk->wk_key));
1187                 memcpy(wk->wk_key, ik.ik_keydata, ik.ik_keylen);
1188                 IEEE80211_ADDR_COPY(wk->wk_macaddr,
1189                     ni != NULL ?  ni->ni_macaddr : ik.ik_macaddr);
1190                 if (!ieee80211_crypto_setkey(vap, wk))
1191                         error = EIO;
1192                 else if ((ik.ik_flags & IEEE80211_KEY_DEFAULT))
1193                         vap->iv_def_txkey = kid;
1194         } else
1195                 error = ENXIO;
1196         ieee80211_key_update_end(vap);
1197         if (ni != NULL)
1198                 ieee80211_free_node(ni);
1199         return error;
1200 }
1201
1202 static __noinline int
1203 ieee80211_ioctl_delkey(struct ieee80211vap *vap, struct ieee80211req *ireq)
1204 {
1205         struct ieee80211req_del_key dk;
1206         int kid, error;
1207
1208         if (ireq->i_len != sizeof(dk))
1209                 return EINVAL;
1210         error = copyin(ireq->i_data, &dk, sizeof(dk));
1211         if (error)
1212                 return error;
1213         kid = dk.idk_keyix;
1214         /* XXX uint8_t -> uint16_t */
1215         if (dk.idk_keyix == (uint8_t) IEEE80211_KEYIX_NONE) {
1216                 struct ieee80211_node *ni;
1217
1218                 if (vap->iv_opmode == IEEE80211_M_STA) {
1219                         ni = ieee80211_ref_node(vap->iv_bss);
1220                         if (!IEEE80211_ADDR_EQ(dk.idk_macaddr, ni->ni_bssid)) {
1221                                 ieee80211_free_node(ni);
1222                                 return EADDRNOTAVAIL;
1223                         }
1224                 } else {
1225                         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap,
1226                                 dk.idk_macaddr);
1227                         if (ni == NULL)
1228                                 return ENOENT;
1229                 }
1230                 /* XXX error return */
1231                 ieee80211_node_delucastkey(ni);
1232                 ieee80211_free_node(ni);
1233         } else {
1234                 if (kid >= IEEE80211_WEP_NKID)
1235                         return EINVAL;
1236                 /* XXX error return */
1237                 ieee80211_crypto_delkey(vap, &vap->iv_nw_keys[kid]);
1238         }
1239         return 0;
1240 }
1241
1242 struct mlmeop {
1243         struct ieee80211vap *vap;
1244         int     op;
1245         int     reason;
1246 };
1247
1248 static void
1249 mlmedebug(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN],
1250         int op, int reason)
1251 {
1252 #ifdef IEEE80211_DEBUG
1253         static const struct {
1254                 int mask;
1255                 const char *opstr;
1256         } ops[] = {
1257                 { 0, "op#0" },
1258                 { IEEE80211_MSG_IOCTL | IEEE80211_MSG_STATE |
1259                   IEEE80211_MSG_ASSOC, "assoc" },
1260                 { IEEE80211_MSG_IOCTL | IEEE80211_MSG_STATE |
1261                   IEEE80211_MSG_ASSOC, "disassoc" },
1262                 { IEEE80211_MSG_IOCTL | IEEE80211_MSG_STATE |
1263                   IEEE80211_MSG_AUTH, "deauth" },
1264                 { IEEE80211_MSG_IOCTL | IEEE80211_MSG_STATE |
1265                   IEEE80211_MSG_AUTH, "authorize" },
1266                 { IEEE80211_MSG_IOCTL | IEEE80211_MSG_STATE |
1267                   IEEE80211_MSG_AUTH, "unauthorize" },
1268         };
1269
1270         if (op == IEEE80211_MLME_AUTH) {
1271                 IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_IOCTL |
1272                     IEEE80211_MSG_STATE | IEEE80211_MSG_AUTH, mac,
1273                     "station authenticate %s via MLME (reason %d)",
1274                     reason == IEEE80211_STATUS_SUCCESS ? "ACCEPT" : "REJECT",
1275                     reason);
1276         } else if (!(IEEE80211_MLME_ASSOC <= op && op <= IEEE80211_MLME_AUTH)) {
1277                 IEEE80211_NOTE_MAC(vap, IEEE80211_MSG_ANY, mac,
1278                     "unknown MLME request %d (reason %d)", op, reason);
1279         } else if (reason == IEEE80211_STATUS_SUCCESS) {
1280                 IEEE80211_NOTE_MAC(vap, ops[op].mask, mac,
1281                     "station %s via MLME", ops[op].opstr);
1282         } else {
1283                 IEEE80211_NOTE_MAC(vap, ops[op].mask, mac,
1284                     "station %s via MLME (reason %d)", ops[op].opstr, reason);
1285         }
1286 #endif /* IEEE80211_DEBUG */
1287 }
1288
1289 static void
1290 domlme(void *arg, struct ieee80211_node *ni)
1291 {
1292         struct mlmeop *mop = arg;
1293         struct ieee80211vap *vap = ni->ni_vap;
1294
1295         if (vap != mop->vap)
1296                 return;
1297         /*
1298          * NB: if ni_associd is zero then the node is already cleaned
1299          * up and we don't need to do this (we're safely holding a
1300          * reference but should otherwise not modify it's state).
1301          */ 
1302         if (ni->ni_associd == 0)
1303                 return;
1304         mlmedebug(vap, ni->ni_macaddr, mop->op, mop->reason);
1305         if (mop->op == IEEE80211_MLME_DEAUTH) {
1306                 IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_DEAUTH,
1307                     mop->reason);
1308         } else {
1309                 IEEE80211_SEND_MGMT(ni, IEEE80211_FC0_SUBTYPE_DISASSOC,
1310                     mop->reason);
1311         }
1312         ieee80211_node_leave(ni);
1313 }
1314
1315 static int
1316 setmlme_dropsta(struct ieee80211vap *vap,
1317         const uint8_t mac[IEEE80211_ADDR_LEN], struct mlmeop *mlmeop)
1318 {
1319         struct ieee80211com *ic = vap->iv_ic;
1320         struct ieee80211_node_table *nt = &ic->ic_sta;
1321         struct ieee80211_node *ni;
1322         int error = 0;
1323
1324         /* NB: the broadcast address means do 'em all */
1325         if (!IEEE80211_ADDR_EQ(mac, ic->ic_ifp->if_broadcastaddr)) {
1326                 ni = ieee80211_find_node_locked(nt, mac);
1327                 if (ni != NULL) {
1328                         domlme(mlmeop, ni);
1329                         ieee80211_free_node(ni);
1330                 } else
1331                         error = ENOENT;
1332         } else {
1333                 ieee80211_iterate_nodes(nt, domlme, mlmeop);
1334         }
1335         return error;
1336 }
1337
1338 static __noinline int
1339 setmlme_common(struct ieee80211vap *vap, int op,
1340         const uint8_t mac[IEEE80211_ADDR_LEN], int reason)
1341 {
1342         struct ieee80211com *ic = vap->iv_ic;
1343         struct ieee80211_node_table *nt = &ic->ic_sta;
1344         struct ieee80211_node *ni;
1345         struct mlmeop mlmeop;
1346         int error;
1347
1348         error = 0;
1349         switch (op) {
1350         case IEEE80211_MLME_DISASSOC:
1351         case IEEE80211_MLME_DEAUTH:
1352                 switch (vap->iv_opmode) {
1353                 case IEEE80211_M_STA:
1354                         mlmedebug(vap, vap->iv_bss->ni_macaddr, op, reason);
1355                         /* XXX not quite right */
1356                         ieee80211_new_state(vap, IEEE80211_S_INIT, reason);
1357                         break;
1358                 case IEEE80211_M_HOSTAP:
1359                         mlmeop.vap = vap;
1360                         mlmeop.op = op;
1361                         mlmeop.reason = reason;
1362                         error = setmlme_dropsta(vap, mac, &mlmeop);
1363                         break;
1364                 case IEEE80211_M_WDS:
1365                         /* XXX user app should send raw frame? */
1366                         if (op != IEEE80211_MLME_DEAUTH) {
1367                                 error = EINVAL;
1368                                 break;
1369                         }
1370 #if 0
1371                         /* XXX accept any address, simplifies user code */
1372                         if (!IEEE80211_ADDR_EQ(mac, vap->iv_bss->ni_macaddr)) {
1373                                 error = EINVAL;
1374                                 break;
1375                         }
1376 #endif
1377                         mlmedebug(vap, vap->iv_bss->ni_macaddr, op, reason);
1378                         ni = ieee80211_ref_node(vap->iv_bss);
1379                         IEEE80211_SEND_MGMT(ni,
1380                             IEEE80211_FC0_SUBTYPE_DEAUTH, reason);
1381                         ieee80211_free_node(ni);
1382                         break;
1383                 default:
1384                         error = EINVAL;
1385                         break;
1386                 }
1387                 break;
1388         case IEEE80211_MLME_AUTHORIZE:
1389         case IEEE80211_MLME_UNAUTHORIZE:
1390                 if (vap->iv_opmode != IEEE80211_M_HOSTAP &&
1391                     vap->iv_opmode != IEEE80211_M_WDS) {
1392                         error = EINVAL;
1393                         break;
1394                 }
1395                 ni = ieee80211_find_vap_node_locked(nt, vap, mac);
1396                 if (ni != NULL) {
1397                         mlmedebug(vap, mac, op, reason);
1398                         if (op == IEEE80211_MLME_AUTHORIZE)
1399                                 ieee80211_node_authorize(ni);
1400                         else
1401                                 ieee80211_node_unauthorize(ni);
1402                         ieee80211_free_node(ni);
1403                 } else
1404                         error = ENOENT;
1405                 break;
1406         case IEEE80211_MLME_AUTH:
1407                 if (vap->iv_opmode != IEEE80211_M_HOSTAP) {
1408                         error = EINVAL;
1409                         break;
1410                 }
1411                 ni = ieee80211_find_vap_node_locked(nt, vap, mac);
1412                 if (ni != NULL) {
1413                         mlmedebug(vap, mac, op, reason);
1414                         if (reason == IEEE80211_STATUS_SUCCESS) {
1415                                 IEEE80211_SEND_MGMT(ni,
1416                                     IEEE80211_FC0_SUBTYPE_AUTH, 2);
1417                                 /*
1418                                  * For shared key auth, just continue the
1419                                  * exchange.  Otherwise when 802.1x is not in
1420                                  * use mark the port authorized at this point
1421                                  * so traffic can flow.
1422                                  */
1423                                 if (ni->ni_authmode != IEEE80211_AUTH_8021X &&
1424                                     ni->ni_challenge == NULL)
1425                                       ieee80211_node_authorize(ni);
1426                         } else {
1427                                 vap->iv_stats.is_rx_acl++;
1428                                 ieee80211_send_error(ni, ni->ni_macaddr,
1429                                     IEEE80211_FC0_SUBTYPE_AUTH, 2|(reason<<16));
1430                                 ieee80211_node_leave(ni);
1431                         }
1432                         ieee80211_free_node(ni);
1433                 } else
1434                         error = ENOENT;
1435                 break;
1436         default:
1437                 error = EINVAL;
1438                 break;
1439         }
1440         return error;
1441 }
1442
1443 struct scanlookup {
1444         const uint8_t *mac;
1445         int esslen;
1446         const uint8_t *essid;
1447         const struct ieee80211_scan_entry *se;
1448 };
1449
1450 /*
1451  * Match mac address and any ssid.
1452  */
1453 static void
1454 mlmelookup(void *arg, const struct ieee80211_scan_entry *se)
1455 {
1456         struct scanlookup *look = arg;
1457
1458         if (!IEEE80211_ADDR_EQ(look->mac, se->se_macaddr))
1459                 return;
1460         if (look->esslen != 0) {
1461                 if (se->se_ssid[1] != look->esslen)
1462                         return;
1463                 if (memcmp(look->essid, se->se_ssid+2, look->esslen))
1464                         return;
1465         }
1466         look->se = se;
1467 }
1468
1469 static __noinline int
1470 setmlme_assoc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN],
1471         int ssid_len, const uint8_t ssid[IEEE80211_NWID_LEN])
1472 {
1473         struct scanlookup lookup;
1474
1475         /* XXX ibss/ahdemo */
1476         if (vap->iv_opmode != IEEE80211_M_STA)
1477                 return EINVAL;
1478
1479         /* NB: this is racey if roaming is !manual */
1480         lookup.se = NULL;
1481         lookup.mac = mac;
1482         lookup.esslen = ssid_len;
1483         lookup.essid = ssid;
1484         ieee80211_scan_iterate(vap, mlmelookup, &lookup);
1485         if (lookup.se == NULL)
1486                 return ENOENT;
1487         mlmedebug(vap, mac, IEEE80211_MLME_ASSOC, 0);
1488         if (!ieee80211_sta_join(vap, lookup.se->se_chan, lookup.se))
1489                 return EIO;             /* XXX unique but could be better */
1490         return 0;
1491 }
1492
1493 static __noinline int
1494 ieee80211_ioctl_setmlme(struct ieee80211vap *vap, struct ieee80211req *ireq)
1495 {
1496         struct ieee80211req_mlme mlme;
1497         int error;
1498
1499         if (ireq->i_len != sizeof(mlme))
1500                 return EINVAL;
1501         error = copyin(ireq->i_data, &mlme, sizeof(mlme));
1502         if (error)
1503                 return error;
1504         if  (mlme.im_op == IEEE80211_MLME_ASSOC)
1505                 return setmlme_assoc(vap, mlme.im_macaddr,
1506                     vap->iv_des_ssid[0].len, vap->iv_des_ssid[0].ssid);
1507         else
1508                 return setmlme_common(vap, mlme.im_op,
1509                     mlme.im_macaddr, mlme.im_reason);
1510 }
1511
1512 static __noinline int
1513 ieee80211_ioctl_macmac(struct ieee80211vap *vap, struct ieee80211req *ireq)
1514 {
1515         uint8_t mac[IEEE80211_ADDR_LEN];
1516         const struct ieee80211_aclator *acl = vap->iv_acl;
1517         int error;
1518
1519         if (ireq->i_len != sizeof(mac))
1520                 return EINVAL;
1521         error = copyin(ireq->i_data, mac, ireq->i_len);
1522         if (error)
1523                 return error;
1524         if (acl == NULL) {
1525                 acl = ieee80211_aclator_get("mac");
1526                 if (acl == NULL || !acl->iac_attach(vap))
1527                         return EINVAL;
1528                 vap->iv_acl = acl;
1529         }
1530         if (ireq->i_type == IEEE80211_IOC_ADDMAC)
1531                 acl->iac_add(vap, mac);
1532         else
1533                 acl->iac_remove(vap, mac);
1534         return 0;
1535 }
1536
1537 static __noinline int
1538 ieee80211_ioctl_setmaccmd(struct ieee80211vap *vap, struct ieee80211req *ireq)
1539 {
1540         const struct ieee80211_aclator *acl = vap->iv_acl;
1541
1542         switch (ireq->i_val) {
1543         case IEEE80211_MACCMD_POLICY_OPEN:
1544         case IEEE80211_MACCMD_POLICY_ALLOW:
1545         case IEEE80211_MACCMD_POLICY_DENY:
1546         case IEEE80211_MACCMD_POLICY_RADIUS:
1547                 if (acl == NULL) {
1548                         acl = ieee80211_aclator_get("mac");
1549                         if (acl == NULL || !acl->iac_attach(vap))
1550                                 return EINVAL;
1551                         vap->iv_acl = acl;
1552                 }
1553                 acl->iac_setpolicy(vap, ireq->i_val);
1554                 break;
1555         case IEEE80211_MACCMD_FLUSH:
1556                 if (acl != NULL)
1557                         acl->iac_flush(vap);
1558                 /* NB: silently ignore when not in use */
1559                 break;
1560         case IEEE80211_MACCMD_DETACH:
1561                 if (acl != NULL) {
1562                         vap->iv_acl = NULL;
1563                         acl->iac_detach(vap);
1564                 }
1565                 break;
1566         default:
1567                 if (acl == NULL)
1568                         return EINVAL;
1569                 else
1570                         return acl->iac_setioctl(vap, ireq);
1571         }
1572         return 0;
1573 }
1574
1575 static __noinline int
1576 ieee80211_ioctl_setchanlist(struct ieee80211vap *vap, struct ieee80211req *ireq)
1577 {
1578         struct ieee80211com *ic = vap->iv_ic;
1579         uint8_t *chanlist, *list;
1580         int i, nchan, maxchan, error;
1581
1582         if (ireq->i_len > sizeof(ic->ic_chan_active))
1583                 ireq->i_len = sizeof(ic->ic_chan_active);
1584         list = kmalloc(ireq->i_len + IEEE80211_CHAN_BYTES, M_TEMP,
1585             M_INTWAIT | M_ZERO);
1586         if (list == NULL)
1587                 return ENOMEM;
1588         error = copyin(ireq->i_data, list, ireq->i_len);
1589         if (error) {
1590                 kfree(list, M_TEMP);
1591                 return error;
1592         }
1593         nchan = 0;
1594         chanlist = list + ireq->i_len;          /* NB: zero'd already */
1595         maxchan = ireq->i_len * NBBY;
1596         for (i = 0; i < ic->ic_nchans; i++) {
1597                 const struct ieee80211_channel *c = &ic->ic_channels[i];
1598                 /*
1599                  * Calculate the intersection of the user list and the
1600                  * available channels so users can do things like specify
1601                  * 1-255 to get all available channels.
1602                  */
1603                 if (c->ic_ieee < maxchan && isset(list, c->ic_ieee)) {
1604                         setbit(chanlist, c->ic_ieee);
1605                         nchan++;
1606                 }
1607         }
1608         if (nchan == 0) {
1609                 kfree(list, M_TEMP);
1610                 return EINVAL;
1611         }
1612         if (ic->ic_bsschan != IEEE80211_CHAN_ANYC &&    /* XXX */
1613             isclr(chanlist, ic->ic_bsschan->ic_ieee))
1614                 ic->ic_bsschan = IEEE80211_CHAN_ANYC;
1615         memcpy(ic->ic_chan_active, chanlist, IEEE80211_CHAN_BYTES);
1616         ieee80211_scan_flush(vap);
1617         kfree(list, M_TEMP);
1618         return ENETRESET;
1619 }
1620
1621 static __noinline int
1622 ieee80211_ioctl_setstastats(struct ieee80211vap *vap, struct ieee80211req *ireq)
1623 {
1624         struct ieee80211_node *ni;
1625         uint8_t macaddr[IEEE80211_ADDR_LEN];
1626         int error;
1627
1628         /*
1629          * NB: we could copyin ieee80211req_sta_stats so apps
1630          *     could make selective changes but that's overkill;
1631          *     just clear all stats for now.
1632          */
1633         if (ireq->i_len < IEEE80211_ADDR_LEN)
1634                 return EINVAL;
1635         error = copyin(ireq->i_data, macaddr, IEEE80211_ADDR_LEN);
1636         if (error != 0)
1637                 return error;
1638         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, macaddr);
1639         if (ni == NULL)
1640                 return ENOENT;
1641         /* XXX require ni_vap == vap? */
1642         memset(&ni->ni_stats, 0, sizeof(ni->ni_stats));
1643         ieee80211_free_node(ni);
1644         return 0;
1645 }
1646
1647 static __noinline int
1648 ieee80211_ioctl_setstatxpow(struct ieee80211vap *vap, struct ieee80211req *ireq)
1649 {
1650         struct ieee80211_node *ni;
1651         struct ieee80211req_sta_txpow txpow;
1652         int error;
1653
1654         if (ireq->i_len != sizeof(txpow))
1655                 return EINVAL;
1656         error = copyin(ireq->i_data, &txpow, sizeof(txpow));
1657         if (error != 0)
1658                 return error;
1659         ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap, txpow.it_macaddr);
1660         if (ni == NULL)
1661                 return ENOENT;
1662         ni->ni_txpower = txpow.it_txpow;
1663         ieee80211_free_node(ni);
1664         return error;
1665 }
1666
1667 static __noinline int
1668 ieee80211_ioctl_setwmeparam(struct ieee80211vap *vap, struct ieee80211req *ireq)
1669 {
1670         struct ieee80211com *ic = vap->iv_ic;
1671         struct ieee80211_wme_state *wme = &ic->ic_wme;
1672         struct wmeParams *wmep, *chanp;
1673         int isbss, ac;
1674
1675         if ((ic->ic_caps & IEEE80211_C_WME) == 0)
1676                 return EOPNOTSUPP;
1677
1678         isbss = (ireq->i_len & IEEE80211_WMEPARAM_BSS);
1679         ac = (ireq->i_len & IEEE80211_WMEPARAM_VAL);
1680         if (ac >= WME_NUM_AC)
1681                 ac = WME_AC_BE;
1682         if (isbss) {
1683                 chanp = &wme->wme_bssChanParams.cap_wmeParams[ac];
1684                 wmep = &wme->wme_wmeBssChanParams.cap_wmeParams[ac];
1685         } else {
1686                 chanp = &wme->wme_chanParams.cap_wmeParams[ac];
1687                 wmep = &wme->wme_wmeChanParams.cap_wmeParams[ac];
1688         }
1689         switch (ireq->i_type) {
1690         case IEEE80211_IOC_WME_CWMIN:           /* WME: CWmin */
1691                 if (isbss) {
1692                         wmep->wmep_logcwmin = ireq->i_val;
1693                         if ((wme->wme_flags & WME_F_AGGRMODE) == 0)
1694                                 chanp->wmep_logcwmin = ireq->i_val;
1695                 } else {
1696                         wmep->wmep_logcwmin = chanp->wmep_logcwmin =
1697                                 ireq->i_val;
1698                 }
1699                 break;
1700         case IEEE80211_IOC_WME_CWMAX:           /* WME: CWmax */
1701                 if (isbss) {
1702                         wmep->wmep_logcwmax = ireq->i_val;
1703                         if ((wme->wme_flags & WME_F_AGGRMODE) == 0)
1704                                 chanp->wmep_logcwmax = ireq->i_val;
1705                 } else {
1706                         wmep->wmep_logcwmax = chanp->wmep_logcwmax =
1707                                 ireq->i_val;
1708                 }
1709                 break;
1710         case IEEE80211_IOC_WME_AIFS:            /* WME: AIFS */
1711                 if (isbss) {
1712                         wmep->wmep_aifsn = ireq->i_val;
1713                         if ((wme->wme_flags & WME_F_AGGRMODE) == 0)
1714                                 chanp->wmep_aifsn = ireq->i_val;
1715                 } else {
1716                         wmep->wmep_aifsn = chanp->wmep_aifsn = ireq->i_val;
1717                 }
1718                 break;
1719         case IEEE80211_IOC_WME_TXOPLIMIT:       /* WME: txops limit */
1720                 if (isbss) {
1721                         wmep->wmep_txopLimit = ireq->i_val;
1722                         if ((wme->wme_flags & WME_F_AGGRMODE) == 0)
1723                                 chanp->wmep_txopLimit = ireq->i_val;
1724                 } else {
1725                         wmep->wmep_txopLimit = chanp->wmep_txopLimit =
1726                                 ireq->i_val;
1727                 }
1728                 break;
1729         case IEEE80211_IOC_WME_ACM:             /* WME: ACM (bss only) */
1730                 wmep->wmep_acm = ireq->i_val;
1731                 if ((wme->wme_flags & WME_F_AGGRMODE) == 0)
1732                         chanp->wmep_acm = ireq->i_val;
1733                 break;
1734         case IEEE80211_IOC_WME_ACKPOLICY:       /* WME: ACK policy (!bss only)*/
1735                 wmep->wmep_noackPolicy = chanp->wmep_noackPolicy =
1736                         (ireq->i_val) == 0;
1737                 break;
1738         }
1739         ieee80211_wme_updateparams(vap);
1740         return 0;
1741 }
1742
1743 static int
1744 find11gchannel(struct ieee80211com *ic, int start, int freq)
1745 {
1746         const struct ieee80211_channel *c;
1747         int i;
1748
1749         for (i = start+1; i < ic->ic_nchans; i++) {
1750                 c = &ic->ic_channels[i];
1751                 if (c->ic_freq == freq && IEEE80211_IS_CHAN_ANYG(c))
1752                         return 1;
1753         }
1754         /* NB: should not be needed but in case things are mis-sorted */
1755         for (i = 0; i < start; i++) {
1756                 c = &ic->ic_channels[i];
1757                 if (c->ic_freq == freq && IEEE80211_IS_CHAN_ANYG(c))
1758                         return 1;
1759         }
1760         return 0;
1761 }
1762
1763 static struct ieee80211_channel *
1764 findchannel(struct ieee80211com *ic, int ieee, int mode)
1765 {
1766         static const u_int chanflags[IEEE80211_MODE_MAX] = {
1767             [IEEE80211_MODE_AUTO]       = 0,
1768             [IEEE80211_MODE_11A]        = IEEE80211_CHAN_A,
1769             [IEEE80211_MODE_11B]        = IEEE80211_CHAN_B,
1770             [IEEE80211_MODE_11G]        = IEEE80211_CHAN_G,
1771             [IEEE80211_MODE_FH]         = IEEE80211_CHAN_FHSS,
1772             [IEEE80211_MODE_TURBO_A]    = IEEE80211_CHAN_108A,
1773             [IEEE80211_MODE_TURBO_G]    = IEEE80211_CHAN_108G,
1774             [IEEE80211_MODE_STURBO_A]   = IEEE80211_CHAN_STURBO,
1775             [IEEE80211_MODE_HALF]       = IEEE80211_CHAN_HALF,
1776             [IEEE80211_MODE_QUARTER]    = IEEE80211_CHAN_QUARTER,
1777             /* NB: handled specially below */
1778             [IEEE80211_MODE_11NA]       = IEEE80211_CHAN_A,
1779             [IEEE80211_MODE_11NG]       = IEEE80211_CHAN_G,
1780         };
1781         u_int modeflags;
1782         int i;
1783
1784         modeflags = chanflags[mode];
1785         for (i = 0; i < ic->ic_nchans; i++) {
1786                 struct ieee80211_channel *c = &ic->ic_channels[i];
1787
1788                 if (c->ic_ieee != ieee)
1789                         continue;
1790                 if (mode == IEEE80211_MODE_AUTO) {
1791                         /* ignore turbo channels for autoselect */
1792                         if (IEEE80211_IS_CHAN_TURBO(c))
1793                                 continue;
1794                         /*
1795                          * XXX special-case 11b/g channels so we
1796                          *     always select the g channel if both
1797                          *     are present.
1798                          * XXX prefer HT to non-HT?
1799                          */
1800                         if (!IEEE80211_IS_CHAN_B(c) ||
1801                             !find11gchannel(ic, i, c->ic_freq))
1802                                 return c;
1803                 } else {
1804                         /* must check HT specially */
1805                         if ((mode == IEEE80211_MODE_11NA ||
1806                             mode == IEEE80211_MODE_11NG) &&
1807                             !IEEE80211_IS_CHAN_HT(c))
1808                                 continue;
1809                         if ((c->ic_flags & modeflags) == modeflags)
1810                                 return c;
1811                 }
1812         }
1813         return NULL;
1814 }
1815
1816 /*
1817  * Check the specified against any desired mode (aka netband).
1818  * This is only used (presently) when operating in hostap mode
1819  * to enforce consistency.
1820  */
1821 static int
1822 check_mode_consistency(const struct ieee80211_channel *c, int mode)
1823 {
1824         KASSERT(c != IEEE80211_CHAN_ANYC, ("oops, no channel"));
1825
1826         switch (mode) {
1827         case IEEE80211_MODE_11B:
1828                 return (IEEE80211_IS_CHAN_B(c));
1829         case IEEE80211_MODE_11G:
1830                 return (IEEE80211_IS_CHAN_ANYG(c) && !IEEE80211_IS_CHAN_HT(c));
1831         case IEEE80211_MODE_11A:
1832                 return (IEEE80211_IS_CHAN_A(c) && !IEEE80211_IS_CHAN_HT(c));
1833         case IEEE80211_MODE_STURBO_A:
1834                 return (IEEE80211_IS_CHAN_STURBO(c));
1835         case IEEE80211_MODE_11NA:
1836                 return (IEEE80211_IS_CHAN_HTA(c));
1837         case IEEE80211_MODE_11NG:
1838                 return (IEEE80211_IS_CHAN_HTG(c));
1839         }
1840         return 1;
1841
1842 }
1843
1844 /*
1845  * Common code to set the current channel.  If the device
1846  * is up and running this may result in an immediate channel
1847  * change or a kick of the state machine.
1848  */
1849 static int
1850 setcurchan(struct ieee80211vap *vap, struct ieee80211_channel *c)
1851 {
1852         struct ieee80211com *ic = vap->iv_ic;
1853         int error;
1854
1855         if (c != IEEE80211_CHAN_ANYC) {
1856                 if (IEEE80211_IS_CHAN_RADAR(c))
1857                         return EBUSY;   /* XXX better code? */
1858                 if (vap->iv_opmode == IEEE80211_M_HOSTAP) {
1859                         if (IEEE80211_IS_CHAN_NOHOSTAP(c))
1860                                 return EINVAL;
1861                         if (!check_mode_consistency(c, vap->iv_des_mode))
1862                                 return EINVAL;
1863                 } else if (vap->iv_opmode == IEEE80211_M_IBSS) {
1864                         if (IEEE80211_IS_CHAN_NOADHOC(c))
1865                                 return EINVAL;
1866                 }
1867                 if (vap->iv_state == IEEE80211_S_RUN &&
1868                     vap->iv_bss->ni_chan == c)
1869                         return 0;       /* NB: nothing to do */
1870         }
1871         vap->iv_des_chan = c;
1872
1873         error = 0;
1874         if (vap->iv_opmode == IEEE80211_M_MONITOR &&
1875             vap->iv_des_chan != IEEE80211_CHAN_ANYC) {
1876                 /*
1877                  * Monitor mode can switch directly.
1878                  */
1879                 if (IFNET_IS_UP_RUNNING(vap->iv_ifp)) {
1880                         /* XXX need state machine for other vap's to follow */
1881                         ieee80211_setcurchan(ic, vap->iv_des_chan);
1882                         vap->iv_bss->ni_chan = ic->ic_curchan;
1883                 } else
1884                         ic->ic_curchan = vap->iv_des_chan;
1885                         ic->ic_rt = ieee80211_get_ratetable(ic->ic_curchan);
1886         } else {
1887                 /*
1888                  * Need to go through the state machine in case we
1889                  * need to reassociate or the like.  The state machine
1890                  * will pickup the desired channel and avoid scanning.
1891                  */
1892                 if (IS_UP_AUTO(vap))
1893                         ieee80211_new_state(vap, IEEE80211_S_SCAN, 0);
1894                 else if (vap->iv_des_chan != IEEE80211_CHAN_ANYC) {
1895                         /*
1896                          * When not up+running and a real channel has
1897                          * been specified fix the current channel so
1898                          * there is immediate feedback; e.g. via ifconfig.
1899                          */
1900                         ic->ic_curchan = vap->iv_des_chan;
1901                         ic->ic_rt = ieee80211_get_ratetable(ic->ic_curchan);
1902                 }
1903         }
1904         return error;
1905 }
1906
1907 /*
1908  * Old api for setting the current channel; this is
1909  * deprecated because channel numbers are ambiguous.
1910  */
1911 static __noinline int
1912 ieee80211_ioctl_setchannel(struct ieee80211vap *vap,
1913         const struct ieee80211req *ireq)
1914 {
1915         struct ieee80211com *ic = vap->iv_ic;
1916         struct ieee80211_channel *c;
1917
1918         /* XXX 0xffff overflows 16-bit signed */
1919         if (ireq->i_val == 0 ||
1920             ireq->i_val == (int16_t) IEEE80211_CHAN_ANY) {
1921                 c = IEEE80211_CHAN_ANYC;
1922         } else {
1923                 struct ieee80211_channel *c2;
1924
1925                 c = findchannel(ic, ireq->i_val, vap->iv_des_mode);
1926                 if (c == NULL) {
1927                         c = findchannel(ic, ireq->i_val,
1928                                 IEEE80211_MODE_AUTO);
1929                         if (c == NULL)
1930                                 return EINVAL;
1931                 }
1932                 /*
1933                  * Fine tune channel selection based on desired mode:
1934                  *   if 11b is requested, find the 11b version of any
1935                  *      11g channel returned,
1936                  *   if static turbo, find the turbo version of any
1937                  *      11a channel return,
1938                  *   if 11na is requested, find the ht version of any
1939                  *      11a channel returned,
1940                  *   if 11ng is requested, find the ht version of any
1941                  *      11g channel returned,
1942                  *   otherwise we should be ok with what we've got.
1943                  */
1944                 switch (vap->iv_des_mode) {
1945                 case IEEE80211_MODE_11B:
1946                         if (IEEE80211_IS_CHAN_ANYG(c)) {
1947                                 c2 = findchannel(ic, ireq->i_val,
1948                                         IEEE80211_MODE_11B);
1949                                 /* NB: should not happen, =>'s 11g w/o 11b */
1950                                 if (c2 != NULL)
1951                                         c = c2;
1952                         }
1953                         break;
1954                 case IEEE80211_MODE_TURBO_A:
1955                         if (IEEE80211_IS_CHAN_A(c)) {
1956                                 c2 = findchannel(ic, ireq->i_val,
1957                                         IEEE80211_MODE_TURBO_A);
1958                                 if (c2 != NULL)
1959                                         c = c2;
1960                         }
1961                         break;
1962                 case IEEE80211_MODE_11NA:
1963                         if (IEEE80211_IS_CHAN_A(c)) {
1964                                 c2 = findchannel(ic, ireq->i_val,
1965                                         IEEE80211_MODE_11NA);
1966                                 if (c2 != NULL)
1967                                         c = c2;
1968                         }
1969                         break;
1970                 case IEEE80211_MODE_11NG:
1971                         if (IEEE80211_IS_CHAN_ANYG(c)) {
1972                                 c2 = findchannel(ic, ireq->i_val,
1973                                         IEEE80211_MODE_11NG);
1974                                 if (c2 != NULL)
1975                                         c = c2;
1976                         }
1977                         break;
1978                 default:                /* NB: no static turboG */
1979                         break;
1980                 }
1981         }
1982         return setcurchan(vap, c);
1983 }
1984
1985 /*
1986  * New/current api for setting the current channel; a complete
1987  * channel description is provide so there is no ambiguity in
1988  * identifying the channel.
1989  */
1990 static __noinline int
1991 ieee80211_ioctl_setcurchan(struct ieee80211vap *vap,
1992         const struct ieee80211req *ireq)
1993 {
1994         struct ieee80211com *ic = vap->iv_ic;
1995         struct ieee80211_channel chan, *c;
1996         int error;
1997
1998         if (ireq->i_len != sizeof(chan))
1999                 return EINVAL;
2000         error = copyin(ireq->i_data, &chan, sizeof(chan));
2001         if (error != 0)
2002                 return error;
2003         /* XXX 0xffff overflows 16-bit signed */
2004         if (chan.ic_freq == 0 || chan.ic_freq == IEEE80211_CHAN_ANY) {
2005                 c = IEEE80211_CHAN_ANYC;
2006         } else {
2007                 c = ieee80211_find_channel(ic, chan.ic_freq, chan.ic_flags);
2008                 if (c == NULL)
2009                         return EINVAL;
2010         }
2011         return setcurchan(vap, c);
2012 }
2013
2014 static __noinline int
2015 ieee80211_ioctl_setregdomain(struct ieee80211vap *vap,
2016         const struct ieee80211req *ireq)
2017 {
2018         struct ieee80211_regdomain_req *reg;
2019         int nchans, error;
2020
2021         nchans = 1 + ((ireq->i_len - sizeof(struct ieee80211_regdomain_req)) /
2022             sizeof(struct ieee80211_channel));
2023         if (!(1 <= nchans && nchans <= IEEE80211_CHAN_MAX)) {
2024                 IEEE80211_DPRINTF(vap, IEEE80211_MSG_IOCTL,
2025                     "%s: bad # chans, i_len %d nchans %d\n", __func__,
2026                     ireq->i_len, nchans);
2027                 return EINVAL;
2028         }
2029         reg = (struct ieee80211_regdomain_req *)
2030             kmalloc(IEEE80211_REGDOMAIN_SIZE(nchans), M_TEMP, M_INTWAIT);
2031         if (reg == NULL) {
2032                 IEEE80211_DPRINTF(vap, IEEE80211_MSG_IOCTL,
2033                     "%s: no memory, nchans %d\n", __func__, nchans);
2034                 return ENOMEM;
2035         }
2036         error = copyin(ireq->i_data, reg, IEEE80211_REGDOMAIN_SIZE(nchans));
2037         if (error == 0) {
2038                 /* NB: validate inline channel count against storage size */
2039                 if (reg->chaninfo.ic_nchans != nchans) {
2040                         IEEE80211_DPRINTF(vap, IEEE80211_MSG_IOCTL,
2041                             "%s: chan cnt mismatch, %d != %d\n", __func__,
2042                                 reg->chaninfo.ic_nchans, nchans);
2043                         error = EINVAL;
2044                 } else
2045                         error = ieee80211_setregdomain(vap, reg);
2046         }
2047         kfree(reg, M_TEMP);
2048
2049         return (error == 0 ? ENETRESET : error);
2050 }
2051
2052 static int
2053 ieee80211_ioctl_setroam(struct ieee80211vap *vap,
2054         const struct ieee80211req *ireq)
2055 {
2056         if (ireq->i_len != sizeof(vap->iv_roamparms))
2057                 return EINVAL;
2058         /* XXX validate params */
2059         /* XXX? ENETRESET to push to device? */
2060         return copyin(ireq->i_data, vap->iv_roamparms,
2061             sizeof(vap->iv_roamparms));
2062 }
2063
2064 static int
2065 checkrate(const struct ieee80211_rateset *rs, int rate)
2066 {
2067         int i;
2068
2069         if (rate == IEEE80211_FIXED_RATE_NONE)
2070                 return 1;
2071         for (i = 0; i < rs->rs_nrates; i++)
2072                 if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == rate)
2073                         return 1;
2074         return 0;
2075 }
2076
2077 static int
2078 checkmcs(int mcs)
2079 {
2080         if (mcs == IEEE80211_FIXED_RATE_NONE)
2081                 return 1;
2082         if ((mcs & IEEE80211_RATE_MCS) == 0)    /* MCS always have 0x80 set */
2083                 return 0;
2084         return (mcs & 0x7f) <= 15;      /* XXX could search ht rate set */
2085 }
2086
2087 static __noinline int
2088 ieee80211_ioctl_settxparams(struct ieee80211vap *vap,
2089         const struct ieee80211req *ireq)
2090 {
2091         struct ieee80211com *ic = vap->iv_ic;
2092         struct ieee80211_txparams_req parms;    /* XXX stack use? */
2093         struct ieee80211_txparam *src, *dst;
2094         const struct ieee80211_rateset *rs;
2095         int error, mode, changed, is11n, nmodes;
2096
2097         /* NB: accept short requests for backwards compat */
2098         if (ireq->i_len > sizeof(parms))
2099                 return EINVAL;
2100         error = copyin(ireq->i_data, &parms, ireq->i_len);
2101         if (error != 0)
2102                 return error;
2103         nmodes = ireq->i_len / sizeof(struct ieee80211_txparam);
2104         changed = 0;
2105         /* validate parameters and check if anything changed */
2106         for (mode = IEEE80211_MODE_11A; mode < nmodes; mode++) {
2107                 if (isclr(ic->ic_modecaps, mode))
2108                         continue;
2109                 src = &parms.params[mode];
2110                 dst = &vap->iv_txparms[mode];
2111                 rs = &ic->ic_sup_rates[mode];   /* NB: 11n maps to legacy */
2112                 is11n = (mode == IEEE80211_MODE_11NA ||
2113                          mode == IEEE80211_MODE_11NG);
2114                 if (src->ucastrate != dst->ucastrate) {
2115                         if (!checkrate(rs, src->ucastrate) &&
2116                             (!is11n || !checkmcs(src->ucastrate)))
2117                                 return EINVAL;
2118                         changed++;
2119                 }
2120                 if (src->mcastrate != dst->mcastrate) {
2121                         if (!checkrate(rs, src->mcastrate) &&
2122                             (!is11n || !checkmcs(src->mcastrate)))
2123                                 return EINVAL;
2124                         changed++;
2125                 }
2126                 if (src->mgmtrate != dst->mgmtrate) {
2127                         if (!checkrate(rs, src->mgmtrate) &&
2128                             (!is11n || !checkmcs(src->mgmtrate)))
2129                                 return EINVAL;
2130                         changed++;
2131                 }
2132                 if (src->maxretry != dst->maxretry)     /* NB: no bounds */
2133                         changed++;
2134         }
2135         if (changed) {
2136                 /*
2137                  * Copy new parameters in place and notify the
2138                  * driver so it can push state to the device.
2139                  */
2140                 for (mode = IEEE80211_MODE_11A; mode < nmodes; mode++) {
2141                         if (isset(ic->ic_modecaps, mode))
2142                                 vap->iv_txparms[mode] = parms.params[mode];
2143                 }
2144                 /* XXX could be more intelligent,
2145                    e.g. don't reset if setting not being used */
2146                 return ENETRESET;
2147         }
2148         return 0;
2149 }
2150
2151 /*
2152  * Application Information Element support.
2153  */
2154 static int
2155 setappie(struct ieee80211_appie **aie, const struct ieee80211req *ireq)
2156 {
2157         struct ieee80211_appie *app = *aie;
2158         struct ieee80211_appie *napp;
2159         int error;
2160
2161         if (ireq->i_len == 0) {         /* delete any existing ie */
2162                 if (app != NULL) {
2163                         *aie = NULL;    /* XXX racey */
2164                         kfree(app, M_80211_NODE_IE);
2165                 }
2166                 return 0;
2167         }
2168         if (!(2 <= ireq->i_len && ireq->i_len <= IEEE80211_MAX_APPIE))
2169                 return EINVAL;
2170         /*
2171          * Allocate a new appie structure and copy in the user data.
2172          * When done swap in the new structure.  Note that we do not
2173          * guard against users holding a ref to the old structure;
2174          * this must be handled outside this code.
2175          *
2176          * XXX bad bad bad
2177          */
2178         napp = (struct ieee80211_appie *) kmalloc(
2179             sizeof(struct ieee80211_appie) + ireq->i_len, M_80211_NODE_IE,
2180             M_INTWAIT);
2181         if (napp == NULL)
2182                 return ENOMEM;
2183         /* XXX holding ic lock */
2184         error = copyin(ireq->i_data, napp->ie_data, ireq->i_len);
2185         if (error) {
2186                 kfree(napp, M_80211_NODE_IE);
2187                 return error;
2188         }
2189         napp->ie_len = ireq->i_len;
2190         *aie = napp;
2191         if (app != NULL)
2192                 kfree(app, M_80211_NODE_IE);
2193         return 0;
2194 }
2195
2196 static void
2197 setwparsnie(struct ieee80211vap *vap, uint8_t *ie, int space)
2198 {
2199         /* validate data is present as best we can */
2200         if (space == 0 || 2+ie[1] > space)
2201                 return;
2202         if (ie[0] == IEEE80211_ELEMID_VENDOR)
2203                 vap->iv_wpa_ie = ie;
2204         else if (ie[0] == IEEE80211_ELEMID_RSN)
2205                 vap->iv_rsn_ie = ie;
2206 }
2207
2208 static __noinline int
2209 ieee80211_ioctl_setappie_locked(struct ieee80211vap *vap,
2210         const struct ieee80211req *ireq, int fc0)
2211 {
2212         int error;
2213
2214         switch (fc0 & IEEE80211_FC0_SUBTYPE_MASK) {
2215         case IEEE80211_FC0_SUBTYPE_BEACON:
2216                 if (vap->iv_opmode != IEEE80211_M_HOSTAP &&
2217                     vap->iv_opmode != IEEE80211_M_IBSS) {
2218                         error = EINVAL;
2219                         break;
2220                 }
2221                 error = setappie(&vap->iv_appie_beacon, ireq);
2222                 if (error == 0)
2223                         ieee80211_beacon_notify(vap, IEEE80211_BEACON_APPIE);
2224                 break;
2225         case IEEE80211_FC0_SUBTYPE_PROBE_RESP:
2226                 error = setappie(&vap->iv_appie_proberesp, ireq);
2227                 break;
2228         case IEEE80211_FC0_SUBTYPE_ASSOC_RESP:
2229                 if (vap->iv_opmode == IEEE80211_M_HOSTAP)
2230                         error = setappie(&vap->iv_appie_assocresp, ireq);
2231                 else
2232                         error = EINVAL;
2233                 break;
2234         case IEEE80211_FC0_SUBTYPE_PROBE_REQ:
2235                 error = setappie(&vap->iv_appie_probereq, ireq);
2236                 break;
2237         case IEEE80211_FC0_SUBTYPE_ASSOC_REQ:
2238                 if (vap->iv_opmode == IEEE80211_M_STA)
2239                         error = setappie(&vap->iv_appie_assocreq, ireq);
2240                 else
2241                         error = EINVAL;
2242                 break;
2243         case (IEEE80211_APPIE_WPA & IEEE80211_FC0_SUBTYPE_MASK):
2244                 error = setappie(&vap->iv_appie_wpa, ireq);
2245                 if (error == 0) {
2246                         /*
2247                          * Must split single blob of data into separate
2248                          * WPA and RSN ie's because they go in different
2249                          * locations in the mgt frames.
2250                          * XXX use IEEE80211_IOC_WPA2 so user code does split
2251                          */
2252                         vap->iv_wpa_ie = NULL;
2253                         vap->iv_rsn_ie = NULL;
2254                         if (vap->iv_appie_wpa != NULL) {
2255                                 struct ieee80211_appie *appie =
2256                                     vap->iv_appie_wpa;
2257                                 uint8_t *data = appie->ie_data;
2258
2259                                 /* XXX ie length validate is painful, cheat */
2260                                 setwparsnie(vap, data, appie->ie_len);
2261                                 setwparsnie(vap, data + 2 + data[1],
2262                                     appie->ie_len - (2 + data[1]));
2263                         }
2264                         if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
2265                             vap->iv_opmode == IEEE80211_M_IBSS) {
2266                                 /*
2267                                  * Must rebuild beacon frame as the update
2268                                  * mechanism doesn't handle WPA/RSN ie's.
2269                                  * Could extend it but it doesn't normally
2270                                  * change; this is just to deal with hostapd
2271                                  * plumbing the ie after the interface is up.
2272                                  */
2273                                 error = ENETRESET;
2274                         }
2275                 }
2276                 break;
2277         default:
2278                 error = EINVAL;
2279                 break;
2280         }
2281         return error;
2282 }
2283
2284 static __noinline int
2285 ieee80211_ioctl_setappie(struct ieee80211vap *vap,
2286         const struct ieee80211req *ireq)
2287 {
2288         int error;
2289         uint8_t fc0;
2290
2291         fc0 = ireq->i_val & 0xff;
2292         if ((fc0 & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT)
2293                 return EINVAL;
2294         /* NB: could check iv_opmode and reject but hardly worth the effort */
2295         error = ieee80211_ioctl_setappie_locked(vap, ireq, fc0);
2296         return error;
2297 }
2298
2299 static __noinline int
2300 ieee80211_ioctl_chanswitch(struct ieee80211vap *vap, struct ieee80211req *ireq)
2301 {
2302         struct ieee80211com *ic = vap->iv_ic;
2303         struct ieee80211_chanswitch_req csr;
2304         struct ieee80211_channel *c;
2305         int error;
2306
2307         if (ireq->i_len != sizeof(csr))
2308                 return EINVAL;
2309         error = copyin(ireq->i_data, &csr, sizeof(csr));
2310         if (error != 0)
2311                 return error;
2312         /* XXX adhoc mode not supported */
2313         if (vap->iv_opmode != IEEE80211_M_HOSTAP ||
2314             (vap->iv_flags & IEEE80211_F_DOTH) == 0)
2315                 return EOPNOTSUPP;
2316         c = ieee80211_find_channel(ic,
2317             csr.csa_chan.ic_freq, csr.csa_chan.ic_flags);
2318         if (c == NULL)
2319                 return ENOENT;
2320         if ((ic->ic_flags & IEEE80211_F_CSAPENDING) == 0)
2321                 ieee80211_csa_startswitch(ic, c, csr.csa_mode, csr.csa_count);
2322         else if (csr.csa_count == 0)
2323                 ieee80211_csa_cancelswitch(ic);
2324         else
2325                 error = EBUSY;
2326         return error;
2327 }
2328
2329 static __noinline int
2330 ieee80211_ioctl_scanreq(struct ieee80211vap *vap, struct ieee80211req *ireq)
2331 {
2332 #define IEEE80211_IOC_SCAN_FLAGS \
2333         (IEEE80211_IOC_SCAN_NOPICK | IEEE80211_IOC_SCAN_ACTIVE | \
2334          IEEE80211_IOC_SCAN_PICK1ST | IEEE80211_IOC_SCAN_BGSCAN | \
2335          IEEE80211_IOC_SCAN_ONCE | IEEE80211_IOC_SCAN_NOBCAST | \
2336          IEEE80211_IOC_SCAN_NOJOIN | IEEE80211_IOC_SCAN_FLUSH | \
2337          IEEE80211_IOC_SCAN_CHECK)
2338         struct ieee80211com *ic = vap->iv_ic;
2339         struct ieee80211_scan_req sr;           /* XXX off stack? */
2340         int error, i;
2341
2342         /* NB: parent must be running */
2343         if ((ic->ic_ifp->if_flags & IFF_RUNNING) == 0)
2344                 return ENXIO;
2345
2346         if (ireq->i_len != sizeof(sr))
2347                 return EINVAL;
2348         error = copyin(ireq->i_data, &sr, sizeof(sr));
2349         if (error != 0)
2350                 return error;
2351         /* convert duration */
2352         if (sr.sr_duration == IEEE80211_IOC_SCAN_FOREVER)
2353                 sr.sr_duration = IEEE80211_SCAN_FOREVER;
2354         else {
2355                 if (sr.sr_duration < IEEE80211_IOC_SCAN_DURATION_MIN ||
2356                     sr.sr_duration > IEEE80211_IOC_SCAN_DURATION_MAX)
2357                         return EINVAL;
2358                 sr.sr_duration = msecs_to_ticks(sr.sr_duration);
2359                 if (sr.sr_duration < 1)
2360                         sr.sr_duration = 1;
2361         }
2362         /* convert min/max channel dwell */
2363         if (sr.sr_mindwell != 0) {
2364                 sr.sr_mindwell = msecs_to_ticks(sr.sr_mindwell);
2365                 if (sr.sr_mindwell < 1)
2366                         sr.sr_mindwell = 1;
2367         }
2368         if (sr.sr_maxdwell != 0) {
2369                 sr.sr_maxdwell = msecs_to_ticks(sr.sr_maxdwell);
2370                 if (sr.sr_maxdwell < 1)
2371                         sr.sr_maxdwell = 1;
2372         }
2373         /* NB: silently reduce ssid count to what is supported */
2374         if (sr.sr_nssid > IEEE80211_SCAN_MAX_SSID)
2375                 sr.sr_nssid = IEEE80211_SCAN_MAX_SSID;
2376         for (i = 0; i < sr.sr_nssid; i++)
2377                 if (sr.sr_ssid[i].len > IEEE80211_NWID_LEN)
2378                         return EINVAL;
2379         /* cleanse flags just in case, could reject if invalid flags */
2380         sr.sr_flags &= IEEE80211_IOC_SCAN_FLAGS;
2381         /*
2382          * Add an implicit NOPICK if the vap is not marked UP.  This
2383          * allows applications to scan without joining a bss (or picking
2384          * a channel and setting up a bss) and without forcing manual
2385          * roaming mode--you just need to mark the parent device UP.
2386          */
2387         if ((vap->iv_ifp->if_flags & IFF_UP) == 0)
2388                 sr.sr_flags |= IEEE80211_IOC_SCAN_NOPICK;
2389
2390         IEEE80211_DPRINTF(vap, IEEE80211_MSG_SCAN,
2391             "%s: flags 0x%x%s duration 0x%x mindwell %u maxdwell %u nssid %d\n",
2392             __func__, sr.sr_flags,
2393             (vap->iv_ifp->if_flags & IFF_UP) == 0 ? " (!IFF_UP)" : "",
2394             sr.sr_duration, sr.sr_mindwell, sr.sr_maxdwell, sr.sr_nssid);
2395         /*
2396          * If we are in INIT state then the driver has never had a chance
2397          * to setup hardware state to do a scan; we must use the state
2398          * machine to get us up to the SCAN state but once we reach SCAN
2399          * state we then want to use the supplied params.  Stash the
2400          * parameters in the vap and mark IEEE80211_FEXT_SCANREQ; the
2401          * state machines will recognize this and use the stashed params
2402          * to issue the scan request.
2403          *
2404          * Otherwise just invoke the scan machinery directly.
2405          */
2406         if (vap->iv_state == IEEE80211_S_INIT) {
2407                 /* NB: clobbers previous settings */
2408                 vap->iv_scanreq_flags = sr.sr_flags;
2409                 vap->iv_scanreq_duration = sr.sr_duration;
2410                 vap->iv_scanreq_nssid = sr.sr_nssid;
2411                 for (i = 0; i < sr.sr_nssid; i++) {
2412                         vap->iv_scanreq_ssid[i].len = sr.sr_ssid[i].len;
2413                         memcpy(vap->iv_scanreq_ssid[i].ssid, sr.sr_ssid[i].ssid,
2414                             sr.sr_ssid[i].len);
2415                 }
2416                 vap->iv_flags_ext |= IEEE80211_FEXT_SCANREQ;
2417                 ieee80211_new_state(vap, IEEE80211_S_SCAN, 0);
2418         } else {
2419                 vap->iv_flags_ext &= ~IEEE80211_FEXT_SCANREQ;
2420                 /* XXX neeed error return codes */
2421                 if (sr.sr_flags & IEEE80211_IOC_SCAN_CHECK) {
2422                         (void) ieee80211_check_scan(vap, sr.sr_flags,
2423                             sr.sr_duration, sr.sr_mindwell, sr.sr_maxdwell,
2424                             sr.sr_nssid,
2425                             /* NB: cheat, we assume structures are compatible */
2426                             (const struct ieee80211_scan_ssid *) &sr.sr_ssid[0]);
2427                 } else {
2428                         (void) ieee80211_start_scan(vap, sr.sr_flags,
2429                             sr.sr_duration, sr.sr_mindwell, sr.sr_maxdwell,
2430                             sr.sr_nssid,
2431                             /* NB: cheat, we assume structures are compatible */
2432                             (const struct ieee80211_scan_ssid *) &sr.sr_ssid[0]);
2433                 }
2434         }
2435         return error;
2436 #undef IEEE80211_IOC_SCAN_FLAGS
2437 }
2438
2439 static __noinline int
2440 ieee80211_ioctl_setstavlan(struct ieee80211vap *vap, struct ieee80211req *ireq)
2441 {
2442         struct ieee80211_node *ni;
2443         struct ieee80211req_sta_vlan vlan;
2444         int error;
2445
2446         if (ireq->i_len != sizeof(vlan))
2447                 return EINVAL;
2448         error = copyin(ireq->i_data, &vlan, sizeof(vlan));
2449         if (error != 0)
2450                 return error;
2451         if (!IEEE80211_ADDR_EQ(vlan.sv_macaddr, zerobssid)) {
2452                 ni = ieee80211_find_vap_node(&vap->iv_ic->ic_sta, vap,
2453                     vlan.sv_macaddr);
2454                 if (ni == NULL)
2455                         return ENOENT;
2456         } else
2457                 ni = ieee80211_ref_node(vap->iv_bss);
2458         ni->ni_vlan = vlan.sv_vlan;
2459         ieee80211_free_node(ni);
2460         return error;
2461 }
2462
2463 static int
2464 isvap11g(const struct ieee80211vap *vap)
2465 {
2466         const struct ieee80211_node *bss = vap->iv_bss;
2467         return bss->ni_chan != IEEE80211_CHAN_ANYC &&
2468             IEEE80211_IS_CHAN_ANYG(bss->ni_chan);
2469 }
2470
2471 static int
2472 isvapht(const struct ieee80211vap *vap)
2473 {
2474         const struct ieee80211_node *bss = vap->iv_bss;
2475         return bss->ni_chan != IEEE80211_CHAN_ANYC &&
2476             IEEE80211_IS_CHAN_HT(bss->ni_chan);
2477 }
2478
2479 /*
2480  * Dummy ioctl set handler so the linker set is defined.
2481  */
2482 static int
2483 dummy_ioctl_set(struct ieee80211vap *vap, struct ieee80211req *ireq)
2484 {
2485         return ENOSYS;
2486 }
2487 IEEE80211_IOCTL_SET(dummy, dummy_ioctl_set);
2488
2489 static int
2490 ieee80211_ioctl_setdefault(struct ieee80211vap *vap, struct ieee80211req *ireq)
2491 {
2492         ieee80211_ioctl_setfunc * const *set;
2493         int error;
2494
2495         SET_FOREACH(set, ieee80211_ioctl_setset) {
2496                 error = (*set)(vap, ireq);
2497                 if (error != ENOSYS)
2498                         return error;
2499         }
2500         return EINVAL;
2501 }
2502
2503 static __noinline int
2504 ieee80211_ioctl_set80211(struct ieee80211vap *vap, u_long cmd, struct ieee80211req *ireq)
2505 {
2506         struct ieee80211com *ic = vap->iv_ic;
2507         int error;
2508         const struct ieee80211_authenticator *auth;
2509         uint8_t tmpkey[IEEE80211_KEYBUF_SIZE];
2510         char tmpssid[IEEE80211_NWID_LEN];
2511         uint8_t tmpbssid[IEEE80211_ADDR_LEN];
2512         struct ieee80211_key *k;
2513         u_int kid;
2514         uint32_t flags;
2515
2516         error = 0;
2517         switch (ireq->i_type) {
2518         case IEEE80211_IOC_SSID:
2519                 if (ireq->i_val != 0 ||
2520                     ireq->i_len > IEEE80211_NWID_LEN)
2521                         return EINVAL;
2522                 error = copyin(ireq->i_data, tmpssid, ireq->i_len);
2523                 if (error)
2524                         break;
2525                 memset(vap->iv_des_ssid[0].ssid, 0, IEEE80211_NWID_LEN);
2526                 vap->iv_des_ssid[0].len = ireq->i_len;
2527                 memcpy(vap->iv_des_ssid[0].ssid, tmpssid, ireq->i_len);
2528                 vap->iv_des_nssid = (ireq->i_len > 0);
2529                 error = ENETRESET;
2530                 break;
2531         case IEEE80211_IOC_WEP:
2532                 switch (ireq->i_val) {
2533                 case IEEE80211_WEP_OFF:
2534                         vap->iv_flags &= ~IEEE80211_F_PRIVACY;
2535                         vap->iv_flags &= ~IEEE80211_F_DROPUNENC;
2536                         break;
2537                 case IEEE80211_WEP_ON:
2538                         vap->iv_flags |= IEEE80211_F_PRIVACY;
2539                         vap->iv_flags |= IEEE80211_F_DROPUNENC;
2540                         break;
2541                 case IEEE80211_WEP_MIXED:
2542                         vap->iv_flags |= IEEE80211_F_PRIVACY;
2543                         vap->iv_flags &= ~IEEE80211_F_DROPUNENC;
2544                         break;
2545                 }
2546                 error = ENETRESET;
2547                 break;
2548         case IEEE80211_IOC_WEPKEY:
2549                 kid = (u_int) ireq->i_val;
2550                 if (kid >= IEEE80211_WEP_NKID)
2551                         return EINVAL;
2552                 k = &vap->iv_nw_keys[kid];
2553                 if (ireq->i_len == 0) {
2554                         /* zero-len =>'s delete any existing key */
2555                         (void) ieee80211_crypto_delkey(vap, k);
2556                         break;
2557                 }
2558                 if (ireq->i_len > sizeof(tmpkey))
2559                         return EINVAL;
2560                 memset(tmpkey, 0, sizeof(tmpkey));
2561                 error = copyin(ireq->i_data, tmpkey, ireq->i_len);
2562                 if (error)
2563                         break;
2564                 ieee80211_key_update_begin(vap);
2565                 k->wk_keyix = kid;      /* NB: force fixed key id */
2566                 if (ieee80211_crypto_newkey(vap, IEEE80211_CIPHER_WEP,
2567                     IEEE80211_KEY_XMIT | IEEE80211_KEY_RECV, k)) {
2568                         k->wk_keylen = ireq->i_len;
2569                         memcpy(k->wk_key, tmpkey, sizeof(tmpkey));
2570                         IEEE80211_ADDR_COPY(k->wk_macaddr, vap->iv_myaddr);
2571                         if  (!ieee80211_crypto_setkey(vap, k))
2572                                 error = EINVAL;
2573                 } else
2574                         error = EINVAL;
2575                 ieee80211_key_update_end(vap);
2576                 break;
2577         case IEEE80211_IOC_WEPTXKEY:
2578                 kid = (u_int) ireq->i_val;
2579                 if (kid >= IEEE80211_WEP_NKID &&
2580                     (uint16_t) kid != IEEE80211_KEYIX_NONE)
2581                         return EINVAL;
2582                 vap->iv_def_txkey = kid;
2583                 break;
2584         case IEEE80211_IOC_AUTHMODE:
2585                 switch (ireq->i_val) {
2586                 case IEEE80211_AUTH_WPA:
2587                 case IEEE80211_AUTH_8021X:      /* 802.1x */
2588                 case IEEE80211_AUTH_OPEN:       /* open */
2589                 case IEEE80211_AUTH_SHARED:     /* shared-key */
2590                 case IEEE80211_AUTH_AUTO:       /* auto */
2591                         auth = ieee80211_authenticator_get(ireq->i_val);
2592                         if (auth == NULL)
2593                                 return EINVAL;
2594                         break;
2595                 default:
2596                         return EINVAL;
2597                 }
2598                 switch (ireq->i_val) {
2599                 case IEEE80211_AUTH_WPA:        /* WPA w/ 802.1x */
2600                         vap->iv_flags |= IEEE80211_F_PRIVACY;
2601                         ireq->i_val = IEEE80211_AUTH_8021X;
2602                         break;
2603                 case IEEE80211_AUTH_OPEN:       /* open */
2604                         vap->iv_flags &= ~(IEEE80211_F_WPA|IEEE80211_F_PRIVACY);
2605                         break;
2606                 case IEEE80211_AUTH_SHARED:     /* shared-key */
2607                 case IEEE80211_AUTH_8021X:      /* 802.1x */
2608                         vap->iv_flags &= ~IEEE80211_F_WPA;
2609                         /* both require a key so mark the PRIVACY capability */
2610                         vap->iv_flags |= IEEE80211_F_PRIVACY;
2611                         break;
2612                 case IEEE80211_AUTH_AUTO:       /* auto */
2613                         vap->iv_flags &= ~IEEE80211_F_WPA;
2614                         /* XXX PRIVACY handling? */
2615                         /* XXX what's the right way to do this? */
2616                         break;
2617                 }
2618                 /* NB: authenticator attach/detach happens on state change */
2619                 vap->iv_bss->ni_authmode = ireq->i_val;
2620                 /* XXX mixed/mode/usage? */
2621                 vap->iv_auth = auth;
2622                 error = ENETRESET;
2623                 break;
2624         case IEEE80211_IOC_CHANNEL:
2625                 error = ieee80211_ioctl_setchannel(vap, ireq);
2626                 break;
2627         case IEEE80211_IOC_POWERSAVE:
2628                 switch (ireq->i_val) {
2629                 case IEEE80211_POWERSAVE_OFF:
2630                         if (vap->iv_flags & IEEE80211_F_PMGTON) {
2631                                 ieee80211_syncflag(vap, -IEEE80211_F_PMGTON);
2632                                 error = ERESTART;
2633                         }
2634                         break;
2635                 case IEEE80211_POWERSAVE_ON:
2636                         if ((vap->iv_caps & IEEE80211_C_PMGT) == 0)
2637                                 error = EOPNOTSUPP;
2638                         else if ((vap->iv_flags & IEEE80211_F_PMGTON) == 0) {
2639                                 ieee80211_syncflag(vap, IEEE80211_F_PMGTON);
2640                                 error = ERESTART;
2641                         }
2642                         break;
2643                 default:
2644                         error = EINVAL;
2645                         break;
2646                 }
2647                 break;
2648         case IEEE80211_IOC_POWERSAVESLEEP:
2649                 if (ireq->i_val < 0)
2650                         return EINVAL;
2651                 ic->ic_lintval = ireq->i_val;
2652                 error = ERESTART;
2653                 break;
2654         case IEEE80211_IOC_RTSTHRESHOLD:
2655                 if (!(IEEE80211_RTS_MIN <= ireq->i_val &&
2656                       ireq->i_val <= IEEE80211_RTS_MAX))
2657                         return EINVAL;
2658                 vap->iv_rtsthreshold = ireq->i_val;
2659                 error = ERESTART;
2660                 break;
2661         case IEEE80211_IOC_PROTMODE:
2662                 if (ireq->i_val > IEEE80211_PROT_RTSCTS)
2663                         return EINVAL;
2664                 ic->ic_protmode = ireq->i_val;
2665                 /* NB: if not operating in 11g this can wait */
2666                 if (ic->ic_bsschan != IEEE80211_CHAN_ANYC &&
2667                     IEEE80211_IS_CHAN_ANYG(ic->ic_bsschan))
2668                         error = ERESTART;
2669                 break;
2670         case IEEE80211_IOC_TXPOWER:
2671                 if ((ic->ic_caps & IEEE80211_C_TXPMGT) == 0)
2672                         return EOPNOTSUPP;
2673                 if (!(IEEE80211_TXPOWER_MIN <= ireq->i_val &&
2674                       ireq->i_val <= IEEE80211_TXPOWER_MAX))
2675                         return EINVAL;
2676                 ic->ic_txpowlimit = ireq->i_val;
2677                 error = ERESTART;
2678                 break;
2679         case IEEE80211_IOC_ROAMING:
2680                 if (!(IEEE80211_ROAMING_DEVICE <= ireq->i_val &&
2681                     ireq->i_val <= IEEE80211_ROAMING_MANUAL))
2682                         return EINVAL;
2683                 vap->iv_roaming = ireq->i_val;
2684                 /* XXXX reset? */
2685                 break;
2686         case IEEE80211_IOC_PRIVACY:
2687                 if (ireq->i_val) {
2688                         /* XXX check for key state? */
2689                         vap->iv_flags |= IEEE80211_F_PRIVACY;
2690                 } else
2691                         vap->iv_flags &= ~IEEE80211_F_PRIVACY;
2692                 /* XXX ERESTART? */
2693                 break;
2694         case IEEE80211_IOC_DROPUNENCRYPTED:
2695                 if (ireq->i_val)
2696                         vap->iv_flags |= IEEE80211_F_DROPUNENC;
2697                 else
2698                         vap->iv_flags &= ~IEEE80211_F_DROPUNENC;
2699                 /* XXX ERESTART? */
2700                 break;
2701         case IEEE80211_IOC_WPAKEY:
2702                 error = ieee80211_ioctl_setkey(vap, ireq);
2703                 break;
2704         case IEEE80211_IOC_DELKEY:
2705                 error = ieee80211_ioctl_delkey(vap, ireq);
2706                 break;
2707         case IEEE80211_IOC_MLME:
2708                 error = ieee80211_ioctl_setmlme(vap, ireq);
2709                 break;
2710         case IEEE80211_IOC_COUNTERMEASURES:
2711                 if (ireq->i_val) {
2712                         if ((vap->iv_flags & IEEE80211_F_WPA) == 0)
2713                                 return EOPNOTSUPP;
2714                         vap->iv_flags |= IEEE80211_F_COUNTERM;
2715                 } else
2716                         vap->iv_flags &= ~IEEE80211_F_COUNTERM;
2717                 /* XXX ERESTART? */
2718                 break;
2719         case IEEE80211_IOC_WPA:
2720                 if (ireq->i_val > 3)
2721                         return EINVAL;
2722                 /* XXX verify ciphers available */
2723                 flags = vap->iv_flags & ~IEEE80211_F_WPA;
2724                 switch (ireq->i_val) {
2725                 case 1:
2726                         if (!(vap->iv_caps & IEEE80211_C_WPA1))
2727                                 return EOPNOTSUPP;
2728                         flags |= IEEE80211_F_WPA1;
2729                         break;
2730                 case 2:
2731                         if (!(vap->iv_caps & IEEE80211_C_WPA2))
2732                                 return EOPNOTSUPP;
2733                         flags |= IEEE80211_F_WPA2;
2734                         break;
2735                 case 3:
2736                         if ((vap->iv_caps & IEEE80211_C_WPA) != IEEE80211_C_WPA)
2737                                 return EOPNOTSUPP;
2738                         flags |= IEEE80211_F_WPA1 | IEEE80211_F_WPA2;
2739                         break;
2740                 default:        /*  Can't set any -> error */
2741                         return EOPNOTSUPP;
2742                 }
2743                 vap->iv_flags = flags;
2744                 error = ERESTART;       /* NB: can change beacon frame */
2745                 break;
2746         case IEEE80211_IOC_WME:
2747                 if (ireq->i_val) {
2748                         if ((vap->iv_caps & IEEE80211_C_WME) == 0)
2749                                 return EOPNOTSUPP;
2750                         ieee80211_syncflag(vap, IEEE80211_F_WME);
2751                 } else
2752                         ieee80211_syncflag(vap, -IEEE80211_F_WME);
2753                 error = ERESTART;       /* NB: can change beacon frame */
2754                 break;
2755         case IEEE80211_IOC_HIDESSID:
2756                 if (ireq->i_val)
2757                         vap->iv_flags |= IEEE80211_F_HIDESSID;
2758                 else
2759                         vap->iv_flags &= ~IEEE80211_F_HIDESSID;
2760                 error = ERESTART;               /* XXX ENETRESET? */
2761                 break;
2762         case IEEE80211_IOC_APBRIDGE:
2763                 if (ireq->i_val == 0)
2764                         vap->iv_flags |= IEEE80211_F_NOBRIDGE;
2765                 else
2766                         vap->iv_flags &= ~IEEE80211_F_NOBRIDGE;
2767                 break;
2768         case IEEE80211_IOC_BSSID:
2769                 if (ireq->i_len != sizeof(tmpbssid))
2770                         return EINVAL;
2771                 error = copyin(ireq->i_data, tmpbssid, ireq->i_len);
2772                 if (error)
2773                         break;
2774                 IEEE80211_ADDR_COPY(vap->iv_des_bssid, tmpbssid);
2775                 if (IEEE80211_ADDR_EQ(vap->iv_des_bssid, zerobssid))
2776                         vap->iv_flags &= ~IEEE80211_F_DESBSSID;
2777                 else
2778                         vap->iv_flags |= IEEE80211_F_DESBSSID;
2779                 error = ENETRESET;
2780                 break;
2781         case IEEE80211_IOC_CHANLIST:
2782                 error = ieee80211_ioctl_setchanlist(vap, ireq);
2783                 break;
2784 #define OLD_IEEE80211_IOC_SCAN_REQ      23
2785 #ifdef OLD_IEEE80211_IOC_SCAN_REQ
2786         case OLD_IEEE80211_IOC_SCAN_REQ:
2787                 IEEE80211_DPRINTF(vap, IEEE80211_MSG_SCAN,
2788                         "%s: active scan request\n", __func__);
2789                 /*
2790                  * If we are in INIT state then the driver has never
2791                  * had a chance to setup hardware state to do a scan;
2792                  * use the state machine to get us up the SCAN state.
2793                  * Otherwise just invoke the scan machinery to start
2794                  * a one-time scan.
2795                  */
2796                 if (vap->iv_state == IEEE80211_S_INIT)
2797                         ieee80211_new_state(vap, IEEE80211_S_SCAN, 0);
2798                 else
2799                         (void) ieee80211_start_scan(vap,
2800                                 IEEE80211_SCAN_ACTIVE |
2801                                 IEEE80211_SCAN_NOPICK |
2802                                 IEEE80211_SCAN_ONCE,
2803                                 IEEE80211_SCAN_FOREVER, 0, 0,
2804                                 /* XXX use ioctl params */
2805                                 vap->iv_des_nssid, vap->iv_des_ssid);
2806                 break;
2807 #endif /* OLD_IEEE80211_IOC_SCAN_REQ */
2808         case IEEE80211_IOC_SCAN_REQ:
2809                 error = ieee80211_ioctl_scanreq(vap, ireq);
2810                 break;
2811         case IEEE80211_IOC_SCAN_CANCEL:
2812                 IEEE80211_DPRINTF(vap, IEEE80211_MSG_SCAN,
2813                     "%s: cancel scan\n", __func__);
2814                 ieee80211_cancel_scan(vap);
2815                 break;
2816         case IEEE80211_IOC_HTCONF:
2817                 if (ireq->i_val & 1)
2818                         ieee80211_syncflag_ht(vap, IEEE80211_FHT_HT);
2819                 else
2820                         ieee80211_syncflag_ht(vap, -IEEE80211_FHT_HT);
2821                 if (ireq->i_val & 2)
2822                         ieee80211_syncflag_ht(vap, IEEE80211_FHT_USEHT40);
2823                 else
2824                         ieee80211_syncflag_ht(vap, -IEEE80211_FHT_USEHT40);
2825                 error = ENETRESET;
2826                 break;
2827         case IEEE80211_IOC_ADDMAC:
2828         case IEEE80211_IOC_DELMAC:
2829                 error = ieee80211_ioctl_macmac(vap, ireq);
2830                 break;
2831         case IEEE80211_IOC_MACCMD:
2832                 error = ieee80211_ioctl_setmaccmd(vap, ireq);
2833                 break;
2834         case IEEE80211_IOC_STA_STATS:
2835                 error = ieee80211_ioctl_setstastats(vap, ireq);
2836                 break;
2837         case IEEE80211_IOC_STA_TXPOW:
2838                 error = ieee80211_ioctl_setstatxpow(vap, ireq);
2839                 break;
2840         case IEEE80211_IOC_WME_CWMIN:           /* WME: CWmin */
2841         case IEEE80211_IOC_WME_CWMAX:           /* WME: CWmax */
2842         case IEEE80211_IOC_WME_AIFS:            /* WME: AIFS */
2843         case IEEE80211_IOC_WME_TXOPLIMIT:       /* WME: txops limit */
2844         case IEEE80211_IOC_WME_ACM:             /* WME: ACM (bss only) */
2845         case IEEE80211_IOC_WME_ACKPOLICY:       /* WME: ACK policy (bss only) */
2846                 error = ieee80211_ioctl_setwmeparam(vap, ireq);
2847                 break;
2848         case IEEE80211_IOC_DTIM_PERIOD:
2849                 if (vap->iv_opmode != IEEE80211_M_HOSTAP &&
2850                     vap->iv_opmode != IEEE80211_M_MBSS &&
2851                     vap->iv_opmode != IEEE80211_M_IBSS)
2852                         return EINVAL;
2853                 if (IEEE80211_DTIM_MIN <= ireq->i_val &&
2854                     ireq->i_val <= IEEE80211_DTIM_MAX) {
2855                         vap->iv_dtim_period = ireq->i_val;
2856                         error = ENETRESET;              /* requires restart */
2857                 } else
2858                         error = EINVAL;
2859                 break;
2860         case IEEE80211_IOC_BEACON_INTERVAL:
2861                 if (vap->iv_opmode != IEEE80211_M_HOSTAP &&
2862                     vap->iv_opmode != IEEE80211_M_MBSS &&
2863                     vap->iv_opmode != IEEE80211_M_IBSS)
2864                         return EINVAL;
2865                 if (IEEE80211_BINTVAL_MIN <= ireq->i_val &&
2866                     ireq->i_val <= IEEE80211_BINTVAL_MAX) {
2867                         ic->ic_bintval = ireq->i_val;
2868                         error = ENETRESET;              /* requires restart */
2869                 } else
2870                         error = EINVAL;
2871                 break;
2872         case IEEE80211_IOC_PUREG:
2873                 if (ireq->i_val)
2874                         vap->iv_flags |= IEEE80211_F_PUREG;
2875                 else
2876                         vap->iv_flags &= ~IEEE80211_F_PUREG;
2877                 /* NB: reset only if we're operating on an 11g channel */
2878                 if (isvap11g(vap))
2879                         error = ENETRESET;
2880                 break;
2881         case IEEE80211_IOC_BGSCAN:
2882                 if (ireq->i_val) {
2883                         if ((vap->iv_caps & IEEE80211_C_BGSCAN) == 0)
2884                                 return EOPNOTSUPP;
2885                         vap->iv_flags |= IEEE80211_F_BGSCAN;
2886                 } else
2887                         vap->iv_flags &= ~IEEE80211_F_BGSCAN;
2888                 break;
2889         case IEEE80211_IOC_BGSCAN_IDLE:
2890                 if (ireq->i_val >= IEEE80211_BGSCAN_IDLE_MIN)
2891                         vap->iv_bgscanidle = ireq->i_val*hz/1000;
2892                 else
2893                         error = EINVAL;
2894                 break;
2895         case IEEE80211_IOC_BGSCAN_INTERVAL:
2896                 if (ireq->i_val >= IEEE80211_BGSCAN_INTVAL_MIN)
2897                         vap->iv_bgscanintvl = ireq->i_val*hz;
2898                 else
2899                         error = EINVAL;
2900                 break;
2901         case IEEE80211_IOC_SCANVALID:
2902                 if (ireq->i_val >= IEEE80211_SCAN_VALID_MIN)
2903                         vap->iv_scanvalid = ireq->i_val*hz;
2904                 else
2905                         error = EINVAL;
2906                 break;
2907         case IEEE80211_IOC_FRAGTHRESHOLD:
2908                 if ((vap->iv_caps & IEEE80211_C_TXFRAG) == 0 &&
2909                     ireq->i_val != IEEE80211_FRAG_MAX)
2910                         return EOPNOTSUPP;
2911                 if (!(IEEE80211_FRAG_MIN <= ireq->i_val &&
2912                       ireq->i_val <= IEEE80211_FRAG_MAX))
2913                         return EINVAL;
2914                 vap->iv_fragthreshold = ireq->i_val;
2915                 error = ERESTART;
2916                 break;
2917         case IEEE80211_IOC_BURST:
2918                 if (ireq->i_val) {
2919                         if ((vap->iv_caps & IEEE80211_C_BURST) == 0)
2920                                 return EOPNOTSUPP;
2921                         ieee80211_syncflag(vap, IEEE80211_F_BURST);
2922                 } else
2923                         ieee80211_syncflag(vap, -IEEE80211_F_BURST);
2924                 error = ERESTART;
2925                 break;
2926         case IEEE80211_IOC_BMISSTHRESHOLD:
2927                 if (!(IEEE80211_HWBMISS_MIN <= ireq->i_val &&
2928                       ireq->i_val <= IEEE80211_HWBMISS_MAX))
2929                         return EINVAL;
2930                 vap->iv_bmissthreshold = ireq->i_val;
2931                 error = ERESTART;
2932                 break;
2933         case IEEE80211_IOC_CURCHAN:
2934                 error = ieee80211_ioctl_setcurchan(vap, ireq);
2935                 break;
2936         case IEEE80211_IOC_SHORTGI:
2937                 if (ireq->i_val) {
2938 #define IEEE80211_HTCAP_SHORTGI \
2939         (IEEE80211_HTCAP_SHORTGI20 | IEEE80211_HTCAP_SHORTGI40)
2940                         if (((ireq->i_val ^ vap->iv_htcaps) & IEEE80211_HTCAP_SHORTGI) != 0)
2941                                 return EINVAL;
2942                         if (ireq->i_val & IEEE80211_HTCAP_SHORTGI20)
2943                                 vap->iv_flags_ht |= IEEE80211_FHT_SHORTGI20;
2944                         if (ireq->i_val & IEEE80211_HTCAP_SHORTGI40)
2945                                 vap->iv_flags_ht |= IEEE80211_FHT_SHORTGI40;
2946 #undef IEEE80211_HTCAP_SHORTGI
2947                 } else
2948                         vap->iv_flags_ht &=
2949                             ~(IEEE80211_FHT_SHORTGI20 | IEEE80211_FHT_SHORTGI40);
2950                 error = ERESTART;
2951                 break;
2952         case IEEE80211_IOC_AMPDU:
2953                 if (ireq->i_val && (vap->iv_htcaps & IEEE80211_HTC_AMPDU) == 0)
2954                         return EINVAL;
2955                 if (ireq->i_val & 1)
2956                         vap->iv_flags_ht |= IEEE80211_FHT_AMPDU_TX;
2957                 else
2958                         vap->iv_flags_ht &= ~IEEE80211_FHT_AMPDU_TX;
2959                 if (ireq->i_val & 2)
2960                         vap->iv_flags_ht |= IEEE80211_FHT_AMPDU_RX;
2961                 else
2962                         vap->iv_flags_ht &= ~IEEE80211_FHT_AMPDU_RX;
2963                 /* NB: reset only if we're operating on an 11n channel */
2964                 if (isvapht(vap))
2965                         error = ERESTART;
2966                 break;
2967         case IEEE80211_IOC_AMPDU_LIMIT:
2968                 if (!(IEEE80211_HTCAP_MAXRXAMPDU_8K <= ireq->i_val &&
2969                       ireq->i_val <= IEEE80211_HTCAP_MAXRXAMPDU_64K))
2970                         return EINVAL;
2971                 if (vap->iv_opmode == IEEE80211_M_HOSTAP)
2972                         vap->iv_ampdu_rxmax = ireq->i_val;
2973                 else
2974                         vap->iv_ampdu_limit = ireq->i_val;
2975                 error = ERESTART;
2976                 break;
2977         case IEEE80211_IOC_AMPDU_DENSITY:
2978                 if (!(IEEE80211_HTCAP_MPDUDENSITY_NA <= ireq->i_val &&
2979                       ireq->i_val <= IEEE80211_HTCAP_MPDUDENSITY_16))
2980                         return EINVAL;
2981                 vap->iv_ampdu_density = ireq->i_val;
2982                 error = ERESTART;
2983                 break;
2984         case IEEE80211_IOC_AMSDU:
2985                 if (ireq->i_val && (vap->iv_htcaps & IEEE80211_HTC_AMSDU) == 0)
2986                         return EINVAL;
2987                 if (ireq->i_val & 1)
2988                         vap->iv_flags_ht |= IEEE80211_FHT_AMSDU_TX;
2989                 else
2990                         vap->iv_flags_ht &= ~IEEE80211_FHT_AMSDU_TX;
2991                 if (ireq->i_val & 2)
2992                         vap->iv_flags_ht |= IEEE80211_FHT_AMSDU_RX;
2993                 else
2994                         vap->iv_flags_ht &= ~IEEE80211_FHT_AMSDU_RX;
2995                 /* NB: reset only if we're operating on an 11n channel */
2996                 if (isvapht(vap))
2997                         error = ERESTART;
2998                 break;
2999         case IEEE80211_IOC_AMSDU_LIMIT:
3000                 /* XXX validate */
3001                 vap->iv_amsdu_limit = ireq->i_val;      /* XXX truncation? */
3002                 break;
3003         case IEEE80211_IOC_PUREN:
3004                 if (ireq->i_val) {
3005                         if ((vap->iv_flags_ht & IEEE80211_FHT_HT) == 0)
3006                                 return EINVAL;
3007                         vap->iv_flags_ht |= IEEE80211_FHT_PUREN;
3008                 } else
3009                         vap->iv_flags_ht &= ~IEEE80211_FHT_PUREN;
3010                 /* NB: reset only if we're operating on an 11n channel */
3011                 if (isvapht(vap))
3012                         error = ERESTART;
3013                 break;
3014         case IEEE80211_IOC_DOTH:
3015                 if (ireq->i_val) {
3016 #if 0
3017                         /* XXX no capability */
3018                         if ((vap->iv_caps & IEEE80211_C_DOTH) == 0)
3019                                 return EOPNOTSUPP;
3020 #endif
3021                         vap->iv_flags |= IEEE80211_F_DOTH;
3022                 } else
3023                         vap->iv_flags &= ~IEEE80211_F_DOTH;
3024                 error = ENETRESET;
3025                 break;
3026         case IEEE80211_IOC_REGDOMAIN:
3027                 error = ieee80211_ioctl_setregdomain(vap, ireq);
3028                 break;
3029         case IEEE80211_IOC_ROAM:
3030                 error = ieee80211_ioctl_setroam(vap, ireq);
3031                 break;
3032         case IEEE80211_IOC_TXPARAMS:
3033                 error = ieee80211_ioctl_settxparams(vap, ireq);
3034                 break;
3035         case IEEE80211_IOC_HTCOMPAT:
3036                 if (ireq->i_val) {
3037                         if ((vap->iv_flags_ht & IEEE80211_FHT_HT) == 0)
3038                                 return EOPNOTSUPP;
3039                         vap->iv_flags_ht |= IEEE80211_FHT_HTCOMPAT;
3040                 } else
3041                         vap->iv_flags_ht &= ~IEEE80211_FHT_HTCOMPAT;
3042                 /* NB: reset only if we're operating on an 11n channel */
3043                 if (isvapht(vap))
3044                         error = ERESTART;
3045                 break;
3046         case IEEE80211_IOC_DWDS:
3047                 if (ireq->i_val) {
3048                         /* NB: DWDS only makes sense for WDS-capable devices */
3049                         if ((ic->ic_caps & IEEE80211_C_WDS) == 0)
3050                                 return EOPNOTSUPP;
3051                         /* NB: DWDS is used only with ap+sta vaps */
3052                         if (vap->iv_opmode != IEEE80211_M_HOSTAP &&
3053                             vap->iv_opmode != IEEE80211_M_STA)
3054                                 return EINVAL;
3055                         vap->iv_flags |= IEEE80211_F_DWDS;
3056                         if (vap->iv_opmode == IEEE80211_M_STA)
3057                                 vap->iv_flags_ext |= IEEE80211_FEXT_4ADDR;
3058                 } else {
3059                         vap->iv_flags &= ~IEEE80211_F_DWDS;
3060                         if (vap->iv_opmode == IEEE80211_M_STA)
3061                                 vap->iv_flags_ext &= ~IEEE80211_FEXT_4ADDR;
3062                 }
3063                 break;
3064         case IEEE80211_IOC_INACTIVITY:
3065                 if (ireq->i_val)
3066                         vap->iv_flags_ext |= IEEE80211_FEXT_INACT;
3067                 else
3068                         vap->iv_flags_ext &= ~IEEE80211_FEXT_INACT;
3069                 break;
3070         case IEEE80211_IOC_APPIE:
3071                 error = ieee80211_ioctl_setappie(vap, ireq);
3072                 break;
3073         case IEEE80211_IOC_WPS:
3074                 if (ireq->i_val) {
3075                         if ((vap->iv_caps & IEEE80211_C_WPA) == 0)
3076                                 return EOPNOTSUPP;
3077                         vap->iv_flags_ext |= IEEE80211_FEXT_WPS;
3078                 } else
3079                         vap->iv_flags_ext &= ~IEEE80211_FEXT_WPS;
3080                 break;
3081         case IEEE80211_IOC_TSN:
3082                 if (ireq->i_val) {
3083                         if ((vap->iv_caps & IEEE80211_C_WPA) == 0)
3084                                 return EOPNOTSUPP;
3085                         vap->iv_flags_ext |= IEEE80211_FEXT_TSN;
3086                 } else
3087                         vap->iv_flags_ext &= ~IEEE80211_FEXT_TSN;
3088                 break;
3089         case IEEE80211_IOC_CHANSWITCH:
3090                 error = ieee80211_ioctl_chanswitch(vap, ireq);
3091                 break;
3092         case IEEE80211_IOC_DFS:
3093                 if (ireq->i_val) {
3094                         if ((vap->iv_caps & IEEE80211_C_DFS) == 0)
3095                                 return EOPNOTSUPP;
3096                         /* NB: DFS requires 11h support */
3097                         if ((vap->iv_flags & IEEE80211_F_DOTH) == 0)
3098                                 return EINVAL;
3099                         vap->iv_flags_ext |= IEEE80211_FEXT_DFS;
3100                 } else
3101                         vap->iv_flags_ext &= ~IEEE80211_FEXT_DFS;
3102                 break;
3103         case IEEE80211_IOC_DOTD:
3104                 if (ireq->i_val)
3105                         vap->iv_flags_ext |= IEEE80211_FEXT_DOTD;
3106                 else
3107                         vap->iv_flags_ext &= ~IEEE80211_FEXT_DOTD;
3108                 if (vap->iv_opmode == IEEE80211_M_STA)
3109                         error = ENETRESET;
3110                 break;
3111         case IEEE80211_IOC_HTPROTMODE:
3112                 if (ireq->i_val > IEEE80211_PROT_RTSCTS)
3113                         return EINVAL;
3114                 ic->ic_htprotmode = ireq->i_val ?
3115                     IEEE80211_PROT_RTSCTS : IEEE80211_PROT_NONE;
3116                 /* NB: if not operating in 11n this can wait */
3117                 if (isvapht(vap))
3118                         error = ERESTART;
3119                 break;
3120         case IEEE80211_IOC_STA_VLAN:
3121                 error = ieee80211_ioctl_setstavlan(vap, ireq);
3122                 break;
3123         case IEEE80211_IOC_SMPS:
3124                 if ((ireq->i_val &~ IEEE80211_HTCAP_SMPS) != 0 ||
3125                     ireq->i_val == 0x0008)      /* value of 2 is reserved */
3126                         return EINVAL;
3127                 if (ireq->i_val != IEEE80211_HTCAP_SMPS_OFF &&
3128                     (vap->iv_htcaps & IEEE80211_HTC_SMPS) == 0)
3129                         return EOPNOTSUPP;
3130                 vap->iv_htcaps = (vap->iv_htcaps &~ IEEE80211_HTCAP_SMPS) |
3131                         ireq->i_val;
3132                 /* NB: if not operating in 11n this can wait */
3133                 if (isvapht(vap))
3134                         error = ERESTART;
3135                 break;
3136         case IEEE80211_IOC_RIFS:
3137                 if (ireq->i_val != 0) {
3138                         if ((vap->iv_htcaps & IEEE80211_HTC_RIFS) == 0)
3139                                 return EOPNOTSUPP;
3140                         vap->iv_flags_ht |= IEEE80211_FHT_RIFS;
3141                 } else
3142                         vap->iv_flags_ht &= ~IEEE80211_FHT_RIFS;
3143                 /* NB: if not operating in 11n this can wait */
3144                 if (isvapht(vap))
3145                         error = ERESTART;
3146                 break;
3147         default:
3148                 error = ieee80211_ioctl_setdefault(vap, ireq);
3149                 break;
3150         }
3151         /*
3152          * The convention is that ENETRESET means an operation
3153          * requires a complete re-initialization of the device (e.g.
3154          * changing something that affects the association state).
3155          * ERESTART means the request may be handled with only a
3156          * reload of the hardware state.  We hand ERESTART requests
3157          * to the iv_reset callback so the driver can decide.  If
3158          * a device does not fillin iv_reset then it defaults to one
3159          * that returns ENETRESET.  Otherwise a driver may return
3160          * ENETRESET (in which case a full reset will be done) or
3161          * 0 to mean there's no need to do anything (e.g. when the
3162          * change has no effect on the driver/device).
3163          */
3164         if (error == ERESTART)
3165                 error = IFNET_IS_UP_RUNNING(vap->iv_ifp) ?
3166                     vap->iv_reset(vap, ireq->i_type) : 0;
3167         if (error == ENETRESET) {
3168                 /* XXX need to re-think AUTO handling */
3169                 if (IS_UP_AUTO(vap))
3170                         ieee80211_init(vap);
3171                 error = 0;
3172         }
3173         return error;
3174 }
3175
3176 /*
3177  * Rebuild the parent's multicast address list after an add/del
3178  * of a multicast address for a vap.  We have no way to tell
3179  * what happened above to optimize the work so we purge the entire
3180  * list and rebuild from scratch.  This is way expensive.
3181  * Note also the half-baked workaround for if_addmulti calling
3182  * back to the parent device; there's no way to insert mcast
3183  * entries quietly and/or cheaply.
3184  */
3185 static void
3186 ieee80211_ioctl_updatemulti(struct ieee80211com *ic)
3187 {
3188         struct ifnet *parent = ic->ic_ifp;
3189         struct ieee80211vap *vap;
3190         void *ioctl;
3191
3192         wlan_serialize_exit();
3193         if_delallmulti(parent);
3194         ioctl = parent->if_ioctl;       /* XXX WAR if_allmulti */
3195         parent->if_ioctl = NULL;
3196         TAILQ_FOREACH(vap, &ic->ic_vaps, iv_next) {
3197                 struct ifnet *ifp = vap->iv_ifp;
3198                 struct ifmultiaddr *ifma;
3199
3200                 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
3201                         if (ifma->ifma_addr->sa_family != AF_LINK)
3202                                 continue;
3203                         (void) if_addmulti(parent, ifma->ifma_addr, NULL);
3204                 }
3205         }
3206         parent->if_ioctl = ioctl;
3207         ieee80211_runtask(ic, &ic->ic_mcast_task);
3208         wlan_serialize_enter();
3209 }
3210
3211 int
3212 ieee80211_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *ucred)
3213 {
3214         struct ieee80211vap *vap = ifp->if_softc;
3215         struct ieee80211com *ic = vap->iv_ic;
3216         int error = 0;
3217         struct ifreq *ifr;
3218
3219         wlan_assert_serialized();
3220
3221         switch (cmd) {
3222         case SIOCSIFFLAGS:
3223                 ieee80211_syncifflag_locked(ic, IFF_PROMISC);
3224                 ieee80211_syncifflag_locked(ic, IFF_ALLMULTI);
3225                 if (ifp->if_flags & IFF_UP) {
3226                         /*
3227                          * Bring ourself up unless we're already operational.
3228                          * If we're the first vap and the parent is not up
3229                          * then it will automatically be brought up as a
3230                          * side-effect of bringing ourself up.
3231                          */
3232                         if (vap->iv_state == IEEE80211_S_INIT)
3233                                 ieee80211_start_locked(vap);
3234                 } else if (ifp->if_flags & IFF_RUNNING) {
3235                         /*
3236                          * Stop ourself.  If we are the last vap to be
3237                          * marked down the parent will also be taken down.
3238                          */
3239                         ieee80211_stop_locked(vap);
3240                 }
3241                 /* Wait for parent ioctl handler if it was queued */
3242                 ieee80211_waitfor_parent(ic);
3243                 break;
3244         case SIOCADDMULTI:
3245         case SIOCDELMULTI:
3246                 ieee80211_ioctl_updatemulti(ic);
3247                 break;
3248         case SIOCSIFMEDIA:
3249         case SIOCGIFMEDIA:
3250                 ifr = (struct ifreq *)data;
3251                 error = ifmedia_ioctl(ifp, ifr, &vap->iv_media, cmd);
3252                 break;
3253         case SIOCG80211:
3254                 error = ieee80211_ioctl_get80211(vap, cmd,
3255                                 (struct ieee80211req *) data);
3256                 break;
3257         case SIOCS80211:
3258                 error = priv_check(curthread, PRIV_NET80211_MANAGE);
3259                 if (error == 0)
3260                         error = ieee80211_ioctl_set80211(vap, cmd,
3261                                         (struct ieee80211req *) data);
3262                 break;
3263         case SIOCG80211STATS:
3264                 ifr = (struct ifreq *)data;
3265                 copyout(&vap->iv_stats, ifr->ifr_data, sizeof (vap->iv_stats));
3266                 break;
3267         case SIOCSIFMTU:
3268                 ifr = (struct ifreq *)data;
3269                 if (!(IEEE80211_MTU_MIN <= ifr->ifr_mtu &&
3270                     ifr->ifr_mtu <= IEEE80211_MTU_MAX))
3271                         error = EINVAL;
3272                 else
3273                         ifp->if_mtu = ifr->ifr_mtu;
3274                 break;
3275         /* Pass NDIS ioctls up to the driver */
3276         case SIOCGDRVSPEC:
3277         case SIOCSDRVSPEC:
3278         case SIOCGPRIVATE_0: {
3279                 struct ifnet *parent = vap->iv_ic->ic_ifp;
3280                 error = parent->if_ioctl(parent, cmd, data, ucred);
3281                 break;
3282         }
3283         default:
3284                 error = ether_ioctl(ifp, cmd, data);
3285                 break;
3286         }
3287         return error;
3288 }