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