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