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
,
114 ath9k_hw_set_desc_link(ah
, ds
, 0);
117 static void ath_tx_cabq(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
119 struct ath_softc
*sc
= hw
->priv
;
120 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
121 struct ath_tx_control txctl
;
123 memset(&txctl
, 0, sizeof(struct ath_tx_control
));
124 txctl
.txq
= sc
->beacon
.cabq
;
126 ath_dbg(common
, ATH_DBG_XMIT
,
127 "transmitting CABQ packet, skb: %p\n", skb
);
129 if (ath_tx_start(hw
, skb
, &txctl
) != 0) {
130 ath_dbg(common
, ATH_DBG_XMIT
, "CABQ TX failed\n");
131 dev_kfree_skb_any(skb
);
135 static struct ath_buf
*ath_beacon_generate(struct ieee80211_hw
*hw
,
136 struct ieee80211_vif
*vif
)
138 struct ath_softc
*sc
= hw
->priv
;
139 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
143 struct ath_txq
*cabq
;
144 struct ieee80211_tx_info
*info
;
147 ath9k_reset_beacon_status(sc
);
149 avp
= (void *)vif
->drv_priv
;
150 cabq
= sc
->beacon
.cabq
;
152 if ((avp
->av_bcbuf
== NULL
) || !avp
->is_bslot_active
)
155 /* Release the old beacon first */
160 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
161 skb
->len
, DMA_TO_DEVICE
);
162 dev_kfree_skb_any(skb
);
166 /* Get a new beacon from mac80211 */
168 skb
= ieee80211_beacon_get(hw
, vif
);
172 ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
=
175 info
= IEEE80211_SKB_CB(skb
);
176 if (info
->flags
& IEEE80211_TX_CTL_ASSIGN_SEQ
) {
178 * TODO: make sure the seq# gets assigned properly (vs. other
181 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)skb
->data
;
182 sc
->tx
.seq_no
+= 0x10;
183 hdr
->seq_ctrl
&= cpu_to_le16(IEEE80211_SCTL_FRAG
);
184 hdr
->seq_ctrl
|= cpu_to_le16(sc
->tx
.seq_no
);
187 bf
->bf_buf_addr
= dma_map_single(sc
->dev
, skb
->data
,
188 skb
->len
, DMA_TO_DEVICE
);
189 if (unlikely(dma_mapping_error(sc
->dev
, bf
->bf_buf_addr
))) {
190 dev_kfree_skb_any(skb
);
193 ath_err(common
, "dma_mapping_error on beaconing\n");
197 skb
= ieee80211_get_buffered_bc(hw
, vif
);
200 * if the CABQ traffic from previous DTIM is pending and the current
201 * beacon is also a DTIM.
202 * 1) if there is only one vif let the cab traffic continue.
203 * 2) if there are more than one vif and we are using staggered
204 * beacons, then drain the cabq by dropping all the frames in
205 * the cabq so that the current vifs cab traffic can be scheduled.
207 spin_lock_bh(&cabq
->axq_lock
);
208 cabq_depth
= cabq
->axq_depth
;
209 spin_unlock_bh(&cabq
->axq_lock
);
211 if (skb
&& cabq_depth
) {
213 ath_dbg(common
, ATH_DBG_BEACON
,
214 "Flushing previous cabq traffic\n");
215 ath_draintxq(sc
, cabq
, false);
219 ath_beacon_setup(sc
, avp
, bf
, info
->control
.rates
[0].idx
);
222 ath_tx_cabq(hw
, skb
);
223 skb
= ieee80211_get_buffered_bc(hw
, vif
);
229 int ath_beacon_alloc(struct ath_softc
*sc
, struct ieee80211_vif
*vif
)
231 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
235 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
238 avp
= (void *)vif
->drv_priv
;
240 /* Allocate a beacon descriptor if we haven't done so. */
241 if (!avp
->av_bcbuf
) {
242 /* Allocate beacon state for hostap/ibss. We know
243 * a buffer is available. */
244 avp
->av_bcbuf
= list_first_entry(&sc
->beacon
.bbuf
,
245 struct ath_buf
, list
);
246 list_del(&avp
->av_bcbuf
->list
);
248 if (ath9k_uses_beacons(vif
->type
)) {
251 * Assign the vif to a beacon xmit slot. As
252 * above, this cannot fail to find one.
255 for (slot
= 0; slot
< ATH_BCBUF
; slot
++)
256 if (sc
->beacon
.bslot
[slot
] == NULL
) {
257 avp
->av_bslot
= slot
;
258 avp
->is_bslot_active
= false;
260 /* NB: keep looking for a double slot */
261 if (slot
== 0 || !sc
->beacon
.bslot
[slot
-1])
264 BUG_ON(sc
->beacon
.bslot
[avp
->av_bslot
] != NULL
);
265 sc
->beacon
.bslot
[avp
->av_bslot
] = vif
;
270 /* release the previous beacon frame, if it already exists. */
272 if (bf
->bf_mpdu
!= NULL
) {
274 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
275 skb
->len
, DMA_TO_DEVICE
);
276 dev_kfree_skb_any(skb
);
281 /* NB: the beacon data buffer must be 32-bit aligned. */
282 skb
= ieee80211_beacon_get(sc
->hw
, vif
);
286 tstamp
= ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
;
287 sc
->beacon
.bc_tstamp
= (u32
) le64_to_cpu(tstamp
);
288 /* Calculate a TSF adjustment factor required for staggered beacons. */
289 if (avp
->av_bslot
> 0) {
293 intval
= cur_conf
->beacon_interval
? : ATH_DEFAULT_BINTVAL
;
296 * Calculate the TSF offset for this beacon slot, i.e., the
297 * number of usecs that need to be added to the timestamp field
298 * in Beacon and Probe Response frames. Beacon slot 0 is
299 * processed at the correct offset, so it does not require TSF
300 * adjustment. Other slots are adjusted to get the timestamp
301 * close to the TBTT for the BSS.
303 tsfadjust
= TU_TO_USEC(intval
* avp
->av_bslot
) / ATH_BCBUF
;
304 avp
->tsf_adjust
= cpu_to_le64(tsfadjust
);
306 ath_dbg(common
, ATH_DBG_BEACON
,
307 "stagger beacons, bslot %d intval %u tsfadjust %llu\n",
308 avp
->av_bslot
, intval
, (unsigned long long)tsfadjust
);
310 ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
=
313 avp
->tsf_adjust
= cpu_to_le64(0);
316 bf
->bf_buf_addr
= dma_map_single(sc
->dev
, skb
->data
,
317 skb
->len
, DMA_TO_DEVICE
);
318 if (unlikely(dma_mapping_error(sc
->dev
, bf
->bf_buf_addr
))) {
319 dev_kfree_skb_any(skb
);
322 ath_err(common
, "dma_mapping_error on beacon alloc\n");
325 avp
->is_bslot_active
= true;
330 void ath_beacon_return(struct ath_softc
*sc
, struct ath_vif
*avp
)
332 if (avp
->av_bcbuf
!= NULL
) {
335 avp
->is_bslot_active
= false;
336 if (avp
->av_bslot
!= -1) {
337 sc
->beacon
.bslot
[avp
->av_bslot
] = NULL
;
343 if (bf
->bf_mpdu
!= NULL
) {
344 struct sk_buff
*skb
= bf
->bf_mpdu
;
345 dma_unmap_single(sc
->dev
, bf
->bf_buf_addr
,
346 skb
->len
, DMA_TO_DEVICE
);
347 dev_kfree_skb_any(skb
);
351 list_add_tail(&bf
->list
, &sc
->beacon
.bbuf
);
353 avp
->av_bcbuf
= NULL
;
357 void ath_beacon_tasklet(unsigned long data
)
359 struct ath_softc
*sc
= (struct ath_softc
*)data
;
360 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
361 struct ath_hw
*ah
= sc
->sc_ah
;
362 struct ath_common
*common
= ath9k_hw_common(ah
);
363 struct ath_buf
*bf
= NULL
;
364 struct ieee80211_vif
*vif
;
365 struct ath_tx_status ts
;
370 * Check if the previous beacon has gone out. If
371 * not don't try to post another, skip this period
372 * and wait for the next. Missed beacons indicate
373 * a problem and should not occur. If we miss too
374 * many consecutive beacons reset the device.
376 if (ath9k_hw_numtxpending(ah
, sc
->beacon
.beaconq
) != 0) {
377 sc
->beacon
.bmisscnt
++;
379 if (sc
->beacon
.bmisscnt
< BSTUCK_THRESH
* sc
->nbcnvifs
) {
380 ath_dbg(common
, ATH_DBG_BSTUCK
,
381 "missed %u consecutive beacons\n",
382 sc
->beacon
.bmisscnt
);
383 ath9k_hw_stop_dma_queue(ah
, sc
->beacon
.beaconq
);
384 if (sc
->beacon
.bmisscnt
> 3)
385 ath9k_hw_bstuck_nfcal(ah
);
386 } else if (sc
->beacon
.bmisscnt
>= BSTUCK_THRESH
) {
387 ath_dbg(common
, ATH_DBG_BSTUCK
,
388 "beacon is officially stuck\n");
389 sc
->sc_flags
|= SC_OP_TSF_RESET
;
390 ieee80211_queue_work(sc
->hw
, &sc
->hw_reset_work
);
397 * Generate beacon frames. we are sending frames
398 * staggered so calculate the slot for this frame based
399 * on the tsf to safeguard against missing an swba.
403 if (ah
->opmode
== NL80211_IFTYPE_AP
) {
408 intval
= cur_conf
->beacon_interval
? : ATH_DEFAULT_BINTVAL
;
409 tsf
= ath9k_hw_gettsf64(ah
);
410 tsf
+= TU_TO_USEC(ah
->config
.sw_beacon_response_time
);
411 tsftu
= TSF_TO_TU((tsf
* ATH_BCBUF
) >>32, tsf
* ATH_BCBUF
);
412 slot
= (tsftu
% (intval
* ATH_BCBUF
)) / intval
;
413 vif
= sc
->beacon
.bslot
[slot
];
415 ath_dbg(common
, ATH_DBG_BEACON
,
416 "slot %d [tsf %llu tsftu %u intval %u] vif %p\n",
417 slot
, tsf
, tsftu
/ ATH_BCBUF
, intval
, vif
);
420 vif
= sc
->beacon
.bslot
[slot
];
426 bf
= ath_beacon_generate(sc
->hw
, vif
);
428 bfaddr
= bf
->bf_daddr
;
432 if (sc
->beacon
.bmisscnt
!= 0) {
433 ath_dbg(common
, ATH_DBG_BSTUCK
,
434 "resume beacon xmit after %u misses\n",
435 sc
->beacon
.bmisscnt
);
436 sc
->beacon
.bmisscnt
= 0;
441 * Handle slot time change when a non-ERP station joins/leaves
442 * an 11g network. The 802.11 layer notifies us via callback,
443 * we mark updateslot, then wait one beacon before effecting
444 * the change. This gives associated stations at least one
445 * beacon interval to note the state change.
447 * NB: The slot time change state machine is clocked according
448 * to whether we are bursting or staggering beacons. We
449 * recognize the request to update and record the current
450 * slot then don't transition until that slot is reached
451 * again. If we miss a beacon for that slot then we'll be
452 * slow to transition but we'll be sure at least one beacon
453 * interval has passed. When bursting slot is always left
454 * set to ATH_BCBUF so this check is a noop.
456 if (sc
->beacon
.updateslot
== UPDATE
) {
457 sc
->beacon
.updateslot
= COMMIT
; /* commit next beacon */
458 sc
->beacon
.slotupdate
= slot
;
459 } else if (sc
->beacon
.updateslot
== COMMIT
&& sc
->beacon
.slotupdate
== slot
) {
460 ah
->slottime
= sc
->beacon
.slottime
;
461 ath9k_hw_init_global_settings(ah
);
462 sc
->beacon
.updateslot
= OK
;
465 /* NB: cabq traffic should already be queued and primed */
466 ath9k_hw_puttxbuf(ah
, sc
->beacon
.beaconq
, bfaddr
);
467 ath9k_hw_txstart(ah
, sc
->beacon
.beaconq
);
469 sc
->beacon
.ast_be_xmit
+= bc
; /* XXX per-vif? */
470 if (ah
->caps
.hw_caps
& ATH9K_HW_CAP_EDMA
) {
471 spin_lock_bh(&sc
->sc_pcu_lock
);
472 ath9k_hw_txprocdesc(ah
, bf
->bf_desc
, (void *)&ts
);
473 spin_unlock_bh(&sc
->sc_pcu_lock
);
478 static void ath9k_beacon_init(struct ath_softc
*sc
,
482 if (sc
->sc_flags
& SC_OP_TSF_RESET
) {
484 ath9k_hw_reset_tsf(sc
->sc_ah
);
487 ath9k_hw_beaconinit(sc
->sc_ah
, next_beacon
, beacon_period
);
489 if (sc
->sc_flags
& SC_OP_TSF_RESET
) {
490 ath9k_ps_restore(sc
);
491 sc
->sc_flags
&= ~SC_OP_TSF_RESET
;
496 * For multi-bss ap support beacons are either staggered evenly over N slots or
497 * burst together. For the former arrange for the SWBA to be delivered for each
498 * slot. Slots that are not occupied will generate nothing.
500 static void ath_beacon_config_ap(struct ath_softc
*sc
,
501 struct ath_beacon_config
*conf
)
503 struct ath_hw
*ah
= sc
->sc_ah
;
504 u32 nexttbtt
, intval
;
506 /* NB: the beacon interval is kept internally in TU's */
507 intval
= TU_TO_USEC(conf
->beacon_interval
);
508 intval
/= ATH_BCBUF
; /* for staggered beacons */
512 * In AP mode we enable the beacon timers and SWBA interrupts to
513 * prepare beacon frames.
515 ah
->imask
|= ATH9K_INT_SWBA
;
516 ath_beaconq_config(sc
);
518 /* Set the computed AP beacon timers */
520 ath9k_hw_disable_interrupts(ah
);
521 sc
->sc_flags
|= SC_OP_TSF_RESET
;
522 ath9k_beacon_init(sc
, nexttbtt
, intval
);
523 sc
->beacon
.bmisscnt
= 0;
524 ath9k_hw_set_interrupts(ah
, ah
->imask
);
525 ath9k_hw_enable_interrupts(ah
);
529 * This sets up the beacon timers according to the timestamp of the last
530 * received beacon and the current TSF, configures PCF and DTIM
531 * handling, programs the sleep registers so the hardware will wakeup in
532 * time to receive beacons, and configures the beacon miss handling so
533 * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
534 * we've associated with.
536 static void ath_beacon_config_sta(struct ath_softc
*sc
,
537 struct ath_beacon_config
*conf
)
539 struct ath_hw
*ah
= sc
->sc_ah
;
540 struct ath_common
*common
= ath9k_hw_common(ah
);
541 struct ath9k_beacon_state bs
;
542 int dtimperiod
, dtimcount
, sleepduration
;
543 int cfpperiod
, cfpcount
;
544 u32 nexttbtt
= 0, intval
, tsftu
;
546 int num_beacons
, offset
, dtim_dec_count
, cfp_dec_count
;
548 /* No need to configure beacon if we are not associated */
549 if (!common
->curaid
) {
550 ath_dbg(common
, ATH_DBG_BEACON
,
551 "STA is not yet associated..skipping beacon config\n");
555 memset(&bs
, 0, sizeof(bs
));
556 intval
= conf
->beacon_interval
;
559 * Setup dtim and cfp parameters according to
560 * last beacon we received (which may be none).
562 dtimperiod
= conf
->dtim_period
;
563 dtimcount
= conf
->dtim_count
;
564 if (dtimcount
>= dtimperiod
) /* NB: sanity check */
566 cfpperiod
= 1; /* NB: no PCF support yet */
569 sleepduration
= conf
->listen_interval
* intval
;
572 * Pull nexttbtt forward to reflect the current
573 * TSF and calculate dtim+cfp state for the result.
575 tsf
= ath9k_hw_gettsf64(ah
);
576 tsftu
= TSF_TO_TU(tsf
>>32, tsf
) + FUDGE
;
578 num_beacons
= tsftu
/ intval
+ 1;
579 offset
= tsftu
% intval
;
580 nexttbtt
= tsftu
- offset
;
584 /* DTIM Beacon every dtimperiod Beacon */
585 dtim_dec_count
= num_beacons
% dtimperiod
;
586 /* CFP every cfpperiod DTIM Beacon */
587 cfp_dec_count
= (num_beacons
/ dtimperiod
) % cfpperiod
;
591 dtimcount
-= dtim_dec_count
;
593 dtimcount
+= dtimperiod
;
595 cfpcount
-= cfp_dec_count
;
597 cfpcount
+= cfpperiod
;
599 bs
.bs_intval
= intval
;
600 bs
.bs_nexttbtt
= nexttbtt
;
601 bs
.bs_dtimperiod
= dtimperiod
*intval
;
602 bs
.bs_nextdtim
= bs
.bs_nexttbtt
+ dtimcount
*intval
;
603 bs
.bs_cfpperiod
= cfpperiod
*bs
.bs_dtimperiod
;
604 bs
.bs_cfpnext
= bs
.bs_nextdtim
+ cfpcount
*bs
.bs_dtimperiod
;
605 bs
.bs_cfpmaxduration
= 0;
608 * Calculate the number of consecutive beacons to miss* before taking
609 * a BMISS interrupt. The configuration is specified in TU so we only
610 * need calculate based on the beacon interval. Note that we clamp the
611 * result to at most 15 beacons.
613 if (sleepduration
> intval
) {
614 bs
.bs_bmissthreshold
= conf
->listen_interval
*
615 ATH_DEFAULT_BMISS_LIMIT
/ 2;
617 bs
.bs_bmissthreshold
= DIV_ROUND_UP(conf
->bmiss_timeout
, intval
);
618 if (bs
.bs_bmissthreshold
> 15)
619 bs
.bs_bmissthreshold
= 15;
620 else if (bs
.bs_bmissthreshold
<= 0)
621 bs
.bs_bmissthreshold
= 1;
625 * Calculate sleep duration. The configuration is given in ms.
626 * We ensure a multiple of the beacon period is used. Also, if the sleep
627 * duration is greater than the DTIM period then it makes senses
628 * to make it a multiple of that.
633 bs
.bs_sleepduration
= roundup(IEEE80211_MS_TO_TU(100), sleepduration
);
634 if (bs
.bs_sleepduration
> bs
.bs_dtimperiod
)
635 bs
.bs_sleepduration
= bs
.bs_dtimperiod
;
637 /* TSF out of range threshold fixed at 1 second */
638 bs
.bs_tsfoor_threshold
= ATH9K_TSFOOR_THRESHOLD
;
640 ath_dbg(common
, ATH_DBG_BEACON
, "tsf: %llu tsftu: %u\n", tsf
, tsftu
);
641 ath_dbg(common
, ATH_DBG_BEACON
,
642 "bmiss: %u sleep: %u cfp-period: %u maxdur: %u next: %u\n",
643 bs
.bs_bmissthreshold
, bs
.bs_sleepduration
,
644 bs
.bs_cfpperiod
, bs
.bs_cfpmaxduration
, bs
.bs_cfpnext
);
646 /* Set the computed STA beacon timers */
648 ath9k_hw_disable_interrupts(ah
);
649 ath9k_hw_set_sta_beacon_timers(ah
, &bs
);
650 ah
->imask
|= ATH9K_INT_BMISS
;
652 ath9k_hw_set_interrupts(ah
, ah
->imask
);
653 ath9k_hw_enable_interrupts(ah
);
656 static void ath_beacon_config_adhoc(struct ath_softc
*sc
,
657 struct ath_beacon_config
*conf
)
659 struct ath_hw
*ah
= sc
->sc_ah
;
660 struct ath_common
*common
= ath9k_hw_common(ah
);
661 u32 tsf
, intval
, nexttbtt
;
663 ath9k_reset_beacon_status(sc
);
665 intval
= TU_TO_USEC(conf
->beacon_interval
);
666 tsf
= roundup(ath9k_hw_gettsf32(ah
) + TU_TO_USEC(FUDGE
), intval
);
667 nexttbtt
= tsf
+ intval
;
669 ath_dbg(common
, ATH_DBG_BEACON
,
670 "IBSS nexttbtt %u intval %u (%u)\n",
671 nexttbtt
, intval
, conf
->beacon_interval
);
674 * In IBSS mode enable the beacon timers but only enable SWBA interrupts
675 * if we need to manually prepare beacon frames. Otherwise we use a
676 * self-linked tx descriptor and let the hardware deal with things.
678 ah
->imask
|= ATH9K_INT_SWBA
;
680 ath_beaconq_config(sc
);
682 /* Set the computed ADHOC beacon timers */
684 ath9k_hw_disable_interrupts(ah
);
685 ath9k_beacon_init(sc
, nexttbtt
, intval
);
686 sc
->beacon
.bmisscnt
= 0;
688 ath9k_hw_set_interrupts(ah
, ah
->imask
);
689 ath9k_hw_enable_interrupts(ah
);
692 static bool ath9k_allow_beacon_config(struct ath_softc
*sc
,
693 struct ieee80211_vif
*vif
)
695 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
696 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
697 struct ieee80211_bss_conf
*bss_conf
= &vif
->bss_conf
;
698 struct ath_vif
*avp
= (void *)vif
->drv_priv
;
701 * Can not have different beacon interval on multiple
704 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_AP
) &&
705 (sc
->nbcnvifs
> 1) &&
706 (vif
->type
== NL80211_IFTYPE_AP
) &&
707 (cur_conf
->beacon_interval
!= bss_conf
->beacon_int
)) {
708 ath_dbg(common
, ATH_DBG_CONFIG
,
709 "Changing beacon interval of multiple \
714 * Can not configure station vif's beacon config
717 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_AP
) &&
718 (vif
->type
!= NL80211_IFTYPE_AP
)) {
719 ath_dbg(common
, ATH_DBG_CONFIG
,
720 "STA vif's beacon not allowed on AP mode\n");
724 * Do not allow beacon config if HW was already configured
725 * with another STA vif
727 if ((sc
->sc_ah
->opmode
== NL80211_IFTYPE_STATION
) &&
728 (vif
->type
== NL80211_IFTYPE_STATION
) &&
729 (sc
->sc_flags
& SC_OP_BEACONS
) &&
730 !avp
->primary_sta_vif
) {
731 ath_dbg(common
, ATH_DBG_CONFIG
,
732 "Beacon already configured for a station interface\n");
738 void ath_beacon_config(struct ath_softc
*sc
, struct ieee80211_vif
*vif
)
740 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
741 struct ieee80211_bss_conf
*bss_conf
= &vif
->bss_conf
;
743 if (!ath9k_allow_beacon_config(sc
, vif
))
746 /* Setup the beacon configuration parameters */
747 cur_conf
->beacon_interval
= bss_conf
->beacon_int
;
748 cur_conf
->dtim_period
= bss_conf
->dtim_period
;
749 cur_conf
->listen_interval
= 1;
750 cur_conf
->dtim_count
= 1;
751 cur_conf
->bmiss_timeout
=
752 ATH_DEFAULT_BMISS_LIMIT
* cur_conf
->beacon_interval
;
755 * It looks like mac80211 may end up using beacon interval of zero in
756 * some cases (at least for mesh point). Avoid getting into an
757 * infinite loop by using a bit safer value instead. To be safe,
758 * do sanity check on beacon interval for all operating modes.
760 if (cur_conf
->beacon_interval
== 0)
761 cur_conf
->beacon_interval
= 100;
764 * We don't parse dtim period from mac80211 during the driver
765 * initialization as it breaks association with hidden-ssid
766 * AP and it causes latency in roaming
768 if (cur_conf
->dtim_period
== 0)
769 cur_conf
->dtim_period
= 1;
774 static bool ath_has_valid_bslot(struct ath_softc
*sc
)
780 for (slot
= 0; slot
< ATH_BCBUF
; slot
++) {
781 if (sc
->beacon
.bslot
[slot
]) {
782 avp
= (void *)sc
->beacon
.bslot
[slot
]->drv_priv
;
783 if (avp
->is_bslot_active
) {
793 void ath_set_beacon(struct ath_softc
*sc
)
795 struct ath_common
*common
= ath9k_hw_common(sc
->sc_ah
);
796 struct ath_beacon_config
*cur_conf
= &sc
->cur_beacon_conf
;
798 switch (sc
->sc_ah
->opmode
) {
799 case NL80211_IFTYPE_AP
:
800 if (ath_has_valid_bslot(sc
))
801 ath_beacon_config_ap(sc
, cur_conf
);
803 case NL80211_IFTYPE_ADHOC
:
804 case NL80211_IFTYPE_MESH_POINT
:
805 ath_beacon_config_adhoc(sc
, cur_conf
);
807 case NL80211_IFTYPE_STATION
:
808 ath_beacon_config_sta(sc
, cur_conf
);
811 ath_dbg(common
, ATH_DBG_CONFIG
,
812 "Unsupported beaconing mode\n");
816 sc
->sc_flags
|= SC_OP_BEACONS
;
819 void ath9k_set_beaconing_status(struct ath_softc
*sc
, bool status
)
821 struct ath_hw
*ah
= sc
->sc_ah
;
823 if (!ath_has_valid_bslot(sc
))
828 /* Re-enable beaconing */
829 ah
->imask
|= ATH9K_INT_SWBA
;
830 ath9k_hw_set_interrupts(ah
, ah
->imask
);
832 /* Disable SWBA interrupt */
833 ah
->imask
&= ~ATH9K_INT_SWBA
;
834 ath9k_hw_set_interrupts(ah
, ah
->imask
);
835 tasklet_kill(&sc
->bcon_tasklet
);
836 ath9k_hw_stop_dma_queue(ah
, sc
->beacon
.beaconq
);
838 ath9k_ps_restore(sc
);