sys/netproto/802_11/wlan/ieee80211_ioctl.c

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