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