2 * Copyright (c) 2008-2011 Atheros Communications Inc.
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.
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.
17 #include <linux/dma-mapping.h>
22 static void ath9k_reset_beacon_status(struct ath_softc
*sc
)
24 sc
->beacon
.tx_processed
= false;
25 sc
->beacon
.tx_last
= false;
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
33 int ath_beaconq_config(struct ath_softc
*sc
)
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
;
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. */
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
;
55 if (!ath9k_hw_set_txq_props(ah
, sc
->beacon
.beaconq
, &qi
)) {
57 "Unable to update h/w beacon queue parameters\n");
60 ath9k_hw_resettxqueue(ah
, sc
->beacon
.beaconq
);
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.
70 static void ath_beacon_setup(struct ath_softc
*sc
, struct ath_vif
*avp
,
71 struct ath_buf
*bf
, int rateidx
)
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
);
77 struct ath9k_11n_rate_series series
[4];
78 int flags
, ctsrate
= 0, ctsduration
= 0;
79 struct ieee80211_supported_band
*sband
;
82 ath9k_reset_beacon_status(sc
);
85 flags
= ATH9K_TXDESC_NOACK
;
89 sband
= &sc
->sbands
[common
->hw
->conf
.channel
->band
];
90 rate
= sband
->bitrates
[rateidx
].hw_value
;
91 if (sc
->sc_flags
& SC_OP_PREAMBLE_SHORT
)
92 rate
|= sband
->bitrates
[rateidx
].hw_value_short
;
94 ath9k_hw_set11n_txdesc(ah
, ds
, skb
->len
+ FCS_LEN
,
95 ATH9K_PKT_TYPE_BEACON
,
97 ATH9K_TXKEYIX_INVALID
,
101 /* NB: beacon's BufLen must be a multiple of 4 bytes */
102 ath9k_hw_filltxdesc(ah
, ds
, roundup(skb
->len
, 4),
103 true, true, ds
, bf
->bf_buf_addr
,
106 memset(series
, 0, sizeof(struct ath9k_11n_rate_series
) * 4);
108 series
[0].Rate
= rate
;
109 series
[0].ChSel
= ath_txchainmask_reduction(sc
,
110 ah
->txchainmask
, series
[0].Rate
);
111 series
[0].RateFlags
= (ctsrate
) ? ATH9K_RATESERIES_RTS_CTS
: 0;
112 ath9k_hw_set11n_ratescenario(ah
, ds
, ds
, 0, ctsrate
, ctsduration
,
116 static void ath_tx_cabq(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
118 struct ath_softc
*sc
= hw
->priv
;
119 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
120 struct ath_tx_control txctl
;
122 memset(&txctl
, 0, sizeof(struct ath_tx_control
));
123 txctl
.txq
= sc
->beacon
.cabq
;
125 ath_dbg(common
, ATH_DBG_XMIT
,
126 "transmitting CABQ packet, skb: %p\n", skb
);
128 if (ath_tx_start(hw
, skb
, &txctl
) != 0) {
129 ath_dbg(common
, ATH_DBG_XMIT
, "CABQ TX failed\n");
130 dev_kfree_skb_any(skb
);
134 static struct ath_buf
*ath_beacon_generate(struct ieee80211_hw
*hw
,
135 struct ieee80211_vif
*vif
)
137 struct ath_softc
*sc
= hw
->priv
;
138 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
142 struct ath_txq
*cabq
;
143 struct ieee80211_tx_info
*info
;
146 ath9k_reset_beacon_status(sc
);
148 avp
= (void *)vif
->drv_priv
;
149 cabq
= sc
->beacon
.cabq
;
151 if ((avp
->av_bcbuf
== NULL
) || !avp
->is_bslot_active
)
154 /* Release the old beacon first */
159 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
160 skb
->len
, DMA_TO_DEVICE
);
161 dev_kfree_skb_any(skb
);
165 /* Get a new beacon from mac80211 */
167 skb
= ieee80211_beacon_get(hw
, vif
);
171 ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
=
174 info
= IEEE80211_SKB_CB(skb
);
175 if (info
->flags
& IEEE80211_TX_CTL_ASSIGN_SEQ
) {
177 * TODO: make sure the seq# gets assigned properly (vs. other
180 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)skb
->data
;
181 sc
->tx
.seq_no
+= 0x10;
182 hdr
->seq_ctrl
&= cpu_to_le16(IEEE80211_SCTL_FRAG
);
183 hdr
->seq_ctrl
|= cpu_to_le16(sc
->tx
.seq_no
);
186 bf
->bf_buf_addr
= dma_map_single(sc
->dev
, skb
->data
,
187 skb
->len
, DMA_TO_DEVICE
);
188 if (unlikely(dma_mapping_error(sc
->dev
, bf
->bf_buf_addr
))) {
189 dev_kfree_skb_any(skb
);
192 ath_err(common
, "dma_mapping_error on beaconing\n");
196 skb
= ieee80211_get_buffered_bc(hw
, vif
);
199 * if the CABQ traffic from previous DTIM is pending and the current
200 * beacon is also a DTIM.
201 * 1) if there is only one vif let the cab traffic continue.
202 * 2) if there are more than one vif and we are using staggered
203 * beacons, then drain the cabq by dropping all the frames in
204 * the cabq so that the current vifs cab traffic can be scheduled.
206 spin_lock_bh(&cabq
->axq_lock
);
207 cabq_depth
= cabq
->axq_depth
;
208 spin_unlock_bh(&cabq
->axq_lock
);
210 if (skb
&& cabq_depth
) {
212 ath_dbg(common
, ATH_DBG_BEACON
,
213 "Flushing previous cabq traffic\n");
214 ath_draintxq(sc
, cabq
, false);
218 ath_beacon_setup(sc
, avp
, bf
, info
->control
.rates
[0].idx
);
221 ath_tx_cabq(hw
, skb
);
222 skb
= ieee80211_get_buffered_bc(hw
, vif
);
228 int ath_beacon_alloc(struct ath_softc
*sc
, struct ieee80211_vif
*vif
)
230 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
234 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
237 avp
= (void *)vif
->drv_priv
;
239 /* Allocate a beacon descriptor if we haven't done so. */
240 if (!avp
->av_bcbuf
) {
241 /* Allocate beacon state for hostap/ibss. We know
242 * a buffer is available. */
243 avp
->av_bcbuf
= list_first_entry(&sc
->beacon
.bbuf
,
244 struct ath_buf
, list
);
245 list_del(&avp
->av_bcbuf
->list
);
247 if (ath9k_uses_beacons(vif
->type
)) {
250 * Assign the vif to a beacon xmit slot. As
251 * above, this cannot fail to find one.
254 for (slot
= 0; slot
< ATH_BCBUF
; slot
++)
255 if (sc
->beacon
.bslot
[slot
] == NULL
) {
256 avp
->av_bslot
= slot
;
257 avp
->is_bslot_active
= false;
259 /* NB: keep looking for a double slot */
260 if (slot
== 0 || !sc
->beacon
.bslot
[slot
-1])
263 BUG_ON(sc
->beacon
.bslot
[avp
->av_bslot
] != NULL
);
264 sc
->beacon
.bslot
[avp
->av_bslot
] = vif
;
269 /* release the previous beacon frame, if it already exists. */
271 if (bf
->bf_mpdu
!= NULL
) {
273 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
274 skb
->len
, DMA_TO_DEVICE
);
275 dev_kfree_skb_any(skb
);
280 /* NB: the beacon data buffer must be 32-bit aligned. */
281 skb
= ieee80211_beacon_get(sc
->hw
, vif
);
285 tstamp
= ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
;
286 sc
->beacon
.bc_tstamp
= (u32
) le64_to_cpu(tstamp
);
287 /* Calculate a TSF adjustment factor required for staggered beacons. */
288 if (avp
->av_bslot
> 0) {
292 intval
= cur_conf
->beacon_interval
? : ATH_DEFAULT_BINTVAL
;
295 * Calculate the TSF offset for this beacon slot, i.e., the
296 * number of usecs that need to be added to the timestamp field
297 * in Beacon and Probe Response frames. Beacon slot 0 is
298 * processed at the correct offset, so it does not require TSF
299 * adjustment. Other slots are adjusted to get the timestamp
300 * close to the TBTT for the BSS.
302 tsfadjust
= TU_TO_USEC(intval
* avp
->av_bslot
) / ATH_BCBUF
;
303 avp
->tsf_adjust
= cpu_to_le64(tsfadjust
);
305 ath_dbg(common
, ATH_DBG_BEACON
,
306 "stagger beacons, bslot %d intval %u tsfadjust %llu\n",
307 avp
->av_bslot
, intval
, (unsigned long long)tsfadjust
);
309 ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
=
312 avp
->tsf_adjust
= cpu_to_le64(0);
315 bf
->bf_buf_addr
= dma_map_single(sc
->dev
, skb
->data
,
316 skb
->len
, DMA_TO_DEVICE
);
317 if (unlikely(dma_mapping_error(sc
->dev
, bf
->bf_buf_addr
))) {
318 dev_kfree_skb_any(skb
);
321 ath_err(common
, "dma_mapping_error on beacon alloc\n");
324 avp
->is_bslot_active
= true;
329 void ath_beacon_return(struct ath_softc
*sc
, struct ath_vif
*avp
)
331 if (avp
->av_bcbuf
!= NULL
) {
334 avp
->is_bslot_active
= false;
335 if (avp
->av_bslot
!= -1) {
336 sc
->beacon
.bslot
[avp
->av_bslot
] = NULL
;
342 if (bf
->bf_mpdu
!= NULL
) {
343 struct sk_buff
*skb
= bf
->bf_mpdu
;
344 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
345 skb
->len
, DMA_TO_DEVICE
);
346 dev_kfree_skb_any(skb
);
350 list_add_tail(&bf
->list
, &sc
->beacon
.bbuf
);
352 avp
->av_bcbuf
= NULL
;
356 void ath_beacon_tasklet(unsigned long data
)
358 struct ath_softc
*sc
= (struct ath_softc
*)data
;
359 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
360 struct ath_hw
*ah
= sc
->sc_ah
;
361 struct ath_common
*common
= ath9k_hw_common(ah
);
362 struct ath_buf
*bf
= NULL
;
363 struct ieee80211_vif
*vif
;
364 struct ath_tx_status ts
;
369 * Check if the previous beacon has gone out. If
370 * not don't try to post another, skip this period
371 * and wait for the next. Missed beacons indicate
372 * a problem and should not occur. If we miss too
373 * many consecutive beacons reset the device.
375 if (ath9k_hw_numtxpending(ah
, sc
->beacon
.beaconq
) != 0) {
376 sc
->beacon
.bmisscnt
++;
378 if (sc
->beacon
.bmisscnt
< BSTUCK_THRESH
* sc
->nbcnvifs
) {
379 ath_dbg(common
, ATH_DBG_BSTUCK
,
380 "missed %u consecutive beacons\n",
381 sc
->beacon
.bmisscnt
);
382 ath9k_hw_stop_dma_queue(ah
, sc
->beacon
.beaconq
);
383 if (sc
->beacon
.bmisscnt
> 3)
384 ath9k_hw_bstuck_nfcal(ah
);
385 } else if (sc
->beacon
.bmisscnt
>= BSTUCK_THRESH
) {
386 ath_dbg(common
, ATH_DBG_BSTUCK
,
387 "beacon is officially stuck\n");
388 sc
->sc_flags
|= SC_OP_TSF_RESET
;
389 ieee80211_queue_work(sc
->hw
, &sc
->hw_reset_work
);
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.
402 if (ah
->opmode
== NL80211_IFTYPE_AP
) {
407 intval
= cur_conf
->beacon_interval
? : ATH_DEFAULT_BINTVAL
;
408 tsf
= ath9k_hw_gettsf64(ah
);
409 tsf
+= TU_TO_USEC(ah
->config
.sw_beacon_response_time
);
410 tsftu
= TSF_TO_TU((tsf
* ATH_BCBUF
) >>32, tsf
* ATH_BCBUF
);
411 slot
= (tsftu
% (intval
* ATH_BCBUF
)) / intval
;
412 vif
= sc
->beacon
.bslot
[slot
];
414 ath_dbg(common
, ATH_DBG_BEACON
,
415 "slot %d [tsf %llu tsftu %u intval %u] vif %p\n",
416 slot
, tsf
, tsftu
/ ATH_BCBUF
, intval
, vif
);
419 vif
= sc
->beacon
.bslot
[slot
];
425 bf
= ath_beacon_generate(sc
->hw
, vif
);
427 bfaddr
= bf
->bf_daddr
;
431 if (sc
->beacon
.bmisscnt
!= 0) {
432 ath_dbg(common
, ATH_DBG_BSTUCK
,
433 "resume beacon xmit after %u misses\n",
434 sc
->beacon
.bmisscnt
);
435 sc
->beacon
.bmisscnt
= 0;
440 * Handle slot time change when a non-ERP station joins/leaves
441 * an 11g network. The 802.11 layer notifies us via callback,
442 * we mark updateslot, then wait one beacon before effecting
443 * the change. This gives associated stations at least one
444 * beacon interval to note the state change.
446 * NB: The slot time change state machine is clocked according
447 * to whether we are bursting or staggering beacons. We
448 * recognize the request to update and record the current
449 * slot then don't transition until that slot is reached
450 * again. If we miss a beacon for that slot then we'll be
451 * slow to transition but we'll be sure at least one beacon
452 * interval has passed. When bursting slot is always left
453 * set to ATH_BCBUF so this check is a noop.
455 if (sc
->beacon
.updateslot
== UPDATE
) {
456 sc
->beacon
.updateslot
= COMMIT
; /* commit next beacon */
457 sc
->beacon
.slotupdate
= slot
;
458 } else if (sc
->beacon
.updateslot
== COMMIT
&& sc
->beacon
.slotupdate
== slot
) {
459 ah
->slottime
= sc
->beacon
.slottime
;
460 ath9k_hw_init_global_settings(ah
);
461 sc
->beacon
.updateslot
= OK
;
464 /* NB: cabq traffic should already be queued and primed */
465 ath9k_hw_puttxbuf(ah
, sc
->beacon
.beaconq
, bfaddr
);
466 ath9k_hw_txstart(ah
, sc
->beacon
.beaconq
);
468 sc
->beacon
.ast_be_xmit
+= bc
; /* XXX per-vif? */
469 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
) {
470 spin_lock_bh(&sc
->sc_pcu_lock
);
471 ath9k_hw_txprocdesc(ah
, bf
->bf_desc
, (void *)&ts
);
472 spin_unlock_bh(&sc
->sc_pcu_lock
);
477 static void ath9k_beacon_init(struct ath_softc
*sc
,
481 if (sc
->sc_flags
& SC_OP_TSF_RESET
) {
483 ath9k_hw_reset_tsf(sc
->sc_ah
);
486 ath9k_hw_beaconinit(sc
->sc_ah
, next_beacon
, beacon_period
);
488 if (sc
->sc_flags
& SC_OP_TSF_RESET
) {
489 ath9k_ps_restore(sc
);
490 sc
->sc_flags
&= ~SC_OP_TSF_RESET
;
495 * For multi-bss ap support beacons are either staggered evenly over N slots or
496 * burst together. For the former arrange for the SWBA to be delivered for each
497 * slot. Slots that are not occupied will generate nothing.
499 static void ath_beacon_config_ap(struct ath_softc
*sc
,
500 struct ath_beacon_config
*conf
)
502 struct ath_hw
*ah
= sc
->sc_ah
;
503 u32 nexttbtt
, intval
;
505 /* NB: the beacon interval is kept internally in TU's */
506 intval
= TU_TO_USEC(conf
->beacon_interval
);
507 intval
/= ATH_BCBUF
; /* for staggered beacons */
511 * In AP mode we enable the beacon timers and SWBA interrupts to
512 * prepare beacon frames.
514 ah
->imask
|= ATH9K_INT_SWBA
;
515 ath_beaconq_config(sc
);
517 /* Set the computed AP beacon timers */
519 ath9k_hw_disable_interrupts(ah
);
520 sc
->sc_flags
|= SC_OP_TSF_RESET
;
521 ath9k_beacon_init(sc
, nexttbtt
, intval
);
522 sc
->beacon
.bmisscnt
= 0;
523 ath9k_hw_set_interrupts(ah
, ah
->imask
);
524 ath9k_hw_enable_interrupts(ah
);
528 * This sets up the beacon timers according to the timestamp of the last
529 * received beacon and the current TSF, configures PCF and DTIM
530 * handling, programs the sleep registers so the hardware will wakeup in
531 * time to receive beacons, and configures the beacon miss handling so
532 * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
533 * we've associated with.
535 static void ath_beacon_config_sta(struct ath_softc
*sc
,
536 struct ath_beacon_config
*conf
)
538 struct ath_hw
*ah
= sc
->sc_ah
;
539 struct ath_common
*common
= ath9k_hw_common(ah
);
540 struct ath9k_beacon_state bs
;
541 int dtimperiod
, dtimcount
, sleepduration
;
542 int cfpperiod
, cfpcount
;
543 u32 nexttbtt
= 0, intval
, tsftu
;
545 int num_beacons
, offset
, dtim_dec_count
, cfp_dec_count
;
547 /* No need to configure beacon if we are not associated */
548 if (!common
->curaid
) {
549 ath_dbg(common
, ATH_DBG_BEACON
,
550 "STA is not yet associated..skipping beacon config\n");
554 memset(&bs
, 0, sizeof(bs
));
555 intval
= conf
->beacon_interval
;
558 * Setup dtim and cfp parameters according to
559 * last beacon we received (which may be none).
561 dtimperiod
= conf
->dtim_period
;
562 dtimcount
= conf
->dtim_count
;
563 if (dtimcount
>= dtimperiod
) /* NB: sanity check */
565 cfpperiod
= 1; /* NB: no PCF support yet */
568 sleepduration
= conf
->listen_interval
* intval
;
571 * Pull nexttbtt forward to reflect the current
572 * TSF and calculate dtim+cfp state for the result.
574 tsf
= ath9k_hw_gettsf64(ah
);
575 tsftu
= TSF_TO_TU(tsf
>>32, tsf
) + FUDGE
;
577 num_beacons
= tsftu
/ intval
+ 1;
578 offset
= tsftu
% intval
;
579 nexttbtt
= tsftu
- offset
;
583 /* DTIM Beacon every dtimperiod Beacon */
584 dtim_dec_count
= num_beacons
% dtimperiod
;
585 /* CFP every cfpperiod DTIM Beacon */
586 cfp_dec_count
= (num_beacons
/ dtimperiod
) % cfpperiod
;
590 dtimcount
-= dtim_dec_count
;
592 dtimcount
+= dtimperiod
;
594 cfpcount
-= cfp_dec_count
;
596 cfpcount
+= cfpperiod
;
598 bs
.bs_intval
= intval
;
599 bs
.bs_nexttbtt
= nexttbtt
;
600 bs
.bs_dtimperiod
= dtimperiod
*intval
;
601 bs
.bs_nextdtim
= bs
.bs_nexttbtt
+ dtimcount
*intval
;
602 bs
.bs_cfpperiod
= cfpperiod
*bs
.bs_dtimperiod
;
603 bs
.bs_cfpnext
= bs
.bs_nextdtim
+ cfpcount
*bs
.bs_dtimperiod
;
604 bs
.bs_cfpmaxduration
= 0;
607 * Calculate the number of consecutive beacons to miss* before taking
608 * a BMISS interrupt. The configuration is specified in TU so we only
609 * need calculate based on the beacon interval. Note that we clamp the
610 * result to at most 15 beacons.
612 if (sleepduration
> intval
) {
613 bs
.bs_bmissthreshold
= conf
->listen_interval
*
614 ATH_DEFAULT_BMISS_LIMIT
/ 2;
616 bs
.bs_bmissthreshold
= DIV_ROUND_UP(conf
->bmiss_timeout
, intval
);
617 if (bs
.bs_bmissthreshold
> 15)
618 bs
.bs_bmissthreshold
= 15;
619 else if (bs
.bs_bmissthreshold
<= 0)
620 bs
.bs_bmissthreshold
= 1;
624 * Calculate sleep duration. The configuration is given in ms.
625 * We ensure a multiple of the beacon period is used. Also, if the sleep
626 * duration is greater than the DTIM period then it makes senses
627 * to make it a multiple of that.
632 bs
.bs_sleepduration
= roundup(IEEE80211_MS_TO_TU(100), sleepduration
);
633 if (bs
.bs_sleepduration
> bs
.bs_dtimperiod
)
634 bs
.bs_sleepduration
= bs
.bs_dtimperiod
;
636 /* TSF out of range threshold fixed at 1 second */
637 bs
.bs_tsfoor_threshold
= ATH9K_TSFOOR_THRESHOLD
;
639 ath_dbg(common
, ATH_DBG_BEACON
, "tsf: %llu tsftu: %u\n", tsf
, tsftu
);
640 ath_dbg(common
, ATH_DBG_BEACON
,
641 "bmiss: %u sleep: %u cfp-period: %u maxdur: %u next: %u\n",
642 bs
.bs_bmissthreshold
, bs
.bs_sleepduration
,
643 bs
.bs_cfpperiod
, bs
.bs_cfpmaxduration
, bs
.bs_cfpnext
);
645 /* Set the computed STA beacon timers */
647 ath9k_hw_disable_interrupts(ah
);
648 ath9k_hw_set_sta_beacon_timers(ah
, &bs
);
649 ah
->imask
|= ATH9K_INT_BMISS
;
651 ath9k_hw_set_interrupts(ah
, ah
->imask
);
652 ath9k_hw_enable_interrupts(ah
);
655 static void ath_beacon_config_adhoc(struct ath_softc
*sc
,
656 struct ath_beacon_config
*conf
)
658 struct ath_hw
*ah
= sc
->sc_ah
;
659 struct ath_common
*common
= ath9k_hw_common(ah
);
660 u32 tsf
, intval
, nexttbtt
;
662 ath9k_reset_beacon_status(sc
);
664 intval
= TU_TO_USEC(conf
->beacon_interval
);
665 tsf
= roundup(ath9k_hw_gettsf32(ah
) + TU_TO_USEC(FUDGE
), intval
);
666 nexttbtt
= tsf
+ intval
;
668 ath_dbg(common
, ATH_DBG_BEACON
,
669 "IBSS nexttbtt %u intval %u (%u)\n",
670 nexttbtt
, intval
, conf
->beacon_interval
);
673 * In IBSS mode enable the beacon timers but only enable SWBA interrupts
674 * if we need to manually prepare beacon frames. Otherwise we use a
675 * self-linked tx descriptor and let the hardware deal with things.
677 ah
->imask
|= ATH9K_INT_SWBA
;
679 ath_beaconq_config(sc
);
681 /* Set the computed ADHOC beacon timers */
683 ath9k_hw_disable_interrupts(ah
);
684 ath9k_beacon_init(sc
, nexttbtt
, intval
);
685 sc
->beacon
.bmisscnt
= 0;
687 ath9k_hw_set_interrupts(ah
, ah
->imask
);
688 ath9k_hw_enable_interrupts(ah
);
691 static bool ath9k_allow_beacon_config(struct ath_softc
*sc
,
692 struct ieee80211_vif
*vif
)
694 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
695 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
696 struct ieee80211_bss_conf
*bss_conf
= &vif
->bss_conf
;
697 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
700 * Can not have different beacon interval on multiple
703 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_AP
) &&
704 (sc
->nbcnvifs
> 1) &&
705 (vif
->type
== NL80211_IFTYPE_AP
) &&
706 (cur_conf
->beacon_interval
!= bss_conf
->beacon_int
)) {
707 ath_dbg(common
, ATH_DBG_CONFIG
,
708 "Changing beacon interval of multiple \
713 * Can not configure station vif's beacon config
716 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_AP
) &&
717 (vif
->type
!= NL80211_IFTYPE_AP
)) {
718 ath_dbg(common
, ATH_DBG_CONFIG
,
719 "STA vif's beacon not allowed on AP mode\n");
723 * Do not allow beacon config if HW was already configured
724 * with another STA vif
726 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_STATION
) &&
727 (vif
->type
== NL80211_IFTYPE_STATION
) &&
728 (sc
->sc_flags
& SC_OP_BEACONS
) &&
729 !avp
->primary_sta_vif
) {
730 ath_dbg(common
, ATH_DBG_CONFIG
,
731 "Beacon already configured for a station interface\n");
737 void ath_beacon_config(struct ath_softc
*sc
, struct ieee80211_vif
*vif
)
739 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
740 struct ieee80211_bss_conf
*bss_conf
= &vif
->bss_conf
;
742 if (!ath9k_allow_beacon_config(sc
, vif
))
745 /* Setup the beacon configuration parameters */
746 cur_conf
->beacon_interval
= bss_conf
->beacon_int
;
747 cur_conf
->dtim_period
= bss_conf
->dtim_period
;
748 cur_conf
->listen_interval
= 1;
749 cur_conf
->dtim_count
= 1;
750 cur_conf
->bmiss_timeout
=
751 ATH_DEFAULT_BMISS_LIMIT
* cur_conf
->beacon_interval
;
754 * It looks like mac80211 may end up using beacon interval of zero in
755 * some cases (at least for mesh point). Avoid getting into an
756 * infinite loop by using a bit safer value instead. To be safe,
757 * do sanity check on beacon interval for all operating modes.
759 if (cur_conf
->beacon_interval
== 0)
760 cur_conf
->beacon_interval
= 100;
763 * We don't parse dtim period from mac80211 during the driver
764 * initialization as it breaks association with hidden-ssid
765 * AP and it causes latency in roaming
767 if (cur_conf
->dtim_period
== 0)
768 cur_conf
->dtim_period
= 1;
773 static bool ath_has_valid_bslot(struct ath_softc
*sc
)
779 for (slot
= 0; slot
< ATH_BCBUF
; slot
++) {
780 if (sc
->beacon
.bslot
[slot
]) {
781 avp
= (void *)sc
->beacon
.bslot
[slot
]->drv_priv
;
782 if (avp
->is_bslot_active
) {
792 void ath_set_beacon(struct ath_softc
*sc
)
794 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
795 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
797 switch (sc
->sc_ah
->opmode
) {
798 case NL80211_IFTYPE_AP
:
799 if (ath_has_valid_bslot(sc
))
800 ath_beacon_config_ap(sc
, cur_conf
);
802 case NL80211_IFTYPE_ADHOC
:
803 case NL80211_IFTYPE_MESH_POINT
:
804 ath_beacon_config_adhoc(sc
, cur_conf
);
806 case NL80211_IFTYPE_STATION
:
807 ath_beacon_config_sta(sc
, cur_conf
);
810 ath_dbg(common
, ATH_DBG_CONFIG
,
811 "Unsupported beaconing mode\n");
815 sc
->sc_flags
|= SC_OP_BEACONS
;
818 void ath9k_set_beaconing_status(struct ath_softc
*sc
, bool status
)
820 struct ath_hw
*ah
= sc
->sc_ah
;
822 if (!ath_has_valid_bslot(sc
))
827 /* Re-enable beaconing */
828 ah
->imask
|= ATH9K_INT_SWBA
;
829 ath9k_hw_set_interrupts(ah
, ah
->imask
);
831 /* Disable SWBA interrupt */
832 ah
->imask
&= ~ATH9K_INT_SWBA
;
833 ath9k_hw_set_interrupts(ah
, ah
->imask
);
834 tasklet_kill(&sc
->bcon_tasklet
);
835 ath9k_hw_stop_dma_queue(ah
, sc
->beacon
.beaconq
);
837 ath9k_ps_restore(sc
);