xref: /openbmc/linux/drivers/net/wireless/ath/ath9k/recv.c (revision 58f5fffdc3b8567b3fa8ed77d75699db87e2d1d4)
1203c4805SLuis R. Rodriguez /*
2203c4805SLuis R. Rodriguez  * Copyright (c) 2008-2009 Atheros Communications Inc.
3203c4805SLuis R. Rodriguez  *
4203c4805SLuis R. Rodriguez  * Permission to use, copy, modify, and/or distribute this software for any
5203c4805SLuis R. Rodriguez  * purpose with or without fee is hereby granted, provided that the above
6203c4805SLuis R. Rodriguez  * copyright notice and this permission notice appear in all copies.
7203c4805SLuis R. Rodriguez  *
8203c4805SLuis R. Rodriguez  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9203c4805SLuis R. Rodriguez  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10203c4805SLuis R. Rodriguez  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11203c4805SLuis R. Rodriguez  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12203c4805SLuis R. Rodriguez  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13203c4805SLuis R. Rodriguez  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14203c4805SLuis R. Rodriguez  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15203c4805SLuis R. Rodriguez  */
16203c4805SLuis R. Rodriguez 
17203c4805SLuis R. Rodriguez #include "ath9k.h"
18203c4805SLuis R. Rodriguez 
19203c4805SLuis R. Rodriguez static struct ieee80211_hw * ath_get_virt_hw(struct ath_softc *sc,
20203c4805SLuis R. Rodriguez 					     struct ieee80211_hdr *hdr)
21203c4805SLuis R. Rodriguez {
22203c4805SLuis R. Rodriguez 	struct ieee80211_hw *hw = sc->pri_wiphy->hw;
23203c4805SLuis R. Rodriguez 	int i;
24203c4805SLuis R. Rodriguez 
25203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->wiphy_lock);
26203c4805SLuis R. Rodriguez 	for (i = 0; i < sc->num_sec_wiphy; i++) {
27203c4805SLuis R. Rodriguez 		struct ath_wiphy *aphy = sc->sec_wiphy[i];
28203c4805SLuis R. Rodriguez 		if (aphy == NULL)
29203c4805SLuis R. Rodriguez 			continue;
30203c4805SLuis R. Rodriguez 		if (compare_ether_addr(hdr->addr1, aphy->hw->wiphy->perm_addr)
31203c4805SLuis R. Rodriguez 		    == 0) {
32203c4805SLuis R. Rodriguez 			hw = aphy->hw;
33203c4805SLuis R. Rodriguez 			break;
34203c4805SLuis R. Rodriguez 		}
35203c4805SLuis R. Rodriguez 	}
36203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->wiphy_lock);
37203c4805SLuis R. Rodriguez 	return hw;
38203c4805SLuis R. Rodriguez }
39203c4805SLuis R. Rodriguez 
40203c4805SLuis R. Rodriguez /*
41203c4805SLuis R. Rodriguez  * Setup and link descriptors.
42203c4805SLuis R. Rodriguez  *
43203c4805SLuis R. Rodriguez  * 11N: we can no longer afford to self link the last descriptor.
44203c4805SLuis R. Rodriguez  * MAC acknowledges BA status as long as it copies frames to host
45203c4805SLuis R. Rodriguez  * buffer (or rx fifo). This can incorrectly acknowledge packets
46203c4805SLuis R. Rodriguez  * to a sender if last desc is self-linked.
47203c4805SLuis R. Rodriguez  */
48203c4805SLuis R. Rodriguez static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf)
49203c4805SLuis R. Rodriguez {
50203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
51203c4805SLuis R. Rodriguez 	struct ath_desc *ds;
52203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
53203c4805SLuis R. Rodriguez 
54203c4805SLuis R. Rodriguez 	ATH_RXBUF_RESET(bf);
55203c4805SLuis R. Rodriguez 
56203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
57203c4805SLuis R. Rodriguez 	ds->ds_link = 0; /* link to null */
58203c4805SLuis R. Rodriguez 	ds->ds_data = bf->bf_buf_addr;
59203c4805SLuis R. Rodriguez 
60203c4805SLuis R. Rodriguez 	/* virtual addr of the beginning of the buffer. */
61203c4805SLuis R. Rodriguez 	skb = bf->bf_mpdu;
62203c4805SLuis R. Rodriguez 	ASSERT(skb != NULL);
63203c4805SLuis R. Rodriguez 	ds->ds_vdata = skb->data;
64203c4805SLuis R. Rodriguez 
65203c4805SLuis R. Rodriguez 	/* setup rx descriptors. The rx.bufsize here tells the harware
66203c4805SLuis R. Rodriguez 	 * how much data it can DMA to us and that we are prepared
67203c4805SLuis R. Rodriguez 	 * to process */
68203c4805SLuis R. Rodriguez 	ath9k_hw_setuprxdesc(ah, ds,
69203c4805SLuis R. Rodriguez 			     sc->rx.bufsize,
70203c4805SLuis R. Rodriguez 			     0);
71203c4805SLuis R. Rodriguez 
72203c4805SLuis R. Rodriguez 	if (sc->rx.rxlink == NULL)
73203c4805SLuis R. Rodriguez 		ath9k_hw_putrxbuf(ah, bf->bf_daddr);
74203c4805SLuis R. Rodriguez 	else
75203c4805SLuis R. Rodriguez 		*sc->rx.rxlink = bf->bf_daddr;
76203c4805SLuis R. Rodriguez 
77203c4805SLuis R. Rodriguez 	sc->rx.rxlink = &ds->ds_link;
78203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
79203c4805SLuis R. Rodriguez }
80203c4805SLuis R. Rodriguez 
81203c4805SLuis R. Rodriguez static void ath_setdefantenna(struct ath_softc *sc, u32 antenna)
82203c4805SLuis R. Rodriguez {
83203c4805SLuis R. Rodriguez 	/* XXX block beacon interrupts */
84203c4805SLuis R. Rodriguez 	ath9k_hw_setantenna(sc->sc_ah, antenna);
85203c4805SLuis R. Rodriguez 	sc->rx.defant = antenna;
86203c4805SLuis R. Rodriguez 	sc->rx.rxotherant = 0;
87203c4805SLuis R. Rodriguez }
88203c4805SLuis R. Rodriguez 
89203c4805SLuis R. Rodriguez /*
90203c4805SLuis R. Rodriguez  *  Extend 15-bit time stamp from rx descriptor to
91203c4805SLuis R. Rodriguez  *  a full 64-bit TSF using the current h/w TSF.
92203c4805SLuis R. Rodriguez */
93203c4805SLuis R. Rodriguez static u64 ath_extend_tsf(struct ath_softc *sc, u32 rstamp)
94203c4805SLuis R. Rodriguez {
95203c4805SLuis R. Rodriguez 	u64 tsf;
96203c4805SLuis R. Rodriguez 
97203c4805SLuis R. Rodriguez 	tsf = ath9k_hw_gettsf64(sc->sc_ah);
98203c4805SLuis R. Rodriguez 	if ((tsf & 0x7fff) < rstamp)
99203c4805SLuis R. Rodriguez 		tsf -= 0x8000;
100203c4805SLuis R. Rodriguez 	return (tsf & ~0x7fff) | rstamp;
101203c4805SLuis R. Rodriguez }
102203c4805SLuis R. Rodriguez 
103203c4805SLuis R. Rodriguez static struct sk_buff *ath_rxbuf_alloc(struct ath_softc *sc, u32 len, gfp_t gfp_mask)
104203c4805SLuis R. Rodriguez {
105203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
106203c4805SLuis R. Rodriguez 	u32 off;
107203c4805SLuis R. Rodriguez 
108203c4805SLuis R. Rodriguez 	/*
109203c4805SLuis R. Rodriguez 	 * Cache-line-align.  This is important (for the
110203c4805SLuis R. Rodriguez 	 * 5210 at least) as not doing so causes bogus data
111203c4805SLuis R. Rodriguez 	 * in rx'd frames.
112203c4805SLuis R. Rodriguez 	 */
113203c4805SLuis R. Rodriguez 
114203c4805SLuis R. Rodriguez 	/* Note: the kernel can allocate a value greater than
115203c4805SLuis R. Rodriguez 	 * what we ask it to give us. We really only need 4 KB as that
116203c4805SLuis R. Rodriguez 	 * is this hardware supports and in fact we need at least 3849
117203c4805SLuis R. Rodriguez 	 * as that is the MAX AMSDU size this hardware supports.
118203c4805SLuis R. Rodriguez 	 * Unfortunately this means we may get 8 KB here from the
119203c4805SLuis R. Rodriguez 	 * kernel... and that is actually what is observed on some
120203c4805SLuis R. Rodriguez 	 * systems :( */
121203c4805SLuis R. Rodriguez 	skb = __dev_alloc_skb(len + sc->cachelsz - 1, gfp_mask);
122203c4805SLuis R. Rodriguez 	if (skb != NULL) {
123203c4805SLuis R. Rodriguez 		off = ((unsigned long) skb->data) % sc->cachelsz;
124203c4805SLuis R. Rodriguez 		if (off != 0)
125203c4805SLuis R. Rodriguez 			skb_reserve(skb, sc->cachelsz - off);
126203c4805SLuis R. Rodriguez 	} else {
127203c4805SLuis R. Rodriguez 		DPRINTF(sc, ATH_DBG_FATAL,
128203c4805SLuis R. Rodriguez 			"skbuff alloc of size %u failed\n", len);
129203c4805SLuis R. Rodriguez 		return NULL;
130203c4805SLuis R. Rodriguez 	}
131203c4805SLuis R. Rodriguez 
132203c4805SLuis R. Rodriguez 	return skb;
133203c4805SLuis R. Rodriguez }
134203c4805SLuis R. Rodriguez 
135203c4805SLuis R. Rodriguez /*
136203c4805SLuis R. Rodriguez  * For Decrypt or Demic errors, we only mark packet status here and always push
137203c4805SLuis R. Rodriguez  * up the frame up to let mac80211 handle the actual error case, be it no
138203c4805SLuis R. Rodriguez  * decryption key or real decryption error. This let us keep statistics there.
139203c4805SLuis R. Rodriguez  */
140203c4805SLuis R. Rodriguez static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
141203c4805SLuis R. Rodriguez 			  struct ieee80211_rx_status *rx_status, bool *decrypt_error,
142203c4805SLuis R. Rodriguez 			  struct ath_softc *sc)
143203c4805SLuis R. Rodriguez {
144203c4805SLuis R. Rodriguez 	struct ieee80211_hdr *hdr;
145203c4805SLuis R. Rodriguez 	u8 ratecode;
146203c4805SLuis R. Rodriguez 	__le16 fc;
147203c4805SLuis R. Rodriguez 	struct ieee80211_hw *hw;
148203c4805SLuis R. Rodriguez 
149203c4805SLuis R. Rodriguez 	hdr = (struct ieee80211_hdr *)skb->data;
150203c4805SLuis R. Rodriguez 	fc = hdr->frame_control;
151203c4805SLuis R. Rodriguez 	memset(rx_status, 0, sizeof(struct ieee80211_rx_status));
152203c4805SLuis R. Rodriguez 	hw = ath_get_virt_hw(sc, hdr);
153203c4805SLuis R. Rodriguez 
154203c4805SLuis R. Rodriguez 	if (ds->ds_rxstat.rs_more) {
155203c4805SLuis R. Rodriguez 		/*
156203c4805SLuis R. Rodriguez 		 * Frame spans multiple descriptors; this cannot happen yet
157203c4805SLuis R. Rodriguez 		 * as we don't support jumbograms. If not in monitor mode,
158203c4805SLuis R. Rodriguez 		 * discard the frame. Enable this if you want to see
159203c4805SLuis R. Rodriguez 		 * error frames in Monitor mode.
160203c4805SLuis R. Rodriguez 		 */
161203c4805SLuis R. Rodriguez 		if (sc->sc_ah->opmode != NL80211_IFTYPE_MONITOR)
162203c4805SLuis R. Rodriguez 			goto rx_next;
163203c4805SLuis R. Rodriguez 	} else if (ds->ds_rxstat.rs_status != 0) {
164203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_CRC)
165203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
166203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_PHY)
167203c4805SLuis R. Rodriguez 			goto rx_next;
168203c4805SLuis R. Rodriguez 
169203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_DECRYPT) {
170203c4805SLuis R. Rodriguez 			*decrypt_error = true;
171203c4805SLuis R. Rodriguez 		} else if (ds->ds_rxstat.rs_status & ATH9K_RXERR_MIC) {
172203c4805SLuis R. Rodriguez 			if (ieee80211_is_ctl(fc))
173203c4805SLuis R. Rodriguez 				/*
174203c4805SLuis R. Rodriguez 				 * Sometimes, we get invalid
175203c4805SLuis R. Rodriguez 				 * MIC failures on valid control frames.
176203c4805SLuis R. Rodriguez 				 * Remove these mic errors.
177203c4805SLuis R. Rodriguez 				 */
178203c4805SLuis R. Rodriguez 				ds->ds_rxstat.rs_status &= ~ATH9K_RXERR_MIC;
179203c4805SLuis R. Rodriguez 			else
180203c4805SLuis R. Rodriguez 				rx_status->flag |= RX_FLAG_MMIC_ERROR;
181203c4805SLuis R. Rodriguez 		}
182203c4805SLuis R. Rodriguez 		/*
183203c4805SLuis R. Rodriguez 		 * Reject error frames with the exception of
184203c4805SLuis R. Rodriguez 		 * decryption and MIC failures. For monitor mode,
185203c4805SLuis R. Rodriguez 		 * we also ignore the CRC error.
186203c4805SLuis R. Rodriguez 		 */
187203c4805SLuis R. Rodriguez 		if (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR) {
188203c4805SLuis R. Rodriguez 			if (ds->ds_rxstat.rs_status &
189203c4805SLuis R. Rodriguez 			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
190203c4805SLuis R. Rodriguez 			      ATH9K_RXERR_CRC))
191203c4805SLuis R. Rodriguez 				goto rx_next;
192203c4805SLuis R. Rodriguez 		} else {
193203c4805SLuis R. Rodriguez 			if (ds->ds_rxstat.rs_status &
194203c4805SLuis R. Rodriguez 			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) {
195203c4805SLuis R. Rodriguez 				goto rx_next;
196203c4805SLuis R. Rodriguez 			}
197203c4805SLuis R. Rodriguez 		}
198203c4805SLuis R. Rodriguez 	}
199203c4805SLuis R. Rodriguez 
200203c4805SLuis R. Rodriguez 	ratecode = ds->ds_rxstat.rs_rate;
201203c4805SLuis R. Rodriguez 
202203c4805SLuis R. Rodriguez 	if (ratecode & 0x80) {
203203c4805SLuis R. Rodriguez 		/* HT rate */
204203c4805SLuis R. Rodriguez 		rx_status->flag |= RX_FLAG_HT;
205203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_flags & ATH9K_RX_2040)
206203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_40MHZ;
207203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_flags & ATH9K_RX_GI)
208203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_SHORT_GI;
209203c4805SLuis R. Rodriguez 		rx_status->rate_idx = ratecode & 0x7f;
210203c4805SLuis R. Rodriguez 	} else {
211203c4805SLuis R. Rodriguez 		int i = 0, cur_band, n_rates;
212203c4805SLuis R. Rodriguez 
213203c4805SLuis R. Rodriguez 		cur_band = hw->conf.channel->band;
214203c4805SLuis R. Rodriguez 		n_rates = sc->sbands[cur_band].n_bitrates;
215203c4805SLuis R. Rodriguez 
216203c4805SLuis R. Rodriguez 		for (i = 0; i < n_rates; i++) {
217203c4805SLuis R. Rodriguez 			if (sc->sbands[cur_band].bitrates[i].hw_value ==
218203c4805SLuis R. Rodriguez 			    ratecode) {
219203c4805SLuis R. Rodriguez 				rx_status->rate_idx = i;
220203c4805SLuis R. Rodriguez 				break;
221203c4805SLuis R. Rodriguez 			}
222203c4805SLuis R. Rodriguez 
223203c4805SLuis R. Rodriguez 			if (sc->sbands[cur_band].bitrates[i].hw_value_short ==
224203c4805SLuis R. Rodriguez 			    ratecode) {
225203c4805SLuis R. Rodriguez 				rx_status->rate_idx = i;
226203c4805SLuis R. Rodriguez 				rx_status->flag |= RX_FLAG_SHORTPRE;
227203c4805SLuis R. Rodriguez 				break;
228203c4805SLuis R. Rodriguez 			}
229203c4805SLuis R. Rodriguez 		}
230203c4805SLuis R. Rodriguez 	}
231203c4805SLuis R. Rodriguez 
232203c4805SLuis R. Rodriguez 	rx_status->mactime = ath_extend_tsf(sc, ds->ds_rxstat.rs_tstamp);
233203c4805SLuis R. Rodriguez 	rx_status->band = hw->conf.channel->band;
234203c4805SLuis R. Rodriguez 	rx_status->freq = hw->conf.channel->center_freq;
235203c4805SLuis R. Rodriguez 	rx_status->noise = sc->ani.noise_floor;
236203c4805SLuis R. Rodriguez 	rx_status->signal = rx_status->noise + ds->ds_rxstat.rs_rssi;
237203c4805SLuis R. Rodriguez 	rx_status->antenna = ds->ds_rxstat.rs_antenna;
238203c4805SLuis R. Rodriguez 
239203c4805SLuis R. Rodriguez 	/* at 45 you will be able to use MCS 15 reliably. A more elaborate
240203c4805SLuis R. Rodriguez 	 * scheme can be used here but it requires tables of SNR/throughput for
241203c4805SLuis R. Rodriguez 	 * each possible mode used. */
242203c4805SLuis R. Rodriguez 	rx_status->qual =  ds->ds_rxstat.rs_rssi * 100 / 45;
243203c4805SLuis R. Rodriguez 
244203c4805SLuis R. Rodriguez 	/* rssi can be more than 45 though, anything above that
245203c4805SLuis R. Rodriguez 	 * should be considered at 100% */
246203c4805SLuis R. Rodriguez 	if (rx_status->qual > 100)
247203c4805SLuis R. Rodriguez 		rx_status->qual = 100;
248203c4805SLuis R. Rodriguez 
249203c4805SLuis R. Rodriguez 	rx_status->flag |= RX_FLAG_TSFT;
250203c4805SLuis R. Rodriguez 
251203c4805SLuis R. Rodriguez 	return 1;
252203c4805SLuis R. Rodriguez rx_next:
253203c4805SLuis R. Rodriguez 	return 0;
254203c4805SLuis R. Rodriguez }
255203c4805SLuis R. Rodriguez 
256203c4805SLuis R. Rodriguez static void ath_opmode_init(struct ath_softc *sc)
257203c4805SLuis R. Rodriguez {
258203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
259203c4805SLuis R. Rodriguez 	u32 rfilt, mfilt[2];
260203c4805SLuis R. Rodriguez 
261203c4805SLuis R. Rodriguez 	/* configure rx filter */
262203c4805SLuis R. Rodriguez 	rfilt = ath_calcrxfilter(sc);
263203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, rfilt);
264203c4805SLuis R. Rodriguez 
265203c4805SLuis R. Rodriguez 	/* configure bssid mask */
266203c4805SLuis R. Rodriguez 	if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
267203c4805SLuis R. Rodriguez 		ath9k_hw_setbssidmask(sc);
268203c4805SLuis R. Rodriguez 
269203c4805SLuis R. Rodriguez 	/* configure operational mode */
270203c4805SLuis R. Rodriguez 	ath9k_hw_setopmode(ah);
271203c4805SLuis R. Rodriguez 
272203c4805SLuis R. Rodriguez 	/* Handle any link-level address change. */
273203c4805SLuis R. Rodriguez 	ath9k_hw_setmac(ah, sc->sc_ah->macaddr);
274203c4805SLuis R. Rodriguez 
275203c4805SLuis R. Rodriguez 	/* calculate and install multicast filter */
276203c4805SLuis R. Rodriguez 	mfilt[0] = mfilt[1] = ~0;
277203c4805SLuis R. Rodriguez 	ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]);
278203c4805SLuis R. Rodriguez }
279203c4805SLuis R. Rodriguez 
280203c4805SLuis R. Rodriguez int ath_rx_init(struct ath_softc *sc, int nbufs)
281203c4805SLuis R. Rodriguez {
282203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
283203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
284203c4805SLuis R. Rodriguez 	int error = 0;
285203c4805SLuis R. Rodriguez 
286203c4805SLuis R. Rodriguez 	spin_lock_init(&sc->rx.rxflushlock);
287203c4805SLuis R. Rodriguez 	sc->sc_flags &= ~SC_OP_RXFLUSH;
288203c4805SLuis R. Rodriguez 	spin_lock_init(&sc->rx.rxbuflock);
289203c4805SLuis R. Rodriguez 
290203c4805SLuis R. Rodriguez 	sc->rx.bufsize = roundup(IEEE80211_MAX_MPDU_LEN,
291203c4805SLuis R. Rodriguez 				 min(sc->cachelsz, (u16)64));
292203c4805SLuis R. Rodriguez 
293203c4805SLuis R. Rodriguez 	DPRINTF(sc, ATH_DBG_CONFIG, "cachelsz %u rxbufsize %u\n",
294203c4805SLuis R. Rodriguez 		sc->cachelsz, sc->rx.bufsize);
295203c4805SLuis R. Rodriguez 
296203c4805SLuis R. Rodriguez 	/* Initialize rx descriptors */
297203c4805SLuis R. Rodriguez 
298203c4805SLuis R. Rodriguez 	error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
299203c4805SLuis R. Rodriguez 				  "rx", nbufs, 1);
300203c4805SLuis R. Rodriguez 	if (error != 0) {
301203c4805SLuis R. Rodriguez 		DPRINTF(sc, ATH_DBG_FATAL,
302203c4805SLuis R. Rodriguez 			"failed to allocate rx descriptors: %d\n", error);
303203c4805SLuis R. Rodriguez 		goto err;
304203c4805SLuis R. Rodriguez 	}
305203c4805SLuis R. Rodriguez 
306203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
307203c4805SLuis R. Rodriguez 		skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_KERNEL);
308203c4805SLuis R. Rodriguez 		if (skb == NULL) {
309203c4805SLuis R. Rodriguez 			error = -ENOMEM;
310203c4805SLuis R. Rodriguez 			goto err;
311203c4805SLuis R. Rodriguez 		}
312203c4805SLuis R. Rodriguez 
313203c4805SLuis R. Rodriguez 		bf->bf_mpdu = skb;
314203c4805SLuis R. Rodriguez 		bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
315203c4805SLuis R. Rodriguez 						 sc->rx.bufsize,
316203c4805SLuis R. Rodriguez 						 DMA_FROM_DEVICE);
317203c4805SLuis R. Rodriguez 		if (unlikely(dma_mapping_error(sc->dev,
318203c4805SLuis R. Rodriguez 					       bf->bf_buf_addr))) {
319203c4805SLuis R. Rodriguez 			dev_kfree_skb_any(skb);
320203c4805SLuis R. Rodriguez 			bf->bf_mpdu = NULL;
321203c4805SLuis R. Rodriguez 			DPRINTF(sc, ATH_DBG_FATAL,
322203c4805SLuis R. Rodriguez 				"dma_mapping_error() on RX init\n");
323203c4805SLuis R. Rodriguez 			error = -ENOMEM;
324203c4805SLuis R. Rodriguez 			goto err;
325203c4805SLuis R. Rodriguez 		}
326203c4805SLuis R. Rodriguez 		bf->bf_dmacontext = bf->bf_buf_addr;
327203c4805SLuis R. Rodriguez 	}
328203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
329203c4805SLuis R. Rodriguez 
330203c4805SLuis R. Rodriguez err:
331203c4805SLuis R. Rodriguez 	if (error)
332203c4805SLuis R. Rodriguez 		ath_rx_cleanup(sc);
333203c4805SLuis R. Rodriguez 
334203c4805SLuis R. Rodriguez 	return error;
335203c4805SLuis R. Rodriguez }
336203c4805SLuis R. Rodriguez 
337203c4805SLuis R. Rodriguez void ath_rx_cleanup(struct ath_softc *sc)
338203c4805SLuis R. Rodriguez {
339203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
340203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
341203c4805SLuis R. Rodriguez 
342203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
343203c4805SLuis R. Rodriguez 		skb = bf->bf_mpdu;
344203c4805SLuis R. Rodriguez 		if (skb) {
345203c4805SLuis R. Rodriguez 			dma_unmap_single(sc->dev, bf->bf_buf_addr,
346203c4805SLuis R. Rodriguez 					 sc->rx.bufsize, DMA_FROM_DEVICE);
347203c4805SLuis R. Rodriguez 			dev_kfree_skb(skb);
348203c4805SLuis R. Rodriguez 		}
349203c4805SLuis R. Rodriguez 	}
350203c4805SLuis R. Rodriguez 
351203c4805SLuis R. Rodriguez 	if (sc->rx.rxdma.dd_desc_len != 0)
352203c4805SLuis R. Rodriguez 		ath_descdma_cleanup(sc, &sc->rx.rxdma, &sc->rx.rxbuf);
353203c4805SLuis R. Rodriguez }
354203c4805SLuis R. Rodriguez 
355203c4805SLuis R. Rodriguez /*
356203c4805SLuis R. Rodriguez  * Calculate the receive filter according to the
357203c4805SLuis R. Rodriguez  * operating mode and state:
358203c4805SLuis R. Rodriguez  *
359203c4805SLuis R. Rodriguez  * o always accept unicast, broadcast, and multicast traffic
360203c4805SLuis R. Rodriguez  * o maintain current state of phy error reception (the hal
361203c4805SLuis R. Rodriguez  *   may enable phy error frames for noise immunity work)
362203c4805SLuis R. Rodriguez  * o probe request frames are accepted only when operating in
363203c4805SLuis R. Rodriguez  *   hostap, adhoc, or monitor modes
364203c4805SLuis R. Rodriguez  * o enable promiscuous mode according to the interface state
365203c4805SLuis R. Rodriguez  * o accept beacons:
366203c4805SLuis R. Rodriguez  *   - when operating in adhoc mode so the 802.11 layer creates
367203c4805SLuis R. Rodriguez  *     node table entries for peers,
368203c4805SLuis R. Rodriguez  *   - when operating in station mode for collecting rssi data when
369203c4805SLuis R. Rodriguez  *     the station is otherwise quiet, or
370203c4805SLuis R. Rodriguez  *   - when operating as a repeater so we see repeater-sta beacons
371203c4805SLuis R. Rodriguez  *   - when scanning
372203c4805SLuis R. Rodriguez  */
373203c4805SLuis R. Rodriguez 
374203c4805SLuis R. Rodriguez u32 ath_calcrxfilter(struct ath_softc *sc)
375203c4805SLuis R. Rodriguez {
376203c4805SLuis R. Rodriguez #define	RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR)
377203c4805SLuis R. Rodriguez 
378203c4805SLuis R. Rodriguez 	u32 rfilt;
379203c4805SLuis R. Rodriguez 
380203c4805SLuis R. Rodriguez 	rfilt = (ath9k_hw_getrxfilter(sc->sc_ah) & RX_FILTER_PRESERVE)
381203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
382203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_MCAST;
383203c4805SLuis R. Rodriguez 
384203c4805SLuis R. Rodriguez 	/* If not a STA, enable processing of Probe Requests */
385203c4805SLuis R. Rodriguez 	if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
386203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROBEREQ;
387203c4805SLuis R. Rodriguez 
388203c4805SLuis R. Rodriguez 	/*
389203c4805SLuis R. Rodriguez 	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
390203c4805SLuis R. Rodriguez 	 * mode interface or when in monitor mode. AP mode does not need this
391203c4805SLuis R. Rodriguez 	 * since it receives all in-BSS frames anyway.
392203c4805SLuis R. Rodriguez 	 */
393203c4805SLuis R. Rodriguez 	if (((sc->sc_ah->opmode != NL80211_IFTYPE_AP) &&
394203c4805SLuis R. Rodriguez 	     (sc->rx.rxfilter & FIF_PROMISC_IN_BSS)) ||
395203c4805SLuis R. Rodriguez 	    (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR))
396203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROM;
397203c4805SLuis R. Rodriguez 
398203c4805SLuis R. Rodriguez 	if (sc->rx.rxfilter & FIF_CONTROL)
399203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_CONTROL;
400203c4805SLuis R. Rodriguez 
401203c4805SLuis R. Rodriguez 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
402203c4805SLuis R. Rodriguez 	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
403203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MYBEACON;
404203c4805SLuis R. Rodriguez 	else
405203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_BEACON;
406203c4805SLuis R. Rodriguez 
407203c4805SLuis R. Rodriguez 	/* If in HOSTAP mode, want to enable reception of PSPOLL frames */
408203c4805SLuis R. Rodriguez 	if (sc->sc_ah->opmode == NL80211_IFTYPE_AP)
409203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PSPOLL;
410203c4805SLuis R. Rodriguez 
411203c4805SLuis R. Rodriguez 	if (sc->sec_wiphy) {
412203c4805SLuis R. Rodriguez 		/* TODO: only needed if more than one BSSID is in use in
413203c4805SLuis R. Rodriguez 		 * station/adhoc mode */
414203c4805SLuis R. Rodriguez 		/* TODO: for older chips, may need to add ATH9K_RX_FILTER_PROM
415203c4805SLuis R. Rodriguez 		 */
416203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
417203c4805SLuis R. Rodriguez 	}
418203c4805SLuis R. Rodriguez 
419203c4805SLuis R. Rodriguez 	return rfilt;
420203c4805SLuis R. Rodriguez 
421203c4805SLuis R. Rodriguez #undef RX_FILTER_PRESERVE
422203c4805SLuis R. Rodriguez }
423203c4805SLuis R. Rodriguez 
424203c4805SLuis R. Rodriguez int ath_startrecv(struct ath_softc *sc)
425203c4805SLuis R. Rodriguez {
426203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
427203c4805SLuis R. Rodriguez 	struct ath_buf *bf, *tbf;
428203c4805SLuis R. Rodriguez 
429203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxbuflock);
430203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
431203c4805SLuis R. Rodriguez 		goto start_recv;
432203c4805SLuis R. Rodriguez 
433203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
434203c4805SLuis R. Rodriguez 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
435203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
436203c4805SLuis R. Rodriguez 	}
437203c4805SLuis R. Rodriguez 
438203c4805SLuis R. Rodriguez 	/* We could have deleted elements so the list may be empty now */
439203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
440203c4805SLuis R. Rodriguez 		goto start_recv;
441203c4805SLuis R. Rodriguez 
442203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
443203c4805SLuis R. Rodriguez 	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
444203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
445203c4805SLuis R. Rodriguez 
446203c4805SLuis R. Rodriguez start_recv:
447203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxbuflock);
448203c4805SLuis R. Rodriguez 	ath_opmode_init(sc);
449203c4805SLuis R. Rodriguez 	ath9k_hw_startpcureceive(ah);
450203c4805SLuis R. Rodriguez 
451203c4805SLuis R. Rodriguez 	return 0;
452203c4805SLuis R. Rodriguez }
453203c4805SLuis R. Rodriguez 
454203c4805SLuis R. Rodriguez bool ath_stoprecv(struct ath_softc *sc)
455203c4805SLuis R. Rodriguez {
456203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
457203c4805SLuis R. Rodriguez 	bool stopped;
458203c4805SLuis R. Rodriguez 
459203c4805SLuis R. Rodriguez 	ath9k_hw_stoppcurecv(ah);
460203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, 0);
461203c4805SLuis R. Rodriguez 	stopped = ath9k_hw_stopdmarecv(ah);
462203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
463203c4805SLuis R. Rodriguez 
464203c4805SLuis R. Rodriguez 	return stopped;
465203c4805SLuis R. Rodriguez }
466203c4805SLuis R. Rodriguez 
467203c4805SLuis R. Rodriguez void ath_flushrecv(struct ath_softc *sc)
468203c4805SLuis R. Rodriguez {
469203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxflushlock);
470203c4805SLuis R. Rodriguez 	sc->sc_flags |= SC_OP_RXFLUSH;
471203c4805SLuis R. Rodriguez 	ath_rx_tasklet(sc, 1);
472203c4805SLuis R. Rodriguez 	sc->sc_flags &= ~SC_OP_RXFLUSH;
473203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxflushlock);
474203c4805SLuis R. Rodriguez }
475203c4805SLuis R. Rodriguez 
476cc65965cSJouni Malinen static bool ath_beacon_dtim_pending_cab(struct sk_buff *skb)
477cc65965cSJouni Malinen {
478cc65965cSJouni Malinen 	/* Check whether the Beacon frame has DTIM indicating buffered bc/mc */
479cc65965cSJouni Malinen 	struct ieee80211_mgmt *mgmt;
480cc65965cSJouni Malinen 	u8 *pos, *end, id, elen;
481cc65965cSJouni Malinen 	struct ieee80211_tim_ie *tim;
482cc65965cSJouni Malinen 
483cc65965cSJouni Malinen 	mgmt = (struct ieee80211_mgmt *)skb->data;
484cc65965cSJouni Malinen 	pos = mgmt->u.beacon.variable;
485cc65965cSJouni Malinen 	end = skb->data + skb->len;
486cc65965cSJouni Malinen 
487cc65965cSJouni Malinen 	while (pos + 2 < end) {
488cc65965cSJouni Malinen 		id = *pos++;
489cc65965cSJouni Malinen 		elen = *pos++;
490cc65965cSJouni Malinen 		if (pos + elen > end)
491cc65965cSJouni Malinen 			break;
492cc65965cSJouni Malinen 
493cc65965cSJouni Malinen 		if (id == WLAN_EID_TIM) {
494cc65965cSJouni Malinen 			if (elen < sizeof(*tim))
495cc65965cSJouni Malinen 				break;
496cc65965cSJouni Malinen 			tim = (struct ieee80211_tim_ie *) pos;
497cc65965cSJouni Malinen 			if (tim->dtim_count != 0)
498cc65965cSJouni Malinen 				break;
499cc65965cSJouni Malinen 			return tim->bitmap_ctrl & 0x01;
500cc65965cSJouni Malinen 		}
501cc65965cSJouni Malinen 
502cc65965cSJouni Malinen 		pos += elen;
503cc65965cSJouni Malinen 	}
504cc65965cSJouni Malinen 
505cc65965cSJouni Malinen 	return false;
506cc65965cSJouni Malinen }
507cc65965cSJouni Malinen 
508cc65965cSJouni Malinen static void ath_rx_ps_back_to_sleep(struct ath_softc *sc)
509cc65965cSJouni Malinen {
510cc65965cSJouni Malinen 	sc->sc_flags &= ~(SC_OP_WAIT_FOR_BEACON | SC_OP_WAIT_FOR_CAB);
511cc65965cSJouni Malinen }
512cc65965cSJouni Malinen 
513cc65965cSJouni Malinen static void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb)
514cc65965cSJouni Malinen {
515cc65965cSJouni Malinen 	struct ieee80211_mgmt *mgmt;
516cc65965cSJouni Malinen 
517cc65965cSJouni Malinen 	if (skb->len < 24 + 8 + 2 + 2)
518cc65965cSJouni Malinen 		return;
519cc65965cSJouni Malinen 
520cc65965cSJouni Malinen 	mgmt = (struct ieee80211_mgmt *)skb->data;
521cc65965cSJouni Malinen 	if (memcmp(sc->curbssid, mgmt->bssid, ETH_ALEN) != 0)
522cc65965cSJouni Malinen 		return; /* not from our current AP */
523cc65965cSJouni Malinen 
524ccdfeab6SJouni Malinen 	if (sc->sc_flags & SC_OP_BEACON_SYNC) {
525ccdfeab6SJouni Malinen 		sc->sc_flags &= ~SC_OP_BEACON_SYNC;
526ccdfeab6SJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "Reconfigure Beacon timers based on "
527ccdfeab6SJouni Malinen 			"timestamp from the AP\n");
528ccdfeab6SJouni Malinen 		ath_beacon_config(sc, NULL);
529ccdfeab6SJouni Malinen 	}
530ccdfeab6SJouni Malinen 
531cc65965cSJouni Malinen 	if (!(sc->hw->conf.flags & IEEE80211_CONF_PS)) {
532cc65965cSJouni Malinen 		/* We are not in PS mode anymore; remain awake */
533cc65965cSJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "Not in PS mode anymore, remain "
534cc65965cSJouni Malinen 			"awake\n");
535cc65965cSJouni Malinen 		sc->sc_flags &= ~(SC_OP_WAIT_FOR_BEACON | SC_OP_WAIT_FOR_CAB);
536cc65965cSJouni Malinen 		return;
537cc65965cSJouni Malinen 	}
538cc65965cSJouni Malinen 
539cc65965cSJouni Malinen 	if (ath_beacon_dtim_pending_cab(skb)) {
540cc65965cSJouni Malinen 		/*
541cc65965cSJouni Malinen 		 * Remain awake waiting for buffered broadcast/multicast
542*58f5fffdSGabor Juhos 		 * frames. If the last broadcast/multicast frame is not
543*58f5fffdSGabor Juhos 		 * received properly, the next beacon frame will work as
544*58f5fffdSGabor Juhos 		 * a backup trigger for returning into NETWORK SLEEP state,
545*58f5fffdSGabor Juhos 		 * so we are waiting for it as well.
546cc65965cSJouni Malinen 		 */
547cc65965cSJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "Received DTIM beacon indicating "
548cc65965cSJouni Malinen 			"buffered broadcast/multicast frame(s)\n");
549*58f5fffdSGabor Juhos 		sc->sc_flags |= SC_OP_WAIT_FOR_CAB | SC_OP_WAIT_FOR_BEACON;
550cc65965cSJouni Malinen 		return;
551cc65965cSJouni Malinen 	}
552cc65965cSJouni Malinen 
553cc65965cSJouni Malinen 	if (sc->sc_flags & SC_OP_WAIT_FOR_CAB) {
554cc65965cSJouni Malinen 		/*
555cc65965cSJouni Malinen 		 * This can happen if a broadcast frame is dropped or the AP
556cc65965cSJouni Malinen 		 * fails to send a frame indicating that all CAB frames have
557cc65965cSJouni Malinen 		 * been delivered.
558cc65965cSJouni Malinen 		 */
559cc65965cSJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "PS wait for CAB frames timed out\n");
560cc65965cSJouni Malinen 	}
561cc65965cSJouni Malinen 
562cc65965cSJouni Malinen 	/* No more broadcast/multicast frames to be received at this point. */
563cc65965cSJouni Malinen 	ath_rx_ps_back_to_sleep(sc);
564cc65965cSJouni Malinen }
565cc65965cSJouni Malinen 
566cc65965cSJouni Malinen static void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb)
567cc65965cSJouni Malinen {
568cc65965cSJouni Malinen 	struct ieee80211_hdr *hdr;
569cc65965cSJouni Malinen 
570cc65965cSJouni Malinen 	hdr = (struct ieee80211_hdr *)skb->data;
571cc65965cSJouni Malinen 
572cc65965cSJouni Malinen 	/* Process Beacon and CAB receive in PS state */
5739a23f9caSJouni Malinen 	if ((sc->sc_flags & SC_OP_WAIT_FOR_BEACON) &&
5749a23f9caSJouni Malinen 	    ieee80211_is_beacon(hdr->frame_control))
575cc65965cSJouni Malinen 		ath_rx_ps_beacon(sc, skb);
576cc65965cSJouni Malinen 	else if ((sc->sc_flags & SC_OP_WAIT_FOR_CAB) &&
577cc65965cSJouni Malinen 		 (ieee80211_is_data(hdr->frame_control) ||
578cc65965cSJouni Malinen 		  ieee80211_is_action(hdr->frame_control)) &&
579cc65965cSJouni Malinen 		 is_multicast_ether_addr(hdr->addr1) &&
580cc65965cSJouni Malinen 		 !ieee80211_has_moredata(hdr->frame_control)) {
581cc65965cSJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "All PS CAB frames received, back to "
582cc65965cSJouni Malinen 			"sleep\n");
583cc65965cSJouni Malinen 		/*
584cc65965cSJouni Malinen 		 * No more broadcast/multicast frames to be received at this
585cc65965cSJouni Malinen 		 * point.
586cc65965cSJouni Malinen 		 */
587cc65965cSJouni Malinen 		ath_rx_ps_back_to_sleep(sc);
5889a23f9caSJouni Malinen 	} else if ((sc->sc_flags & SC_OP_WAIT_FOR_PSPOLL_DATA) &&
5899a23f9caSJouni Malinen 		   !is_multicast_ether_addr(hdr->addr1) &&
5909a23f9caSJouni Malinen 		   !ieee80211_has_morefrags(hdr->frame_control)) {
5919a23f9caSJouni Malinen 		sc->sc_flags &= ~SC_OP_WAIT_FOR_PSPOLL_DATA;
5929a23f9caSJouni Malinen 		DPRINTF(sc, ATH_DBG_PS, "Going back to sleep after having "
5939a23f9caSJouni Malinen 			"received PS-Poll data (0x%x)\n",
5949a23f9caSJouni Malinen 			sc->sc_flags & (SC_OP_WAIT_FOR_BEACON |
5959a23f9caSJouni Malinen 					SC_OP_WAIT_FOR_CAB |
5969a23f9caSJouni Malinen 					SC_OP_WAIT_FOR_PSPOLL_DATA |
5979a23f9caSJouni Malinen 					SC_OP_WAIT_FOR_TX_ACK));
598cc65965cSJouni Malinen 	}
599cc65965cSJouni Malinen }
600cc65965cSJouni Malinen 
6019d64a3cfSJouni Malinen static void ath_rx_send_to_mac80211(struct ath_softc *sc, struct sk_buff *skb,
6029d64a3cfSJouni Malinen 				    struct ieee80211_rx_status *rx_status)
6039d64a3cfSJouni Malinen {
6049d64a3cfSJouni Malinen 	struct ieee80211_hdr *hdr;
6059d64a3cfSJouni Malinen 
6069d64a3cfSJouni Malinen 	hdr = (struct ieee80211_hdr *)skb->data;
6079d64a3cfSJouni Malinen 
6089d64a3cfSJouni Malinen 	/* Send the frame to mac80211 */
6099d64a3cfSJouni Malinen 	if (is_multicast_ether_addr(hdr->addr1)) {
6109d64a3cfSJouni Malinen 		int i;
6119d64a3cfSJouni Malinen 		/*
6129d64a3cfSJouni Malinen 		 * Deliver broadcast/multicast frames to all suitable
6139d64a3cfSJouni Malinen 		 * virtual wiphys.
6149d64a3cfSJouni Malinen 		 */
6159d64a3cfSJouni Malinen 		/* TODO: filter based on channel configuration */
6169d64a3cfSJouni Malinen 		for (i = 0; i < sc->num_sec_wiphy; i++) {
6179d64a3cfSJouni Malinen 			struct ath_wiphy *aphy = sc->sec_wiphy[i];
6189d64a3cfSJouni Malinen 			struct sk_buff *nskb;
6199d64a3cfSJouni Malinen 			if (aphy == NULL)
6209d64a3cfSJouni Malinen 				continue;
6219d64a3cfSJouni Malinen 			nskb = skb_copy(skb, GFP_ATOMIC);
6229d64a3cfSJouni Malinen 			if (nskb)
6239d64a3cfSJouni Malinen 				__ieee80211_rx(aphy->hw, nskb, rx_status);
6249d64a3cfSJouni Malinen 		}
6259d64a3cfSJouni Malinen 		__ieee80211_rx(sc->hw, skb, rx_status);
6269d64a3cfSJouni Malinen 	} else {
6279d64a3cfSJouni Malinen 		/* Deliver unicast frames based on receiver address */
6289d64a3cfSJouni Malinen 		__ieee80211_rx(ath_get_virt_hw(sc, hdr), skb, rx_status);
6299d64a3cfSJouni Malinen 	}
6309d64a3cfSJouni Malinen }
6319d64a3cfSJouni Malinen 
632203c4805SLuis R. Rodriguez int ath_rx_tasklet(struct ath_softc *sc, int flush)
633203c4805SLuis R. Rodriguez {
634203c4805SLuis R. Rodriguez #define PA2DESC(_sc, _pa)                                               \
635203c4805SLuis R. Rodriguez 	((struct ath_desc *)((caddr_t)(_sc)->rx.rxdma.dd_desc +		\
636203c4805SLuis R. Rodriguez 			     ((_pa) - (_sc)->rx.rxdma.dd_desc_paddr)))
637203c4805SLuis R. Rodriguez 
638203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
639203c4805SLuis R. Rodriguez 	struct ath_desc *ds;
640203c4805SLuis R. Rodriguez 	struct sk_buff *skb = NULL, *requeue_skb;
641203c4805SLuis R. Rodriguez 	struct ieee80211_rx_status rx_status;
642203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
643203c4805SLuis R. Rodriguez 	struct ieee80211_hdr *hdr;
644203c4805SLuis R. Rodriguez 	int hdrlen, padsize, retval;
645203c4805SLuis R. Rodriguez 	bool decrypt_error = false;
646203c4805SLuis R. Rodriguez 	u8 keyix;
647203c4805SLuis R. Rodriguez 	__le16 fc;
648203c4805SLuis R. Rodriguez 
649203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxbuflock);
650203c4805SLuis R. Rodriguez 
651203c4805SLuis R. Rodriguez 	do {
652203c4805SLuis R. Rodriguez 		/* If handling rx interrupt and flush is in progress => exit */
653203c4805SLuis R. Rodriguez 		if ((sc->sc_flags & SC_OP_RXFLUSH) && (flush == 0))
654203c4805SLuis R. Rodriguez 			break;
655203c4805SLuis R. Rodriguez 
656203c4805SLuis R. Rodriguez 		if (list_empty(&sc->rx.rxbuf)) {
657203c4805SLuis R. Rodriguez 			sc->rx.rxlink = NULL;
658203c4805SLuis R. Rodriguez 			break;
659203c4805SLuis R. Rodriguez 		}
660203c4805SLuis R. Rodriguez 
661203c4805SLuis R. Rodriguez 		bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
662203c4805SLuis R. Rodriguez 		ds = bf->bf_desc;
663203c4805SLuis R. Rodriguez 
664203c4805SLuis R. Rodriguez 		/*
665203c4805SLuis R. Rodriguez 		 * Must provide the virtual address of the current
666203c4805SLuis R. Rodriguez 		 * descriptor, the physical address, and the virtual
667203c4805SLuis R. Rodriguez 		 * address of the next descriptor in the h/w chain.
668203c4805SLuis R. Rodriguez 		 * This allows the HAL to look ahead to see if the
669203c4805SLuis R. Rodriguez 		 * hardware is done with a descriptor by checking the
670203c4805SLuis R. Rodriguez 		 * done bit in the following descriptor and the address
671203c4805SLuis R. Rodriguez 		 * of the current descriptor the DMA engine is working
672203c4805SLuis R. Rodriguez 		 * on.  All this is necessary because of our use of
673203c4805SLuis R. Rodriguez 		 * a self-linked list to avoid rx overruns.
674203c4805SLuis R. Rodriguez 		 */
675203c4805SLuis R. Rodriguez 		retval = ath9k_hw_rxprocdesc(ah, ds,
676203c4805SLuis R. Rodriguez 					     bf->bf_daddr,
677203c4805SLuis R. Rodriguez 					     PA2DESC(sc, ds->ds_link),
678203c4805SLuis R. Rodriguez 					     0);
679203c4805SLuis R. Rodriguez 		if (retval == -EINPROGRESS) {
680203c4805SLuis R. Rodriguez 			struct ath_buf *tbf;
681203c4805SLuis R. Rodriguez 			struct ath_desc *tds;
682203c4805SLuis R. Rodriguez 
683203c4805SLuis R. Rodriguez 			if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
684203c4805SLuis R. Rodriguez 				sc->rx.rxlink = NULL;
685203c4805SLuis R. Rodriguez 				break;
686203c4805SLuis R. Rodriguez 			}
687203c4805SLuis R. Rodriguez 
688203c4805SLuis R. Rodriguez 			tbf = list_entry(bf->list.next, struct ath_buf, list);
689203c4805SLuis R. Rodriguez 
690203c4805SLuis R. Rodriguez 			/*
691203c4805SLuis R. Rodriguez 			 * On some hardware the descriptor status words could
692203c4805SLuis R. Rodriguez 			 * get corrupted, including the done bit. Because of
693203c4805SLuis R. Rodriguez 			 * this, check if the next descriptor's done bit is
694203c4805SLuis R. Rodriguez 			 * set or not.
695203c4805SLuis R. Rodriguez 			 *
696203c4805SLuis R. Rodriguez 			 * If the next descriptor's done bit is set, the current
697203c4805SLuis R. Rodriguez 			 * descriptor has been corrupted. Force s/w to discard
698203c4805SLuis R. Rodriguez 			 * this descriptor and continue...
699203c4805SLuis R. Rodriguez 			 */
700203c4805SLuis R. Rodriguez 
701203c4805SLuis R. Rodriguez 			tds = tbf->bf_desc;
702203c4805SLuis R. Rodriguez 			retval = ath9k_hw_rxprocdesc(ah, tds, tbf->bf_daddr,
703203c4805SLuis R. Rodriguez 					     PA2DESC(sc, tds->ds_link), 0);
704203c4805SLuis R. Rodriguez 			if (retval == -EINPROGRESS) {
705203c4805SLuis R. Rodriguez 				break;
706203c4805SLuis R. Rodriguez 			}
707203c4805SLuis R. Rodriguez 		}
708203c4805SLuis R. Rodriguez 
709203c4805SLuis R. Rodriguez 		skb = bf->bf_mpdu;
710203c4805SLuis R. Rodriguez 		if (!skb)
711203c4805SLuis R. Rodriguez 			continue;
712203c4805SLuis R. Rodriguez 
713203c4805SLuis R. Rodriguez 		/*
714203c4805SLuis R. Rodriguez 		 * Synchronize the DMA transfer with CPU before
715203c4805SLuis R. Rodriguez 		 * 1. accessing the frame
716203c4805SLuis R. Rodriguez 		 * 2. requeueing the same buffer to h/w
717203c4805SLuis R. Rodriguez 		 */
718203c4805SLuis R. Rodriguez 		dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
719203c4805SLuis R. Rodriguez 				sc->rx.bufsize,
720203c4805SLuis R. Rodriguez 				DMA_FROM_DEVICE);
721203c4805SLuis R. Rodriguez 
722203c4805SLuis R. Rodriguez 		/*
723203c4805SLuis R. Rodriguez 		 * If we're asked to flush receive queue, directly
724203c4805SLuis R. Rodriguez 		 * chain it back at the queue without processing it.
725203c4805SLuis R. Rodriguez 		 */
726203c4805SLuis R. Rodriguez 		if (flush)
727203c4805SLuis R. Rodriguez 			goto requeue;
728203c4805SLuis R. Rodriguez 
729203c4805SLuis R. Rodriguez 		if (!ds->ds_rxstat.rs_datalen)
730203c4805SLuis R. Rodriguez 			goto requeue;
731203c4805SLuis R. Rodriguez 
732203c4805SLuis R. Rodriguez 		/* The status portion of the descriptor could get corrupted. */
733203c4805SLuis R. Rodriguez 		if (sc->rx.bufsize < ds->ds_rxstat.rs_datalen)
734203c4805SLuis R. Rodriguez 			goto requeue;
735203c4805SLuis R. Rodriguez 
736203c4805SLuis R. Rodriguez 		if (!ath_rx_prepare(skb, ds, &rx_status, &decrypt_error, sc))
737203c4805SLuis R. Rodriguez 			goto requeue;
738203c4805SLuis R. Rodriguez 
739203c4805SLuis R. Rodriguez 		/* Ensure we always have an skb to requeue once we are done
740203c4805SLuis R. Rodriguez 		 * processing the current buffer's skb */
741203c4805SLuis R. Rodriguez 		requeue_skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_ATOMIC);
742203c4805SLuis R. Rodriguez 
743203c4805SLuis R. Rodriguez 		/* If there is no memory we ignore the current RX'd frame,
744203c4805SLuis R. Rodriguez 		 * tell hardware it can give us a new frame using the old
745203c4805SLuis R. Rodriguez 		 * skb and put it at the tail of the sc->rx.rxbuf list for
746203c4805SLuis R. Rodriguez 		 * processing. */
747203c4805SLuis R. Rodriguez 		if (!requeue_skb)
748203c4805SLuis R. Rodriguez 			goto requeue;
749203c4805SLuis R. Rodriguez 
750203c4805SLuis R. Rodriguez 		/* Unmap the frame */
751203c4805SLuis R. Rodriguez 		dma_unmap_single(sc->dev, bf->bf_buf_addr,
752203c4805SLuis R. Rodriguez 				 sc->rx.bufsize,
753203c4805SLuis R. Rodriguez 				 DMA_FROM_DEVICE);
754203c4805SLuis R. Rodriguez 
755203c4805SLuis R. Rodriguez 		skb_put(skb, ds->ds_rxstat.rs_datalen);
756203c4805SLuis R. Rodriguez 		skb->protocol = cpu_to_be16(ETH_P_CONTROL);
757203c4805SLuis R. Rodriguez 
758203c4805SLuis R. Rodriguez 		/* see if any padding is done by the hw and remove it */
759203c4805SLuis R. Rodriguez 		hdr = (struct ieee80211_hdr *)skb->data;
760203c4805SLuis R. Rodriguez 		hdrlen = ieee80211_get_hdrlen_from_skb(skb);
761203c4805SLuis R. Rodriguez 		fc = hdr->frame_control;
762203c4805SLuis R. Rodriguez 
763203c4805SLuis R. Rodriguez 		/* The MAC header is padded to have 32-bit boundary if the
764203c4805SLuis R. Rodriguez 		 * packet payload is non-zero. The general calculation for
765203c4805SLuis R. Rodriguez 		 * padsize would take into account odd header lengths:
766203c4805SLuis R. Rodriguez 		 * padsize = (4 - hdrlen % 4) % 4; However, since only
767203c4805SLuis R. Rodriguez 		 * even-length headers are used, padding can only be 0 or 2
768203c4805SLuis R. Rodriguez 		 * bytes and we can optimize this a bit. In addition, we must
769203c4805SLuis R. Rodriguez 		 * not try to remove padding from short control frames that do
770203c4805SLuis R. Rodriguez 		 * not have payload. */
771203c4805SLuis R. Rodriguez 		padsize = hdrlen & 3;
772203c4805SLuis R. Rodriguez 		if (padsize && hdrlen >= 24) {
773203c4805SLuis R. Rodriguez 			memmove(skb->data + padsize, skb->data, hdrlen);
774203c4805SLuis R. Rodriguez 			skb_pull(skb, padsize);
775203c4805SLuis R. Rodriguez 		}
776203c4805SLuis R. Rodriguez 
777203c4805SLuis R. Rodriguez 		keyix = ds->ds_rxstat.rs_keyix;
778203c4805SLuis R. Rodriguez 
779203c4805SLuis R. Rodriguez 		if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error) {
780203c4805SLuis R. Rodriguez 			rx_status.flag |= RX_FLAG_DECRYPTED;
7819d64a3cfSJouni Malinen 		} else if (ieee80211_has_protected(fc)
782203c4805SLuis R. Rodriguez 			   && !decrypt_error && skb->len >= hdrlen + 4) {
783203c4805SLuis R. Rodriguez 			keyix = skb->data[hdrlen + 3] >> 6;
784203c4805SLuis R. Rodriguez 
785203c4805SLuis R. Rodriguez 			if (test_bit(keyix, sc->keymap))
786203c4805SLuis R. Rodriguez 				rx_status.flag |= RX_FLAG_DECRYPTED;
787203c4805SLuis R. Rodriguez 		}
788203c4805SLuis R. Rodriguez 		if (ah->sw_mgmt_crypto &&
789203c4805SLuis R. Rodriguez 		    (rx_status.flag & RX_FLAG_DECRYPTED) &&
7909d64a3cfSJouni Malinen 		    ieee80211_is_mgmt(fc)) {
791203c4805SLuis R. Rodriguez 			/* Use software decrypt for management frames. */
792203c4805SLuis R. Rodriguez 			rx_status.flag &= ~RX_FLAG_DECRYPTED;
793203c4805SLuis R. Rodriguez 		}
794203c4805SLuis R. Rodriguez 
795203c4805SLuis R. Rodriguez 		/* We will now give hardware our shiny new allocated skb */
796203c4805SLuis R. Rodriguez 		bf->bf_mpdu = requeue_skb;
797203c4805SLuis R. Rodriguez 		bf->bf_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
798203c4805SLuis R. Rodriguez 					 sc->rx.bufsize,
799203c4805SLuis R. Rodriguez 					 DMA_FROM_DEVICE);
800203c4805SLuis R. Rodriguez 		if (unlikely(dma_mapping_error(sc->dev,
801203c4805SLuis R. Rodriguez 			  bf->bf_buf_addr))) {
802203c4805SLuis R. Rodriguez 			dev_kfree_skb_any(requeue_skb);
803203c4805SLuis R. Rodriguez 			bf->bf_mpdu = NULL;
804203c4805SLuis R. Rodriguez 			DPRINTF(sc, ATH_DBG_FATAL,
805203c4805SLuis R. Rodriguez 				"dma_mapping_error() on RX\n");
806cc65965cSJouni Malinen 			ath_rx_send_to_mac80211(sc, skb, &rx_status);
807203c4805SLuis R. Rodriguez 			break;
808203c4805SLuis R. Rodriguez 		}
809203c4805SLuis R. Rodriguez 		bf->bf_dmacontext = bf->bf_buf_addr;
810203c4805SLuis R. Rodriguez 
811203c4805SLuis R. Rodriguez 		/*
812203c4805SLuis R. Rodriguez 		 * change the default rx antenna if rx diversity chooses the
813203c4805SLuis R. Rodriguez 		 * other antenna 3 times in a row.
814203c4805SLuis R. Rodriguez 		 */
815203c4805SLuis R. Rodriguez 		if (sc->rx.defant != ds->ds_rxstat.rs_antenna) {
816203c4805SLuis R. Rodriguez 			if (++sc->rx.rxotherant >= 3)
817203c4805SLuis R. Rodriguez 				ath_setdefantenna(sc, ds->ds_rxstat.rs_antenna);
818203c4805SLuis R. Rodriguez 		} else {
819203c4805SLuis R. Rodriguez 			sc->rx.rxotherant = 0;
820203c4805SLuis R. Rodriguez 		}
821203c4805SLuis R. Rodriguez 
8229a23f9caSJouni Malinen 		if (unlikely(sc->sc_flags & (SC_OP_WAIT_FOR_BEACON |
823f0e9a860SGabor Juhos 					     SC_OP_WAIT_FOR_CAB |
8249a23f9caSJouni Malinen 					     SC_OP_WAIT_FOR_PSPOLL_DATA)))
825cc65965cSJouni Malinen 			ath_rx_ps(sc, skb);
826cc65965cSJouni Malinen 
827cc65965cSJouni Malinen 		ath_rx_send_to_mac80211(sc, skb, &rx_status);
828cc65965cSJouni Malinen 
829203c4805SLuis R. Rodriguez requeue:
830203c4805SLuis R. Rodriguez 		list_move_tail(&bf->list, &sc->rx.rxbuf);
831203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
832203c4805SLuis R. Rodriguez 	} while (1);
833203c4805SLuis R. Rodriguez 
834203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxbuflock);
835203c4805SLuis R. Rodriguez 
836203c4805SLuis R. Rodriguez 	return 0;
837203c4805SLuis R. Rodriguez #undef PA2DESC
838203c4805SLuis R. Rodriguez }
839