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