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