blob: 11bc55e3d69759088e34433ce19c74ee9ef9e5b1 [file] [log] [blame]
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07001/*
Sujith Manoharan5b681382011-05-17 13:36:18 +05302 * Copyright (c) 2008-2011 Atheros Communications Inc.
Luis R. Rodriguezf078f202008-08-04 00:16:41 -07003 *
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
Alexey Dobriyanb7f080c2011-06-16 11:01:34 +000017#include <linux/dma-mapping.h>
Sujith394cf0a2009-02-09 13:26:54 +053018#include "ath9k.h"
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070019
Sujith5379c8a2009-03-03 10:16:54 +053020#define FUDGE 2
21
Felix Fietkauba4903f2011-05-17 21:09:54 +020022static void ath9k_reset_beacon_status(struct ath_softc *sc)
23{
24 sc->beacon.tx_processed = false;
25 sc->beacon.tx_last = false;
26}
27
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070028/*
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070029 * 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*/
Vivek Natarajan94db2932009-11-25 12:01:54 +053033int ath_beaconq_config(struct ath_softc *sc)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070034{
Sujithcbe61d82009-02-09 13:27:12 +053035 struct ath_hw *ah = sc->sc_ah;
Luis R. Rodriguezc46917b2009-09-13 02:42:02 -070036 struct ath_common *common = ath9k_hw_common(ah);
Vivek Natarajan94db2932009-11-25 12:01:54 +053037 struct ath9k_tx_queue_info qi, qi_be;
Felix Fietkau066dae92010-11-07 14:59:39 +010038 struct ath_txq *txq;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070039
Sujithb77f4832008-12-07 21:44:03 +053040 ath9k_hw_get_txq_props(ah, sc->beacon.beaconq, &qi);
Sujith2660b812009-02-09 13:27:26 +053041 if (sc->sc_ah->opmode == NL80211_IFTYPE_AP) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070042 /* Always burst out beacon and CAB traffic. */
43 qi.tqi_aifs = 1;
44 qi.tqi_cwmin = 0;
45 qi.tqi_cwmax = 0;
46 } else {
47 /* Adhoc mode; important thing is to use 2x cwmin. */
Felix Fietkau066dae92010-11-07 14:59:39 +010048 txq = sc->tx.txq_map[WME_AC_BE];
49 ath9k_hw_get_txq_props(ah, txq->axq_qnum, &qi_be);
Vivek Natarajan94db2932009-11-25 12:01:54 +053050 qi.tqi_aifs = qi_be.tqi_aifs;
51 qi.tqi_cwmin = 4*qi_be.tqi_cwmin;
52 qi.tqi_cwmax = qi_be.tqi_cwmax;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070053 }
54
Sujithb77f4832008-12-07 21:44:03 +053055 if (!ath9k_hw_set_txq_props(ah, sc->beacon.beaconq, &qi)) {
Joe Perches38002762010-12-02 19:12:36 -080056 ath_err(common,
57 "Unable to update h/w beacon queue parameters\n");
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070058 return 0;
59 } else {
Sujith9fc9ab02009-03-03 10:16:51 +053060 ath9k_hw_resettxqueue(ah, sc->beacon.beaconq);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070061 return 1;
62 }
63}
64
65/*
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070066 * Associates the beacon frame buffer with a transmit descriptor. Will set
Felix Fietkaudd347f22011-03-22 21:54:17 +010067 * up rate codes, and channel flags. Beacons are always sent out at the
68 * lowest rate, and are not retried.
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070069*/
Sujith Manoharand47a61a2012-03-14 14:41:05 +053070static void ath_beacon_setup(struct ath_softc *sc, struct ieee80211_vif *vif,
Jouni Malinen64b84012010-02-16 17:56:18 +020071 struct ath_buf *bf, int rateidx)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070072{
Sujitha22be222009-03-30 15:28:36 +053073 struct sk_buff *skb = bf->bf_mpdu;
Sujithcbe61d82009-02-09 13:27:12 +053074 struct ath_hw *ah = sc->sc_ah;
Luis R. Rodriguez43c27612009-09-13 21:07:07 -070075 struct ath_common *common = ath9k_hw_common(ah);
Felix Fietkau493cf042011-09-14 21:24:22 +020076 struct ath_tx_info info;
Felix Fietkau545750d2009-11-23 22:21:01 +010077 struct ieee80211_supported_band *sband;
Felix Fietkau493cf042011-09-14 21:24:22 +020078 u8 chainmask = ah->txchainmask;
Felix Fietkau545750d2009-11-23 22:21:01 +010079 u8 rate = 0;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070080
Felix Fietkauba4903f2011-05-17 21:09:54 +020081 ath9k_reset_beacon_status(sc);
82
Felix Fietkau545750d2009-11-23 22:21:01 +010083 sband = &sc->sbands[common->hw->conf.channel->band];
Jouni Malinen64b84012010-02-16 17:56:18 +020084 rate = sband->bitrates[rateidx].hw_value;
Sujith Manoharand47a61a2012-03-14 14:41:05 +053085 if (vif->bss_conf.use_short_preamble)
Jouni Malinen64b84012010-02-16 17:56:18 +020086 rate |= sband->bitrates[rateidx].hw_value_short;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070087
Felix Fietkau493cf042011-09-14 21:24:22 +020088 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;
Rajkumar Manoharancd484ae2012-04-13 16:44:22 +053094 info.flags = ATH9K_TXDESC_NOACK | ATH9K_TXDESC_CLRDMASK;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070095
Felix Fietkau493cf042011-09-14 21:24:22 +020096 info.buf_addr[0] = bf->bf_buf_addr;
97 info.buf_len[0] = roundup(skb->len, 4);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -070098
Felix Fietkau493cf042011-09-14 21:24:22 +020099 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);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700109}
110
Felix Fietkau28d16702010-11-14 15:20:10 +0100111static void ath_tx_cabq(struct ieee80211_hw *hw, struct sk_buff *skb)
112{
Felix Fietkau9ac58612011-01-24 19:23:18 +0100113 struct ath_softc *sc = hw->priv;
Felix Fietkau28d16702010-11-14 15:20:10 +0100114 struct ath_common *common = ath9k_hw_common(sc->sc_ah);
115 struct ath_tx_control txctl;
116
117 memset(&txctl, 0, sizeof(struct ath_tx_control));
118 txctl.txq = sc->beacon.cabq;
119
Joe Perchesd2182b62011-12-15 14:55:53 -0800120 ath_dbg(common, XMIT, "transmitting CABQ packet, skb: %p\n", skb);
Felix Fietkau28d16702010-11-14 15:20:10 +0100121
122 if (ath_tx_start(hw, skb, &txctl) != 0) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800123 ath_dbg(common, XMIT, "CABQ TX failed\n");
Felix Fietkau28d16702010-11-14 15:20:10 +0100124 dev_kfree_skb_any(skb);
125 }
126}
127
Jouni Malinenc52f33d2009-03-03 19:23:29 +0200128static struct ath_buf *ath_beacon_generate(struct ieee80211_hw *hw,
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200129 struct ieee80211_vif *vif)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700130{
Felix Fietkau9ac58612011-01-24 19:23:18 +0100131 struct ath_softc *sc = hw->priv;
Luis R. Rodriguezc46917b2009-09-13 02:42:02 -0700132 struct ath_common *common = ath9k_hw_common(sc->sc_ah);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700133 struct ath_buf *bf;
Sujith17d79042009-02-09 13:27:03 +0530134 struct ath_vif *avp;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700135 struct sk_buff *skb;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700136 struct ath_txq *cabq;
Jouni Malinen147583c2008-08-11 14:01:50 +0300137 struct ieee80211_tx_info *info;
Sujith980b24d2008-09-17 10:15:09 +0530138 int cabq_depth;
139
Felix Fietkauba4903f2011-05-17 21:09:54 +0200140 ath9k_reset_beacon_status(sc);
141
Sujith5640b082008-10-29 10:16:06 +0530142 avp = (void *)vif->drv_priv;
Sujithb77f4832008-12-07 21:44:03 +0530143 cabq = sc->beacon.cabq;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700144
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530145 if ((avp->av_bcbuf == NULL) || !avp->is_bslot_active)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700146 return NULL;
Sujith980b24d2008-09-17 10:15:09 +0530147
Sujith9fc9ab02009-03-03 10:16:51 +0530148 /* Release the old beacon first */
149
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700150 bf = avp->av_bcbuf;
Sujitha22be222009-03-30 15:28:36 +0530151 skb = bf->bf_mpdu;
Jouni Malinena8fff502008-08-11 14:01:48 +0300152 if (skb) {
Ben Greearc1739eb32010-10-14 12:45:29 -0700153 dma_unmap_single(sc->dev, bf->bf_buf_addr,
Sujith9fc9ab02009-03-03 10:16:51 +0530154 skb->len, DMA_TO_DEVICE);
Jouni Malinen3fbb9d92008-12-05 20:42:45 +0200155 dev_kfree_skb_any(skb);
Ben Greear6cf9e992010-10-14 12:45:30 -0700156 bf->bf_buf_addr = 0;
Jouni Malinena8fff502008-08-11 14:01:48 +0300157 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700158
Sujith9fc9ab02009-03-03 10:16:51 +0530159 /* Get a new beacon from mac80211 */
160
Jouni Malinenc52f33d2009-03-03 19:23:29 +0200161 skb = ieee80211_beacon_get(hw, vif);
Jouni Malinena8fff502008-08-11 14:01:48 +0300162 bf->bf_mpdu = skb;
163 if (skb == NULL)
164 return NULL;
Jouni Malinen4ed96f02009-03-12 21:53:23 +0200165 ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp =
166 avp->tsf_adjust;
Sujith980b24d2008-09-17 10:15:09 +0530167
Jouni Malinen147583c2008-08-11 14:01:50 +0300168 info = IEEE80211_SKB_CB(skb);
169 if (info->flags & IEEE80211_TX_CTL_ASSIGN_SEQ) {
170 /*
171 * TODO: make sure the seq# gets assigned properly (vs. other
172 * TX frames)
173 */
Sujith980b24d2008-09-17 10:15:09 +0530174 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
Sujithb77f4832008-12-07 21:44:03 +0530175 sc->tx.seq_no += 0x10;
Jouni Malinen147583c2008-08-11 14:01:50 +0300176 hdr->seq_ctrl &= cpu_to_le16(IEEE80211_SCTL_FRAG);
Sujithb77f4832008-12-07 21:44:03 +0530177 hdr->seq_ctrl |= cpu_to_le16(sc->tx.seq_no);
Jouni Malinen147583c2008-08-11 14:01:50 +0300178 }
Sujith980b24d2008-09-17 10:15:09 +0530179
Ben Greearc1739eb32010-10-14 12:45:29 -0700180 bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
181 skb->len, DMA_TO_DEVICE);
Gabor Juhos7da3c552009-01-14 20:17:03 +0100182 if (unlikely(dma_mapping_error(sc->dev, bf->bf_buf_addr))) {
Luis R. Rodriguezf8316df2008-12-03 03:35:29 -0800183 dev_kfree_skb_any(skb);
184 bf->bf_mpdu = NULL;
Ben Greear6cf9e992010-10-14 12:45:30 -0700185 bf->bf_buf_addr = 0;
Joe Perches38002762010-12-02 19:12:36 -0800186 ath_err(common, "dma_mapping_error on beaconing\n");
Luis R. Rodriguezf8316df2008-12-03 03:35:29 -0800187 return NULL;
188 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700189
Jouni Malinenc52f33d2009-03-03 19:23:29 +0200190 skb = ieee80211_get_buffered_bc(hw, vif);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700191
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700192 /*
193 * if the CABQ traffic from previous DTIM is pending and the current
194 * beacon is also a DTIM.
Sujith17d79042009-02-09 13:27:03 +0530195 * 1) if there is only one vif let the cab traffic continue.
196 * 2) if there are more than one vif and we are using staggered
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700197 * beacons, then drain the cabq by dropping all the frames in
Sujith17d79042009-02-09 13:27:03 +0530198 * the cabq so that the current vifs cab traffic can be scheduled.
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700199 */
200 spin_lock_bh(&cabq->axq_lock);
201 cabq_depth = cabq->axq_depth;
202 spin_unlock_bh(&cabq->axq_lock);
203
Jouni Malinene022edb2008-08-22 17:31:33 +0300204 if (skb && cabq_depth) {
Sujith17d79042009-02-09 13:27:03 +0530205 if (sc->nvifs > 1) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800206 ath_dbg(common, BEACON,
Joe Perches226afe62010-12-02 19:12:37 -0800207 "Flushing previous cabq traffic\n");
Sujith9fc9ab02009-03-03 10:16:51 +0530208 ath_draintxq(sc, cabq, false);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700209 }
210 }
211
Sujith Manoharand47a61a2012-03-14 14:41:05 +0530212 ath_beacon_setup(sc, vif, bf, info->control.rates[0].idx);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700213
Jouni Malinene022edb2008-08-22 17:31:33 +0300214 while (skb) {
Jouni Malinenc52f33d2009-03-03 19:23:29 +0200215 ath_tx_cabq(hw, skb);
216 skb = ieee80211_get_buffered_bc(hw, vif);
Jouni Malinene022edb2008-08-22 17:31:33 +0300217 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700218
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700219 return bf;
220}
221
Felix Fietkau9ac58612011-01-24 19:23:18 +0100222int ath_beacon_alloc(struct ath_softc *sc, struct ieee80211_vif *vif)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700223{
Luis R. Rodriguezc46917b2009-09-13 02:42:02 -0700224 struct ath_common *common = ath9k_hw_common(sc->sc_ah);
Sujith17d79042009-02-09 13:27:03 +0530225 struct ath_vif *avp;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700226 struct ath_buf *bf;
227 struct sk_buff *skb;
Steve Brown9814f6b2011-02-07 17:10:39 -0700228 struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
Sujith459f5f92008-09-17 10:15:36 +0530229 __le64 tstamp;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700230
Sujith5640b082008-10-29 10:16:06 +0530231 avp = (void *)vif->drv_priv;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700232
233 /* Allocate a beacon descriptor if we haven't done so. */
234 if (!avp->av_bcbuf) {
Sujith980b24d2008-09-17 10:15:09 +0530235 /* Allocate beacon state for hostap/ibss. We know
236 * a buffer is available. */
Sujithb77f4832008-12-07 21:44:03 +0530237 avp->av_bcbuf = list_first_entry(&sc->beacon.bbuf,
Sujith980b24d2008-09-17 10:15:09 +0530238 struct ath_buf, list);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700239 list_del(&avp->av_bcbuf->list);
240
Ben Greear48014162011-01-15 19:13:48 +0000241 if (ath9k_uses_beacons(vif->type)) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700242 int slot;
243 /*
Sujith17d79042009-02-09 13:27:03 +0530244 * Assign the vif to a beacon xmit slot. As
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700245 * above, this cannot fail to find one.
246 */
247 avp->av_bslot = 0;
248 for (slot = 0; slot < ATH_BCBUF; slot++)
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200249 if (sc->beacon.bslot[slot] == NULL) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700250 avp->av_bslot = slot;
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530251 avp->is_bslot_active = false;
Felix Fietkau774610e2010-05-13 20:37:24 +0200252
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700253 /* NB: keep looking for a double slot */
Felix Fietkau774610e2010-05-13 20:37:24 +0200254 if (slot == 0 || !sc->beacon.bslot[slot-1])
255 break;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700256 }
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200257 BUG_ON(sc->beacon.bslot[avp->av_bslot] != NULL);
258 sc->beacon.bslot[avp->av_bslot] = vif;
Sujith17d79042009-02-09 13:27:03 +0530259 sc->nbcnvifs++;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700260 }
261 }
262
Sujith9fc9ab02009-03-03 10:16:51 +0530263 /* release the previous beacon frame, if it already exists. */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700264 bf = avp->av_bcbuf;
265 if (bf->bf_mpdu != NULL) {
Sujitha22be222009-03-30 15:28:36 +0530266 skb = bf->bf_mpdu;
Ben Greearc1739eb32010-10-14 12:45:29 -0700267 dma_unmap_single(sc->dev, bf->bf_buf_addr,
Sujith9fc9ab02009-03-03 10:16:51 +0530268 skb->len, DMA_TO_DEVICE);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700269 dev_kfree_skb_any(skb);
270 bf->bf_mpdu = NULL;
Ben Greear6cf9e992010-10-14 12:45:30 -0700271 bf->bf_buf_addr = 0;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700272 }
273
Sujith9fc9ab02009-03-03 10:16:51 +0530274 /* NB: the beacon data buffer must be 32-bit aligned. */
Sujith5640b082008-10-29 10:16:06 +0530275 skb = ieee80211_beacon_get(sc->hw, vif);
Felix Fietkaud7e86c32011-01-20 21:57:30 +0100276 if (skb == NULL)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700277 return -ENOMEM;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700278
Sujith459f5f92008-09-17 10:15:36 +0530279 tstamp = ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp;
Felix Fietkaudd347f22011-03-22 21:54:17 +0100280 sc->beacon.bc_tstamp = (u32) le64_to_cpu(tstamp);
Jouni Malinen4ed96f02009-03-12 21:53:23 +0200281 /* Calculate a TSF adjustment factor required for staggered beacons. */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700282 if (avp->av_bslot > 0) {
283 u64 tsfadjust;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700284 int intval;
285
Steve Brown9814f6b2011-02-07 17:10:39 -0700286 intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700287
288 /*
Jouni Malinen4ed96f02009-03-12 21:53:23 +0200289 * Calculate the TSF offset for this beacon slot, i.e., the
290 * number of usecs that need to be added to the timestamp field
291 * in Beacon and Probe Response frames. Beacon slot 0 is
292 * processed at the correct offset, so it does not require TSF
293 * adjustment. Other slots are adjusted to get the timestamp
294 * close to the TBTT for the BSS.
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700295 */
Felix Fietkaudd347f22011-03-22 21:54:17 +0100296 tsfadjust = TU_TO_USEC(intval * avp->av_bslot) / ATH_BCBUF;
297 avp->tsf_adjust = cpu_to_le64(tsfadjust);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700298
Joe Perchesd2182b62011-12-15 14:55:53 -0800299 ath_dbg(common, BEACON,
Joe Perches226afe62010-12-02 19:12:37 -0800300 "stagger beacons, bslot %d intval %u tsfadjust %llu\n",
301 avp->av_bslot, intval, (unsigned long long)tsfadjust);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700302
Jouni Malinen4ed96f02009-03-12 21:53:23 +0200303 ((struct ieee80211_mgmt *)skb->data)->u.beacon.timestamp =
304 avp->tsf_adjust;
305 } else
306 avp->tsf_adjust = cpu_to_le64(0);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700307
Luis R. Rodriguezf8316df2008-12-03 03:35:29 -0800308 bf->bf_mpdu = skb;
Ben Greearc1739eb32010-10-14 12:45:29 -0700309 bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
310 skb->len, DMA_TO_DEVICE);
Gabor Juhos7da3c552009-01-14 20:17:03 +0100311 if (unlikely(dma_mapping_error(sc->dev, bf->bf_buf_addr))) {
Luis R. Rodriguezf8316df2008-12-03 03:35:29 -0800312 dev_kfree_skb_any(skb);
313 bf->bf_mpdu = NULL;
Ben Greear6cf9e992010-10-14 12:45:30 -0700314 bf->bf_buf_addr = 0;
Joe Perches38002762010-12-02 19:12:36 -0800315 ath_err(common, "dma_mapping_error on beacon alloc\n");
Luis R. Rodriguezf8316df2008-12-03 03:35:29 -0800316 return -ENOMEM;
317 }
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530318 avp->is_bslot_active = true;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700319
320 return 0;
321}
322
Sujith17d79042009-02-09 13:27:03 +0530323void ath_beacon_return(struct ath_softc *sc, struct ath_vif *avp)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700324{
325 if (avp->av_bcbuf != NULL) {
326 struct ath_buf *bf;
327
Rajkumar Manoharanf60c49b2011-04-08 17:06:25 +0530328 avp->is_bslot_active = false;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700329 if (avp->av_bslot != -1) {
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200330 sc->beacon.bslot[avp->av_bslot] = NULL;
Sujith17d79042009-02-09 13:27:03 +0530331 sc->nbcnvifs--;
Rajkumar Manoharan66da4242011-04-04 22:56:17 +0530332 avp->av_bslot = -1;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700333 }
334
335 bf = avp->av_bcbuf;
336 if (bf->bf_mpdu != NULL) {
Sujitha22be222009-03-30 15:28:36 +0530337 struct sk_buff *skb = bf->bf_mpdu;
Ben Greearc1739eb32010-10-14 12:45:29 -0700338 dma_unmap_single(sc->dev, bf->bf_buf_addr,
Sujith9fc9ab02009-03-03 10:16:51 +0530339 skb->len, DMA_TO_DEVICE);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700340 dev_kfree_skb_any(skb);
341 bf->bf_mpdu = NULL;
Ben Greear6cf9e992010-10-14 12:45:30 -0700342 bf->bf_buf_addr = 0;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700343 }
Sujithb77f4832008-12-07 21:44:03 +0530344 list_add_tail(&bf->list, &sc->beacon.bbuf);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700345
346 avp->av_bcbuf = NULL;
347 }
348}
349
Sujith9fc9ab02009-03-03 10:16:51 +0530350void ath_beacon_tasklet(unsigned long data)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700351{
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700352 struct ath_softc *sc = (struct ath_softc *)data;
Steve Brown9814f6b2011-02-07 17:10:39 -0700353 struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
Sujithcbe61d82009-02-09 13:27:12 +0530354 struct ath_hw *ah = sc->sc_ah;
Luis R. Rodriguezc46917b2009-09-13 02:42:02 -0700355 struct ath_common *common = ath9k_hw_common(ah);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700356 struct ath_buf *bf = NULL;
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200357 struct ieee80211_vif *vif;
Mohammed Shafi Shajakhan98f0a5e2011-12-28 19:09:54 +0530358 bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200359 int slot;
Felix Fietkauc6820f12011-05-16 23:22:00 +0200360 u32 bfaddr, bc = 0;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700361
Rajkumar Manoharan4e7fb712012-04-13 16:44:21 +0530362 if (work_pending(&sc->hw_reset_work)) {
363 ath_dbg(common, RESET,
364 "reset work is pending, skip beaconing now\n");
365 return;
366 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700367 /*
368 * Check if the previous beacon has gone out. If
369 * not don't try to post another, skip this period
370 * and wait for the next. Missed beacons indicate
371 * a problem and should not occur. If we miss too
372 * many consecutive beacons reset the device.
373 */
Sujithb77f4832008-12-07 21:44:03 +0530374 if (ath9k_hw_numtxpending(ah, sc->beacon.beaconq) != 0) {
375 sc->beacon.bmisscnt++;
Sujith9546aae2009-03-03 10:16:53 +0530376
Felix Fietkaub381fa32012-04-12 22:35:58 +0200377 if (!ath9k_hw_check_alive(ah))
378 ieee80211_queue_work(sc->hw, &sc->hw_check_work);
379
Felix Fietkauc944daf42011-03-22 21:54:19 +0100380 if (sc->beacon.bmisscnt < BSTUCK_THRESH * sc->nbcnvifs) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800381 ath_dbg(common, BSTUCK,
Joe Perches226afe62010-12-02 19:12:37 -0800382 "missed %u consecutive beacons\n",
383 sc->beacon.bmisscnt);
Felix Fietkauefff3952011-03-11 21:38:20 +0100384 ath9k_hw_stop_dma_queue(ah, sc->beacon.beaconq);
Felix Fietkau87c510fe2011-03-22 21:54:18 +0100385 if (sc->beacon.bmisscnt > 3)
386 ath9k_hw_bstuck_nfcal(ah);
Sujithb77f4832008-12-07 21:44:03 +0530387 } else if (sc->beacon.bmisscnt >= BSTUCK_THRESH) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800388 ath_dbg(common, BSTUCK, "beacon is officially stuck\n");
Rajkumar Manoharan4e7fb712012-04-13 16:44:21 +0530389 sc->beacon.bmisscnt = 0;
Jeff Hansenb74444f2009-05-27 12:48:27 +0000390 sc->sc_flags |= SC_OP_TSF_RESET;
Felix Fietkau236de512011-09-03 01:40:25 +0200391 ieee80211_queue_work(sc->hw, &sc->hw_reset_work);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700392 }
Sujith9546aae2009-03-03 10:16:53 +0530393
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700394 return;
395 }
Sujith980b24d2008-09-17 10:15:09 +0530396
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700397 /*
398 * Generate beacon frames. we are sending frames
399 * staggered so calculate the slot for this frame based
400 * on the tsf to safeguard against missing an swba.
401 */
402
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700403
Felix Fietkauc6820f12011-05-16 23:22:00 +0200404 if (ah->opmode == NL80211_IFTYPE_AP) {
405 u16 intval;
406 u32 tsftu;
407 u64 tsf;
Sujith980b24d2008-09-17 10:15:09 +0530408
Felix Fietkauc6820f12011-05-16 23:22:00 +0200409 intval = cur_conf->beacon_interval ? : ATH_DEFAULT_BINTVAL;
410 tsf = ath9k_hw_gettsf64(ah);
411 tsf += TU_TO_USEC(ah->config.sw_beacon_response_time);
412 tsftu = TSF_TO_TU((tsf * ATH_BCBUF) >>32, tsf * ATH_BCBUF);
413 slot = (tsftu % (intval * ATH_BCBUF)) / intval;
414 vif = sc->beacon.bslot[slot];
415
Joe Perchesd2182b62011-12-15 14:55:53 -0800416 ath_dbg(common, BEACON,
Felix Fietkauc6820f12011-05-16 23:22:00 +0200417 "slot %d [tsf %llu tsftu %u intval %u] vif %p\n",
418 slot, tsf, tsftu / ATH_BCBUF, intval, vif);
419 } else {
420 slot = 0;
421 vif = sc->beacon.bslot[slot];
422 }
423
Sujith980b24d2008-09-17 10:15:09 +0530424
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700425 bfaddr = 0;
Jouni Malinen2c3db3d2009-03-03 19:23:26 +0200426 if (vif) {
Felix Fietkau7545daf2011-01-24 19:23:16 +0100427 bf = ath_beacon_generate(sc->hw, vif);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700428 if (bf != NULL) {
429 bfaddr = bf->bf_daddr;
430 bc = 1;
431 }
Felix Fietkauc944daf42011-03-22 21:54:19 +0100432
433 if (sc->beacon.bmisscnt != 0) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800434 ath_dbg(common, BSTUCK,
Felix Fietkauc944daf42011-03-22 21:54:19 +0100435 "resume beacon xmit after %u misses\n",
436 sc->beacon.bmisscnt);
437 sc->beacon.bmisscnt = 0;
438 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700439 }
Sujith9546aae2009-03-03 10:16:53 +0530440
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700441 /*
442 * Handle slot time change when a non-ERP station joins/leaves
443 * an 11g network. The 802.11 layer notifies us via callback,
444 * we mark updateslot, then wait one beacon before effecting
445 * the change. This gives associated stations at least one
446 * beacon interval to note the state change.
447 *
448 * NB: The slot time change state machine is clocked according
449 * to whether we are bursting or staggering beacons. We
450 * recognize the request to update and record the current
451 * slot then don't transition until that slot is reached
452 * again. If we miss a beacon for that slot then we'll be
453 * slow to transition but we'll be sure at least one beacon
454 * interval has passed. When bursting slot is always left
455 * set to ATH_BCBUF so this check is a noop.
456 */
Sujithb77f4832008-12-07 21:44:03 +0530457 if (sc->beacon.updateslot == UPDATE) {
458 sc->beacon.updateslot = COMMIT; /* commit next beacon */
459 sc->beacon.slotupdate = slot;
460 } else if (sc->beacon.updateslot == COMMIT && sc->beacon.slotupdate == slot) {
Felix Fietkau0005baf2010-01-15 02:33:40 +0100461 ah->slottime = sc->beacon.slottime;
462 ath9k_hw_init_global_settings(ah);
Sujithb77f4832008-12-07 21:44:03 +0530463 sc->beacon.updateslot = OK;
Sujithff37e332008-11-24 12:07:55 +0530464 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700465 if (bfaddr != 0) {
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700466 /* NB: cabq traffic should already be queued and primed */
Sujithb77f4832008-12-07 21:44:03 +0530467 ath9k_hw_puttxbuf(ah, sc->beacon.beaconq, bfaddr);
Mohammed Shafi Shajakhan98f0a5e2011-12-28 19:09:54 +0530468
469 if (!edma)
470 ath9k_hw_txstart(ah, sc->beacon.beaconq);
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700471
Sujith17d79042009-02-09 13:27:03 +0530472 sc->beacon.ast_be_xmit += bc; /* XXX per-vif? */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700473 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700474}
475
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700476static void ath9k_beacon_init(struct ath_softc *sc,
477 u32 next_beacon,
478 u32 beacon_period)
479{
Felix Fietkaudd347f22011-03-22 21:54:17 +0100480 if (sc->sc_flags & SC_OP_TSF_RESET) {
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700481 ath9k_ps_wakeup(sc);
Felix Fietkaudd347f22011-03-22 21:54:17 +0100482 ath9k_hw_reset_tsf(sc->sc_ah);
483 }
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700484
485 ath9k_hw_beaconinit(sc->sc_ah, next_beacon, beacon_period);
486
Felix Fietkaudd347f22011-03-22 21:54:17 +0100487 if (sc->sc_flags & SC_OP_TSF_RESET) {
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700488 ath9k_ps_restore(sc);
Felix Fietkaudd347f22011-03-22 21:54:17 +0100489 sc->sc_flags &= ~SC_OP_TSF_RESET;
490 }
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700491}
492
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700493/*
Sujith5379c8a2009-03-03 10:16:54 +0530494 * For multi-bss ap support beacons are either staggered evenly over N slots or
495 * burst together. For the former arrange for the SWBA to be delivered for each
496 * slot. Slots that are not occupied will generate nothing.
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700497 */
Sujith5379c8a2009-03-03 10:16:54 +0530498static void ath_beacon_config_ap(struct ath_softc *sc,
Vasanthakumar Thiagarajand31e20a2009-05-15 18:59:21 +0530499 struct ath_beacon_config *conf)
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700500{
Pavel Roskin30691682010-03-31 18:05:31 -0400501 struct ath_hw *ah = sc->sc_ah;
Sujith980b24d2008-09-17 10:15:09 +0530502 u32 nexttbtt, intval;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700503
Sujith5379c8a2009-03-03 10:16:54 +0530504 /* NB: the beacon interval is kept internally in TU's */
Rajkumar Manoharanf29f5c02011-05-20 17:52:11 +0530505 intval = TU_TO_USEC(conf->beacon_interval);
Sujith5379c8a2009-03-03 10:16:54 +0530506 intval /= ATH_BCBUF; /* for staggered beacons */
507 nexttbtt = intval;
Felix Fietkaud8728ee2010-02-19 18:21:42 +0100508
Sujith5379c8a2009-03-03 10:16:54 +0530509 /*
510 * In AP mode we enable the beacon timers and SWBA interrupts to
511 * prepare beacon frames.
512 */
Pavel Roskin30691682010-03-31 18:05:31 -0400513 ah->imask |= ATH9K_INT_SWBA;
Sujith5379c8a2009-03-03 10:16:54 +0530514 ath_beaconq_config(sc);
515
516 /* Set the computed AP beacon timers */
517
Felix Fietkau4df30712010-11-08 20:54:47 +0100518 ath9k_hw_disable_interrupts(ah);
Felix Fietkauc31c8262011-09-14 21:23:02 +0200519 sc->sc_flags |= SC_OP_TSF_RESET;
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700520 ath9k_beacon_init(sc, nexttbtt, intval);
Sujith5379c8a2009-03-03 10:16:54 +0530521 sc->beacon.bmisscnt = 0;
Felix Fietkau72d874c2011-10-08 20:06:19 +0200522 ath9k_hw_set_interrupts(ah);
Rajkumar Manoharanb037b692011-08-05 18:59:40 +0530523 ath9k_hw_enable_interrupts(ah);
Sujith5379c8a2009-03-03 10:16:54 +0530524}
525
526/*
527 * This sets up the beacon timers according to the timestamp of the last
528 * received beacon and the current TSF, configures PCF and DTIM
529 * handling, programs the sleep registers so the hardware will wakeup in
530 * time to receive beacons, and configures the beacon miss handling so
531 * we'll receive a BMISS interrupt when we stop seeing beacons from the AP
532 * we've associated with.
533 */
534static void ath_beacon_config_sta(struct ath_softc *sc,
Vasanthakumar Thiagarajand31e20a2009-05-15 18:59:21 +0530535 struct ath_beacon_config *conf)
Sujith5379c8a2009-03-03 10:16:54 +0530536{
Pavel Roskin30691682010-03-31 18:05:31 -0400537 struct ath_hw *ah = sc->sc_ah;
538 struct ath_common *common = ath9k_hw_common(ah);
Sujith5379c8a2009-03-03 10:16:54 +0530539 struct ath9k_beacon_state bs;
540 int dtimperiod, dtimcount, sleepduration;
541 int cfpperiod, cfpcount;
542 u32 nexttbtt = 0, intval, tsftu;
543 u64 tsf;
Jouni Malinen267a9012009-05-20 21:56:39 +0300544 int num_beacons, offset, dtim_dec_count, cfp_dec_count;
Sujith5379c8a2009-03-03 10:16:54 +0530545
Senthil Balasubramanian1a200342010-02-03 22:50:18 +0530546 /* No need to configure beacon if we are not associated */
547 if (!common->curaid) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800548 ath_dbg(common, BEACON,
Joe Perches226afe62010-12-02 19:12:37 -0800549 "STA is not yet associated..skipping beacon config\n");
Senthil Balasubramanian1a200342010-02-03 22:50:18 +0530550 return;
551 }
552
Sujith5379c8a2009-03-03 10:16:54 +0530553 memset(&bs, 0, sizeof(bs));
Rajkumar Manoharanf29f5c02011-05-20 17:52:11 +0530554 intval = conf->beacon_interval;
Sujith5379c8a2009-03-03 10:16:54 +0530555
556 /*
557 * Setup dtim and cfp parameters according to
558 * last beacon we received (which may be none).
559 */
560 dtimperiod = conf->dtim_period;
Sujith5379c8a2009-03-03 10:16:54 +0530561 dtimcount = conf->dtim_count;
562 if (dtimcount >= dtimperiod) /* NB: sanity check */
563 dtimcount = 0;
564 cfpperiod = 1; /* NB: no PCF support yet */
565 cfpcount = 0;
566
567 sleepduration = conf->listen_interval * intval;
Sujith5379c8a2009-03-03 10:16:54 +0530568
569 /*
570 * Pull nexttbtt forward to reflect the current
571 * TSF and calculate dtim+cfp state for the result.
572 */
Pavel Roskin30691682010-03-31 18:05:31 -0400573 tsf = ath9k_hw_gettsf64(ah);
Sujith5379c8a2009-03-03 10:16:54 +0530574 tsftu = TSF_TO_TU(tsf>>32, tsf) + FUDGE;
Jouni Malinen267a9012009-05-20 21:56:39 +0300575
576 num_beacons = tsftu / intval + 1;
577 offset = tsftu % intval;
578 nexttbtt = tsftu - offset;
579 if (offset)
Sujith5379c8a2009-03-03 10:16:54 +0530580 nexttbtt += intval;
Jouni Malinen267a9012009-05-20 21:56:39 +0300581
582 /* DTIM Beacon every dtimperiod Beacon */
583 dtim_dec_count = num_beacons % dtimperiod;
584 /* CFP every cfpperiod DTIM Beacon */
585 cfp_dec_count = (num_beacons / dtimperiod) % cfpperiod;
586 if (dtim_dec_count)
587 cfp_dec_count++;
588
589 dtimcount -= dtim_dec_count;
590 if (dtimcount < 0)
591 dtimcount += dtimperiod;
592
593 cfpcount -= cfp_dec_count;
594 if (cfpcount < 0)
595 cfpcount += cfpperiod;
Sujith5379c8a2009-03-03 10:16:54 +0530596
597 bs.bs_intval = intval;
598 bs.bs_nexttbtt = nexttbtt;
599 bs.bs_dtimperiod = dtimperiod*intval;
600 bs.bs_nextdtim = bs.bs_nexttbtt + dtimcount*intval;
601 bs.bs_cfpperiod = cfpperiod*bs.bs_dtimperiod;
602 bs.bs_cfpnext = bs.bs_nextdtim + cfpcount*bs.bs_dtimperiod;
603 bs.bs_cfpmaxduration = 0;
604
605 /*
606 * Calculate the number of consecutive beacons to miss* before taking
607 * a BMISS interrupt. The configuration is specified in TU so we only
608 * need calculate based on the beacon interval. Note that we clamp the
609 * result to at most 15 beacons.
610 */
611 if (sleepduration > intval) {
612 bs.bs_bmissthreshold = conf->listen_interval *
613 ATH_DEFAULT_BMISS_LIMIT / 2;
Sujith5640b082008-10-29 10:16:06 +0530614 } else {
Sujith5379c8a2009-03-03 10:16:54 +0530615 bs.bs_bmissthreshold = DIV_ROUND_UP(conf->bmiss_timeout, intval);
616 if (bs.bs_bmissthreshold > 15)
617 bs.bs_bmissthreshold = 15;
618 else if (bs.bs_bmissthreshold <= 0)
619 bs.bs_bmissthreshold = 1;
Sujith5640b082008-10-29 10:16:06 +0530620 }
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700621
Sujith5379c8a2009-03-03 10:16:54 +0530622 /*
623 * Calculate sleep duration. The configuration is given in ms.
624 * We ensure a multiple of the beacon period is used. Also, if the sleep
625 * duration is greater than the DTIM period then it makes senses
626 * to make it a multiple of that.
627 *
628 * XXX fixed at 100ms
629 */
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700630
Sujith5379c8a2009-03-03 10:16:54 +0530631 bs.bs_sleepduration = roundup(IEEE80211_MS_TO_TU(100), sleepduration);
632 if (bs.bs_sleepduration > bs.bs_dtimperiod)
633 bs.bs_sleepduration = bs.bs_dtimperiod;
634
635 /* TSF out of range threshold fixed at 1 second */
636 bs.bs_tsfoor_threshold = ATH9K_TSFOOR_THRESHOLD;
637
Joe Perchesd2182b62011-12-15 14:55:53 -0800638 ath_dbg(common, BEACON, "tsf: %llu tsftu: %u\n", tsf, tsftu);
639 ath_dbg(common, BEACON,
Joe Perches226afe62010-12-02 19:12:37 -0800640 "bmiss: %u sleep: %u cfp-period: %u maxdur: %u next: %u\n",
641 bs.bs_bmissthreshold, bs.bs_sleepduration,
642 bs.bs_cfpperiod, bs.bs_cfpmaxduration, bs.bs_cfpnext);
Sujith5379c8a2009-03-03 10:16:54 +0530643
644 /* Set the computed STA beacon timers */
645
Felix Fietkau4df30712010-11-08 20:54:47 +0100646 ath9k_hw_disable_interrupts(ah);
Pavel Roskin30691682010-03-31 18:05:31 -0400647 ath9k_hw_set_sta_beacon_timers(ah, &bs);
648 ah->imask |= ATH9K_INT_BMISS;
Rajkumar Manoharandeb75182011-05-06 18:27:46 +0530649
Felix Fietkau72d874c2011-10-08 20:06:19 +0200650 ath9k_hw_set_interrupts(ah);
Rajkumar Manoharane8fe7332011-08-05 18:59:41 +0530651 ath9k_hw_enable_interrupts(ah);
Sujith5379c8a2009-03-03 10:16:54 +0530652}
653
654static void ath_beacon_config_adhoc(struct ath_softc *sc,
Mohammed Shafi Shajakhanee832d32010-12-28 13:06:26 +0530655 struct ath_beacon_config *conf)
Sujith5379c8a2009-03-03 10:16:54 +0530656{
Pavel Roskin30691682010-03-31 18:05:31 -0400657 struct ath_hw *ah = sc->sc_ah;
658 struct ath_common *common = ath9k_hw_common(ah);
Fabrice Deyber81168e52011-05-24 08:44:35 -0500659 u32 tsf, intval, nexttbtt;
Sujith5379c8a2009-03-03 10:16:54 +0530660
Felix Fietkauba4903f2011-05-17 21:09:54 +0200661 ath9k_reset_beacon_status(sc);
Rajkumar Manoharande5f8fc2012-04-13 13:16:34 +0530662 if (!(sc->sc_flags & SC_OP_BEACONS))
663 ath9k_hw_settsf64(ah, sc->beacon.bc_tstamp);
Felix Fietkauba4903f2011-05-17 21:09:54 +0200664
Rajkumar Manoharanf29f5c02011-05-20 17:52:11 +0530665 intval = TU_TO_USEC(conf->beacon_interval);
Fabrice Deyber81168e52011-05-24 08:44:35 -0500666 tsf = roundup(ath9k_hw_gettsf32(ah) + TU_TO_USEC(FUDGE), intval);
667 nexttbtt = tsf + intval;
Sujith5379c8a2009-03-03 10:16:54 +0530668
Joe Perchesd2182b62011-12-15 14:55:53 -0800669 ath_dbg(common, BEACON, "IBSS nexttbtt %u intval %u (%u)\n",
Joe Perches226afe62010-12-02 19:12:37 -0800670 nexttbtt, intval, conf->beacon_interval);
Sujith5379c8a2009-03-03 10:16:54 +0530671
672 /*
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.
676 */
Felix Fietkaua65e4cb42010-05-13 20:37:25 +0200677 ah->imask |= ATH9K_INT_SWBA;
Sujith5379c8a2009-03-03 10:16:54 +0530678
679 ath_beaconq_config(sc);
680
681 /* Set the computed ADHOC beacon timers */
682
Felix Fietkau4df30712010-11-08 20:54:47 +0100683 ath9k_hw_disable_interrupts(ah);
Luis R. Rodriguez21526d52009-09-09 20:05:39 -0700684 ath9k_beacon_init(sc, nexttbtt, intval);
Sujith5379c8a2009-03-03 10:16:54 +0530685 sc->beacon.bmisscnt = 0;
Rajkumar Manoharane8fe7332011-08-05 18:59:41 +0530686
Felix Fietkau72d874c2011-10-08 20:06:19 +0200687 ath9k_hw_set_interrupts(ah);
Rajkumar Manoharane8fe7332011-08-05 18:59:41 +0530688 ath9k_hw_enable_interrupts(ah);
Sujith5379c8a2009-03-03 10:16:54 +0530689}
690
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530691static bool ath9k_allow_beacon_config(struct ath_softc *sc,
692 struct ieee80211_vif *vif)
Sujith5379c8a2009-03-03 10:16:54 +0530693{
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530694 struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
Luis R. Rodriguezc46917b2009-09-13 02:42:02 -0700695 struct ath_common *common = ath9k_hw_common(sc->sc_ah);
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530696 struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
697 struct ath_vif *avp = (void *)vif->drv_priv;
698
699 /*
700 * Can not have different beacon interval on multiple
701 * AP interface case
702 */
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)) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800707 ath_dbg(common, CONFIG,
708 "Changing beacon interval of multiple AP interfaces !\n");
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530709 return false;
710 }
711 /*
712 * Can not configure station vif's beacon config
713 * while on AP opmode
714 */
715 if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) &&
716 (vif->type != NL80211_IFTYPE_AP)) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800717 ath_dbg(common, CONFIG,
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530718 "STA vif's beacon not allowed on AP mode\n");
719 return false;
720 }
721 /*
722 * Do not allow beacon config if HW was already configured
723 * with another STA vif
724 */
725 if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
726 (vif->type == NL80211_IFTYPE_STATION) &&
727 (sc->sc_flags & SC_OP_BEACONS) &&
728 !avp->primary_sta_vif) {
Joe Perchesd2182b62011-12-15 14:55:53 -0800729 ath_dbg(common, CONFIG,
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530730 "Beacon already configured for a station interface\n");
731 return false;
732 }
733 return true;
734}
735
736void ath_beacon_config(struct ath_softc *sc, struct ieee80211_vif *vif)
737{
738 struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
739 struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
740
741 if (!ath9k_allow_beacon_config(sc, vif))
742 return;
Sujith5379c8a2009-03-03 10:16:54 +0530743
744 /* Setup the beacon configuration parameters */
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530745 cur_conf->beacon_interval = bss_conf->beacon_int;
746 cur_conf->dtim_period = bss_conf->dtim_period;
Ben Greear48014162011-01-15 19:13:48 +0000747 cur_conf->listen_interval = 1;
748 cur_conf->dtim_count = 1;
749 cur_conf->bmiss_timeout =
750 ATH_DEFAULT_BMISS_LIMIT * cur_conf->beacon_interval;
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530751
Vasanthakumar Thiagarajanc4f9f162009-06-12 10:55:55 +0530752 /*
753 * It looks like mac80211 may end up using beacon interval of zero in
754 * some cases (at least for mesh point). Avoid getting into an
755 * infinite loop by using a bit safer value instead. To be safe,
756 * do sanity check on beacon interval for all operating modes.
757 */
758 if (cur_conf->beacon_interval == 0)
759 cur_conf->beacon_interval = 100;
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530760
Mohammed Shafi Shajakhanee832d32010-12-28 13:06:26 +0530761 /*
Mohammed Shafi Shajakhan3a2329f2011-02-07 21:08:28 +0530762 * We don't parse dtim period from mac80211 during the driver
763 * initialization as it breaks association with hidden-ssid
764 * AP and it causes latency in roaming
Mohammed Shafi Shajakhanee832d32010-12-28 13:06:26 +0530765 */
766 if (cur_conf->dtim_period == 0)
767 cur_conf->dtim_period = 1;
768
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530769 ath_set_beacon(sc);
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530770}
771
Rajkumar Manoharan8e22ad32011-04-17 21:38:10 +0530772static bool ath_has_valid_bslot(struct ath_softc *sc)
773{
774 struct ath_vif *avp;
775 int slot;
776 bool found = false;
777
778 for (slot = 0; slot < ATH_BCBUF; slot++) {
779 if (sc->beacon.bslot[slot]) {
780 avp = (void *)sc->beacon.bslot[slot]->drv_priv;
781 if (avp->is_bslot_active) {
782 found = true;
783 break;
784 }
785 }
786 }
787 return found;
788}
789
790
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530791void ath_set_beacon(struct ath_softc *sc)
792{
793 struct ath_common *common = ath9k_hw_common(sc->sc_ah);
794 struct ath_beacon_config *cur_conf = &sc->cur_beacon_conf;
795
Felix Fietkau26cd3222011-04-02 03:39:48 +0200796 switch (sc->sc_ah->opmode) {
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530797 case NL80211_IFTYPE_AP:
Rajkumar Manoharan8e22ad32011-04-17 21:38:10 +0530798 if (ath_has_valid_bslot(sc))
799 ath_beacon_config_ap(sc, cur_conf);
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530800 break;
801 case NL80211_IFTYPE_ADHOC:
802 case NL80211_IFTYPE_MESH_POINT:
Mohammed Shafi Shajakhanee832d32010-12-28 13:06:26 +0530803 ath_beacon_config_adhoc(sc, cur_conf);
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530804 break;
805 case NL80211_IFTYPE_STATION:
806 ath_beacon_config_sta(sc, cur_conf);
807 break;
808 default:
Joe Perchesd2182b62011-12-15 14:55:53 -0800809 ath_dbg(common, CONFIG, "Unsupported beaconing mode\n");
Vasanthakumar Thiagarajan6b96f932009-05-15 18:59:22 +0530810 return;
811 }
812
813 sc->sc_flags |= SC_OP_BEACONS;
Luis R. Rodriguezf078f202008-08-04 00:16:41 -0700814}
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530815
816void ath9k_set_beaconing_status(struct ath_softc *sc, bool status)
817{
818 struct ath_hw *ah = sc->sc_ah;
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530819
Rajkumar Manoharaned2578c2012-04-19 19:13:51 +0530820 if (!ath_has_valid_bslot(sc)) {
821 sc->sc_flags &= ~SC_OP_BEACONS;
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530822 return;
Rajkumar Manoharaned2578c2012-04-19 19:13:51 +0530823 }
Rajkumar Manoharan99e4d432011-04-04 22:56:19 +0530824
825 ath9k_ps_wakeup(sc);
826 if (status) {
827 /* Re-enable beaconing */
828 ah->imask |= ATH9K_INT_SWBA;
Felix Fietkau72d874c2011-10-08 20:06:19 +0200829 ath9k_hw_set_interrupts(ah);
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530830 } else {
831 /* Disable SWBA interrupt */
832 ah->imask &= ~ATH9K_INT_SWBA;
Felix Fietkau72d874c2011-10-08 20:06:19 +0200833 ath9k_hw_set_interrupts(ah);
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530834 tasklet_kill(&sc->bcon_tasklet);
Felix Fietkauefff3952011-03-11 21:38:20 +0100835 ath9k_hw_stop_dma_queue(ah, sc->beacon.beaconq);
Rajkumar Manoharan014cf3b2011-02-09 17:46:39 +0530836 }
837 ath9k_ps_restore(sc);
838}