sys/net80211/ieee80211_ioctl.c

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