sys/dev/netif/iwm/if_iwm_mac_ctxt.c

   1 /*      $OpenBSD: if_iwm.c,v 1.39 2015/03/23 00:35:19 jsg Exp $ */
   2
   3 /*
   4  * Copyright (c) 2014 genua mbh <info@genua.de>
   5  * Copyright (c) 2014 Fixup Software Ltd.
   6  *
   7  * Permission to use, copy, modify, and distribute this software for any
   8  * purpose with or without fee is hereby granted, provided that the above
   9  * copyright notice and this permission notice appear in all copies.
  10  *
  11  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  12  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  13  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  14  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  15  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  16  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  17  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  18  */
  19
  20 /*-
  21  * Based on BSD-licensed source modules in the Linux iwlwifi driver,
  22  * which were used as the reference documentation for this implementation.
  23  *
  24  * Driver version we are currently based off of is
  25  * Linux 3.14.3 (tag id a2df521e42b1d9a23f620ac79dbfe8655a8391dd)
  26  *
  27  ***********************************************************************
  28  *
  29  * This file is provided under a dual BSD/GPLv2 license.  When using or
  30  * redistributing this file, you may do so under either license.
  31  *
  32  * GPL LICENSE SUMMARY
  33  *
  34  * Copyright(c) 2007 - 2013 Intel Corporation. All rights reserved.
  35  *
  36  * This program is free software; you can redistribute it and/or modify
  37  * it under the terms of version 2 of the GNU General Public License as
  38  * published by the Free Software Foundation.
  39  *
  40  * This program is distributed in the hope that it will be useful, but
  41  * WITHOUT ANY WARRANTY; without even the implied warranty of
  42  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  43  * General Public License for more details.
  44  *
  45  * You should have received a copy of the GNU General Public License
  46  * along with this program; if not, write to the Free Software
  47  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
  48  * USA
  49  *
  50  * The full GNU General Public License is included in this distribution
  51  * in the file called COPYING.
  52  *
  53  * Contact Information:
  54  *  Intel Linux Wireless <ilw@linux.intel.com>
  55  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  56  *
  57  *
  58  * BSD LICENSE
  59  *
  60  * Copyright(c) 2005 - 2013 Intel Corporation. All rights reserved.
  61  * All rights reserved.
  62  *
  63  * Redistribution and use in source and binary forms, with or without
  64  * modification, are permitted provided that the following conditions
  65  * are met:
  66  *
  67  *  * Redistributions of source code must retain the above copyright
  68  *    notice, this list of conditions and the following disclaimer.
  69  *  * Redistributions in binary form must reproduce the above copyright
  70  *    notice, this list of conditions and the following disclaimer in
  71  *    the documentation and/or other materials provided with the
  72  *    distribution.
  73  *  * Neither the name Intel Corporation nor the names of its
  74  *    contributors may be used to endorse or promote products derived
  75  *    from this software without specific prior written permission.
  76  *
  77  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  78  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  79  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  80  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  81  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  82  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  83  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  84  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  85  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  86  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  87  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  88  */
  89
  90 /*-
  91  * Copyright (c) 2007-2010 Damien Bergamini <damien.bergamini@free.fr>
  92  *
  93  * Permission to use, copy, modify, and distribute this software for any
  94  * purpose with or without fee is hereby granted, provided that the above
  95  * copyright notice and this permission notice appear in all copies.
  96  *
  97  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  98  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  99  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 100  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 101  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 102  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 103  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 104  */
 105 #include <sys/cdefs.h>
 106 __FBSDID("$FreeBSD$");
 107
 108 #include <sys/param.h>
 109 #include <sys/bus.h>
 110 #include <sys/endian.h>
 111 #include <sys/firmware.h>
 112 #include <sys/kernel.h>
 113 #include <sys/malloc.h>
 114 #include <sys/mbuf.h>
 115 #include <sys/rman.h>
 116 #include <sys/sysctl.h>
 117 #include <sys/linker.h>
 118
 119 #include <machine/endian.h>
 120
 121 #include <bus/pci/pcivar.h>
 122 #include <bus/pci/pcireg.h>
 123
 124 #include <net/bpf.h>
 125
 126 #include <net/if.h>
 127 #include <net/if_var.h>
 128 #include <net/if_arp.h>
 129 #include <net/if_dl.h>
 130 #include <net/if_media.h>
 131 #include <net/if_types.h>
 132
 133 #include <netinet/in.h>
 134 #include <netinet/in_systm.h>
 135 #include <netinet/if_ether.h>
 136 #include <netinet/ip.h>
 137
 138 #include <netproto/802_11/ieee80211_var.h>
 139 #include <netproto/802_11/ieee80211_regdomain.h>
 140 #include <netproto/802_11/ieee80211_ratectl.h>
 141 #include <netproto/802_11/ieee80211_radiotap.h>
 142
 143 #include "if_iwmreg.h"
 144 #include "if_iwmvar.h"
 145 #include "if_iwm_debug.h"
 146 #include "if_iwm_util.h"
 147 #include "if_iwm_mac_ctxt.h"
 148
 149 const uint8_t iwm_mvm_ac_to_tx_fifo[] = {
 150         IWM_MVM_TX_FIFO_BE,
 151         IWM_MVM_TX_FIFO_BK,
 152         IWM_MVM_TX_FIFO_VI,
 153         IWM_MVM_TX_FIFO_VO,
 154 };
 155
 156 static void
 157 iwm_mvm_ack_rates(struct iwm_softc *sc, int is2ghz,
 158         int *cck_rates, int *ofdm_rates, struct iwm_node *in)
 159 {
 160         int lowest_present_ofdm = 100;
 161         int lowest_present_cck = 100;
 162         uint8_t cck = 0;
 163         uint8_t ofdm = 0;
 164         int i;
 165         struct ieee80211_rateset *rs = &in->in_ni.ni_rates;
 166
 167         if (is2ghz) {
 168                 for (i = IWM_FIRST_CCK_RATE; i <= IWM_LAST_CCK_RATE; i++) {
 169                         if ((iwm_ridx2rate(rs, i) & IEEE80211_RATE_BASIC) == 0)
 170                                 continue;
 171                         cck |= (1 << i);
 172                         if (lowest_present_cck > i)
 173                                 lowest_present_cck = i;
 174                 }
 175         }
 176         for (i = IWM_FIRST_OFDM_RATE; i <= IWM_LAST_NON_HT_RATE; i++) {
 177                 if ((iwm_ridx2rate(rs, i) & IEEE80211_RATE_BASIC) == 0)
 178                         continue;
 179                 ofdm |= (1 << (i - IWM_FIRST_OFDM_RATE));
 180                 if (lowest_present_ofdm > i)
 181                         lowest_present_ofdm = i;
 182         }
 183
 184         /*
 185          * Now we've got the basic rates as bitmaps in the ofdm and cck
 186          * variables. This isn't sufficient though, as there might not
 187          * be all the right rates in the bitmap. E.g. if the only basic
 188          * rates are 5.5 Mbps and 11 Mbps, we still need to add 1 Mbps
 189          * and 6 Mbps because the 802.11-2007 standard says in 9.6:
 190          *
 191          *    [...] a STA responding to a received frame shall transmit
 192          *    its Control Response frame [...] at the highest rate in the
 193          *    BSSBasicRateSet parameter that is less than or equal to the
 194          *    rate of the immediately previous frame in the frame exchange
 195          *    sequence ([...]) and that is of the same modulation class
 196          *    ([...]) as the received frame. If no rate contained in the
 197          *    BSSBasicRateSet parameter meets these conditions, then the
 198          *    control frame sent in response to a received frame shall be
 199          *    transmitted at the highest mandatory rate of the PHY that is
 200          *    less than or equal to the rate of the received frame, and
 201          *    that is of the same modulation class as the received frame.
 202          *
 203          * As a consequence, we need to add all mandatory rates that are
 204          * lower than all of the basic rates to these bitmaps.
 205          */
 206
 207         if (IWM_RATE_24M_INDEX < lowest_present_ofdm)
 208                 ofdm |= IWM_RATE_BIT_MSK(24) >> IWM_FIRST_OFDM_RATE;
 209         if (IWM_RATE_12M_INDEX < lowest_present_ofdm)
 210                 ofdm |= IWM_RATE_BIT_MSK(12) >> IWM_FIRST_OFDM_RATE;
 211         /* 6M already there or needed so always add */
 212         ofdm |= IWM_RATE_BIT_MSK(6) >> IWM_FIRST_OFDM_RATE;
 213
 214         /*
 215          * CCK is a bit more complex with DSSS vs. HR/DSSS vs. ERP.
 216          * Note, however:
 217          *  - if no CCK rates are basic, it must be ERP since there must
 218          *    be some basic rates at all, so they're OFDM => ERP PHY
 219          *    (or we're in 5 GHz, and the cck bitmap will never be used)
 220          *  - if 11M is a basic rate, it must be ERP as well, so add 5.5M
 221          *  - if 5.5M is basic, 1M and 2M are mandatory
 222          *  - if 2M is basic, 1M is mandatory
 223          *  - if 1M is basic, that's the only valid ACK rate.
 224          * As a consequence, it's not as complicated as it sounds, just add
 225          * any lower rates to the ACK rate bitmap.
 226          */
 227         if (IWM_RATE_11M_INDEX < lowest_present_cck)
 228                 cck |= IWM_RATE_BIT_MSK(11) >> IWM_FIRST_CCK_RATE;
 229         if (IWM_RATE_5M_INDEX < lowest_present_cck)
 230                 cck |= IWM_RATE_BIT_MSK(5) >> IWM_FIRST_CCK_RATE;
 231         if (IWM_RATE_2M_INDEX < lowest_present_cck)
 232                 cck |= IWM_RATE_BIT_MSK(2) >> IWM_FIRST_CCK_RATE;
 233         /* 1M already there or needed so always add */
 234         cck |= IWM_RATE_BIT_MSK(1) >> IWM_FIRST_CCK_RATE;
 235
 236         *cck_rates = cck;
 237         *ofdm_rates = ofdm;
 238 }
 239
 240 static void
 241 iwm_mvm_mac_ctxt_cmd_common(struct iwm_softc *sc, struct iwm_node *in,
 242         struct iwm_mac_ctx_cmd *cmd, uint32_t action)
 243 {
 244         struct ieee80211com *ic = &sc->sc_ic;
 245         struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
 246         struct ieee80211_node *ni = vap->iv_bss;
 247         struct iwm_vap *ivp = IWM_VAP(vap);
 248         int cck_ack_rates, ofdm_ack_rates;
 249         int i;
 250         int is2ghz;
 251
 252         /*
 253          * id is the MAC address ID - something to do with MAC filtering.
 254          * color - not sure.
 255          *
 256          * These are both functions of the vap, not of the node.
 257          * So, for now, hard-code both to 0 (default).
 258          */
 259         cmd->id_and_color = htole32(IWM_FW_CMD_ID_AND_COLOR(ivp->id,
 260             ivp->color));
 261         cmd->action = htole32(action);
 262
 263         cmd->mac_type = htole32(IWM_FW_MAC_TYPE_BSS_STA);
 264
 265         /*
 266          * The TSF ID is one of four TSF tracking resources in the firmware.
 267          * Read the iwlwifi/mvm code for more details.
 268          *
 269          * For now, just hard-code it to TSF tracking ID 0; we only support
 270          * a single STA mode VAP.
 271          *
 272          * It's per-vap, not per-node.
 273          */
 274         cmd->tsf_id = htole32(IWM_DEFAULT_TSFID);
 275
 276         IEEE80211_ADDR_COPY(cmd->node_addr, vap->iv_myaddr);
 277
 278         /*
 279          * XXX should we error out if in_assoc is 1 and ni == NULL?
 280          */
 281 #if 0
 282         if (in->in_assoc) {
 283                 IEEE80211_ADDR_COPY(cmd->bssid_addr, ni->ni_bssid);
 284         } else {
 285                 /* eth broadcast address */
 286                 IEEE80211_ADDR_COPY(cmd->bssid_addr, ieee80211broadcastaddr);
 287         }
 288 #else
 289         /*
 290          * XXX This workaround makes the firmware behave more correctly once
 291          *     we are associated, regularly giving us statistics notifications,
 292          *     as well as signaling missed beacons to us.
 293          *     Since we only call iwm_mvm_mac_ctxt_add() and
 294          *     iwm_mvm_mac_ctxt_changed() when already authenticating or
 295          *     associating, ni->ni_bssid should always make sense here.
 296          */
 297         IEEE80211_ADDR_COPY(cmd->bssid_addr, ni->ni_bssid);
 298 #endif
 299
 300         /*
 301          * Default to 2ghz if no node information is given.
 302          */
 303         if (in && in->in_ni.ni_chan != IEEE80211_CHAN_ANYC) {
 304                 is2ghz = !! IEEE80211_IS_CHAN_2GHZ(in->in_ni.ni_chan);
 305         } else {
 306                 is2ghz = 1;
 307         }
 308         iwm_mvm_ack_rates(sc, is2ghz, &cck_ack_rates, &ofdm_ack_rates, in);
 309         cmd->cck_rates = htole32(cck_ack_rates);
 310         cmd->ofdm_rates = htole32(ofdm_ack_rates);
 311
 312         cmd->cck_short_preamble
 313             = htole32((ic->ic_flags & IEEE80211_F_SHPREAMBLE)
 314               ? IWM_MAC_FLG_SHORT_PREAMBLE : 0);
 315         cmd->short_slot
 316             = htole32((ic->ic_flags & IEEE80211_F_SHSLOT)
 317               ? IWM_MAC_FLG_SHORT_SLOT : 0);
 318
 319         for (i = 0; i < WME_NUM_AC; i++) {
 320                 uint8_t txf = iwm_mvm_ac_to_tx_fifo[i];
 321
 322                 cmd->ac[txf].cw_min = htole16(ivp->queue_params[i].cw_min);
 323                 cmd->ac[txf].cw_max = htole16(ivp->queue_params[i].cw_max);
 324                 cmd->ac[txf].edca_txop =
 325                     htole16(ivp->queue_params[i].edca_txop);
 326                 cmd->ac[txf].aifsn = ivp->queue_params[i].aifsn;
 327                 cmd->ac[txf].fifos_mask = (1 << txf);
 328         }
 329
 330         if (ivp->have_wme)
 331                 cmd->qos_flags |= htole32(IWM_MAC_QOS_FLG_UPDATE_EDCA);
 332
 333         if (ic->ic_flags & IEEE80211_F_USEPROT)
 334                 cmd->protection_flags |= htole32(IWM_MAC_PROT_FLG_TGG_PROTECT);
 335
 336         cmd->filter_flags = htole32(IWM_MAC_FILTER_ACCEPT_GRP);
 337 }
 338
 339 static int
 340 iwm_mvm_mac_ctxt_send_cmd(struct iwm_softc *sc, struct iwm_mac_ctx_cmd *cmd)
 341 {
 342         int ret = iwm_mvm_send_cmd_pdu(sc, IWM_MAC_CONTEXT_CMD, IWM_CMD_SYNC,
 343                                        sizeof(*cmd), cmd);
 344         if (ret)
 345                 device_printf(sc->sc_dev,
 346                     "%s: Failed to send MAC context (action:%d): %d\n",
 347                     __func__, le32toh(cmd->action), ret);
 348         return ret;
 349 }
 350
 351 /*
 352  * Fill the specific data for mac context of type station or p2p client
 353  */
 354 static void
 355 iwm_mvm_mac_ctxt_cmd_fill_sta(struct iwm_softc *sc, struct iwm_node *in,
 356         struct iwm_mac_data_sta *ctxt_sta, int force_assoc_off)
 357 {
 358         struct ieee80211_node *ni = &in->in_ni;
 359         unsigned dtim_period, dtim_count;
 360         struct ieee80211com *ic = &sc->sc_ic;
 361         struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
 362
 363         /* will this work? */
 364         dtim_period = vap->iv_dtim_period;
 365         dtim_count = vap->iv_dtim_count;
 366         IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
 367             "%s: force_assoc_off=%d\n", __func__, force_assoc_off);
 368         IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
 369             "DTIM: period=%d count=%d\n", dtim_period, dtim_count);
 370         IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
 371             "BEACON: tsf: %llu, ni_intval=%d\n",
 372             (unsigned long long) le64toh(ni->ni_tstamp.tsf),
 373             ni->ni_intval);
 374
 375         /* We need the dtim_period to set the MAC as associated */
 376         if (in->in_assoc && dtim_period && !force_assoc_off) {
 377                 uint64_t tsf;
 378                 uint32_t dtim_offs;
 379
 380                 /*
 381                  * The DTIM count counts down, so when it is N that means N
 382                  * more beacon intervals happen until the DTIM TBTT. Therefore
 383                  * add this to the current time. If that ends up being in the
 384                  * future, the firmware will handle it.
 385                  *
 386                  * Also note that the system_timestamp (which we get here as
 387                  * "sync_device_ts") and TSF timestamp aren't at exactly the
 388                  * same offset in the frame -- the TSF is at the first symbol
 389                  * of the TSF, the system timestamp is at signal acquisition
 390                  * time. This means there's an offset between them of at most
 391                  * a few hundred microseconds (24 * 8 bits + PLCP time gives
 392                  * 384us in the longest case), this is currently not relevant
 393                  * as the firmware wakes up around 2ms before the TBTT.
 394                  */
 395                 dtim_offs = dtim_count * ni->ni_intval;
 396                 /* convert TU to usecs */
 397                 dtim_offs *= 1024;
 398
 399                 /*
 400                  * net80211: TSF is in 802.11 order, so convert up to local
 401                  * ordering before we manipulate things.
 402                  */
 403                 tsf = le64toh(ni->ni_tstamp.tsf);
 404
 405                 ctxt_sta->dtim_tsf = htole64(tsf + dtim_offs);
 406                 ctxt_sta->dtim_time = htole32(tsf + dtim_offs);
 407
 408                 IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_BEACON | IWM_DEBUG_CMD,
 409                     "DTIM TBTT is 0x%llx/0x%x, offset %d\n",
 410                     (long long)le64toh(ctxt_sta->dtim_tsf),
 411                     le32toh(ctxt_sta->dtim_time), dtim_offs);
 412
 413                 ctxt_sta->is_assoc = htole32(1);
 414         } else {
 415                 ctxt_sta->is_assoc = htole32(0);
 416         }
 417
 418         IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_CMD | IWM_DEBUG_BEACON,
 419             "%s: ni_intval: %d, bi_reciprocal: %d, dtim_interval: %d, dtim_reciprocal: %d\n",
 420             __func__,
 421             ni->ni_intval,
 422             iwm_mvm_reciprocal(ni->ni_intval),
 423             ni->ni_intval * dtim_period,
 424             iwm_mvm_reciprocal(ni->ni_intval * dtim_period));
 425
 426         ctxt_sta->bi = htole32(ni->ni_intval);
 427         ctxt_sta->bi_reciprocal = htole32(iwm_mvm_reciprocal(ni->ni_intval));
 428         ctxt_sta->dtim_interval = htole32(ni->ni_intval * dtim_period);
 429         ctxt_sta->dtim_reciprocal =
 430             htole32(iwm_mvm_reciprocal(ni->ni_intval * dtim_period));
 431
 432         /* 10 = CONN_MAX_LISTEN_INTERVAL */
 433         ctxt_sta->listen_interval = htole32(10);
 434         IWM_DPRINTF(sc, IWM_DEBUG_RESET | IWM_DEBUG_CMD | IWM_DEBUG_BEACON,
 435             "%s: associd=%d\n", __func__, IEEE80211_AID(ni->ni_associd));
 436         ctxt_sta->assoc_id = htole32(IEEE80211_AID(ni->ni_associd));
 437 }
 438
 439 static int
 440 iwm_mvm_mac_ctxt_cmd_station(struct iwm_softc *sc, struct ieee80211vap *vap,
 441         uint32_t action)
 442 {
 443         struct ieee80211_node *ni = vap->iv_bss;
 444         struct iwm_node *in = IWM_NODE(ni);
 445         struct iwm_mac_ctx_cmd cmd = {};
 446
 447         IWM_DPRINTF(sc, IWM_DEBUG_RESET,
 448             "%s: called; action=%d\n", __func__, action);
 449
 450         /* Fill the common data for all mac context types */
 451         iwm_mvm_mac_ctxt_cmd_common(sc, in, &cmd, action);
 452
 453         /* Allow beacons to pass through as long as we are not associated,or we
 454          * do not have dtim period information */
 455         if (!in->in_assoc || !vap->iv_dtim_period)
 456                 cmd.filter_flags |= htole32(IWM_MAC_FILTER_IN_BEACON);
 457         else
 458                 cmd.filter_flags &= ~htole32(IWM_MAC_FILTER_IN_BEACON);
 459
 460         /* Fill the data specific for station mode */
 461         iwm_mvm_mac_ctxt_cmd_fill_sta(sc, in,
 462             &cmd.sta, action == IWM_FW_CTXT_ACTION_ADD);
 463
 464         return iwm_mvm_mac_ctxt_send_cmd(sc, &cmd);
 465 }
 466
 467 static int
 468 iwm_mvm_mac_ctx_send(struct iwm_softc *sc, struct ieee80211vap *vap,
 469     uint32_t action)
 470 {
 471         return iwm_mvm_mac_ctxt_cmd_station(sc, vap, action);
 472 }
 473
 474 int
 475 iwm_mvm_mac_ctxt_add(struct iwm_softc *sc, struct ieee80211vap *vap)
 476 {
 477         struct iwm_vap *iv = IWM_VAP(vap);
 478         int ret;
 479
 480         if (iv->is_uploaded != 0) {
 481                 device_printf(sc->sc_dev, "%s: called; uploaded != 0\n",
 482                     __func__);
 483                 return (EIO);
 484         }
 485
 486         ret = iwm_mvm_mac_ctx_send(sc, vap, IWM_FW_CTXT_ACTION_ADD);
 487         if (ret)
 488                 return (ret);
 489         iv->is_uploaded = 1;
 490         return (0);
 491 }
 492
 493 int
 494 iwm_mvm_mac_ctxt_changed(struct iwm_softc *sc, struct ieee80211vap *vap)
 495 {
 496         struct iwm_vap *iv = IWM_VAP(vap);
 497
 498         if (iv->is_uploaded == 0) {
 499                 device_printf(sc->sc_dev, "%s: called; uploaded = 0\n",
 500                     __func__);
 501                 return (EIO);
 502         }
 503         return iwm_mvm_mac_ctx_send(sc, vap, IWM_FW_CTXT_ACTION_MODIFY);
 504 }
 505
 506 #if 0
 507 static int
 508 iwm_mvm_mac_ctxt_remove(struct iwm_softc *sc, struct iwm_node *in)
 509 {
 510         struct iwm_mac_ctx_cmd cmd;
 511         int ret;
 512
 513         if (!in->in_uploaded) {
 514                 device_printf(sc->sc_dev,
 515                     "attempt to remove !uploaded node %p", in);
 516                 return EIO;
 517         }
 518
 519         memset(&cmd, 0, sizeof(cmd));
 520
 521         cmd.id_and_color = htole32(IWM_FW_CMD_ID_AND_COLOR(IWM_DEFAULT_MACID,
 522             IWM_DEFAULT_COLOR));
 523         cmd.action = htole32(IWM_FW_CTXT_ACTION_REMOVE);
 524
 525         ret = iwm_mvm_send_cmd_pdu(sc,
 526             IWM_MAC_CONTEXT_CMD, IWM_CMD_SYNC, sizeof(cmd), &cmd);
 527         if (ret) {
 528                 device_printf(sc->sc_dev,
 529                     "Failed to remove MAC context: %d\n", ret);
 530                 return ret;
 531         }
 532         in->in_uploaded = 0;
 533
 534         return 0;
 535 }
 536 #endif