drivers/net/wireless/ath/ath9k/main.c

   1 /*
   2  * Copyright (c) 2008-2011 Atheros Communications Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include <linux/nl80211.h>
  18 #include <linux/delay.h>
  19 #include "ath9k.h"
  20 #include "btcoex.h"
  21
  22 static u8 parse_mpdudensity(u8 mpdudensity)
  23 {
  24         /*
  25          * 802.11n D2.0 defined values for "Minimum MPDU Start Spacing":
  26          *   0 for no restriction
  27          *   1 for 1/4 us
  28          *   2 for 1/2 us
  29          *   3 for 1 us
  30          *   4 for 2 us
  31          *   5 for 4 us
  32          *   6 for 8 us
  33          *   7 for 16 us
  34          */
  35         switch (mpdudensity) {
  36         case 0:
  37                 return 0;
  38         case 1:
  39         case 2:
  40         case 3:
  41                 /* Our lower layer calculations limit our precision to
  42                    1 microsecond */
  43                 return 1;
  44         case 4:
  45                 return 2;
  46         case 5:
  47                 return 4;
  48         case 6:
  49                 return 8;
  50         case 7:
  51                 return 16;
  52         default:
  53                 return 0;
  54         }
  55 }
  56
  57 static bool ath9k_has_pending_frames(struct ath_softc *sc, struct ath_txq *txq)
  58 {
  59         bool pending = false;
  60
  61         spin_lock_bh(&txq->axq_lock);
  62
  63         if (txq->axq_depth || !list_empty(&txq->axq_acq))
  64                 pending = true;
  65
  66         spin_unlock_bh(&txq->axq_lock);
  67         return pending;
  68 }
  69
  70 static bool ath9k_setpower(struct ath_softc *sc, enum ath9k_power_mode mode)
  71 {
  72         unsigned long flags;
  73         bool ret;
  74
  75         spin_lock_irqsave(&sc->sc_pm_lock, flags);
  76         ret = ath9k_hw_setpower(sc->sc_ah, mode);
  77         spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
  78
  79         return ret;
  80 }
  81
  82 void ath9k_ps_wakeup(struct ath_softc *sc)
  83 {
  84         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
  85         unsigned long flags;
  86         enum ath9k_power_mode power_mode;
  87
  88         spin_lock_irqsave(&sc->sc_pm_lock, flags);
  89         if (++sc->ps_usecount != 1)
  90                 goto unlock;
  91
  92         power_mode = sc->sc_ah->power_mode;
  93         ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_AWAKE);
  94
  95         /*
  96          * While the hardware is asleep, the cycle counters contain no
  97          * useful data. Better clear them now so that they don't mess up
  98          * survey data results.
  99          */
 100         if (power_mode != ATH9K_PM_AWAKE) {
 101                 spin_lock(&common->cc_lock);
 102                 ath_hw_cycle_counters_update(common);
 103                 memset(&common->cc_survey, 0, sizeof(common->cc_survey));
 104                 spin_unlock(&common->cc_lock);
 105         }
 106
 107  unlock:
 108         spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
 109 }
 110
 111 void ath9k_ps_restore(struct ath_softc *sc)
 112 {
 113         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 114         enum ath9k_power_mode mode;
 115         unsigned long flags;
 116
 117         spin_lock_irqsave(&sc->sc_pm_lock, flags);
 118         if (--sc->ps_usecount != 0)
 119                 goto unlock;
 120
 121         if (sc->ps_idle)
 122                 mode = ATH9K_PM_FULL_SLEEP;
 123         else if (sc->ps_enabled &&
 124                  !(sc->ps_flags & (PS_WAIT_FOR_BEACON |
 125                               PS_WAIT_FOR_CAB |
 126                               PS_WAIT_FOR_PSPOLL_DATA |
 127                               PS_WAIT_FOR_TX_ACK)))
 128                 mode = ATH9K_PM_NETWORK_SLEEP;
 129         else
 130                 goto unlock;
 131
 132         spin_lock(&common->cc_lock);
 133         ath_hw_cycle_counters_update(common);
 134         spin_unlock(&common->cc_lock);
 135
 136         ath9k_hw_setpower(sc->sc_ah, mode);
 137
 138  unlock:
 139         spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
 140 }
 141
 142 void ath_start_ani(struct ath_common *common)
 143 {
 144         struct ath_hw *ah = common->ah;
 145         unsigned long timestamp = jiffies_to_msecs(jiffies);
 146         struct ath_softc *sc = (struct ath_softc *) common->priv;
 147
 148         if (!(sc->sc_flags & SC_OP_ANI_RUN))
 149                 return;
 150
 151         if (sc->sc_flags & SC_OP_OFFCHANNEL)
 152                 return;
 153
 154         common->ani.longcal_timer = timestamp;
 155         common->ani.shortcal_timer = timestamp;
 156         common->ani.checkani_timer = timestamp;
 157
 158         mod_timer(&common->ani.timer,
 159                   jiffies +
 160                         msecs_to_jiffies((u32)ah->config.ani_poll_interval));
 161 }
 162
 163 static void ath_update_survey_nf(struct ath_softc *sc, int channel)
 164 {
 165         struct ath_hw *ah = sc->sc_ah;
 166         struct ath9k_channel *chan = &ah->channels[channel];
 167         struct survey_info *survey = &sc->survey[channel];
 168
 169         if (chan->noisefloor) {
 170                 survey->filled |= SURVEY_INFO_NOISE_DBM;
 171                 survey->noise = ath9k_hw_getchan_noise(ah, chan);
 172         }
 173 }
 174
 175 /*
 176  * Updates the survey statistics and returns the busy time since last
 177  * update in %, if the measurement duration was long enough for the
 178  * result to be useful, -1 otherwise.
 179  */
 180 static int ath_update_survey_stats(struct ath_softc *sc)
 181 {
 182         struct ath_hw *ah = sc->sc_ah;
 183         struct ath_common *common = ath9k_hw_common(ah);
 184         int pos = ah->curchan - &ah->channels[0];
 185         struct survey_info *survey = &sc->survey[pos];
 186         struct ath_cycle_counters *cc = &common->cc_survey;
 187         unsigned int div = common->clockrate * 1000;
 188         int ret = 0;
 189
 190         if (!ah->curchan)
 191                 return -1;
 192
 193         if (ah->power_mode == ATH9K_PM_AWAKE)
 194                 ath_hw_cycle_counters_update(common);
 195
 196         if (cc->cycles > 0) {
 197                 survey->filled |= SURVEY_INFO_CHANNEL_TIME |
 198                         SURVEY_INFO_CHANNEL_TIME_BUSY |
 199                         SURVEY_INFO_CHANNEL_TIME_RX |
 200                         SURVEY_INFO_CHANNEL_TIME_TX;
 201                 survey->channel_time += cc->cycles / div;
 202                 survey->channel_time_busy += cc->rx_busy / div;
 203                 survey->channel_time_rx += cc->rx_frame / div;
 204                 survey->channel_time_tx += cc->tx_frame / div;
 205         }
 206
 207         if (cc->cycles < div)
 208                 return -1;
 209
 210         if (cc->cycles > 0)
 211                 ret = cc->rx_busy * 100 / cc->cycles;
 212
 213         memset(cc, 0, sizeof(*cc));
 214
 215         ath_update_survey_nf(sc, pos);
 216
 217         return ret;
 218 }
 219
 220 static void __ath_cancel_work(struct ath_softc *sc)
 221 {
 222         cancel_work_sync(&sc->paprd_work);
 223         cancel_work_sync(&sc->hw_check_work);
 224         cancel_delayed_work_sync(&sc->tx_complete_work);
 225         cancel_delayed_work_sync(&sc->hw_pll_work);
 226 }
 227
 228 static void ath_cancel_work(struct ath_softc *sc)
 229 {
 230         __ath_cancel_work(sc);
 231         cancel_work_sync(&sc->hw_reset_work);
 232 }
 233
 234 static bool ath_prepare_reset(struct ath_softc *sc, bool retry_tx, bool flush)
 235 {
 236         struct ath_hw *ah = sc->sc_ah;
 237         struct ath_common *common = ath9k_hw_common(ah);
 238         bool ret = true;
 239
 240         ieee80211_stop_queues(sc->hw);
 241
 242         sc->hw_busy_count = 0;
 243         del_timer_sync(&common->ani.timer);
 244
 245         ath9k_debug_samp_bb_mac(sc);
 246         ath9k_hw_disable_interrupts(ah);
 247
 248         if (AR_SREV_9300_20_OR_LATER(ah)) {
 249                 ret &= ath_stoprecv(sc);
 250                 ret &= ath_drain_all_txq(sc, retry_tx);
 251         } else {
 252                 ret &= ath_drain_all_txq(sc, retry_tx);
 253                 ret &= ath_stoprecv(sc);
 254         }
 255
 256         if (!flush) {
 257                 if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
 258                         ath_rx_tasklet(sc, 1, true);
 259                 ath_rx_tasklet(sc, 1, false);
 260         } else {
 261                 ath_flushrecv(sc);
 262         }
 263
 264         return ret;
 265 }
 266
 267 static bool ath_complete_reset(struct ath_softc *sc, bool start)
 268 {
 269         struct ath_hw *ah = sc->sc_ah;
 270         struct ath_common *common = ath9k_hw_common(ah);
 271
 272         if (ath_startrecv(sc) != 0) {
 273                 ath_err(common, "Unable to restart recv logic\n");
 274                 return false;
 275         }
 276
 277         ath9k_cmn_update_txpow(ah, sc->curtxpow,
 278                                sc->config.txpowlimit, &sc->curtxpow);
 279         ath9k_hw_set_interrupts(ah);
 280         ath9k_hw_enable_interrupts(ah);
 281
 282         if (!(sc->sc_flags & (SC_OP_OFFCHANNEL)) && start) {
 283                 if (sc->sc_flags & SC_OP_BEACONS)
 284                         ath_set_beacon(sc);
 285
 286                 ieee80211_queue_delayed_work(sc->hw, &sc->tx_complete_work, 0);
 287                 ieee80211_queue_delayed_work(sc->hw, &sc->hw_pll_work, HZ/2);
 288                 if (!common->disable_ani)
 289                         ath_start_ani(common);
 290         }
 291
 292         if ((ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) && sc->ant_rx != 3) {
 293                 struct ath_hw_antcomb_conf div_ant_conf;
 294                 u8 lna_conf;
 295
 296                 ath9k_hw_antdiv_comb_conf_get(ah, &div_ant_conf);
 297
 298                 if (sc->ant_rx == 1)
 299                         lna_conf = ATH_ANT_DIV_COMB_LNA1;
 300                 else
 301                         lna_conf = ATH_ANT_DIV_COMB_LNA2;
 302                 div_ant_conf.main_lna_conf = lna_conf;
 303                 div_ant_conf.alt_lna_conf = lna_conf;
 304
 305                 ath9k_hw_antdiv_comb_conf_set(ah, &div_ant_conf);
 306         }
 307
 308         ieee80211_wake_queues(sc->hw);
 309
 310         return true;
 311 }
 312
 313 static int ath_reset_internal(struct ath_softc *sc, struct ath9k_channel *hchan,
 314                               bool retry_tx)
 315 {
 316         struct ath_hw *ah = sc->sc_ah;
 317         struct ath_common *common = ath9k_hw_common(ah);
 318         struct ath9k_hw_cal_data *caldata = NULL;
 319         bool fastcc = true;
 320         bool flush = false;
 321         int r;
 322
 323         __ath_cancel_work(sc);
 324
 325         spin_lock_bh(&sc->sc_pcu_lock);
 326
 327         if (!(sc->sc_flags & SC_OP_OFFCHANNEL)) {
 328                 fastcc = false;
 329                 caldata = &sc->caldata;
 330         }
 331
 332         if (!hchan) {
 333                 fastcc = false;
 334                 flush = true;
 335                 hchan = ah->curchan;
 336         }
 337
 338         if (fastcc && !ath9k_hw_check_alive(ah))
 339                 fastcc = false;
 340
 341         if (!ath_prepare_reset(sc, retry_tx, flush))
 342                 fastcc = false;
 343
 344         ath_dbg(common, ATH_DBG_CONFIG,
 345                 "Reset to %u MHz, HT40: %d fastcc: %d\n",
 346                 hchan->channel, !!(hchan->channelFlags & (CHANNEL_HT40MINUS |
 347                                                           CHANNEL_HT40PLUS)),
 348                 fastcc);
 349
 350         r = ath9k_hw_reset(ah, hchan, caldata, fastcc);
 351         if (r) {
 352                 ath_err(common,
 353                         "Unable to reset channel, reset status %d\n", r);
 354                 goto out;
 355         }
 356
 357         if (!ath_complete_reset(sc, true))
 358                 r = -EIO;
 359
 360 out:
 361         spin_unlock_bh(&sc->sc_pcu_lock);
 362         return r;
 363 }
 364
 365
 366 /*
 367  * Set/change channels.  If the channel is really being changed, it's done
 368  * by reseting the chip.  To accomplish this we must first cleanup any pending
 369  * DMA, then restart stuff.
 370 */
 371 static int ath_set_channel(struct ath_softc *sc, struct ieee80211_hw *hw,
 372                     struct ath9k_channel *hchan)
 373 {
 374         int r;
 375
 376         if (sc->sc_flags & SC_OP_INVALID)
 377                 return -EIO;
 378
 379         ath9k_ps_wakeup(sc);
 380
 381         r = ath_reset_internal(sc, hchan, false);
 382
 383         ath9k_ps_restore(sc);
 384
 385         return r;
 386 }
 387
 388 static void ath_paprd_activate(struct ath_softc *sc)
 389 {
 390         struct ath_hw *ah = sc->sc_ah;
 391         struct ath9k_hw_cal_data *caldata = ah->caldata;
 392         int chain;
 393
 394         if (!caldata || !caldata->paprd_done)
 395                 return;
 396
 397         ath9k_ps_wakeup(sc);
 398         ar9003_paprd_enable(ah, false);
 399         for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
 400                 if (!(ah->txchainmask & BIT(chain)))
 401                         continue;
 402
 403                 ar9003_paprd_populate_single_table(ah, caldata, chain);
 404         }
 405
 406         ar9003_paprd_enable(ah, true);
 407         ath9k_ps_restore(sc);
 408 }
 409
 410 static bool ath_paprd_send_frame(struct ath_softc *sc, struct sk_buff *skb, int chain)
 411 {
 412         struct ieee80211_hw *hw = sc->hw;
 413         struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(skb);
 414         struct ath_hw *ah = sc->sc_ah;
 415         struct ath_common *common = ath9k_hw_common(ah);
 416         struct ath_tx_control txctl;
 417         int time_left;
 418
 419         memset(&txctl, 0, sizeof(txctl));
 420         txctl.txq = sc->tx.txq_map[WME_AC_BE];
 421
 422         memset(tx_info, 0, sizeof(*tx_info));
 423         tx_info->band = hw->conf.channel->band;
 424         tx_info->flags |= IEEE80211_TX_CTL_NO_ACK;
 425         tx_info->control.rates[0].idx = 0;
 426         tx_info->control.rates[0].count = 1;
 427         tx_info->control.rates[0].flags = IEEE80211_TX_RC_MCS;
 428         tx_info->control.rates[1].idx = -1;
 429
 430         init_completion(&sc->paprd_complete);
 431         txctl.paprd = BIT(chain);
 432
 433         if (ath_tx_start(hw, skb, &txctl) != 0) {
 434                 ath_dbg(common, ATH_DBG_CALIBRATE, "PAPRD TX failed\n");
 435                 dev_kfree_skb_any(skb);
 436                 return false;
 437         }
 438
 439         time_left = wait_for_completion_timeout(&sc->paprd_complete,
 440                         msecs_to_jiffies(ATH_PAPRD_TIMEOUT));
 441
 442         if (!time_left)
 443                 ath_dbg(common, ATH_DBG_CALIBRATE,
 444                         "Timeout waiting for paprd training on TX chain %d\n",
 445                         chain);
 446
 447         return !!time_left;
 448 }
 449
 450 void ath_paprd_calibrate(struct work_struct *work)
 451 {
 452         struct ath_softc *sc = container_of(work, struct ath_softc, paprd_work);
 453         struct ieee80211_hw *hw = sc->hw;
 454         struct ath_hw *ah = sc->sc_ah;
 455         struct ieee80211_hdr *hdr;
 456         struct sk_buff *skb = NULL;
 457         struct ath9k_hw_cal_data *caldata = ah->caldata;
 458         struct ath_common *common = ath9k_hw_common(ah);
 459         int ftype;
 460         int chain_ok = 0;
 461         int chain;
 462         int len = 1800;
 463
 464         if (!caldata)
 465                 return;
 466
 467         ath9k_ps_wakeup(sc);
 468
 469         if (ar9003_paprd_init_table(ah) < 0)
 470                 goto fail_paprd;
 471
 472         skb = alloc_skb(len, GFP_KERNEL);
 473         if (!skb)
 474                 goto fail_paprd;
 475
 476         skb_put(skb, len);
 477         memset(skb->data, 0, len);
 478         hdr = (struct ieee80211_hdr *)skb->data;
 479         ftype = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC;
 480         hdr->frame_control = cpu_to_le16(ftype);
 481         hdr->duration_id = cpu_to_le16(10);
 482         memcpy(hdr->addr1, hw->wiphy->perm_addr, ETH_ALEN);
 483         memcpy(hdr->addr2, hw->wiphy->perm_addr, ETH_ALEN);
 484         memcpy(hdr->addr3, hw->wiphy->perm_addr, ETH_ALEN);
 485
 486         for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
 487                 if (!(ah->txchainmask & BIT(chain)))
 488                         continue;
 489
 490                 chain_ok = 0;
 491
 492                 ath_dbg(common, ATH_DBG_CALIBRATE,
 493                         "Sending PAPRD frame for thermal measurement "
 494                         "on chain %d\n", chain);
 495                 if (!ath_paprd_send_frame(sc, skb, chain))
 496                         goto fail_paprd;
 497
 498                 ar9003_paprd_setup_gain_table(ah, chain);
 499
 500                 ath_dbg(common, ATH_DBG_CALIBRATE,
 501                         "Sending PAPRD training frame on chain %d\n", chain);
 502                 if (!ath_paprd_send_frame(sc, skb, chain))
 503                         goto fail_paprd;
 504
 505                 if (!ar9003_paprd_is_done(ah)) {
 506                         ath_dbg(common, ATH_DBG_CALIBRATE,
 507                                 "PAPRD not yet done on chain %d\n", chain);
 508                         break;
 509                 }
 510
 511                 if (ar9003_paprd_create_curve(ah, caldata, chain)) {
 512                         ath_dbg(common, ATH_DBG_CALIBRATE,
 513                                 "PAPRD create curve failed on chain %d\n",
 514                                                                    chain);
 515                         break;
 516                 }
 517
 518                 chain_ok = 1;
 519         }
 520         kfree_skb(skb);
 521
 522         if (chain_ok) {
 523                 caldata->paprd_done = true;
 524                 ath_paprd_activate(sc);
 525         }
 526
 527 fail_paprd:
 528         ath9k_ps_restore(sc);
 529 }
 530
 531 /*
 532  *  This routine performs the periodic noise floor calibration function
 533  *  that is used to adjust and optimize the chip performance.  This
 534  *  takes environmental changes (location, temperature) into account.
 535  *  When the task is complete, it reschedules itself depending on the
 536  *  appropriate interval that was calculated.
 537  */
 538 void ath_ani_calibrate(unsigned long data)
 539 {
 540         struct ath_softc *sc = (struct ath_softc *)data;
 541         struct ath_hw *ah = sc->sc_ah;
 542         struct ath_common *common = ath9k_hw_common(ah);
 543         bool longcal = false;
 544         bool shortcal = false;
 545         bool aniflag = false;
 546         unsigned int timestamp = jiffies_to_msecs(jiffies);
 547         u32 cal_interval, short_cal_interval, long_cal_interval;
 548         unsigned long flags;
 549
 550         if (ah->caldata && ah->caldata->nfcal_interference)
 551                 long_cal_interval = ATH_LONG_CALINTERVAL_INT;
 552         else
 553                 long_cal_interval = ATH_LONG_CALINTERVAL;
 554
 555         short_cal_interval = (ah->opmode == NL80211_IFTYPE_AP) ?
 556                 ATH_AP_SHORT_CALINTERVAL : ATH_STA_SHORT_CALINTERVAL;
 557
 558         /* Only calibrate if awake */
 559         if (sc->sc_ah->power_mode != ATH9K_PM_AWAKE)
 560                 goto set_timer;
 561
 562         ath9k_ps_wakeup(sc);
 563
 564         /* Long calibration runs independently of short calibration. */
 565         if ((timestamp - common->ani.longcal_timer) >= long_cal_interval) {
 566                 longcal = true;
 567                 ath_dbg(common, ATH_DBG_ANI, "longcal @%lu\n", jiffies);
 568                 common->ani.longcal_timer = timestamp;
 569         }
 570
 571         /* Short calibration applies only while caldone is false */
 572         if (!common->ani.caldone) {
 573                 if ((timestamp - common->ani.shortcal_timer) >= short_cal_interval) {
 574                         shortcal = true;
 575                         ath_dbg(common, ATH_DBG_ANI,
 576                                 "shortcal @%lu\n", jiffies);
 577                         common->ani.shortcal_timer = timestamp;
 578                         common->ani.resetcal_timer = timestamp;
 579                 }
 580         } else {
 581                 if ((timestamp - common->ani.resetcal_timer) >=
 582                     ATH_RESTART_CALINTERVAL) {
 583                         common->ani.caldone = ath9k_hw_reset_calvalid(ah);
 584                         if (common->ani.caldone)
 585                                 common->ani.resetcal_timer = timestamp;
 586                 }
 587         }
 588
 589         /* Verify whether we must check ANI */
 590         if ((timestamp - common->ani.checkani_timer) >=
 591              ah->config.ani_poll_interval) {
 592                 aniflag = true;
 593                 common->ani.checkani_timer = timestamp;
 594         }
 595
 596         /* Call ANI routine if necessary */
 597         if (aniflag) {
 598                 spin_lock_irqsave(&common->cc_lock, flags);
 599                 ath9k_hw_ani_monitor(ah, ah->curchan);
 600                 ath_update_survey_stats(sc);
 601                 spin_unlock_irqrestore(&common->cc_lock, flags);
 602         }
 603
 604         /* Perform calibration if necessary */
 605         if (longcal || shortcal) {
 606                 common->ani.caldone =
 607                         ath9k_hw_calibrate(ah, ah->curchan,
 608                                                 ah->rxchainmask, longcal);
 609         }
 610
 611         ath9k_ps_restore(sc);
 612
 613 set_timer:
 614         /*
 615         * Set timer interval based on previous results.
 616         * The interval must be the shortest necessary to satisfy ANI,
 617         * short calibration and long calibration.
 618         */
 619         ath9k_debug_samp_bb_mac(sc);
 620         cal_interval = ATH_LONG_CALINTERVAL;
 621         if (sc->sc_ah->config.enable_ani)
 622                 cal_interval = min(cal_interval,
 623                                    (u32)ah->config.ani_poll_interval);
 624         if (!common->ani.caldone)
 625                 cal_interval = min(cal_interval, (u32)short_cal_interval);
 626
 627         mod_timer(&common->ani.timer, jiffies + msecs_to_jiffies(cal_interval));
 628         if ((sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_PAPRD) && ah->caldata) {
 629                 if (!ah->caldata->paprd_done)
 630                         ieee80211_queue_work(sc->hw, &sc->paprd_work);
 631                 else if (!ah->paprd_table_write_done)
 632                         ath_paprd_activate(sc);
 633         }
 634 }
 635
 636 static void ath_node_attach(struct ath_softc *sc, struct ieee80211_sta *sta)
 637 {
 638         struct ath_node *an;
 639         an = (struct ath_node *)sta->drv_priv;
 640
 641 #ifdef CONFIG_ATH9K_DEBUGFS
 642         spin_lock(&sc->nodes_lock);
 643         list_add(&an->list, &sc->nodes);
 644         spin_unlock(&sc->nodes_lock);
 645         an->sta = sta;
 646 #endif
 647         if (sc->sc_flags & SC_OP_TXAGGR) {
 648                 ath_tx_node_init(sc, an);
 649                 an->maxampdu = 1 << (IEEE80211_HT_MAX_AMPDU_FACTOR +
 650                                      sta->ht_cap.ampdu_factor);
 651                 an->mpdudensity = parse_mpdudensity(sta->ht_cap.ampdu_density);
 652         }
 653 }
 654
 655 static void ath_node_detach(struct ath_softc *sc, struct ieee80211_sta *sta)
 656 {
 657         struct ath_node *an = (struct ath_node *)sta->drv_priv;
 658
 659 #ifdef CONFIG_ATH9K_DEBUGFS
 660         spin_lock(&sc->nodes_lock);
 661         list_del(&an->list);
 662         spin_unlock(&sc->nodes_lock);
 663         an->sta = NULL;
 664 #endif
 665
 666         if (sc->sc_flags & SC_OP_TXAGGR)
 667                 ath_tx_node_cleanup(sc, an);
 668 }
 669
 670
 671 void ath9k_tasklet(unsigned long data)
 672 {
 673         struct ath_softc *sc = (struct ath_softc *)data;
 674         struct ath_hw *ah = sc->sc_ah;
 675         struct ath_common *common = ath9k_hw_common(ah);
 676
 677         u32 status = sc->intrstatus;
 678         u32 rxmask;
 679
 680         ath9k_ps_wakeup(sc);
 681         spin_lock(&sc->sc_pcu_lock);
 682
 683         if ((status & ATH9K_INT_FATAL) ||
 684             (status & ATH9K_INT_BB_WATCHDOG)) {
 685 #ifdef CONFIG_ATH9K_DEBUGFS
 686                 enum ath_reset_type type;
 687
 688                 if (status & ATH9K_INT_FATAL)
 689                         type = RESET_TYPE_FATAL_INT;
 690                 else
 691                         type = RESET_TYPE_BB_WATCHDOG;
 692
 693                 RESET_STAT_INC(sc, type);
 694 #endif
 695                 ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
 696                 goto out;
 697         }
 698
 699         /*
 700          * Only run the baseband hang check if beacons stop working in AP or
 701          * IBSS mode, because it has a high false positive rate. For station
 702          * mode it should not be necessary, since the upper layers will detect
 703          * this through a beacon miss automatically and the following channel
 704          * change will trigger a hardware reset anyway
 705          */
 706         if (ath9k_hw_numtxpending(ah, sc->beacon.beaconq) != 0 &&
 707             !ath9k_hw_check_alive(ah))
 708                 ieee80211_queue_work(sc->hw, &sc->hw_check_work);
 709
 710         if ((status & ATH9K_INT_TSFOOR) && sc->ps_enabled) {
 711                 /*
 712                  * TSF sync does not look correct; remain awake to sync with
 713                  * the next Beacon.
 714                  */
 715                 ath_dbg(common, ATH_DBG_PS,
 716                         "TSFOOR - Sync with next Beacon\n");
 717                 sc->ps_flags |= PS_WAIT_FOR_BEACON | PS_BEACON_SYNC;
 718         }
 719
 720         if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
 721                 rxmask = (ATH9K_INT_RXHP | ATH9K_INT_RXLP | ATH9K_INT_RXEOL |
 722                           ATH9K_INT_RXORN);
 723         else
 724                 rxmask = (ATH9K_INT_RX | ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
 725
 726         if (status & rxmask) {
 727                 /* Check for high priority Rx first */
 728                 if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
 729                     (status & ATH9K_INT_RXHP))
 730                         ath_rx_tasklet(sc, 0, true);
 731
 732                 ath_rx_tasklet(sc, 0, false);
 733         }
 734
 735         if (status & ATH9K_INT_TX) {
 736                 if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
 737                         ath_tx_edma_tasklet(sc);
 738                 else
 739                         ath_tx_tasklet(sc);
 740         }
 741
 742         if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
 743                 if (status & ATH9K_INT_GENTIMER)
 744                         ath_gen_timer_isr(sc->sc_ah);
 745
 746 out:
 747         /* re-enable hardware interrupt */
 748         ath9k_hw_enable_interrupts(ah);
 749
 750         spin_unlock(&sc->sc_pcu_lock);
 751         ath9k_ps_restore(sc);
 752 }
 753
 754 irqreturn_t ath_isr(int irq, void *dev)
 755 {
 756 #define SCHED_INTR (                            \
 757                 ATH9K_INT_FATAL |               \
 758                 ATH9K_INT_BB_WATCHDOG |         \
 759                 ATH9K_INT_RXORN |               \
 760                 ATH9K_INT_RXEOL |               \
 761                 ATH9K_INT_RX |                  \
 762                 ATH9K_INT_RXLP |                \
 763                 ATH9K_INT_RXHP |                \
 764                 ATH9K_INT_TX |                  \
 765                 ATH9K_INT_BMISS |               \
 766                 ATH9K_INT_CST |                 \
 767                 ATH9K_INT_TSFOOR |              \
 768                 ATH9K_INT_GENTIMER)
 769
 770         struct ath_softc *sc = dev;
 771         struct ath_hw *ah = sc->sc_ah;
 772         struct ath_common *common = ath9k_hw_common(ah);
 773         enum ath9k_int status;
 774         bool sched = false;
 775
 776         /*
 777          * The hardware is not ready/present, don't
 778          * touch anything. Note this can happen early
 779          * on if the IRQ is shared.
 780          */
 781         if (sc->sc_flags & SC_OP_INVALID)
 782                 return IRQ_NONE;
 783
 784
 785         /* shared irq, not for us */
 786
 787         if (!ath9k_hw_intrpend(ah))
 788                 return IRQ_NONE;
 789
 790         /*
 791          * Figure out the reason(s) for the interrupt.  Note
 792          * that the hal returns a pseudo-ISR that may include
 793          * bits we haven't explicitly enabled so we mask the
 794          * value to insure we only process bits we requested.
 795          */
 796         ath9k_hw_getisr(ah, &status);   /* NB: clears ISR too */
 797         status &= ah->imask;    /* discard unasked-for bits */
 798
 799         /*
 800          * If there are no status bits set, then this interrupt was not
 801          * for me (should have been caught above).
 802          */
 803         if (!status)
 804                 return IRQ_NONE;
 805
 806         /* Cache the status */
 807         sc->intrstatus = status;
 808
 809         if (status & SCHED_INTR)
 810                 sched = true;
 811
 812         /*
 813          * If a FATAL or RXORN interrupt is received, we have to reset the
 814          * chip immediately.
 815          */
 816         if ((status & ATH9K_INT_FATAL) || ((status & ATH9K_INT_RXORN) &&
 817             !(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)))
 818                 goto chip_reset;
 819
 820         if ((ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) &&
 821             (status & ATH9K_INT_BB_WATCHDOG)) {
 822
 823                 spin_lock(&common->cc_lock);
 824                 ath_hw_cycle_counters_update(common);
 825                 ar9003_hw_bb_watchdog_dbg_info(ah);
 826                 spin_unlock(&common->cc_lock);
 827
 828                 goto chip_reset;
 829         }
 830
 831         if (status & ATH9K_INT_SWBA)
 832                 tasklet_schedule(&sc->bcon_tasklet);
 833
 834         if (status & ATH9K_INT_TXURN)
 835                 ath9k_hw_updatetxtriglevel(ah, true);
 836
 837         if (status & ATH9K_INT_RXEOL) {
 838                 ah->imask &= ~(ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
 839                 ath9k_hw_set_interrupts(ah);
 840         }
 841
 842         if (status & ATH9K_INT_MIB) {
 843                 /*
 844                  * Disable interrupts until we service the MIB
 845                  * interrupt; otherwise it will continue to
 846                  * fire.
 847                  */
 848                 ath9k_hw_disable_interrupts(ah);
 849                 /*
 850                  * Let the hal handle the event. We assume
 851                  * it will clear whatever condition caused
 852                  * the interrupt.
 853                  */
 854                 spin_lock(&common->cc_lock);
 855                 ath9k_hw_proc_mib_event(ah);
 856                 spin_unlock(&common->cc_lock);
 857                 ath9k_hw_enable_interrupts(ah);
 858         }
 859
 860         if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
 861                 if (status & ATH9K_INT_TIM_TIMER) {
 862                         if (ATH_DBG_WARN_ON_ONCE(sc->ps_idle))
 863                                 goto chip_reset;
 864                         /* Clear RxAbort bit so that we can
 865                          * receive frames */
 866                         ath9k_setpower(sc, ATH9K_PM_AWAKE);
 867                         ath9k_hw_setrxabort(sc->sc_ah, 0);
 868                         sc->ps_flags |= PS_WAIT_FOR_BEACON;
 869                 }
 870
 871 chip_reset:
 872
 873         ath_debug_stat_interrupt(sc, status);
 874
 875         if (sched) {
 876                 /* turn off every interrupt */
 877                 ath9k_hw_disable_interrupts(ah);
 878                 tasklet_schedule(&sc->intr_tq);
 879         }
 880
 881         return IRQ_HANDLED;
 882
 883 #undef SCHED_INTR
 884 }
 885
 886 static void ath_radio_enable(struct ath_softc *sc, struct ieee80211_hw *hw)
 887 {
 888         struct ath_hw *ah = sc->sc_ah;
 889         struct ath_common *common = ath9k_hw_common(ah);
 890         struct ieee80211_channel *channel = hw->conf.channel;
 891         int r;
 892
 893         ath9k_ps_wakeup(sc);
 894         spin_lock_bh(&sc->sc_pcu_lock);
 895         atomic_set(&ah->intr_ref_cnt, -1);
 896
 897         ath9k_hw_configpcipowersave(ah, false);
 898
 899         if (!ah->curchan)
 900                 ah->curchan = ath9k_cmn_get_curchannel(sc->hw, ah);
 901
 902         r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
 903         if (r) {
 904                 ath_err(common,
 905                         "Unable to reset channel (%u MHz), reset status %d\n",
 906                         channel->center_freq, r);
 907         }
 908
 909         ath_complete_reset(sc, true);
 910
 911         /* Enable LED */
 912         ath9k_hw_cfg_output(ah, ah->led_pin,
 913                             AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
 914         ath9k_hw_set_gpio(ah, ah->led_pin, 0);
 915
 916         spin_unlock_bh(&sc->sc_pcu_lock);
 917
 918         ath9k_ps_restore(sc);
 919 }
 920
 921 void ath_radio_disable(struct ath_softc *sc, struct ieee80211_hw *hw)
 922 {
 923         struct ath_hw *ah = sc->sc_ah;
 924         struct ieee80211_channel *channel = hw->conf.channel;
 925         int r;
 926
 927         ath9k_ps_wakeup(sc);
 928
 929         ath_cancel_work(sc);
 930
 931         spin_lock_bh(&sc->sc_pcu_lock);
 932
 933         /*
 934          * Keep the LED on when the radio is disabled
 935          * during idle unassociated state.
 936          */
 937         if (!sc->ps_idle) {
 938                 ath9k_hw_set_gpio(ah, ah->led_pin, 1);
 939                 ath9k_hw_cfg_gpio_input(ah, ah->led_pin);
 940         }
 941
 942         ath_prepare_reset(sc, false, true);
 943
 944         if (!ah->curchan)
 945                 ah->curchan = ath9k_cmn_get_curchannel(hw, ah);
 946
 947         r = ath9k_hw_reset(ah, ah->curchan, ah->caldata, false);
 948         if (r) {
 949                 ath_err(ath9k_hw_common(sc->sc_ah),
 950                         "Unable to reset channel (%u MHz), reset status %d\n",
 951                         channel->center_freq, r);
 952         }
 953
 954         ath9k_hw_phy_disable(ah);
 955
 956         ath9k_hw_configpcipowersave(ah, true);
 957
 958         spin_unlock_bh(&sc->sc_pcu_lock);
 959         ath9k_ps_restore(sc);
 960 }
 961
 962 static int ath_reset(struct ath_softc *sc, bool retry_tx)
 963 {
 964         int r;
 965
 966         ath9k_ps_wakeup(sc);
 967
 968         r = ath_reset_internal(sc, NULL, retry_tx);
 969
 970         if (retry_tx) {
 971                 int i;
 972                 for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
 973                         if (ATH_TXQ_SETUP(sc, i)) {
 974                                 spin_lock_bh(&sc->tx.txq[i].axq_lock);
 975                                 ath_txq_schedule(sc, &sc->tx.txq[i]);
 976                                 spin_unlock_bh(&sc->tx.txq[i].axq_lock);
 977                         }
 978                 }
 979         }
 980
 981         ath9k_ps_restore(sc);
 982
 983         return r;
 984 }
 985
 986 void ath_reset_work(struct work_struct *work)
 987 {
 988         struct ath_softc *sc = container_of(work, struct ath_softc, hw_reset_work);
 989
 990         ath_reset(sc, true);
 991 }
 992
 993 void ath_hw_check(struct work_struct *work)
 994 {
 995         struct ath_softc *sc = container_of(work, struct ath_softc, hw_check_work);
 996         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 997         unsigned long flags;
 998         int busy;
 999
1000         ath9k_ps_wakeup(sc);
1001         if (ath9k_hw_check_alive(sc->sc_ah))
1002                 goto out;
1003
1004         spin_lock_irqsave(&common->cc_lock, flags);
1005         busy = ath_update_survey_stats(sc);
1006         spin_unlock_irqrestore(&common->cc_lock, flags);
1007
1008         ath_dbg(common, ATH_DBG_RESET, "Possible baseband hang, "
1009                 "busy=%d (try %d)\n", busy, sc->hw_busy_count + 1);
1010         if (busy >= 99) {
1011                 if (++sc->hw_busy_count >= 3) {
1012                         RESET_STAT_INC(sc, RESET_TYPE_BB_HANG);
1013                         ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
1014                 }
1015
1016         } else if (busy >= 0)
1017                 sc->hw_busy_count = 0;
1018
1019 out:
1020         ath9k_ps_restore(sc);
1021 }
1022
1023 static void ath_hw_pll_rx_hang_check(struct ath_softc *sc, u32 pll_sqsum)
1024 {
1025         static int count;
1026         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1027
1028         if (pll_sqsum >= 0x40000) {
1029                 count++;
1030                 if (count == 3) {
1031                         /* Rx is hung for more than 500ms. Reset it */
1032                         ath_dbg(common, ATH_DBG_RESET,
1033                                 "Possible RX hang, resetting");
1034                         RESET_STAT_INC(sc, RESET_TYPE_PLL_HANG);
1035                         ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
1036                         count = 0;
1037                 }
1038         } else
1039                 count = 0;
1040 }
1041
1042 void ath_hw_pll_work(struct work_struct *work)
1043 {
1044         struct ath_softc *sc = container_of(work, struct ath_softc,
1045                                             hw_pll_work.work);
1046         u32 pll_sqsum;
1047
1048         /*
1049          * ensure that the PLL WAR is executed only
1050          * after the STA is associated (or) if the
1051          * beaconing had started in interfaces that
1052          * uses beacons.
1053          */
1054         if (!(sc->sc_flags & SC_OP_BEACONS))
1055                 return;
1056
1057         if (AR_SREV_9485(sc->sc_ah)) {
1058
1059                 ath9k_ps_wakeup(sc);
1060                 pll_sqsum = ar9003_get_pll_sqsum_dvc(sc->sc_ah);
1061                 ath9k_ps_restore(sc);
1062
1063                 ath_hw_pll_rx_hang_check(sc, pll_sqsum);
1064
1065                 ieee80211_queue_delayed_work(sc->hw, &sc->hw_pll_work, HZ/5);
1066         }
1067 }
1068
1069 /**********************/
1070 /* mac80211 callbacks */
1071 /**********************/
1072
1073 static int ath9k_start(struct ieee80211_hw *hw)
1074 {
1075         struct ath_softc *sc = hw->priv;
1076         struct ath_hw *ah = sc->sc_ah;
1077         struct ath_common *common = ath9k_hw_common(ah);
1078         struct ieee80211_channel *curchan = hw->conf.channel;
1079         struct ath9k_channel *init_channel;
1080         int r;
1081
1082         ath_dbg(common, ATH_DBG_CONFIG,
1083                 "Starting driver with initial channel: %d MHz\n",
1084                 curchan->center_freq);
1085
1086         ath9k_ps_wakeup(sc);
1087
1088         mutex_lock(&sc->mutex);
1089
1090         /* setup initial channel */
1091         sc->chan_idx = curchan->hw_value;
1092
1093         init_channel = ath9k_cmn_get_curchannel(hw, ah);
1094
1095         /* Reset SERDES registers */
1096         ath9k_hw_configpcipowersave(ah, false);
1097
1098         /*
1099          * The basic interface to setting the hardware in a good
1100          * state is ``reset''.  On return the hardware is known to
1101          * be powered up and with interrupts disabled.  This must
1102          * be followed by initialization of the appropriate bits
1103          * and then setup of the interrupt mask.
1104          */
1105         spin_lock_bh(&sc->sc_pcu_lock);
1106         r = ath9k_hw_reset(ah, init_channel, ah->caldata, false);
1107         if (r) {
1108                 ath_err(common,
1109                         "Unable to reset hardware; reset status %d (freq %u MHz)\n",
1110                         r, curchan->center_freq);
1111                 spin_unlock_bh(&sc->sc_pcu_lock);
1112                 goto mutex_unlock;
1113         }
1114
1115         /* Setup our intr mask. */
1116         ah->imask = ATH9K_INT_TX | ATH9K_INT_RXEOL |
1117                     ATH9K_INT_RXORN | ATH9K_INT_FATAL |
1118                     ATH9K_INT_GLOBAL;
1119
1120         if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
1121                 ah->imask |= ATH9K_INT_RXHP |
1122                              ATH9K_INT_RXLP |
1123                              ATH9K_INT_BB_WATCHDOG;
1124         else
1125                 ah->imask |= ATH9K_INT_RX;
1126
1127         ah->imask |= ATH9K_INT_GTT;
1128
1129         if (ah->caps.hw_caps & ATH9K_HW_CAP_HT)
1130                 ah->imask |= ATH9K_INT_CST;
1131
1132         sc->sc_flags &= ~SC_OP_INVALID;
1133         sc->sc_ah->is_monitoring = false;
1134
1135         /* Disable BMISS interrupt when we're not associated */
1136         ah->imask &= ~(ATH9K_INT_SWBA | ATH9K_INT_BMISS);
1137
1138         if (!ath_complete_reset(sc, false)) {
1139                 r = -EIO;
1140                 spin_unlock_bh(&sc->sc_pcu_lock);
1141                 goto mutex_unlock;
1142         }
1143
1144         spin_unlock_bh(&sc->sc_pcu_lock);
1145
1146         if ((ah->btcoex_hw.scheme != ATH_BTCOEX_CFG_NONE) &&
1147             !ah->btcoex_hw.enabled) {
1148                 ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT,
1149                                            AR_STOMP_LOW_WLAN_WGHT);
1150                 ath9k_hw_btcoex_enable(ah);
1151
1152                 if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1153                         ath9k_btcoex_timer_resume(sc);
1154         }
1155
1156         if (ah->caps.pcie_lcr_extsync_en && common->bus_ops->extn_synch_en)
1157                 common->bus_ops->extn_synch_en(common);
1158
1159 mutex_unlock:
1160         mutex_unlock(&sc->mutex);
1161
1162         ath9k_ps_restore(sc);
1163
1164         return r;
1165 }
1166
1167 static void ath9k_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
1168 {
1169         struct ath_softc *sc = hw->priv;
1170         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1171         struct ath_tx_control txctl;
1172         struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
1173
1174         if (sc->ps_enabled) {
1175                 /*
1176                  * mac80211 does not set PM field for normal data frames, so we
1177                  * need to update that based on the current PS mode.
1178                  */
1179                 if (ieee80211_is_data(hdr->frame_control) &&
1180                     !ieee80211_is_nullfunc(hdr->frame_control) &&
1181                     !ieee80211_has_pm(hdr->frame_control)) {
1182                         ath_dbg(common, ATH_DBG_PS,
1183                                 "Add PM=1 for a TX frame while in PS mode\n");
1184                         hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM);
1185                 }
1186         }
1187
1188         if (unlikely(sc->sc_ah->power_mode != ATH9K_PM_AWAKE)) {
1189                 /*
1190                  * We are using PS-Poll and mac80211 can request TX while in
1191                  * power save mode. Need to wake up hardware for the TX to be
1192                  * completed and if needed, also for RX of buffered frames.
1193                  */
1194                 ath9k_ps_wakeup(sc);
1195                 if (!(sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP))
1196                         ath9k_hw_setrxabort(sc->sc_ah, 0);
1197                 if (ieee80211_is_pspoll(hdr->frame_control)) {
1198                         ath_dbg(common, ATH_DBG_PS,
1199                                 "Sending PS-Poll to pick a buffered frame\n");
1200                         sc->ps_flags |= PS_WAIT_FOR_PSPOLL_DATA;
1201                 } else {
1202                         ath_dbg(common, ATH_DBG_PS,
1203                                 "Wake up to complete TX\n");
1204                         sc->ps_flags |= PS_WAIT_FOR_TX_ACK;
1205                 }
1206                 /*
1207                  * The actual restore operation will happen only after
1208                  * the sc_flags bit is cleared. We are just dropping
1209                  * the ps_usecount here.
1210                  */
1211                 ath9k_ps_restore(sc);
1212         }
1213
1214         memset(&txctl, 0, sizeof(struct ath_tx_control));
1215         txctl.txq = sc->tx.txq_map[skb_get_queue_mapping(skb)];
1216
1217         ath_dbg(common, ATH_DBG_XMIT, "transmitting packet, skb: %p\n", skb);
1218
1219         if (ath_tx_start(hw, skb, &txctl) != 0) {
1220                 ath_dbg(common, ATH_DBG_XMIT, "TX failed\n");
1221                 goto exit;
1222         }
1223
1224         return;
1225 exit:
1226         dev_kfree_skb_any(skb);
1227 }
1228
1229 static void ath9k_stop(struct ieee80211_hw *hw)
1230 {
1231         struct ath_softc *sc = hw->priv;
1232         struct ath_hw *ah = sc->sc_ah;
1233         struct ath_common *common = ath9k_hw_common(ah);
1234
1235         mutex_lock(&sc->mutex);
1236
1237         ath_cancel_work(sc);
1238
1239         if (sc->sc_flags & SC_OP_INVALID) {
1240                 ath_dbg(common, ATH_DBG_ANY, "Device not present\n");
1241                 mutex_unlock(&sc->mutex);
1242                 return;
1243         }
1244
1245         /* Ensure HW is awake when we try to shut it down. */
1246         ath9k_ps_wakeup(sc);
1247
1248         if (ah->btcoex_hw.enabled) {
1249                 ath9k_hw_btcoex_disable(ah);
1250                 if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE)
1251                         ath9k_btcoex_timer_pause(sc);
1252         }
1253
1254         spin_lock_bh(&sc->sc_pcu_lock);
1255
1256         /* prevent tasklets to enable interrupts once we disable them */
1257         ah->imask &= ~ATH9K_INT_GLOBAL;
1258
1259         /* make sure h/w will not generate any interrupt
1260          * before setting the invalid flag. */
1261         ath9k_hw_disable_interrupts(ah);
1262
1263         if (!(sc->sc_flags & SC_OP_INVALID)) {
1264                 ath_drain_all_txq(sc, false);
1265                 ath_stoprecv(sc);
1266                 ath9k_hw_phy_disable(ah);
1267         } else
1268                 sc->rx.rxlink = NULL;
1269
1270         if (sc->rx.frag) {
1271                 dev_kfree_skb_any(sc->rx.frag);
1272                 sc->rx.frag = NULL;
1273         }
1274
1275         /* disable HAL and put h/w to sleep */
1276         ath9k_hw_disable(ah);
1277
1278         spin_unlock_bh(&sc->sc_pcu_lock);
1279
1280         /* we can now sync irq and kill any running tasklets, since we already
1281          * disabled interrupts and not holding a spin lock */
1282         synchronize_irq(sc->irq);
1283         tasklet_kill(&sc->intr_tq);
1284         tasklet_kill(&sc->bcon_tasklet);
1285
1286         ath9k_ps_restore(sc);
1287
1288         sc->ps_idle = true;
1289         ath_radio_disable(sc, hw);
1290
1291         sc->sc_flags |= SC_OP_INVALID;
1292
1293         mutex_unlock(&sc->mutex);
1294
1295         ath_dbg(common, ATH_DBG_CONFIG, "Driver halt\n");
1296 }
1297
1298 bool ath9k_uses_beacons(int type)
1299 {
1300         switch (type) {
1301         case NL80211_IFTYPE_AP:
1302         case NL80211_IFTYPE_ADHOC:
1303         case NL80211_IFTYPE_MESH_POINT:
1304                 return true;
1305         default:
1306                 return false;
1307         }
1308 }
1309
1310 static void ath9k_reclaim_beacon(struct ath_softc *sc,
1311                                  struct ieee80211_vif *vif)
1312 {
1313         struct ath_vif *avp = (void *)vif->drv_priv;
1314
1315         ath9k_set_beaconing_status(sc, false);
1316         ath_beacon_return(sc, avp);
1317         ath9k_set_beaconing_status(sc, true);
1318         sc->sc_flags &= ~SC_OP_BEACONS;
1319 }
1320
1321 static void ath9k_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
1322 {
1323         struct ath9k_vif_iter_data *iter_data = data;
1324         int i;
1325
1326         if (iter_data->hw_macaddr)
1327                 for (i = 0; i < ETH_ALEN; i++)
1328                         iter_data->mask[i] &=
1329                                 ~(iter_data->hw_macaddr[i] ^ mac[i]);
1330
1331         switch (vif->type) {
1332         case NL80211_IFTYPE_AP:
1333                 iter_data->naps++;
1334                 break;
1335         case NL80211_IFTYPE_STATION:
1336                 iter_data->nstations++;
1337                 break;
1338         case NL80211_IFTYPE_ADHOC:
1339                 iter_data->nadhocs++;
1340                 break;
1341         case NL80211_IFTYPE_MESH_POINT:
1342                 iter_data->nmeshes++;
1343                 break;
1344         case NL80211_IFTYPE_WDS:
1345                 iter_data->nwds++;
1346                 break;
1347         default:
1348                 iter_data->nothers++;
1349                 break;
1350         }
1351 }
1352
1353 /* Called with sc->mutex held. */
1354 void ath9k_calculate_iter_data(struct ieee80211_hw *hw,
1355                                struct ieee80211_vif *vif,
1356                                struct ath9k_vif_iter_data *iter_data)
1357 {
1358         struct ath_softc *sc = hw->priv;
1359         struct ath_hw *ah = sc->sc_ah;
1360         struct ath_common *common = ath9k_hw_common(ah);
1361
1362         /*
1363          * Pick the MAC address of the first interface as the new hardware
1364          * MAC address. The hardware will use it together with the BSSID mask
1365          * when matching addresses.
1366          */
1367         memset(iter_data, 0, sizeof(*iter_data));
1368         iter_data->hw_macaddr = common->macaddr;
1369         memset(&iter_data->mask, 0xff, ETH_ALEN);
1370
1371         if (vif)
1372                 ath9k_vif_iter(iter_data, vif->addr, vif);
1373
1374         /* Get list of all active MAC addresses */
1375         ieee80211_iterate_active_interfaces_atomic(sc->hw, ath9k_vif_iter,
1376                                                    iter_data);
1377 }
1378
1379 /* Called with sc->mutex held. */
1380 static void ath9k_calculate_summary_state(struct ieee80211_hw *hw,
1381                                           struct ieee80211_vif *vif)
1382 {
1383         struct ath_softc *sc = hw->priv;
1384         struct ath_hw *ah = sc->sc_ah;
1385         struct ath_common *common = ath9k_hw_common(ah);
1386         struct ath9k_vif_iter_data iter_data;
1387
1388         ath9k_calculate_iter_data(hw, vif, &iter_data);
1389
1390         /* Set BSSID mask. */
1391         memcpy(common->bssidmask, iter_data.mask, ETH_ALEN);
1392         ath_hw_setbssidmask(common);
1393
1394         /* Set op-mode & TSF */
1395         if (iter_data.naps > 0) {
1396                 ath9k_hw_set_tsfadjust(ah, 1);
1397                 sc->sc_flags |= SC_OP_TSF_RESET;
1398                 ah->opmode = NL80211_IFTYPE_AP;
1399         } else {
1400                 ath9k_hw_set_tsfadjust(ah, 0);
1401                 sc->sc_flags &= ~SC_OP_TSF_RESET;
1402
1403                 if (iter_data.nmeshes)
1404                         ah->opmode = NL80211_IFTYPE_MESH_POINT;
1405                 else if (iter_data.nwds)
1406                         ah->opmode = NL80211_IFTYPE_AP;
1407                 else if (iter_data.nadhocs)
1408                         ah->opmode = NL80211_IFTYPE_ADHOC;
1409                 else
1410                         ah->opmode = NL80211_IFTYPE_STATION;
1411         }
1412
1413         /*
1414          * Enable MIB interrupts when there are hardware phy counters.
1415          */
1416         if ((iter_data.nstations + iter_data.nadhocs + iter_data.nmeshes) > 0) {
1417                 if (ah->config.enable_ani)
1418                         ah->imask |= ATH9K_INT_MIB;
1419                 ah->imask |= ATH9K_INT_TSFOOR;
1420         } else {
1421                 ah->imask &= ~ATH9K_INT_MIB;
1422                 ah->imask &= ~ATH9K_INT_TSFOOR;
1423         }
1424
1425         ath9k_hw_set_interrupts(ah);
1426
1427         /* Set up ANI */
1428         if (iter_data.naps > 0) {
1429                 sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
1430
1431                 if (!common->disable_ani) {
1432                         sc->sc_flags |= SC_OP_ANI_RUN;
1433                         ath_start_ani(common);
1434                 }
1435
1436         } else {
1437                 sc->sc_flags &= ~SC_OP_ANI_RUN;
1438                 del_timer_sync(&common->ani.timer);
1439         }
1440 }
1441
1442 /* Called with sc->mutex held, vif counts set up properly. */
1443 static void ath9k_do_vif_add_setup(struct ieee80211_hw *hw,
1444                                    struct ieee80211_vif *vif)
1445 {
1446         struct ath_softc *sc = hw->priv;
1447
1448         ath9k_calculate_summary_state(hw, vif);
1449
1450         if (ath9k_uses_beacons(vif->type)) {
1451                 int error;
1452                 /* This may fail because upper levels do not have beacons
1453                  * properly configured yet.  That's OK, we assume it
1454                  * will be properly configured and then we will be notified
1455                  * in the info_changed method and set up beacons properly
1456                  * there.
1457                  */
1458                 ath9k_set_beaconing_status(sc, false);
1459                 error = ath_beacon_alloc(sc, vif);
1460                 if (!error)
1461                         ath_beacon_config(sc, vif);
1462                 ath9k_set_beaconing_status(sc, true);
1463         }
1464 }
1465
1466
1467 static int ath9k_add_interface(struct ieee80211_hw *hw,
1468                                struct ieee80211_vif *vif)
1469 {
1470         struct ath_softc *sc = hw->priv;
1471         struct ath_hw *ah = sc->sc_ah;
1472         struct ath_common *common = ath9k_hw_common(ah);
1473         int ret = 0;
1474
1475         ath9k_ps_wakeup(sc);
1476         mutex_lock(&sc->mutex);
1477
1478         switch (vif->type) {
1479         case NL80211_IFTYPE_STATION:
1480         case NL80211_IFTYPE_WDS:
1481         case NL80211_IFTYPE_ADHOC:
1482         case NL80211_IFTYPE_AP:
1483         case NL80211_IFTYPE_MESH_POINT:
1484                 break;
1485         default:
1486                 ath_err(common, "Interface type %d not yet supported\n",
1487                         vif->type);
1488                 ret = -EOPNOTSUPP;
1489                 goto out;
1490         }
1491
1492         if (ath9k_uses_beacons(vif->type)) {
1493                 if (sc->nbcnvifs >= ATH_BCBUF) {
1494                         ath_err(common, "Not enough beacon buffers when adding"
1495                                 " new interface of type: %i\n",
1496                                 vif->type);
1497                         ret = -ENOBUFS;
1498                         goto out;
1499                 }
1500         }
1501
1502         ath_dbg(common, ATH_DBG_CONFIG,
1503                 "Attach a VIF of type: %d\n", vif->type);
1504
1505         sc->nvifs++;
1506
1507         ath9k_do_vif_add_setup(hw, vif);
1508 out:
1509         mutex_unlock(&sc->mutex);
1510         ath9k_ps_restore(sc);
1511         return ret;
1512 }
1513
1514 static int ath9k_change_interface(struct ieee80211_hw *hw,
1515                                   struct ieee80211_vif *vif,
1516                                   enum nl80211_iftype new_type,
1517                                   bool p2p)
1518 {
1519         struct ath_softc *sc = hw->priv;
1520         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1521         int ret = 0;
1522
1523         ath_dbg(common, ATH_DBG_CONFIG, "Change Interface\n");
1524         mutex_lock(&sc->mutex);
1525         ath9k_ps_wakeup(sc);
1526
1527         /* See if new interface type is valid. */
1528         if ((new_type == NL80211_IFTYPE_ADHOC) &&
1529             (sc->nvifs > 1)) {
1530                 ath_err(common, "When using ADHOC, it must be the only"
1531                         " interface.\n");
1532                 ret = -EINVAL;
1533                 goto out;
1534         }
1535
1536         if (ath9k_uses_beacons(new_type) &&
1537             !ath9k_uses_beacons(vif->type)) {
1538                 if (sc->nbcnvifs >= ATH_BCBUF) {
1539                         ath_err(common, "No beacon slot available\n");
1540                         ret = -ENOBUFS;
1541                         goto out;
1542                 }
1543         }
1544
1545         /* Clean up old vif stuff */
1546         if (ath9k_uses_beacons(vif->type))
1547                 ath9k_reclaim_beacon(sc, vif);
1548
1549         /* Add new settings */
1550         vif->type = new_type;
1551         vif->p2p = p2p;
1552
1553         ath9k_do_vif_add_setup(hw, vif);
1554 out:
1555         ath9k_ps_restore(sc);
1556         mutex_unlock(&sc->mutex);
1557         return ret;
1558 }
1559
1560 static void ath9k_remove_interface(struct ieee80211_hw *hw,
1561                                    struct ieee80211_vif *vif)
1562 {
1563         struct ath_softc *sc = hw->priv;
1564         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1565
1566         ath_dbg(common, ATH_DBG_CONFIG, "Detach Interface\n");
1567
1568         ath9k_ps_wakeup(sc);
1569         mutex_lock(&sc->mutex);
1570
1571         sc->nvifs--;
1572
1573         /* Reclaim beacon resources */
1574         if (ath9k_uses_beacons(vif->type))
1575                 ath9k_reclaim_beacon(sc, vif);
1576
1577         ath9k_calculate_summary_state(hw, NULL);
1578
1579         mutex_unlock(&sc->mutex);
1580         ath9k_ps_restore(sc);
1581 }
1582
1583 static void ath9k_enable_ps(struct ath_softc *sc)
1584 {
1585         struct ath_hw *ah = sc->sc_ah;
1586
1587         sc->ps_enabled = true;
1588         if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
1589                 if ((ah->imask & ATH9K_INT_TIM_TIMER) == 0) {
1590                         ah->imask |= ATH9K_INT_TIM_TIMER;
1591                         ath9k_hw_set_interrupts(ah);
1592                 }
1593                 ath9k_hw_setrxabort(ah, 1);
1594         }
1595 }
1596
1597 static void ath9k_disable_ps(struct ath_softc *sc)
1598 {
1599         struct ath_hw *ah = sc->sc_ah;
1600
1601         sc->ps_enabled = false;
1602         ath9k_hw_setpower(ah, ATH9K_PM_AWAKE);
1603         if (!(ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP)) {
1604                 ath9k_hw_setrxabort(ah, 0);
1605                 sc->ps_flags &= ~(PS_WAIT_FOR_BEACON |
1606                                   PS_WAIT_FOR_CAB |
1607                                   PS_WAIT_FOR_PSPOLL_DATA |
1608                                   PS_WAIT_FOR_TX_ACK);
1609                 if (ah->imask & ATH9K_INT_TIM_TIMER) {
1610                         ah->imask &= ~ATH9K_INT_TIM_TIMER;
1611                         ath9k_hw_set_interrupts(ah);
1612                 }
1613         }
1614
1615 }
1616
1617 static int ath9k_config(struct ieee80211_hw *hw, u32 changed)
1618 {
1619         struct ath_softc *sc = hw->priv;
1620         struct ath_hw *ah = sc->sc_ah;
1621         struct ath_common *common = ath9k_hw_common(ah);
1622         struct ieee80211_conf *conf = &hw->conf;
1623         bool disable_radio = false;
1624
1625         mutex_lock(&sc->mutex);
1626
1627         /*
1628          * Leave this as the first check because we need to turn on the
1629          * radio if it was disabled before prior to processing the rest
1630          * of the changes. Likewise we must only disable the radio towards
1631          * the end.
1632          */
1633         if (changed & IEEE80211_CONF_CHANGE_IDLE) {
1634                 sc->ps_idle = !!(conf->flags & IEEE80211_CONF_IDLE);
1635                 if (!sc->ps_idle) {
1636                         ath_radio_enable(sc, hw);
1637                         ath_dbg(common, ATH_DBG_CONFIG,
1638                                 "not-idle: enabling radio\n");
1639                 } else {
1640                         disable_radio = true;
1641                 }
1642         }
1643
1644         /*
1645          * We just prepare to enable PS. We have to wait until our AP has
1646          * ACK'd our null data frame to disable RX otherwise we'll ignore
1647          * those ACKs and end up retransmitting the same null data frames.
1648          * IEEE80211_CONF_CHANGE_PS is only passed by mac80211 for STA mode.
1649          */
1650         if (changed & IEEE80211_CONF_CHANGE_PS) {
1651                 unsigned long flags;
1652                 spin_lock_irqsave(&sc->sc_pm_lock, flags);
1653                 if (conf->flags & IEEE80211_CONF_PS)
1654                         ath9k_enable_ps(sc);
1655                 else
1656                         ath9k_disable_ps(sc);
1657                 spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1658         }
1659
1660         if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
1661                 if (conf->flags & IEEE80211_CONF_MONITOR) {
1662                         ath_dbg(common, ATH_DBG_CONFIG,
1663                                 "Monitor mode is enabled\n");
1664                         sc->sc_ah->is_monitoring = true;
1665                 } else {
1666                         ath_dbg(common, ATH_DBG_CONFIG,
1667                                 "Monitor mode is disabled\n");
1668                         sc->sc_ah->is_monitoring = false;
1669                 }
1670         }
1671
1672         if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1673                 struct ieee80211_channel *curchan = hw->conf.channel;
1674                 int pos = curchan->hw_value;
1675                 int old_pos = -1;
1676                 unsigned long flags;
1677
1678                 if (ah->curchan)
1679                         old_pos = ah->curchan - &ah->channels[0];
1680
1681                 if (hw->conf.flags & IEEE80211_CONF_OFFCHANNEL)
1682                         sc->sc_flags |= SC_OP_OFFCHANNEL;
1683                 else
1684                         sc->sc_flags &= ~SC_OP_OFFCHANNEL;
1685
1686                 ath_dbg(common, ATH_DBG_CONFIG,
1687                         "Set channel: %d MHz type: %d\n",
1688                         curchan->center_freq, conf->channel_type);
1689
1690                 /* update survey stats for the old channel before switching */
1691                 spin_lock_irqsave(&common->cc_lock, flags);
1692                 ath_update_survey_stats(sc);
1693                 spin_unlock_irqrestore(&common->cc_lock, flags);
1694
1695                 ath9k_cmn_update_ichannel(&sc->sc_ah->channels[pos],
1696                                           curchan, conf->channel_type);
1697
1698                 /*
1699                  * If the operating channel changes, change the survey in-use flags
1700                  * along with it.
1701                  * Reset the survey data for the new channel, unless we're switching
1702                  * back to the operating channel from an off-channel operation.
1703                  */
1704                 if (!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL) &&
1705                     sc->cur_survey != &sc->survey[pos]) {
1706
1707                         if (sc->cur_survey)
1708                                 sc->cur_survey->filled &= ~SURVEY_INFO_IN_USE;
1709
1710                         sc->cur_survey = &sc->survey[pos];
1711
1712                         memset(sc->cur_survey, 0, sizeof(struct survey_info));
1713                         sc->cur_survey->filled |= SURVEY_INFO_IN_USE;
1714                 } else if (!(sc->survey[pos].filled & SURVEY_INFO_IN_USE)) {
1715                         memset(&sc->survey[pos], 0, sizeof(struct survey_info));
1716                 }
1717
1718                 if (ath_set_channel(sc, hw, &sc->sc_ah->channels[pos]) < 0) {
1719                         ath_err(common, "Unable to set channel\n");
1720                         mutex_unlock(&sc->mutex);
1721                         return -EINVAL;
1722                 }
1723
1724                 /*
1725                  * The most recent snapshot of channel->noisefloor for the old
1726                  * channel is only available after the hardware reset. Copy it to
1727                  * the survey stats now.
1728                  */
1729                 if (old_pos >= 0)
1730                         ath_update_survey_nf(sc, old_pos);
1731         }
1732
1733         if (changed & IEEE80211_CONF_CHANGE_POWER) {
1734                 ath_dbg(common, ATH_DBG_CONFIG,
1735                         "Set power: %d\n", conf->power_level);
1736                 sc->config.txpowlimit = 2 * conf->power_level;
1737                 ath9k_ps_wakeup(sc);
1738                 ath9k_cmn_update_txpow(ah, sc->curtxpow,
1739                                        sc->config.txpowlimit, &sc->curtxpow);
1740                 ath9k_ps_restore(sc);
1741         }
1742
1743         if (disable_radio) {
1744                 ath_dbg(common, ATH_DBG_CONFIG, "idle: disabling radio\n");
1745                 ath_radio_disable(sc, hw);
1746         }
1747
1748         mutex_unlock(&sc->mutex);
1749
1750         return 0;
1751 }
1752
1753 #define SUPPORTED_FILTERS                       \
1754         (FIF_PROMISC_IN_BSS |                   \
1755         FIF_ALLMULTI |                          \
1756         FIF_CONTROL |                           \
1757         FIF_PSPOLL |                            \
1758         FIF_OTHER_BSS |                         \
1759         FIF_BCN_PRBRESP_PROMISC |               \
1760         FIF_PROBE_REQ |                         \
1761         FIF_FCSFAIL)
1762
1763 /* FIXME: sc->sc_full_reset ? */
1764 static void ath9k_configure_filter(struct ieee80211_hw *hw,
1765                                    unsigned int changed_flags,
1766                                    unsigned int *total_flags,
1767                                    u64 multicast)
1768 {
1769         struct ath_softc *sc = hw->priv;
1770         u32 rfilt;
1771
1772         changed_flags &= SUPPORTED_FILTERS;
1773         *total_flags &= SUPPORTED_FILTERS;
1774
1775         sc->rx.rxfilter = *total_flags;
1776         ath9k_ps_wakeup(sc);
1777         rfilt = ath_calcrxfilter(sc);
1778         ath9k_hw_setrxfilter(sc->sc_ah, rfilt);
1779         ath9k_ps_restore(sc);
1780
1781         ath_dbg(ath9k_hw_common(sc->sc_ah), ATH_DBG_CONFIG,
1782                 "Set HW RX filter: 0x%x\n", rfilt);
1783 }
1784
1785 static int ath9k_sta_add(struct ieee80211_hw *hw,
1786                          struct ieee80211_vif *vif,
1787                          struct ieee80211_sta *sta)
1788 {
1789         struct ath_softc *sc = hw->priv;
1790         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1791         struct ath_node *an = (struct ath_node *) sta->drv_priv;
1792         struct ieee80211_key_conf ps_key = { };
1793         int key;
1794
1795         ath_node_attach(sc, sta);
1796
1797         if (vif->type != NL80211_IFTYPE_AP &&
1798             vif->type != NL80211_IFTYPE_AP_VLAN)
1799                 return 0;
1800
1801         key = ath_key_config(common, vif, sta, &ps_key);
1802         if (key > 0)
1803                 an->ps_key = key;
1804
1805         return 0;
1806 }
1807
1808 static void ath9k_del_ps_key(struct ath_softc *sc,
1809                              struct ieee80211_vif *vif,
1810                              struct ieee80211_sta *sta)
1811 {
1812         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1813         struct ath_node *an = (struct ath_node *) sta->drv_priv;
1814         struct ieee80211_key_conf ps_key = { .hw_key_idx = an->ps_key };
1815
1816         if (!an->ps_key)
1817             return;
1818
1819         ath_key_delete(common, &ps_key);
1820         an->ps_key = 0;
1821 }
1822
1823 static int ath9k_sta_remove(struct ieee80211_hw *hw,
1824                             struct ieee80211_vif *vif,
1825                             struct ieee80211_sta *sta)
1826 {
1827         struct ath_softc *sc = hw->priv;
1828
1829         ath9k_del_ps_key(sc, vif, sta);
1830         ath_node_detach(sc, sta);
1831
1832         return 0;
1833 }
1834
1835 static void ath9k_sta_notify(struct ieee80211_hw *hw,
1836                          struct ieee80211_vif *vif,
1837                          enum sta_notify_cmd cmd,
1838                          struct ieee80211_sta *sta)
1839 {
1840         struct ath_softc *sc = hw->priv;
1841         struct ath_node *an = (struct ath_node *) sta->drv_priv;
1842
1843         if (!(sc->sc_flags & SC_OP_TXAGGR))
1844                 return;
1845
1846         switch (cmd) {
1847         case STA_NOTIFY_SLEEP:
1848                 an->sleeping = true;
1849                 ath_tx_aggr_sleep(sta, sc, an);
1850                 break;
1851         case STA_NOTIFY_AWAKE:
1852                 an->sleeping = false;
1853                 ath_tx_aggr_wakeup(sc, an);
1854                 break;
1855         }
1856 }
1857
1858 static int ath9k_conf_tx(struct ieee80211_hw *hw,
1859                          struct ieee80211_vif *vif, u16 queue,
1860                          const struct ieee80211_tx_queue_params *params)
1861 {
1862         struct ath_softc *sc = hw->priv;
1863         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1864         struct ath_txq *txq;
1865         struct ath9k_tx_queue_info qi;
1866         int ret = 0;
1867
1868         if (queue >= WME_NUM_AC)
1869                 return 0;
1870
1871         txq = sc->tx.txq_map[queue];
1872
1873         ath9k_ps_wakeup(sc);
1874         mutex_lock(&sc->mutex);
1875
1876         memset(&qi, 0, sizeof(struct ath9k_tx_queue_info));
1877
1878         qi.tqi_aifs = params->aifs;
1879         qi.tqi_cwmin = params->cw_min;
1880         qi.tqi_cwmax = params->cw_max;
1881         qi.tqi_burstTime = params->txop;
1882
1883         ath_dbg(common, ATH_DBG_CONFIG,
1884                 "Configure tx [queue/halq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n",
1885                 queue, txq->axq_qnum, params->aifs, params->cw_min,
1886                 params->cw_max, params->txop);
1887
1888         ret = ath_txq_update(sc, txq->axq_qnum, &qi);
1889         if (ret)
1890                 ath_err(common, "TXQ Update failed\n");
1891
1892         if (sc->sc_ah->opmode == NL80211_IFTYPE_ADHOC)
1893                 if (queue == WME_AC_BE && !ret)
1894                         ath_beaconq_config(sc);
1895
1896         mutex_unlock(&sc->mutex);
1897         ath9k_ps_restore(sc);
1898
1899         return ret;
1900 }
1901
1902 static int ath9k_set_key(struct ieee80211_hw *hw,
1903                          enum set_key_cmd cmd,
1904                          struct ieee80211_vif *vif,
1905                          struct ieee80211_sta *sta,
1906                          struct ieee80211_key_conf *key)
1907 {
1908         struct ath_softc *sc = hw->priv;
1909         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1910         int ret = 0;
1911
1912         if (ath9k_modparam_nohwcrypt)
1913                 return -ENOSPC;
1914
1915         if (vif->type == NL80211_IFTYPE_ADHOC &&
1916             (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
1917              key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
1918             !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) {
1919                 /*
1920                  * For now, disable hw crypto for the RSN IBSS group keys. This
1921                  * could be optimized in the future to use a modified key cache
1922                  * design to support per-STA RX GTK, but until that gets
1923                  * implemented, use of software crypto for group addressed
1924                  * frames is a acceptable to allow RSN IBSS to be used.
1925                  */
1926                 return -EOPNOTSUPP;
1927         }
1928
1929         mutex_lock(&sc->mutex);
1930         ath9k_ps_wakeup(sc);
1931         ath_dbg(common, ATH_DBG_CONFIG, "Set HW Key\n");
1932
1933         switch (cmd) {
1934         case SET_KEY:
1935                 if (sta)
1936                         ath9k_del_ps_key(sc, vif, sta);
1937
1938                 ret = ath_key_config(common, vif, sta, key);
1939                 if (ret >= 0) {
1940                         key->hw_key_idx = ret;
1941                         /* push IV and Michael MIC generation to stack */
1942                         key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
1943                         if (key->cipher == WLAN_CIPHER_SUITE_TKIP)
1944                                 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
1945                         if (sc->sc_ah->sw_mgmt_crypto &&
1946                             key->cipher == WLAN_CIPHER_SUITE_CCMP)
1947                                 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT;
1948                         ret = 0;
1949                 }
1950                 break;
1951         case DISABLE_KEY:
1952                 ath_key_delete(common, key);
1953                 break;
1954         default:
1955                 ret = -EINVAL;
1956         }
1957
1958         ath9k_ps_restore(sc);
1959         mutex_unlock(&sc->mutex);
1960
1961         return ret;
1962 }
1963 static void ath9k_bss_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
1964 {
1965         struct ath_softc *sc = data;
1966         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1967         struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
1968         struct ath_vif *avp = (void *)vif->drv_priv;
1969
1970         /*
1971          * Skip iteration if primary station vif's bss info
1972          * was not changed
1973          */
1974         if (sc->sc_flags & SC_OP_PRIM_STA_VIF)
1975                 return;
1976
1977         if (bss_conf->assoc) {
1978                 sc->sc_flags |= SC_OP_PRIM_STA_VIF;
1979                 avp->primary_sta_vif = true;
1980                 memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
1981                 common->curaid = bss_conf->aid;
1982                 ath9k_hw_write_associd(sc->sc_ah);
1983                 ath_dbg(common, ATH_DBG_CONFIG,
1984                                 "Bss Info ASSOC %d, bssid: %pM\n",
1985                                 bss_conf->aid, common->curbssid);
1986                 ath_beacon_config(sc, vif);
1987                 /*
1988                  * Request a re-configuration of Beacon related timers
1989                  * on the receipt of the first Beacon frame (i.e.,
1990                  * after time sync with the AP).
1991                  */
1992                 sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
1993                 /* Reset rssi stats */
1994                 sc->last_rssi = ATH_RSSI_DUMMY_MARKER;
1995                 sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
1996
1997                 if (!common->disable_ani) {
1998                         sc->sc_flags |= SC_OP_ANI_RUN;
1999                         ath_start_ani(common);
2000                 }
2001
2002         }
2003 }
2004
2005 static void ath9k_config_bss(struct ath_softc *sc, struct ieee80211_vif *vif)
2006 {
2007         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2008         struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
2009         struct ath_vif *avp = (void *)vif->drv_priv;
2010
2011         if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
2012                 return;
2013
2014         /* Reconfigure bss info */
2015         if (avp->primary_sta_vif && !bss_conf->assoc) {
2016                 ath_dbg(common, ATH_DBG_CONFIG,
2017                         "Bss Info DISASSOC %d, bssid %pM\n",
2018                         common->curaid, common->curbssid);
2019                 sc->sc_flags &= ~(SC_OP_PRIM_STA_VIF | SC_OP_BEACONS);
2020                 avp->primary_sta_vif = false;
2021                 memset(common->curbssid, 0, ETH_ALEN);
2022                 common->curaid = 0;
2023         }
2024
2025         ieee80211_iterate_active_interfaces_atomic(
2026                         sc->hw, ath9k_bss_iter, sc);
2027
2028         /*
2029          * None of station vifs are associated.
2030          * Clear bssid & aid
2031          */
2032         if (!(sc->sc_flags & SC_OP_PRIM_STA_VIF)) {
2033                 ath9k_hw_write_associd(sc->sc_ah);
2034                 /* Stop ANI */
2035                 sc->sc_flags &= ~SC_OP_ANI_RUN;
2036                 del_timer_sync(&common->ani.timer);
2037                 memset(&sc->caldata, 0, sizeof(sc->caldata));
2038         }
2039 }
2040
2041 static void ath9k_bss_info_changed(struct ieee80211_hw *hw,
2042                                    struct ieee80211_vif *vif,
2043                                    struct ieee80211_bss_conf *bss_conf,
2044                                    u32 changed)
2045 {
2046         struct ath_softc *sc = hw->priv;
2047         struct ath_hw *ah = sc->sc_ah;
2048         struct ath_common *common = ath9k_hw_common(ah);
2049         struct ath_vif *avp = (void *)vif->drv_priv;
2050         int slottime;
2051         int error;
2052
2053         ath9k_ps_wakeup(sc);
2054         mutex_lock(&sc->mutex);
2055
2056         if (changed & BSS_CHANGED_BSSID) {
2057                 ath9k_config_bss(sc, vif);
2058
2059                 ath_dbg(common, ATH_DBG_CONFIG, "BSSID: %pM aid: 0x%x\n",
2060                         common->curbssid, common->curaid);
2061         }
2062
2063         if (changed & BSS_CHANGED_IBSS) {
2064                 /* There can be only one vif available */
2065                 memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN);
2066                 common->curaid = bss_conf->aid;
2067                 ath9k_hw_write_associd(sc->sc_ah);
2068
2069                 if (bss_conf->ibss_joined) {
2070                         sc->sc_ah->stats.avgbrssi = ATH_RSSI_DUMMY_MARKER;
2071
2072                         if (!common->disable_ani) {
2073                                 sc->sc_flags |= SC_OP_ANI_RUN;
2074                                 ath_start_ani(common);
2075                         }
2076
2077                 } else {
2078                         sc->sc_flags &= ~SC_OP_ANI_RUN;
2079                         del_timer_sync(&common->ani.timer);
2080                 }
2081         }
2082
2083         /* Enable transmission of beacons (AP, IBSS, MESH) */
2084         if ((changed & BSS_CHANGED_BEACON) ||
2085             ((changed & BSS_CHANGED_BEACON_ENABLED) && bss_conf->enable_beacon)) {
2086                 ath9k_set_beaconing_status(sc, false);
2087                 error = ath_beacon_alloc(sc, vif);
2088                 if (!error)
2089                         ath_beacon_config(sc, vif);
2090                 ath9k_set_beaconing_status(sc, true);
2091         }
2092
2093         if (changed & BSS_CHANGED_ERP_SLOT) {
2094                 if (bss_conf->use_short_slot)
2095                         slottime = 9;
2096                 else
2097                         slottime = 20;
2098                 if (vif->type == NL80211_IFTYPE_AP) {
2099                         /*
2100                          * Defer update, so that connected stations can adjust
2101                          * their settings at the same time.
2102                          * See beacon.c for more details
2103                          */
2104                         sc->beacon.slottime = slottime;
2105                         sc->beacon.updateslot = UPDATE;
2106                 } else {
2107                         ah->slottime = slottime;
2108                         ath9k_hw_init_global_settings(ah);
2109                 }
2110         }
2111
2112         /* Disable transmission of beacons */
2113         if ((changed & BSS_CHANGED_BEACON_ENABLED) &&
2114             !bss_conf->enable_beacon) {
2115                 ath9k_set_beaconing_status(sc, false);
2116                 avp->is_bslot_active = false;
2117                 ath9k_set_beaconing_status(sc, true);
2118         }
2119
2120         if (changed & BSS_CHANGED_BEACON_INT) {
2121                 /*
2122                  * In case of AP mode, the HW TSF has to be reset
2123                  * when the beacon interval changes.
2124                  */
2125                 if (vif->type == NL80211_IFTYPE_AP) {
2126                         sc->sc_flags |= SC_OP_TSF_RESET;
2127                         ath9k_set_beaconing_status(sc, false);
2128                         error = ath_beacon_alloc(sc, vif);
2129                         if (!error)
2130                                 ath_beacon_config(sc, vif);
2131                         ath9k_set_beaconing_status(sc, true);
2132                 } else
2133                         ath_beacon_config(sc, vif);
2134         }
2135
2136         if (changed & BSS_CHANGED_ERP_PREAMBLE) {
2137                 ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed PREAMBLE %d\n",
2138                         bss_conf->use_short_preamble);
2139                 if (bss_conf->use_short_preamble)
2140                         sc->sc_flags |= SC_OP_PREAMBLE_SHORT;
2141                 else
2142                         sc->sc_flags &= ~SC_OP_PREAMBLE_SHORT;
2143         }
2144
2145         if (changed & BSS_CHANGED_ERP_CTS_PROT) {
2146                 ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n",
2147                         bss_conf->use_cts_prot);
2148                 if (bss_conf->use_cts_prot &&
2149                     hw->conf.channel->band != IEEE80211_BAND_5GHZ)
2150                         sc->sc_flags |= SC_OP_PROTECT_ENABLE;
2151                 else
2152                         sc->sc_flags &= ~SC_OP_PROTECT_ENABLE;
2153         }
2154
2155         mutex_unlock(&sc->mutex);
2156         ath9k_ps_restore(sc);
2157 }
2158
2159 static u64 ath9k_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
2160 {
2161         struct ath_softc *sc = hw->priv;
2162         u64 tsf;
2163
2164         mutex_lock(&sc->mutex);
2165         ath9k_ps_wakeup(sc);
2166         tsf = ath9k_hw_gettsf64(sc->sc_ah);
2167         ath9k_ps_restore(sc);
2168         mutex_unlock(&sc->mutex);
2169
2170         return tsf;
2171 }
2172
2173 static void ath9k_set_tsf(struct ieee80211_hw *hw,
2174                           struct ieee80211_vif *vif,
2175                           u64 tsf)
2176 {
2177         struct ath_softc *sc = hw->priv;
2178
2179         mutex_lock(&sc->mutex);
2180         ath9k_ps_wakeup(sc);
2181         ath9k_hw_settsf64(sc->sc_ah, tsf);
2182         ath9k_ps_restore(sc);
2183         mutex_unlock(&sc->mutex);
2184 }
2185
2186 static void ath9k_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
2187 {
2188         struct ath_softc *sc = hw->priv;
2189
2190         mutex_lock(&sc->mutex);
2191
2192         ath9k_ps_wakeup(sc);
2193         ath9k_hw_reset_tsf(sc->sc_ah);
2194         ath9k_ps_restore(sc);
2195
2196         mutex_unlock(&sc->mutex);
2197 }
2198
2199 static int ath9k_ampdu_action(struct ieee80211_hw *hw,
2200                               struct ieee80211_vif *vif,
2201                               enum ieee80211_ampdu_mlme_action action,
2202                               struct ieee80211_sta *sta,
2203                               u16 tid, u16 *ssn, u8 buf_size)
2204 {
2205         struct ath_softc *sc = hw->priv;
2206         int ret = 0;
2207
2208         local_bh_disable();
2209
2210         switch (action) {
2211         case IEEE80211_AMPDU_RX_START:
2212                 if (!(sc->sc_flags & SC_OP_RXAGGR))
2213                         ret = -ENOTSUPP;
2214                 break;
2215         case IEEE80211_AMPDU_RX_STOP:
2216                 break;
2217         case IEEE80211_AMPDU_TX_START:
2218                 if (!(sc->sc_flags & SC_OP_TXAGGR))
2219                         return -EOPNOTSUPP;
2220
2221                 ath9k_ps_wakeup(sc);
2222                 ret = ath_tx_aggr_start(sc, sta, tid, ssn);
2223                 if (!ret)
2224                         ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2225                 ath9k_ps_restore(sc);
2226                 break;
2227         case IEEE80211_AMPDU_TX_STOP:
2228                 ath9k_ps_wakeup(sc);
2229                 ath_tx_aggr_stop(sc, sta, tid);
2230                 ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
2231                 ath9k_ps_restore(sc);
2232                 break;
2233         case IEEE80211_AMPDU_TX_OPERATIONAL:
2234                 ath9k_ps_wakeup(sc);
2235                 ath_tx_aggr_resume(sc, sta, tid);
2236                 ath9k_ps_restore(sc);
2237                 break;
2238         default:
2239                 ath_err(ath9k_hw_common(sc->sc_ah), "Unknown AMPDU action\n");
2240         }
2241
2242         local_bh_enable();
2243
2244         return ret;
2245 }
2246
2247 static int ath9k_get_survey(struct ieee80211_hw *hw, int idx,
2248                              struct survey_info *survey)
2249 {
2250         struct ath_softc *sc = hw->priv;
2251         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
2252         struct ieee80211_supported_band *sband;
2253         struct ieee80211_channel *chan;
2254         unsigned long flags;
2255         int pos;
2256
2257         spin_lock_irqsave(&common->cc_lock, flags);
2258         if (idx == 0)
2259                 ath_update_survey_stats(sc);
2260
2261         sband = hw->wiphy->bands[IEEE80211_BAND_2GHZ];
2262         if (sband && idx >= sband->n_channels) {
2263                 idx -= sband->n_channels;
2264                 sband = NULL;
2265         }
2266
2267         if (!sband)
2268                 sband = hw->wiphy->bands[IEEE80211_BAND_5GHZ];
2269
2270         if (!sband || idx >= sband->n_channels) {
2271                 spin_unlock_irqrestore(&common->cc_lock, flags);
2272                 return -ENOENT;
2273         }
2274
2275         chan = &sband->channels[idx];
2276         pos = chan->hw_value;
2277         memcpy(survey, &sc->survey[pos], sizeof(*survey));
2278         survey->channel = chan;
2279         spin_unlock_irqrestore(&common->cc_lock, flags);
2280
2281         return 0;
2282 }
2283
2284 static void ath9k_set_coverage_class(struct ieee80211_hw *hw, u8 coverage_class)
2285 {
2286         struct ath_softc *sc = hw->priv;
2287         struct ath_hw *ah = sc->sc_ah;
2288
2289         mutex_lock(&sc->mutex);
2290         ah->coverage_class = coverage_class;
2291
2292         ath9k_ps_wakeup(sc);
2293         ath9k_hw_init_global_settings(ah);
2294         ath9k_ps_restore(sc);
2295
2296         mutex_unlock(&sc->mutex);
2297 }
2298
2299 static void ath9k_flush(struct ieee80211_hw *hw, bool drop)
2300 {
2301         struct ath_softc *sc = hw->priv;
2302         struct ath_hw *ah = sc->sc_ah;
2303         struct ath_common *common = ath9k_hw_common(ah);
2304         int timeout = 200; /* ms */
2305         int i, j;
2306         bool drain_txq;
2307
2308         mutex_lock(&sc->mutex);
2309         cancel_delayed_work_sync(&sc->tx_complete_work);
2310
2311         if (ah->ah_flags & AH_UNPLUGGED) {
2312                 ath_dbg(common, ATH_DBG_ANY, "Device has been unplugged!\n");
2313                 mutex_unlock(&sc->mutex);
2314                 return;
2315         }
2316
2317         if (sc->sc_flags & SC_OP_INVALID) {
2318                 ath_dbg(common, ATH_DBG_ANY, "Device not present\n");
2319                 mutex_unlock(&sc->mutex);
2320                 return;
2321         }
2322
2323         if (drop)
2324                 timeout = 1;
2325
2326         for (j = 0; j < timeout; j++) {
2327                 bool npend = false;
2328
2329                 if (j)
2330                         usleep_range(1000, 2000);
2331
2332                 for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
2333                         if (!ATH_TXQ_SETUP(sc, i))
2334                                 continue;
2335
2336                         npend = ath9k_has_pending_frames(sc, &sc->tx.txq[i]);
2337
2338                         if (npend)
2339                                 break;
2340                 }
2341
2342                 if (!npend)
2343                     goto out;
2344         }
2345
2346         ath9k_ps_wakeup(sc);
2347         spin_lock_bh(&sc->sc_pcu_lock);
2348         drain_txq = ath_drain_all_txq(sc, false);
2349         spin_unlock_bh(&sc->sc_pcu_lock);
2350
2351         if (!drain_txq)
2352                 ath_reset(sc, false);
2353
2354         ath9k_ps_restore(sc);
2355         ieee80211_wake_queues(hw);
2356
2357 out:
2358         ieee80211_queue_delayed_work(hw, &sc->tx_complete_work, 0);
2359         mutex_unlock(&sc->mutex);
2360 }
2361
2362 static bool ath9k_tx_frames_pending(struct ieee80211_hw *hw)
2363 {
2364         struct ath_softc *sc = hw->priv;
2365         int i;
2366
2367         for (i = 0; i < ATH9K_NUM_TX_QUEUES; i++) {
2368                 if (!ATH_TXQ_SETUP(sc, i))
2369                         continue;
2370
2371                 if (ath9k_has_pending_frames(sc, &sc->tx.txq[i]))
2372                         return true;
2373         }
2374         return false;
2375 }
2376
2377 static int ath9k_tx_last_beacon(struct ieee80211_hw *hw)
2378 {
2379         struct ath_softc *sc = hw->priv;
2380         struct ath_hw *ah = sc->sc_ah;
2381         struct ieee80211_vif *vif;
2382         struct ath_vif *avp;
2383         struct ath_buf *bf;
2384         struct ath_tx_status ts;
2385         int status;
2386
2387         vif = sc->beacon.bslot[0];
2388         if (!vif)
2389                 return 0;
2390
2391         avp = (void *)vif->drv_priv;
2392         if (!avp->is_bslot_active)
2393                 return 0;
2394
2395         if (!sc->beacon.tx_processed) {
2396                 tasklet_disable(&sc->bcon_tasklet);
2397
2398                 bf = avp->av_bcbuf;
2399                 if (!bf || !bf->bf_mpdu)
2400                         goto skip;
2401
2402                 status = ath9k_hw_txprocdesc(ah, bf->bf_desc, &ts);
2403                 if (status == -EINPROGRESS)
2404                         goto skip;
2405
2406                 sc->beacon.tx_processed = true;
2407                 sc->beacon.tx_last = !(ts.ts_status & ATH9K_TXERR_MASK);
2408
2409 skip:
2410                 tasklet_enable(&sc->bcon_tasklet);
2411         }
2412
2413         return sc->beacon.tx_last;
2414 }
2415
2416 static int ath9k_get_stats(struct ieee80211_hw *hw,
2417                            struct ieee80211_low_level_stats *stats)
2418 {
2419         struct ath_softc *sc = hw->priv;
2420         struct ath_hw *ah = sc->sc_ah;
2421         struct ath9k_mib_stats *mib_stats = &ah->ah_mibStats;
2422
2423         stats->dot11ACKFailureCount = mib_stats->ackrcv_bad;
2424         stats->dot11RTSFailureCount = mib_stats->rts_bad;
2425         stats->dot11FCSErrorCount = mib_stats->fcs_bad;
2426         stats->dot11RTSSuccessCount = mib_stats->rts_good;
2427         return 0;
2428 }
2429
2430 static u32 fill_chainmask(u32 cap, u32 new)
2431 {
2432         u32 filled = 0;
2433         int i;
2434
2435         for (i = 0; cap && new; i++, cap >>= 1) {
2436                 if (!(cap & BIT(0)))
2437                         continue;
2438
2439                 if (new & BIT(0))
2440                         filled |= BIT(i);
2441
2442                 new >>= 1;
2443         }
2444
2445         return filled;
2446 }
2447
2448 static int ath9k_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
2449 {
2450         struct ath_softc *sc = hw->priv;
2451         struct ath_hw *ah = sc->sc_ah;
2452
2453         if (!rx_ant || !tx_ant)
2454                 return -EINVAL;
2455
2456         sc->ant_rx = rx_ant;
2457         sc->ant_tx = tx_ant;
2458
2459         if (ah->caps.rx_chainmask == 1)
2460                 return 0;
2461
2462         /* AR9100 runs into calibration issues if not all rx chains are enabled */
2463         if (AR_SREV_9100(ah))
2464                 ah->rxchainmask = 0x7;
2465         else
2466                 ah->rxchainmask = fill_chainmask(ah->caps.rx_chainmask, rx_ant);
2467
2468         ah->txchainmask = fill_chainmask(ah->caps.tx_chainmask, tx_ant);
2469         ath9k_reload_chainmask_settings(sc);
2470
2471         return 0;
2472 }
2473
2474 static int ath9k_get_antenna(struct ieee80211_hw *hw, u32 *tx_ant, u32 *rx_ant)
2475 {
2476         struct ath_softc *sc = hw->priv;
2477
2478         *tx_ant = sc->ant_tx;
2479         *rx_ant = sc->ant_rx;
2480         return 0;
2481 }
2482
2483 struct ieee80211_ops ath9k_ops = {
2484         .tx                 = ath9k_tx,
2485         .start              = ath9k_start,
2486         .stop               = ath9k_stop,
2487         .add_interface      = ath9k_add_interface,
2488         .change_interface   = ath9k_change_interface,
2489         .remove_interface   = ath9k_remove_interface,
2490         .config             = ath9k_config,
2491         .configure_filter   = ath9k_configure_filter,
2492         .sta_add            = ath9k_sta_add,
2493         .sta_remove         = ath9k_sta_remove,
2494         .sta_notify         = ath9k_sta_notify,
2495         .conf_tx            = ath9k_conf_tx,
2496         .bss_info_changed   = ath9k_bss_info_changed,
2497         .set_key            = ath9k_set_key,
2498         .get_tsf            = ath9k_get_tsf,
2499         .set_tsf            = ath9k_set_tsf,
2500         .reset_tsf          = ath9k_reset_tsf,
2501         .ampdu_action       = ath9k_ampdu_action,
2502         .get_survey         = ath9k_get_survey,
2503         .rfkill_poll        = ath9k_rfkill_poll_state,
2504         .set_coverage_class = ath9k_set_coverage_class,
2505         .flush              = ath9k_flush,
2506         .tx_frames_pending  = ath9k_tx_frames_pending,
2507         .tx_last_beacon     = ath9k_tx_last_beacon,
2508         .get_stats          = ath9k_get_stats,
2509         .set_antenna        = ath9k_set_antenna,
2510         .get_antenna        = ath9k_get_antenna,
2511 };