drivers/net/wireless/ath/ath9k/beacon.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/dma-mapping.h>
  18 #include "ath9k.h"
  19
  20 #define FUDGE 2
  21
  22 static void ath9k_reset_beacon_status(struct ath_softc *sc)
  23 {
  24         sc->beacon.tx_processed = false;
  25         sc->beacon.tx_last = false;
  26 }
  27
  28 /*
  29  *  This function will modify certain transmit queue properties depending on
  30  *  the operating mode of the station (AP or AdHoc).  Parameters are AIFS
  31  *  settings and channel width min/max
  32 */
  33 static void ath9k_beaconq_config(struct ath_softc *sc)
  34 {
  35         struct ath_hw *ah = sc->sc_ah;
  36         struct ath_common *common = ath9k_hw_common(ah);
  37         struct ath9k_tx_queue_info qi, qi_be;
  38         struct ath_txq *txq;
  39
  40         ath9k_hw_get_txq_props(ah, sc->beacon.beaconq, &qi);
  41
  42         if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) {
  43                 /* Always burst out beacon and CAB traffic. */
  44                 qi.tqi_aifs = 1;
  45                 qi.tqi_cwmin = 0;
  46                 qi.tqi_cwmax = 0;
  47         } else {
  48                 /* Adhoc mode; important thing is to use 2x cwmin. */
  49                 txq = sc->tx.txq_map[IEEE80211_AC_BE];
  50                 ath9k_hw_get_txq_props(ah, txq->axq_qnum, &qi_be);
  51                 qi.tqi_aifs = qi_be.tqi_aifs;
  52                 if (ah->slottime == ATH9K_SLOT_TIME_20)
  53                         qi.tqi_cwmin = 2*qi_be.tqi_cwmin;
  54                 else
  55                         qi.tqi_cwmin = 4*qi_be.tqi_cwmin;
  56                 qi.tqi_cwmax = qi_be.tqi_cwmax;
  57         }
  58
  59         if (!ath9k_hw_set_txq_props(ah, sc->beacon.beaconq, &qi)) {
  60                 ath_err(common, "Unable to update h/w beacon queue parameters\n");
  61         } else {
  62                 ath9k_hw_resettxqueue(ah, sc->beacon.beaconq);
  63         }
  64 }
  65
  66 /*
  67  *  Associates the beacon frame buffer with a transmit descriptor.  Will set
  68  *  up rate codes, and channel flags. Beacons are always sent out at the
  69  *  lowest rate, and are not retried.
  70 */
  71 static void ath9k_beacon_setup(struct ath_softc *sc, struct ieee80211_vif *vif,
  72                              struct ath_buf *bf, int rateidx)
  73 {
  74         struct sk_buff *skb = bf->bf_mpdu;
  75         struct ath_hw *ah = sc->sc_ah;
  76         struct ath_common *common = ath9k_hw_common(ah);
  77         struct ath_tx_info info;
  78         struct ieee80211_supported_band *sband;
  79         u8 chainmask = ah->txchainmask;
  80         u8 rate = 0;
  81
  82         sband = &sc->sbands[common->hw->conf.chandef.chan->band];
  83         rate = sband->bitrates[rateidx].hw_value;
  84         if (vif->bss_conf.use_short_preamble)
  85                 rate |= sband->bitrates[rateidx].hw_value_short;
  86
  87         memset(&info, 0, sizeof(info));
  88         info.pkt_len = skb->len + FCS_LEN;
  89         info.type = ATH9K_PKT_TYPE_BEACON;
  90         info.txpower = MAX_RATE_POWER;
  91         info.keyix = ATH9K_TXKEYIX_INVALID;
  92         info.keytype = ATH9K_KEY_TYPE_CLEAR;
  93         info.flags = ATH9K_TXDESC_NOACK | ATH9K_TXDESC_CLRDMASK;
  94
  95         info.buf_addr[0] = bf->bf_buf_addr;
  96         info.buf_len[0] = roundup(skb->len, 4);
  97
  98         info.is_first = true;
  99         info.is_last = true;
 100
 101         info.qcu = sc->beacon.beaconq;
 102
 103         info.rates[0].Tries = 1;
 104         info.rates[0].Rate = rate;
 105         info.rates[0].ChSel = ath_txchainmask_reduction(sc, chainmask, rate);
 106
 107         ath9k_hw_set_txdesc(ah, bf->bf_desc, &info);
 108 }
 109
 110 static void ath9k_tx_cabq(struct ieee80211_hw *hw, struct sk_buff *skb)
 111 {
 112         struct ath_softc *sc = hw->priv;
 113         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 114         struct ath_tx_control txctl;
 115
 116         memset(&txctl, 0, sizeof(struct ath_tx_control));
 117         txctl.txq = sc->beacon.cabq;
 118
 119         ath_dbg(common, XMIT, "transmitting CABQ packet, skb: %p\n", skb);
 120
 121         if (ath_tx_start(hw, skb, &txctl) != 0) {
 122                 ath_dbg(common, XMIT, "CABQ TX failed\n");
 123                 ieee80211_free_txskb(hw, skb);
 124         }
 125 }
 126
 127 static struct ath_buf *ath9k_beacon_generate(struct ieee80211_hw *hw,
 128                                              struct ieee80211_vif *vif)
 129 {
 130         struct ath_softc *sc = hw->priv;
 131         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 132         struct ath_buf *bf;
 133         struct ath_vif *avp = (void *)vif->drv_priv;
 134         struct sk_buff *skb;
 135         struct ath_txq *cabq = sc->beacon.cabq;
 136         struct ieee80211_tx_info *info;
 137         struct ieee80211_mgmt *mgmt_hdr;
 138         int cabq_depth;
 139
 140         if (avp->av_bcbuf == NULL)
 141                 return NULL;
 142
 143         bf = avp->av_bcbuf;
 144         skb = bf->bf_mpdu;
 145         if (skb) {
 146                 dma_unmap_single(sc->dev, bf->bf_buf_addr,
 147                                  skb->len, DMA_TO_DEVICE);
 148                 dev_kfree_skb_any(skb);
 149                 bf->bf_buf_addr = 0;
 150                 bf->bf_mpdu = NULL;
 151         }
 152
 153         skb = ieee80211_beacon_get(hw, vif);
 154         if (skb == NULL)
 155                 return NULL;
 156
 157         bf->bf_mpdu = skb;
 158
 159         mgmt_hdr = (struct ieee80211_mgmt *)skb->data;
 160         mgmt_hdr->u.beacon.timestamp = avp->tsf_adjust;
 161
 162         info = IEEE80211_SKB_CB(skb);
 163         if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
 164                 /*
 165                  * TODO: make sure the seq# gets assigned properly (vs. other
 166                  * TX frames)
 167                  */
 168                 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
 169                 sc->tx.seq_no += 0x10;
 170                 hdr->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
 171                 hdr->seq_ctrl |= cpu_to_le16(sc->tx.seq_no);
 172         }
 173
 174         bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
 175                                          skb->len, DMA_TO_DEVICE);
 176         if (unlikely(dma_mapping_error(sc->dev, bf->bf_buf_addr))) {
 177                 dev_kfree_skb_any(skb);
 178                 bf->bf_mpdu = NULL;
 179                 bf->bf_buf_addr = 0;
 180                 ath_err(common, "dma_mapping_error on beaconing\n");
 181                 return NULL;
 182         }
 183
 184         skb = ieee80211_get_buffered_bc(hw, vif);
 185
 186         /*
 187          * if the CABQ traffic from previous DTIM is pending and the current
 188          *  beacon is also a DTIM.
 189          *  1) if there is only one vif let the cab traffic continue.
 190          *  2) if there are more than one vif and we are using staggered
 191          *     beacons, then drain the cabq by dropping all the frames in
 192          *     the cabq so that the current vifs cab traffic can be scheduled.
 193          */
 194         spin_lock_bh(&cabq->axq_lock);
 195         cabq_depth = cabq->axq_depth;
 196         spin_unlock_bh(&cabq->axq_lock);
 197
 198         if (skb && cabq_depth) {
 199                 if (sc->nvifs > 1) {
 200                         ath_dbg(common, BEACON,
 201                                 "Flushing previous cabq traffic\n");
 202                         ath_draintxq(sc, cabq);
 203                 }
 204         }
 205
 206         ath9k_beacon_setup(sc, vif, bf, info->control.rates[0].idx);
 207
 208         while (skb) {
 209                 ath9k_tx_cabq(hw, skb);
 210                 skb = ieee80211_get_buffered_bc(hw, vif);
 211         }
 212
 213         return bf;
 214 }
 215
 216 void ath9k_beacon_assign_slot(struct ath_softc *sc, struct ieee80211_vif *vif)
 217 {
 218         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 219         struct ath_vif *avp = (void *)vif->drv_priv;
 220         int slot;
 221
 222         avp->av_bcbuf = list_first_entry(&sc->beacon.bbuf, struct ath_buf, list);
 223         list_del(&avp->av_bcbuf->list);
 224
 225         for (slot = 0; slot < ATH_BCBUF; slot++) {
 226                 if (sc->beacon.bslot[slot] == NULL) {
 227                         avp->av_bslot = slot;
 228                         break;
 229                 }
 230         }
 231
 232         sc->beacon.bslot[avp->av_bslot] = vif;
 233         sc->nbcnvifs++;
 234
 235         ath_dbg(common, CONFIG, "Added interface at beacon slot: %d\n",
 236                 avp->av_bslot);
 237 }
 238
 239 void ath9k_beacon_remove_slot(struct ath_softc *sc, struct ieee80211_vif *vif)
 240 {
 241         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 242         struct ath_vif *avp = (void *)vif->drv_priv;
 243         struct ath_buf *bf = avp->av_bcbuf;
 244
 245         ath_dbg(common, CONFIG, "Removing interface at beacon slot: %d\n",
 246                 avp->av_bslot);
 247
 248         tasklet_disable(&sc->bcon_tasklet);
 249
 250         if (bf && bf->bf_mpdu) {
 251                 struct sk_buff *skb = bf->bf_mpdu;
 252                 dma_unmap_single(sc->dev, bf->bf_buf_addr,
 253                                  skb->len, DMA_TO_DEVICE);
 254                 dev_kfree_skb_any(skb);
 255                 bf->bf_mpdu = NULL;
 256                 bf->bf_buf_addr = 0;
 257         }
 258
 259         avp->av_bcbuf = NULL;
 260         sc->beacon.bslot[avp->av_bslot] = NULL;
 261         sc->nbcnvifs--;
 262         list_add_tail(&bf->list, &sc->beacon.bbuf);
 263
 264         tasklet_enable(&sc->bcon_tasklet);
 265 }
 266
 267 static int ath9k_beacon_choose_slot(struct ath_softc *sc)
 268 {
 269         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 270         struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
 271         u16 intval;
 272         u32 tsftu;
 273         u64 tsf;
 274         int slot;
 275
 276         if (sc->sc_ah->opmode != NL80211_IFTYPE_AP) {
 277                 ath_dbg(common, BEACON, "slot 0, tsf: %llu\n",
 278                         ath9k_hw_gettsf64(sc->sc_ah));
 279                 return 0;
 280         }
 281
 282         intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
 283         tsf = ath9k_hw_gettsf64(sc->sc_ah);
 284         tsf += TU_TO_USEC(sc->sc_ah->config.sw_beacon_response_time);
 285         tsftu = TSF_TO_TU((tsf * ATH_BCBUF) >>32, tsf * ATH_BCBUF);
 286         slot = (tsftu % (intval * ATH_BCBUF)) / intval;
 287
 288         ath_dbg(common, BEACON, "slot: %d tsf: %llu tsftu: %u\n",
 289                 slot, tsf, tsftu / ATH_BCBUF);
 290
 291         return slot;
 292 }
 293
 294 void ath9k_set_tsfadjust(struct ath_softc *sc, struct ieee80211_vif *vif)
 295 {
 296         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 297         struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
 298         struct ath_vif *avp = (void *)vif->drv_priv;
 299         u64 tsfadjust;
 300
 301         if (avp->av_bslot == 0)
 302                 return;
 303
 304         tsfadjust = cur_conf->beacon_interval * avp->av_bslot / ATH_BCBUF;
 305         avp->tsf_adjust = cpu_to_le64(TU_TO_USEC(tsfadjust));
 306
 307         ath_dbg(common, CONFIG, "tsfadjust is: %llu for bslot: %d\n",
 308                 (unsigned long long)tsfadjust, avp->av_bslot);
 309 }
 310
 311 void ath9k_beacon_tasklet(unsigned long data)
 312 {
 313         struct ath_softc *sc = (struct ath_softc *)data;
 314         struct ath_hw *ah = sc->sc_ah;
 315         struct ath_common *common = ath9k_hw_common(ah);
 316         struct ath_buf *bf = NULL;
 317         struct ieee80211_vif *vif;
 318         bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
 319         int slot;
 320
 321         if (test_bit(SC_OP_HW_RESET, &sc->sc_flags)) {
 322                 ath_dbg(common, RESET,
 323                         "reset work is pending, skip beaconing now\n");
 324                 return;
 325         }
 326
 327         /*
 328          * Check if the previous beacon has gone out.  If
 329          * not don't try to post another, skip this period
 330          * and wait for the next.  Missed beacons indicate
 331          * a problem and should not occur.  If we miss too
 332          * many consecutive beacons reset the device.
 333          */
 334         if (ath9k_hw_numtxpending(ah, sc->beacon.beaconq) != 0) {
 335                 sc->beacon.bmisscnt++;
 336
 337                 if (!ath9k_hw_check_alive(ah))
 338                         ieee80211_queue_work(sc->hw, &sc->hw_check_work);
 339
 340                 if (sc->beacon.bmisscnt < BSTUCK_THRESH * sc->nbcnvifs) {
 341                         ath_dbg(common, BSTUCK,
 342                                 "missed %u consecutive beacons\n",
 343                                 sc->beacon.bmisscnt);
 344                         ath9k_hw_stop_dma_queue(ah, sc->beacon.beaconq);
 345                         if (sc->beacon.bmisscnt > 3)
 346                                 ath9k_hw_bstuck_nfcal(ah);
 347                 } else if (sc->beacon.bmisscnt >= BSTUCK_THRESH) {
 348                         ath_dbg(common, BSTUCK, "beacon is officially stuck\n");
 349                         sc->beacon.bmisscnt = 0;
 350                         ath9k_queue_reset(sc, RESET_TYPE_BEACON_STUCK);
 351                 }
 352
 353                 return;
 354         }
 355
 356         slot = ath9k_beacon_choose_slot(sc);
 357         vif = sc->beacon.bslot[slot];
 358
 359         if (!vif || !vif->bss_conf.enable_beacon)
 360                 return;
 361
 362         bf = ath9k_beacon_generate(sc->hw, vif);
 363
 364         if (sc->beacon.bmisscnt != 0) {
 365                 ath_dbg(common, BSTUCK, "resume beacon xmit after %u misses\n",
 366                         sc->beacon.bmisscnt);
 367                 sc->beacon.bmisscnt = 0;
 368         }
 369
 370         /*
 371          * Handle slot time change when a non-ERP station joins/leaves
 372          * an 11g network.  The 802.11 layer notifies us via callback,
 373          * we mark updateslot, then wait one beacon before effecting
 374          * the change.  This gives associated stations at least one
 375          * beacon interval to note the state change.
 376          *
 377          * NB: The slot time change state machine is clocked according
 378          *     to whether we are bursting or staggering beacons.  We
 379          *     recognize the request to update and record the current
 380          *     slot then don't transition until that slot is reached
 381          *     again.  If we miss a beacon for that slot then we'll be
 382          *     slow to transition but we'll be sure at least one beacon
 383          *     interval has passed.  When bursting slot is always left
 384          *     set to ATH_BCBUF so this check is a noop.
 385          */
 386         if (sc->beacon.updateslot == UPDATE) {
 387                 sc->beacon.updateslot = COMMIT;
 388                 sc->beacon.slotupdate = slot;
 389         } else if (sc->beacon.updateslot == COMMIT &&
 390                    sc->beacon.slotupdate == slot) {
 391                 ah->slottime = sc->beacon.slottime;
 392                 ath9k_hw_init_global_settings(ah);
 393                 sc->beacon.updateslot = OK;
 394         }
 395
 396         if (bf) {
 397                 ath9k_reset_beacon_status(sc);
 398
 399                 ath_dbg(common, BEACON,
 400                         "Transmitting beacon for slot: %d\n", slot);
 401
 402                 /* NB: cabq traffic should already be queued and primed */
 403                 ath9k_hw_puttxbuf(ah, sc->beacon.beaconq, bf->bf_daddr);
 404
 405                 if (!edma)
 406                         ath9k_hw_txstart(ah, sc->beacon.beaconq);
 407         }
 408 }
 409
 410 /*
 411  * Both nexttbtt and intval have to be in usecs.
 412  */
 413 static void ath9k_beacon_init(struct ath_softc *sc, u32 nexttbtt,
 414                               u32 intval, bool reset_tsf)
 415 {
 416         struct ath_hw *ah = sc->sc_ah;
 417
 418         ath9k_hw_disable_interrupts(ah);
 419         if (reset_tsf)
 420                 ath9k_hw_reset_tsf(ah);
 421         ath9k_beaconq_config(sc);
 422         ath9k_hw_beaconinit(ah, nexttbtt, intval);
 423         sc->beacon.bmisscnt = 0;
 424         ath9k_hw_set_interrupts(ah);
 425         ath9k_hw_enable_interrupts(ah);
 426 }
 427
 428 /*
 429  * For multi-bss ap support beacons are either staggered evenly over N slots or
 430  * burst together.  For the former arrange for the SWBA to be delivered for each
 431  * slot. Slots that are not occupied will generate nothing.
 432  */
 433 static void ath9k_beacon_config_ap(struct ath_softc *sc,
 434                                    struct ath_beacon_config *conf)
 435 {
 436         struct ath_hw *ah = sc->sc_ah;
 437         struct ath_common *common = ath9k_hw_common(ah);
 438         u32 nexttbtt, intval;
 439
 440         /* NB: the beacon interval is kept internally in TU's */
 441         intval = TU_TO_USEC(conf->beacon_interval);
 442         intval /= ATH_BCBUF;
 443         nexttbtt = intval;
 444
 445         if (conf->enable_beacon)
 446                 ah->imask |= ATH9K_INT_SWBA;
 447         else
 448                 ah->imask &= ~ATH9K_INT_SWBA;
 449
 450         ath_dbg(common, BEACON,
 451                 "AP (%s) nexttbtt: %u intval: %u conf_intval: %u\n",
 452                 (conf->enable_beacon) ? "Enable" : "Disable",
 453                 nexttbtt, intval, conf->beacon_interval);
 454
 455         ath9k_beacon_init(sc, nexttbtt, intval, true);
 456 }
 457
 458 /*
 459  * This sets up the beacon timers according to the timestamp of the last
 460  * received beacon and the current TSF, configures PCF and DTIM
 461  * handling, programs the sleep registers so the hardware will wakeup in
 462  * time to receive beacons, and configures the beacon miss handling so
 463  * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
 464  * we've associated with.
 465  */
 466 static void ath9k_beacon_config_sta(struct ath_softc *sc,
 467                                     struct ath_beacon_config *conf)
 468 {
 469         struct ath_hw *ah = sc->sc_ah;
 470         struct ath_common *common = ath9k_hw_common(ah);
 471         struct ath9k_beacon_state bs;
 472         int dtimperiod, dtimcount, sleepduration;
 473         int cfpperiod, cfpcount;
 474         u32 nexttbtt = 0, intval, tsftu;
 475         u64 tsf;
 476         int num_beacons, offset, dtim_dec_count, cfp_dec_count;
 477
 478         /* No need to configure beacon if we are not associated */
 479         if (!test_bit(SC_OP_PRIM_STA_VIF, &sc->sc_flags)) {
 480                 ath_dbg(common, BEACON,
 481                         "STA is not yet associated..skipping beacon config\n");
 482                 return;
 483         }
 484
 485         memset(&bs, 0, sizeof(bs));
 486         intval = conf->beacon_interval;
 487
 488         /*
 489          * Setup dtim and cfp parameters according to
 490          * last beacon we received (which may be none).
 491          */
 492         dtimperiod = conf->dtim_period;
 493         dtimcount = conf->dtim_count;
 494         if (dtimcount >= dtimperiod)    /* NB: sanity check */
 495                 dtimcount = 0;
 496         cfpperiod = 1;                  /* NB: no PCF support yet */
 497         cfpcount = 0;
 498
 499         sleepduration = conf->listen_interval * intval;
 500
 501         /*
 502          * Pull nexttbtt forward to reflect the current
 503          * TSF and calculate dtim+cfp state for the result.
 504          */
 505         tsf = ath9k_hw_gettsf64(ah);
 506         tsftu = TSF_TO_TU(tsf>>32, tsf) + FUDGE;
 507
 508         num_beacons = tsftu / intval + 1;
 509         offset = tsftu % intval;
 510         nexttbtt = tsftu - offset;
 511         if (offset)
 512                 nexttbtt += intval;
 513
 514         /* DTIM Beacon every dtimperiod Beacon */
 515         dtim_dec_count = num_beacons % dtimperiod;
 516         /* CFP every cfpperiod DTIM Beacon */
 517         cfp_dec_count = (num_beacons / dtimperiod) % cfpperiod;
 518         if (dtim_dec_count)
 519                 cfp_dec_count++;
 520
 521         dtimcount -= dtim_dec_count;
 522         if (dtimcount < 0)
 523                 dtimcount += dtimperiod;
 524
 525         cfpcount -= cfp_dec_count;
 526         if (cfpcount < 0)
 527                 cfpcount += cfpperiod;
 528
 529         bs.bs_intval = intval;
 530         bs.bs_nexttbtt = nexttbtt;
 531         bs.bs_dtimperiod = dtimperiod*intval;
 532         bs.bs_nextdtim = bs.bs_nexttbtt + dtimcount*intval;
 533         bs.bs_cfpperiod = cfpperiod*bs.bs_dtimperiod;
 534         bs.bs_cfpnext = bs.bs_nextdtim + cfpcount*bs.bs_dtimperiod;
 535         bs.bs_cfpmaxduration = 0;
 536
 537         /*
 538          * Calculate the number of consecutive beacons to miss* before taking
 539          * a BMISS interrupt. The configuration is specified in TU so we only
 540          * need calculate based on the beacon interval.  Note that we clamp the
 541          * result to at most 15 beacons.
 542          */
 543         if (sleepduration > intval) {
 544                 bs.bs_bmissthreshold = conf->listen_interval *
 545                         ATH_DEFAULT_BMISS_LIMIT / 2;
 546         } else {
 547                 bs.bs_bmissthreshold = DIV_ROUND_UP(conf->bmiss_timeout, intval);
 548                 if (bs.bs_bmissthreshold > 15)
 549                         bs.bs_bmissthreshold = 15;
 550                 else if (bs.bs_bmissthreshold <= 0)
 551                         bs.bs_bmissthreshold = 1;
 552         }
 553
 554         /*
 555          * Calculate sleep duration. The configuration is given in ms.
 556          * We ensure a multiple of the beacon period is used. Also, if the sleep
 557          * duration is greater than the DTIM period then it makes senses
 558          * to make it a multiple of that.
 559          *
 560          * XXX fixed at 100ms
 561          */
 562
 563         bs.bs_sleepduration = roundup(IEEE80211_MS_TO_TU(100), sleepduration);
 564         if (bs.bs_sleepduration > bs.bs_dtimperiod)
 565                 bs.bs_sleepduration = bs.bs_dtimperiod;
 566
 567         /* TSF out of range threshold fixed at 1 second */
 568         bs.bs_tsfoor_threshold = ATH9K_TSFOOR_THRESHOLD;
 569
 570         ath_dbg(common, BEACON, "tsf: %llu tsftu: %u\n", tsf, tsftu);
 571         ath_dbg(common, BEACON,
 572                 "bmiss: %u sleep: %u cfp-period: %u maxdur: %u next: %u\n",
 573                 bs.bs_bmissthreshold, bs.bs_sleepduration,
 574                 bs.bs_cfpperiod, bs.bs_cfpmaxduration, bs.bs_cfpnext);
 575
 576         /* Set the computed STA beacon timers */
 577
 578         ath9k_hw_disable_interrupts(ah);
 579         ath9k_hw_set_sta_beacon_timers(ah, &bs);
 580         ah->imask |= ATH9K_INT_BMISS;
 581
 582         ath9k_hw_set_interrupts(ah);
 583         ath9k_hw_enable_interrupts(ah);
 584 }
 585
 586 static void ath9k_beacon_config_adhoc(struct ath_softc *sc,
 587                                       struct ath_beacon_config *conf)
 588 {
 589         struct ath_hw *ah = sc->sc_ah;
 590         struct ath_common *common = ath9k_hw_common(ah);
 591         u32 intval, nexttbtt;
 592
 593         ath9k_reset_beacon_status(sc);
 594
 595         intval = TU_TO_USEC(conf->beacon_interval);
 596
 597         if (conf->ibss_creator) {
 598                 nexttbtt = intval;
 599         } else {
 600                 u32 tbtt, offset, tsftu;
 601                 u64 tsf;
 602
 603                 /*
 604                  * Pull nexttbtt forward to reflect the current
 605                  * sync'd TSF.
 606                  */
 607                 tsf = ath9k_hw_gettsf64(ah);
 608                 tsftu = TSF_TO_TU(tsf >> 32, tsf) + FUDGE;
 609                 offset = tsftu % conf->beacon_interval;
 610                 tbtt = tsftu - offset;
 611                 if (offset)
 612                         tbtt += conf->beacon_interval;
 613
 614                 nexttbtt = TU_TO_USEC(tbtt);
 615         }
 616
 617         if (conf->enable_beacon)
 618                 ah->imask |= ATH9K_INT_SWBA;
 619         else
 620                 ah->imask &= ~ATH9K_INT_SWBA;
 621
 622         ath_dbg(common, BEACON,
 623                 "IBSS (%s) nexttbtt: %u intval: %u conf_intval: %u\n",
 624                 (conf->enable_beacon) ? "Enable" : "Disable",
 625                 nexttbtt, intval, conf->beacon_interval);
 626
 627         ath9k_beacon_init(sc, nexttbtt, intval, conf->ibss_creator);
 628
 629         /*
 630          * Set the global 'beacon has been configured' flag for the
 631          * joiner case in IBSS mode.
 632          */
 633         if (!conf->ibss_creator && conf->enable_beacon)
 634                 set_bit(SC_OP_BEACONS, &sc->sc_flags);
 635 }
 636
 637 bool ath9k_allow_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif)
 638 {
 639         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 640         struct ath_vif *avp = (void *)vif->drv_priv;
 641
 642         if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) {
 643                 if ((vif->type != NL80211_IFTYPE_AP) ||
 644                     (sc->nbcnvifs > 1)) {
 645                         ath_dbg(common, CONFIG,
 646                                 "An AP interface is already present !\n");
 647                         return false;
 648                 }
 649         }
 650
 651         if (sc->sc_ah->opmode == NL80211_IFTYPE_STATION) {
 652                 if ((vif->type == NL80211_IFTYPE_STATION) &&
 653                     test_bit(SC_OP_BEACONS, &sc->sc_flags) &&
 654                     !avp->primary_sta_vif) {
 655                         ath_dbg(common, CONFIG,
 656                                 "Beacon already configured for a station interface\n");
 657                         return false;
 658                 }
 659         }
 660
 661         return true;
 662 }
 663
 664 static void ath9k_cache_beacon_config(struct ath_softc *sc,
 665                                       struct ieee80211_bss_conf *bss_conf)
 666 {
 667         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 668         struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
 669
 670         ath_dbg(common, BEACON,
 671                 "Caching beacon data for BSS: %pM\n", bss_conf->bssid);
 672
 673         cur_conf->beacon_interval = bss_conf->beacon_int;
 674         cur_conf->dtim_period = bss_conf->dtim_period;
 675         cur_conf->listen_interval = 1;
 676         cur_conf->dtim_count = 1;
 677         cur_conf->ibss_creator = bss_conf->ibss_creator;
 678         cur_conf->bmiss_timeout =
 679                 ATH_DEFAULT_BMISS_LIMIT * cur_conf->beacon_interval;
 680
 681         /*
 682          * It looks like mac80211 may end up using beacon interval of zero in
 683          * some cases (at least for mesh point). Avoid getting into an
 684          * infinite loop by using a bit safer value instead. To be safe,
 685          * do sanity check on beacon interval for all operating modes.
 686          */
 687         if (cur_conf->beacon_interval == 0)
 688                 cur_conf->beacon_interval = 100;
 689
 690         /*
 691          * We don't parse dtim period from mac80211 during the driver
 692          * initialization as it breaks association with hidden-ssid
 693          * AP and it causes latency in roaming
 694          */
 695         if (cur_conf->dtim_period == 0)
 696                 cur_conf->dtim_period = 1;
 697
 698 }
 699
 700 void ath9k_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif,
 701                          u32 changed)
 702 {
 703         struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
 704         struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
 705         unsigned long flags;
 706         bool skip_beacon = false;
 707
 708         if (sc->sc_ah->opmode == NL80211_IFTYPE_STATION) {
 709                 ath9k_cache_beacon_config(sc, bss_conf);
 710                 ath9k_set_beacon(sc);
 711                 set_bit(SC_OP_BEACONS, &sc->sc_flags);
 712                 return;
 713
 714         }
 715
 716         /*
 717          * Take care of multiple interfaces when
 718          * enabling/disabling SWBA.
 719          */
 720         if (changed & BSS_CHANGED_BEACON_ENABLED) {
 721                 if (!bss_conf->enable_beacon &&
 722                     (sc->nbcnvifs <= 1)) {
 723                         cur_conf->enable_beacon = false;
 724                 } else if (bss_conf->enable_beacon) {
 725                         cur_conf->enable_beacon = true;
 726                         ath9k_cache_beacon_config(sc, bss_conf);
 727                 }
 728         }
 729
 730         /*
 731          * Configure the HW beacon registers only when we have a valid
 732          * beacon interval.
 733          */
 734         if (cur_conf->beacon_interval) {
 735                 /*
 736                  * If we are joining an existing IBSS network, start beaconing
 737                  * only after a TSF-sync has taken place. Ensure that this
 738                  * happens by setting the appropriate flags.
 739                  */
 740                 if ((changed & BSS_CHANGED_IBSS) && !bss_conf->ibss_creator &&
 741                     bss_conf->enable_beacon) {
 742                         spin_lock_irqsave(&sc->sc_pm_lock, flags);
 743                         sc->ps_flags |= PS_BEACON_SYNC | PS_WAIT_FOR_BEACON;
 744                         spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
 745                         skip_beacon = true;
 746                 } else {
 747                         ath9k_set_beacon(sc);
 748                 }
 749
 750                 /*
 751                  * Do not set the SC_OP_BEACONS flag for IBSS joiner mode
 752                  * here, it is done in ath9k_beacon_config_adhoc().
 753                  */
 754                 if (cur_conf->enable_beacon && !skip_beacon)
 755                         set_bit(SC_OP_BEACONS, &sc->sc_flags);
 756                 else
 757                         clear_bit(SC_OP_BEACONS, &sc->sc_flags);
 758         }
 759 }
 760
 761 void ath9k_set_beacon(struct ath_softc *sc)
 762 {
 763         struct ath_common *common = ath9k_hw_common(sc->sc_ah);
 764         struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
 765
 766         switch (sc->sc_ah->opmode) {
 767         case NL80211_IFTYPE_AP:
 768                 ath9k_beacon_config_ap(sc, cur_conf);
 769                 break;
 770         case NL80211_IFTYPE_ADHOC:
 771         case NL80211_IFTYPE_MESH_POINT:
 772                 ath9k_beacon_config_adhoc(sc, cur_conf);
 773                 break;
 774         case NL80211_IFTYPE_STATION:
 775                 ath9k_beacon_config_sta(sc, cur_conf);
 776                 break;
 777         default:
 778                 ath_dbg(common, CONFIG, "Unsupported beaconing mode\n");
 779                 return;
 780         }
 781 }