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