xref: /linux/drivers/net/wireless/ath/ath9k/recv.c (revision 2e1cd495466d14c7d92e10d709f27161afe44b15)
1203c4805SLuis R. Rodriguez /*
25b68138eSSujith Manoharan  * Copyright (c) 2008-2011 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 
17b7f080cfSAlexey Dobriyan #include <linux/dma-mapping.h>
18e93d083fSSimon Wunderlich #include <linux/relay.h>
19203c4805SLuis R. Rodriguez #include "ath9k.h"
20b622a720SLuis R. Rodriguez #include "ar9003_mac.h"
21203c4805SLuis R. Rodriguez 
22b5c80475SFelix Fietkau #define SKB_CB_ATHBUF(__skb)	(*((struct ath_buf **)__skb->cb))
23b5c80475SFelix Fietkau 
24ededf1f8SVasanthakumar Thiagarajan static inline bool ath9k_check_auto_sleep(struct ath_softc *sc)
25ededf1f8SVasanthakumar Thiagarajan {
26ededf1f8SVasanthakumar Thiagarajan 	return sc->ps_enabled &&
27ededf1f8SVasanthakumar Thiagarajan 	       (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_AUTOSLEEP);
28ededf1f8SVasanthakumar Thiagarajan }
29ededf1f8SVasanthakumar Thiagarajan 
30203c4805SLuis R. Rodriguez /*
31203c4805SLuis R. Rodriguez  * Setup and link descriptors.
32203c4805SLuis R. Rodriguez  *
33203c4805SLuis R. Rodriguez  * 11N: we can no longer afford to self link the last descriptor.
34203c4805SLuis R. Rodriguez  * MAC acknowledges BA status as long as it copies frames to host
35203c4805SLuis R. Rodriguez  * buffer (or rx fifo). This can incorrectly acknowledge packets
36203c4805SLuis R. Rodriguez  * to a sender if last desc is self-linked.
37203c4805SLuis R. Rodriguez  */
38203c4805SLuis R. Rodriguez static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf)
39203c4805SLuis R. Rodriguez {
40203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
41cc861f74SLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
42203c4805SLuis R. Rodriguez 	struct ath_desc *ds;
43203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
44203c4805SLuis R. Rodriguez 
45203c4805SLuis R. Rodriguez 	ATH_RXBUF_RESET(bf);
46203c4805SLuis R. Rodriguez 
47203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
48203c4805SLuis R. Rodriguez 	ds->ds_link = 0; /* link to null */
49203c4805SLuis R. Rodriguez 	ds->ds_data = bf->bf_buf_addr;
50203c4805SLuis R. Rodriguez 
51203c4805SLuis R. Rodriguez 	/* virtual addr of the beginning of the buffer. */
52203c4805SLuis R. Rodriguez 	skb = bf->bf_mpdu;
539680e8a3SLuis R. Rodriguez 	BUG_ON(skb == NULL);
54203c4805SLuis R. Rodriguez 	ds->ds_vdata = skb->data;
55203c4805SLuis R. Rodriguez 
56cc861f74SLuis R. Rodriguez 	/*
57cc861f74SLuis R. Rodriguez 	 * setup rx descriptors. The rx_bufsize here tells the hardware
58203c4805SLuis R. Rodriguez 	 * how much data it can DMA to us and that we are prepared
59cc861f74SLuis R. Rodriguez 	 * to process
60cc861f74SLuis R. Rodriguez 	 */
61203c4805SLuis R. Rodriguez 	ath9k_hw_setuprxdesc(ah, ds,
62cc861f74SLuis R. Rodriguez 			     common->rx_bufsize,
63203c4805SLuis R. Rodriguez 			     0);
64203c4805SLuis R. Rodriguez 
65203c4805SLuis R. Rodriguez 	if (sc->rx.rxlink == NULL)
66203c4805SLuis R. Rodriguez 		ath9k_hw_putrxbuf(ah, bf->bf_daddr);
67203c4805SLuis R. Rodriguez 	else
68203c4805SLuis R. Rodriguez 		*sc->rx.rxlink = bf->bf_daddr;
69203c4805SLuis R. Rodriguez 
70203c4805SLuis R. Rodriguez 	sc->rx.rxlink = &ds->ds_link;
71203c4805SLuis R. Rodriguez }
72203c4805SLuis R. Rodriguez 
73203c4805SLuis R. Rodriguez static void ath_setdefantenna(struct ath_softc *sc, u32 antenna)
74203c4805SLuis R. Rodriguez {
75203c4805SLuis R. Rodriguez 	/* XXX block beacon interrupts */
76203c4805SLuis R. Rodriguez 	ath9k_hw_setantenna(sc->sc_ah, antenna);
77203c4805SLuis R. Rodriguez 	sc->rx.defant = antenna;
78203c4805SLuis R. Rodriguez 	sc->rx.rxotherant = 0;
79203c4805SLuis R. Rodriguez }
80203c4805SLuis R. Rodriguez 
81203c4805SLuis R. Rodriguez static void ath_opmode_init(struct ath_softc *sc)
82203c4805SLuis R. Rodriguez {
83203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
841510718dSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
851510718dSLuis R. Rodriguez 
86203c4805SLuis R. Rodriguez 	u32 rfilt, mfilt[2];
87203c4805SLuis R. Rodriguez 
88203c4805SLuis R. Rodriguez 	/* configure rx filter */
89203c4805SLuis R. Rodriguez 	rfilt = ath_calcrxfilter(sc);
90203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, rfilt);
91203c4805SLuis R. Rodriguez 
92203c4805SLuis R. Rodriguez 	/* configure bssid mask */
9313b81559SLuis R. Rodriguez 	ath_hw_setbssidmask(common);
94203c4805SLuis R. Rodriguez 
95203c4805SLuis R. Rodriguez 	/* configure operational mode */
96203c4805SLuis R. Rodriguez 	ath9k_hw_setopmode(ah);
97203c4805SLuis R. Rodriguez 
98203c4805SLuis R. Rodriguez 	/* calculate and install multicast filter */
99203c4805SLuis R. Rodriguez 	mfilt[0] = mfilt[1] = ~0;
100203c4805SLuis R. Rodriguez 	ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]);
101203c4805SLuis R. Rodriguez }
102203c4805SLuis R. Rodriguez 
103b5c80475SFelix Fietkau static bool ath_rx_edma_buf_link(struct ath_softc *sc,
104b5c80475SFelix Fietkau 				 enum ath9k_rx_qtype qtype)
105b5c80475SFelix Fietkau {
106b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
107b5c80475SFelix Fietkau 	struct ath_rx_edma *rx_edma;
108b5c80475SFelix Fietkau 	struct sk_buff *skb;
109b5c80475SFelix Fietkau 	struct ath_buf *bf;
110b5c80475SFelix Fietkau 
111b5c80475SFelix Fietkau 	rx_edma = &sc->rx.rx_edma[qtype];
112b5c80475SFelix Fietkau 	if (skb_queue_len(&rx_edma->rx_fifo) >= rx_edma->rx_fifo_hwsize)
113b5c80475SFelix Fietkau 		return false;
114b5c80475SFelix Fietkau 
115b5c80475SFelix Fietkau 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
116b5c80475SFelix Fietkau 	list_del_init(&bf->list);
117b5c80475SFelix Fietkau 
118b5c80475SFelix Fietkau 	skb = bf->bf_mpdu;
119b5c80475SFelix Fietkau 
120b5c80475SFelix Fietkau 	ATH_RXBUF_RESET(bf);
121b5c80475SFelix Fietkau 	memset(skb->data, 0, ah->caps.rx_status_len);
122b5c80475SFelix Fietkau 	dma_sync_single_for_device(sc->dev, bf->bf_buf_addr,
123b5c80475SFelix Fietkau 				ah->caps.rx_status_len, DMA_TO_DEVICE);
124b5c80475SFelix Fietkau 
125b5c80475SFelix Fietkau 	SKB_CB_ATHBUF(skb) = bf;
126b5c80475SFelix Fietkau 	ath9k_hw_addrxbuf_edma(ah, bf->bf_buf_addr, qtype);
127b5c80475SFelix Fietkau 	skb_queue_tail(&rx_edma->rx_fifo, skb);
128b5c80475SFelix Fietkau 
129b5c80475SFelix Fietkau 	return true;
130b5c80475SFelix Fietkau }
131b5c80475SFelix Fietkau 
132b5c80475SFelix Fietkau static void ath_rx_addbuffer_edma(struct ath_softc *sc,
133b5c80475SFelix Fietkau 				  enum ath9k_rx_qtype qtype, int size)
134b5c80475SFelix Fietkau {
135b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
1366a01f0c0SMohammed Shafi Shajakhan 	struct ath_buf *bf, *tbf;
137b5c80475SFelix Fietkau 
138b5c80475SFelix Fietkau 	if (list_empty(&sc->rx.rxbuf)) {
139d2182b69SJoe Perches 		ath_dbg(common, QUEUE, "No free rx buf available\n");
140b5c80475SFelix Fietkau 		return;
141b5c80475SFelix Fietkau 	}
142b5c80475SFelix Fietkau 
1436a01f0c0SMohammed Shafi Shajakhan 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list)
144b5c80475SFelix Fietkau 		if (!ath_rx_edma_buf_link(sc, qtype))
145b5c80475SFelix Fietkau 			break;
146b5c80475SFelix Fietkau 
147b5c80475SFelix Fietkau }
148b5c80475SFelix Fietkau 
149b5c80475SFelix Fietkau static void ath_rx_remove_buffer(struct ath_softc *sc,
150b5c80475SFelix Fietkau 				 enum ath9k_rx_qtype qtype)
151b5c80475SFelix Fietkau {
152b5c80475SFelix Fietkau 	struct ath_buf *bf;
153b5c80475SFelix Fietkau 	struct ath_rx_edma *rx_edma;
154b5c80475SFelix Fietkau 	struct sk_buff *skb;
155b5c80475SFelix Fietkau 
156b5c80475SFelix Fietkau 	rx_edma = &sc->rx.rx_edma[qtype];
157b5c80475SFelix Fietkau 
158b5c80475SFelix Fietkau 	while ((skb = skb_dequeue(&rx_edma->rx_fifo)) != NULL) {
159b5c80475SFelix Fietkau 		bf = SKB_CB_ATHBUF(skb);
160b5c80475SFelix Fietkau 		BUG_ON(!bf);
161b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
162b5c80475SFelix Fietkau 	}
163b5c80475SFelix Fietkau }
164b5c80475SFelix Fietkau 
165b5c80475SFelix Fietkau static void ath_rx_edma_cleanup(struct ath_softc *sc)
166b5c80475SFelix Fietkau {
167ba542385SMohammed Shafi Shajakhan 	struct ath_hw *ah = sc->sc_ah;
168ba542385SMohammed Shafi Shajakhan 	struct ath_common *common = ath9k_hw_common(ah);
169b5c80475SFelix Fietkau 	struct ath_buf *bf;
170b5c80475SFelix Fietkau 
171b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_LP);
172b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_HP);
173b5c80475SFelix Fietkau 
174b5c80475SFelix Fietkau 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
175ba542385SMohammed Shafi Shajakhan 		if (bf->bf_mpdu) {
176ba542385SMohammed Shafi Shajakhan 			dma_unmap_single(sc->dev, bf->bf_buf_addr,
177ba542385SMohammed Shafi Shajakhan 					common->rx_bufsize,
178ba542385SMohammed Shafi Shajakhan 					DMA_BIDIRECTIONAL);
179b5c80475SFelix Fietkau 			dev_kfree_skb_any(bf->bf_mpdu);
180ba542385SMohammed Shafi Shajakhan 			bf->bf_buf_addr = 0;
181ba542385SMohammed Shafi Shajakhan 			bf->bf_mpdu = NULL;
182ba542385SMohammed Shafi Shajakhan 		}
183b5c80475SFelix Fietkau 	}
184b5c80475SFelix Fietkau }
185b5c80475SFelix Fietkau 
186b5c80475SFelix Fietkau static void ath_rx_edma_init_queue(struct ath_rx_edma *rx_edma, int size)
187b5c80475SFelix Fietkau {
188b5c80475SFelix Fietkau 	skb_queue_head_init(&rx_edma->rx_fifo);
189b5c80475SFelix Fietkau 	rx_edma->rx_fifo_hwsize = size;
190b5c80475SFelix Fietkau }
191b5c80475SFelix Fietkau 
192b5c80475SFelix Fietkau static int ath_rx_edma_init(struct ath_softc *sc, int nbufs)
193b5c80475SFelix Fietkau {
194b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
195b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
196b5c80475SFelix Fietkau 	struct sk_buff *skb;
197b5c80475SFelix Fietkau 	struct ath_buf *bf;
198b5c80475SFelix Fietkau 	int error = 0, i;
199b5c80475SFelix Fietkau 	u32 size;
200b5c80475SFelix Fietkau 
201b5c80475SFelix Fietkau 	ath9k_hw_set_rx_bufsize(ah, common->rx_bufsize -
202b5c80475SFelix Fietkau 				    ah->caps.rx_status_len);
203b5c80475SFelix Fietkau 
204b5c80475SFelix Fietkau 	ath_rx_edma_init_queue(&sc->rx.rx_edma[ATH9K_RX_QUEUE_LP],
205b5c80475SFelix Fietkau 			       ah->caps.rx_lp_qdepth);
206b5c80475SFelix Fietkau 	ath_rx_edma_init_queue(&sc->rx.rx_edma[ATH9K_RX_QUEUE_HP],
207b5c80475SFelix Fietkau 			       ah->caps.rx_hp_qdepth);
208b5c80475SFelix Fietkau 
209b5c80475SFelix Fietkau 	size = sizeof(struct ath_buf) * nbufs;
210b81950b1SFelix Fietkau 	bf = devm_kzalloc(sc->dev, size, GFP_KERNEL);
211b5c80475SFelix Fietkau 	if (!bf)
212b5c80475SFelix Fietkau 		return -ENOMEM;
213b5c80475SFelix Fietkau 
214b5c80475SFelix Fietkau 	INIT_LIST_HEAD(&sc->rx.rxbuf);
215b5c80475SFelix Fietkau 
216b5c80475SFelix Fietkau 	for (i = 0; i < nbufs; i++, bf++) {
217b5c80475SFelix Fietkau 		skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_KERNEL);
218b5c80475SFelix Fietkau 		if (!skb) {
219b5c80475SFelix Fietkau 			error = -ENOMEM;
220b5c80475SFelix Fietkau 			goto rx_init_fail;
221b5c80475SFelix Fietkau 		}
222b5c80475SFelix Fietkau 
223b5c80475SFelix Fietkau 		memset(skb->data, 0, common->rx_bufsize);
224b5c80475SFelix Fietkau 		bf->bf_mpdu = skb;
225b5c80475SFelix Fietkau 
226b5c80475SFelix Fietkau 		bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
227b5c80475SFelix Fietkau 						 common->rx_bufsize,
228b5c80475SFelix Fietkau 						 DMA_BIDIRECTIONAL);
229b5c80475SFelix Fietkau 		if (unlikely(dma_mapping_error(sc->dev,
230b5c80475SFelix Fietkau 						bf->bf_buf_addr))) {
231b5c80475SFelix Fietkau 				dev_kfree_skb_any(skb);
232b5c80475SFelix Fietkau 				bf->bf_mpdu = NULL;
2336cf9e995SBen Greear 				bf->bf_buf_addr = 0;
2343800276aSJoe Perches 				ath_err(common,
235b5c80475SFelix Fietkau 					"dma_mapping_error() on RX init\n");
236b5c80475SFelix Fietkau 				error = -ENOMEM;
237b5c80475SFelix Fietkau 				goto rx_init_fail;
238b5c80475SFelix Fietkau 		}
239b5c80475SFelix Fietkau 
240b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
241b5c80475SFelix Fietkau 	}
242b5c80475SFelix Fietkau 
243b5c80475SFelix Fietkau 	return 0;
244b5c80475SFelix Fietkau 
245b5c80475SFelix Fietkau rx_init_fail:
246b5c80475SFelix Fietkau 	ath_rx_edma_cleanup(sc);
247b5c80475SFelix Fietkau 	return error;
248b5c80475SFelix Fietkau }
249b5c80475SFelix Fietkau 
250b5c80475SFelix Fietkau static void ath_edma_start_recv(struct ath_softc *sc)
251b5c80475SFelix Fietkau {
252b5c80475SFelix Fietkau 	ath9k_hw_rxena(sc->sc_ah);
253b5c80475SFelix Fietkau 
254b5c80475SFelix Fietkau 	ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_HP,
255b5c80475SFelix Fietkau 			      sc->rx.rx_edma[ATH9K_RX_QUEUE_HP].rx_fifo_hwsize);
256b5c80475SFelix Fietkau 
257b5c80475SFelix Fietkau 	ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_LP,
258b5c80475SFelix Fietkau 			      sc->rx.rx_edma[ATH9K_RX_QUEUE_LP].rx_fifo_hwsize);
259b5c80475SFelix Fietkau 
260b5c80475SFelix Fietkau 	ath_opmode_init(sc);
261b5c80475SFelix Fietkau 
2624cb54fa3SSujith Manoharan 	ath9k_hw_startpcureceive(sc->sc_ah, !!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL));
263b5c80475SFelix Fietkau }
264b5c80475SFelix Fietkau 
265b5c80475SFelix Fietkau static void ath_edma_stop_recv(struct ath_softc *sc)
266b5c80475SFelix Fietkau {
267b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_HP);
268b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_LP);
269b5c80475SFelix Fietkau }
270b5c80475SFelix Fietkau 
271203c4805SLuis R. Rodriguez int ath_rx_init(struct ath_softc *sc, int nbufs)
272203c4805SLuis R. Rodriguez {
27327c51f1aSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
274203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
275203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
276203c4805SLuis R. Rodriguez 	int error = 0;
277203c4805SLuis R. Rodriguez 
2784bdd1e97SLuis R. Rodriguez 	spin_lock_init(&sc->sc_pcu_lock);
279203c4805SLuis R. Rodriguez 
2800d95521eSFelix Fietkau 	common->rx_bufsize = IEEE80211_MAX_MPDU_LEN / 2 +
2810d95521eSFelix Fietkau 			     sc->sc_ah->caps.rx_status_len;
2820d95521eSFelix Fietkau 
283b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
284b5c80475SFelix Fietkau 		return ath_rx_edma_init(sc, nbufs);
285b5c80475SFelix Fietkau 	} else {
286d2182b69SJoe Perches 		ath_dbg(common, CONFIG, "cachelsz %u rxbufsize %u\n",
287cc861f74SLuis R. Rodriguez 			common->cachelsz, common->rx_bufsize);
288203c4805SLuis R. Rodriguez 
289203c4805SLuis R. Rodriguez 		/* Initialize rx descriptors */
290203c4805SLuis R. Rodriguez 
291203c4805SLuis R. Rodriguez 		error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
2924adfcdedSVasanthakumar Thiagarajan 				"rx", nbufs, 1, 0);
293203c4805SLuis R. Rodriguez 		if (error != 0) {
2943800276aSJoe Perches 			ath_err(common,
295b5c80475SFelix Fietkau 				"failed to allocate rx descriptors: %d\n",
296b5c80475SFelix Fietkau 				error);
297203c4805SLuis R. Rodriguez 			goto err;
298203c4805SLuis R. Rodriguez 		}
299203c4805SLuis R. Rodriguez 
300203c4805SLuis R. Rodriguez 		list_for_each_entry(bf, &sc->rx.rxbuf, list) {
301b5c80475SFelix Fietkau 			skb = ath_rxbuf_alloc(common, common->rx_bufsize,
302b5c80475SFelix Fietkau 					      GFP_KERNEL);
303203c4805SLuis R. Rodriguez 			if (skb == NULL) {
304203c4805SLuis R. Rodriguez 				error = -ENOMEM;
305203c4805SLuis R. Rodriguez 				goto err;
306203c4805SLuis R. Rodriguez 			}
307203c4805SLuis R. Rodriguez 
308203c4805SLuis R. Rodriguez 			bf->bf_mpdu = skb;
309203c4805SLuis R. Rodriguez 			bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
310cc861f74SLuis R. Rodriguez 					common->rx_bufsize,
311203c4805SLuis R. Rodriguez 					DMA_FROM_DEVICE);
312203c4805SLuis R. Rodriguez 			if (unlikely(dma_mapping_error(sc->dev,
313203c4805SLuis R. Rodriguez 							bf->bf_buf_addr))) {
314203c4805SLuis R. Rodriguez 				dev_kfree_skb_any(skb);
315203c4805SLuis R. Rodriguez 				bf->bf_mpdu = NULL;
3166cf9e995SBen Greear 				bf->bf_buf_addr = 0;
3173800276aSJoe Perches 				ath_err(common,
318203c4805SLuis R. Rodriguez 					"dma_mapping_error() on RX init\n");
319203c4805SLuis R. Rodriguez 				error = -ENOMEM;
320203c4805SLuis R. Rodriguez 				goto err;
321203c4805SLuis R. Rodriguez 			}
322203c4805SLuis R. Rodriguez 		}
323203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
324b5c80475SFelix Fietkau 	}
325203c4805SLuis R. Rodriguez 
326203c4805SLuis R. Rodriguez err:
327203c4805SLuis R. Rodriguez 	if (error)
328203c4805SLuis R. Rodriguez 		ath_rx_cleanup(sc);
329203c4805SLuis R. Rodriguez 
330203c4805SLuis R. Rodriguez 	return error;
331203c4805SLuis R. Rodriguez }
332203c4805SLuis R. Rodriguez 
333203c4805SLuis R. Rodriguez void ath_rx_cleanup(struct ath_softc *sc)
334203c4805SLuis R. Rodriguez {
335cc861f74SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
336cc861f74SLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
337203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
338203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
339203c4805SLuis R. Rodriguez 
340b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
341b5c80475SFelix Fietkau 		ath_rx_edma_cleanup(sc);
342b5c80475SFelix Fietkau 		return;
343b5c80475SFelix Fietkau 	} else {
344203c4805SLuis R. Rodriguez 		list_for_each_entry(bf, &sc->rx.rxbuf, list) {
345203c4805SLuis R. Rodriguez 			skb = bf->bf_mpdu;
346203c4805SLuis R. Rodriguez 			if (skb) {
347203c4805SLuis R. Rodriguez 				dma_unmap_single(sc->dev, bf->bf_buf_addr,
348b5c80475SFelix Fietkau 						common->rx_bufsize,
349b5c80475SFelix Fietkau 						DMA_FROM_DEVICE);
350203c4805SLuis R. Rodriguez 				dev_kfree_skb(skb);
3516cf9e995SBen Greear 				bf->bf_buf_addr = 0;
3526cf9e995SBen Greear 				bf->bf_mpdu = NULL;
353203c4805SLuis R. Rodriguez 			}
354203c4805SLuis R. Rodriguez 		}
355203c4805SLuis R. Rodriguez 	}
356b5c80475SFelix Fietkau }
357203c4805SLuis R. Rodriguez 
358203c4805SLuis R. Rodriguez /*
359203c4805SLuis R. Rodriguez  * Calculate the receive filter according to the
360203c4805SLuis R. Rodriguez  * operating mode and state:
361203c4805SLuis R. Rodriguez  *
362203c4805SLuis R. Rodriguez  * o always accept unicast, broadcast, and multicast traffic
363203c4805SLuis R. Rodriguez  * o maintain current state of phy error reception (the hal
364203c4805SLuis R. Rodriguez  *   may enable phy error frames for noise immunity work)
365203c4805SLuis R. Rodriguez  * o probe request frames are accepted only when operating in
366203c4805SLuis R. Rodriguez  *   hostap, adhoc, or monitor modes
367203c4805SLuis R. Rodriguez  * o enable promiscuous mode according to the interface state
368203c4805SLuis R. Rodriguez  * o accept beacons:
369203c4805SLuis R. Rodriguez  *   - when operating in adhoc mode so the 802.11 layer creates
370203c4805SLuis R. Rodriguez  *     node table entries for peers,
371203c4805SLuis R. Rodriguez  *   - when operating in station mode for collecting rssi data when
372203c4805SLuis R. Rodriguez  *     the station is otherwise quiet, or
373203c4805SLuis R. Rodriguez  *   - when operating as a repeater so we see repeater-sta beacons
374203c4805SLuis R. Rodriguez  *   - when scanning
375203c4805SLuis R. Rodriguez  */
376203c4805SLuis R. Rodriguez 
377203c4805SLuis R. Rodriguez u32 ath_calcrxfilter(struct ath_softc *sc)
378203c4805SLuis R. Rodriguez {
379203c4805SLuis R. Rodriguez 	u32 rfilt;
380203c4805SLuis R. Rodriguez 
381ac06697cSFelix Fietkau 	rfilt = ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
382203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_MCAST;
383203c4805SLuis R. Rodriguez 
38473e4937dSZefir Kurtisi 	/* if operating on a DFS channel, enable radar pulse detection */
38573e4937dSZefir Kurtisi 	if (sc->hw->conf.radar_enabled)
38673e4937dSZefir Kurtisi 		rfilt |= ATH9K_RX_FILTER_PHYRADAR | ATH9K_RX_FILTER_PHYERR;
38773e4937dSZefir Kurtisi 
3889c1d8e4aSJouni Malinen 	if (sc->rx.rxfilter & FIF_PROBE_REQ)
389203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROBEREQ;
390203c4805SLuis R. Rodriguez 
391203c4805SLuis R. Rodriguez 	/*
392203c4805SLuis R. Rodriguez 	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
393203c4805SLuis R. Rodriguez 	 * mode interface or when in monitor mode. AP mode does not need this
394203c4805SLuis R. Rodriguez 	 * since it receives all in-BSS frames anyway.
395203c4805SLuis R. Rodriguez 	 */
3962e286947SFelix Fietkau 	if (sc->sc_ah->is_monitoring)
397203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROM;
398203c4805SLuis R. Rodriguez 
399203c4805SLuis R. Rodriguez 	if (sc->rx.rxfilter & FIF_CONTROL)
400203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_CONTROL;
401203c4805SLuis R. Rodriguez 
402203c4805SLuis R. Rodriguez 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
403cfda6695SBen Greear 	    (sc->nvifs <= 1) &&
404203c4805SLuis R. Rodriguez 	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
405203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MYBEACON;
406203c4805SLuis R. Rodriguez 	else
407203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_BEACON;
408203c4805SLuis R. Rodriguez 
409264bbec8SFelix Fietkau 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
41066afad01SSenthil Balasubramanian 	    (sc->rx.rxfilter & FIF_PSPOLL))
411203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PSPOLL;
412203c4805SLuis R. Rodriguez 
4137ea310beSSujith 	if (conf_is_ht(&sc->hw->conf))
4147ea310beSSujith 		rfilt |= ATH9K_RX_FILTER_COMP_BAR;
4157ea310beSSujith 
4167545daf4SFelix Fietkau 	if (sc->nvifs > 1 || (sc->rx.rxfilter & FIF_OTHER_BSS)) {
417a549459cSThomas Wagner 		/* This is needed for older chips */
418a549459cSThomas Wagner 		if (sc->sc_ah->hw_version.macVersion <= AR_SREV_VERSION_9160)
4195eb6ba83SJavier Cardona 			rfilt |= ATH9K_RX_FILTER_PROM;
420203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
421203c4805SLuis R. Rodriguez 	}
422203c4805SLuis R. Rodriguez 
423b3d7aa43SGabor Juhos 	if (AR_SREV_9550(sc->sc_ah))
424b3d7aa43SGabor Juhos 		rfilt |= ATH9K_RX_FILTER_4ADDRESS;
425b3d7aa43SGabor Juhos 
426203c4805SLuis R. Rodriguez 	return rfilt;
427203c4805SLuis R. Rodriguez 
428203c4805SLuis R. Rodriguez }
429203c4805SLuis R. Rodriguez 
430203c4805SLuis R. Rodriguez int ath_startrecv(struct ath_softc *sc)
431203c4805SLuis R. Rodriguez {
432203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
433203c4805SLuis R. Rodriguez 	struct ath_buf *bf, *tbf;
434203c4805SLuis R. Rodriguez 
435b5c80475SFelix Fietkau 	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
436b5c80475SFelix Fietkau 		ath_edma_start_recv(sc);
437b5c80475SFelix Fietkau 		return 0;
438b5c80475SFelix Fietkau 	}
439b5c80475SFelix Fietkau 
440203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
441203c4805SLuis R. Rodriguez 		goto start_recv;
442203c4805SLuis R. Rodriguez 
443203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
444203c4805SLuis R. Rodriguez 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
445203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
446203c4805SLuis R. Rodriguez 	}
447203c4805SLuis R. Rodriguez 
448203c4805SLuis R. Rodriguez 	/* We could have deleted elements so the list may be empty now */
449203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
450203c4805SLuis R. Rodriguez 		goto start_recv;
451203c4805SLuis R. Rodriguez 
452203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
453203c4805SLuis R. Rodriguez 	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
454203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
455203c4805SLuis R. Rodriguez 
456203c4805SLuis R. Rodriguez start_recv:
457203c4805SLuis R. Rodriguez 	ath_opmode_init(sc);
4584cb54fa3SSujith Manoharan 	ath9k_hw_startpcureceive(ah, !!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL));
459203c4805SLuis R. Rodriguez 
460203c4805SLuis R. Rodriguez 	return 0;
461203c4805SLuis R. Rodriguez }
462203c4805SLuis R. Rodriguez 
4634b883f02SFelix Fietkau static void ath_flushrecv(struct ath_softc *sc)
4644b883f02SFelix Fietkau {
4654b883f02SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
4664b883f02SFelix Fietkau 		ath_rx_tasklet(sc, 1, true);
4674b883f02SFelix Fietkau 	ath_rx_tasklet(sc, 1, false);
4684b883f02SFelix Fietkau }
4694b883f02SFelix Fietkau 
470203c4805SLuis R. Rodriguez bool ath_stoprecv(struct ath_softc *sc)
471203c4805SLuis R. Rodriguez {
472203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
4735882da02SFelix Fietkau 	bool stopped, reset = false;
474203c4805SLuis R. Rodriguez 
475d47844a0SFelix Fietkau 	ath9k_hw_abortpcurecv(ah);
476203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, 0);
4775882da02SFelix Fietkau 	stopped = ath9k_hw_stopdmarecv(ah, &reset);
478b5c80475SFelix Fietkau 
4794b883f02SFelix Fietkau 	ath_flushrecv(sc);
4804b883f02SFelix Fietkau 
481b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
482b5c80475SFelix Fietkau 		ath_edma_stop_recv(sc);
483b5c80475SFelix Fietkau 	else
484203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
485203c4805SLuis R. Rodriguez 
486d584747bSRajkumar Manoharan 	if (!(ah->ah_flags & AH_UNPLUGGED) &&
487d584747bSRajkumar Manoharan 	    unlikely(!stopped)) {
488d7fd1b50SBen Greear 		ath_err(ath9k_hw_common(sc->sc_ah),
489d7fd1b50SBen Greear 			"Could not stop RX, we could be "
49078a7685eSLuis R. Rodriguez 			"confusing the DMA engine when we start RX up\n");
491d7fd1b50SBen Greear 		ATH_DBG_WARN_ON_ONCE(!stopped);
492d7fd1b50SBen Greear 	}
4932232d31bSFelix Fietkau 	return stopped && !reset;
494203c4805SLuis R. Rodriguez }
495203c4805SLuis R. Rodriguez 
496cc65965cSJouni Malinen static bool ath_beacon_dtim_pending_cab(struct sk_buff *skb)
497cc65965cSJouni Malinen {
498cc65965cSJouni Malinen 	/* Check whether the Beacon frame has DTIM indicating buffered bc/mc */
499cc65965cSJouni Malinen 	struct ieee80211_mgmt *mgmt;
500cc65965cSJouni Malinen 	u8 *pos, *end, id, elen;
501cc65965cSJouni Malinen 	struct ieee80211_tim_ie *tim;
502cc65965cSJouni Malinen 
503cc65965cSJouni Malinen 	mgmt = (struct ieee80211_mgmt *)skb->data;
504cc65965cSJouni Malinen 	pos = mgmt->u.beacon.variable;
505cc65965cSJouni Malinen 	end = skb->data + skb->len;
506cc65965cSJouni Malinen 
507cc65965cSJouni Malinen 	while (pos + 2 < end) {
508cc65965cSJouni Malinen 		id = *pos++;
509cc65965cSJouni Malinen 		elen = *pos++;
510cc65965cSJouni Malinen 		if (pos + elen > end)
511cc65965cSJouni Malinen 			break;
512cc65965cSJouni Malinen 
513cc65965cSJouni Malinen 		if (id == WLAN_EID_TIM) {
514cc65965cSJouni Malinen 			if (elen < sizeof(*tim))
515cc65965cSJouni Malinen 				break;
516cc65965cSJouni Malinen 			tim = (struct ieee80211_tim_ie *) pos;
517cc65965cSJouni Malinen 			if (tim->dtim_count != 0)
518cc65965cSJouni Malinen 				break;
519cc65965cSJouni Malinen 			return tim->bitmap_ctrl & 0x01;
520cc65965cSJouni Malinen 		}
521cc65965cSJouni Malinen 
522cc65965cSJouni Malinen 		pos += elen;
523cc65965cSJouni Malinen 	}
524cc65965cSJouni Malinen 
525cc65965cSJouni Malinen 	return false;
526cc65965cSJouni Malinen }
527cc65965cSJouni Malinen 
528cc65965cSJouni Malinen static void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb)
529cc65965cSJouni Malinen {
5301510718dSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
531cc65965cSJouni Malinen 
532cc65965cSJouni Malinen 	if (skb->len < 24 + 8 + 2 + 2)
533cc65965cSJouni Malinen 		return;
534cc65965cSJouni Malinen 
5351b04b930SSujith 	sc->ps_flags &= ~PS_WAIT_FOR_BEACON;
536293dc5dfSGabor Juhos 
5371b04b930SSujith 	if (sc->ps_flags & PS_BEACON_SYNC) {
5381b04b930SSujith 		sc->ps_flags &= ~PS_BEACON_SYNC;
539d2182b69SJoe Perches 		ath_dbg(common, PS,
5401a6404a1SSujith Manoharan 			"Reconfigure beacon timers based on synchronized timestamp\n");
541ef4ad633SSujith Manoharan 		ath9k_set_beacon(sc);
542ccdfeab6SJouni Malinen 	}
543ccdfeab6SJouni Malinen 
544cc65965cSJouni Malinen 	if (ath_beacon_dtim_pending_cab(skb)) {
545cc65965cSJouni Malinen 		/*
546cc65965cSJouni Malinen 		 * Remain awake waiting for buffered broadcast/multicast
54758f5fffdSGabor Juhos 		 * frames. If the last broadcast/multicast frame is not
54858f5fffdSGabor Juhos 		 * received properly, the next beacon frame will work as
54958f5fffdSGabor Juhos 		 * a backup trigger for returning into NETWORK SLEEP state,
55058f5fffdSGabor Juhos 		 * so we are waiting for it as well.
551cc65965cSJouni Malinen 		 */
552d2182b69SJoe Perches 		ath_dbg(common, PS,
553226afe68SJoe Perches 			"Received DTIM beacon indicating buffered broadcast/multicast frame(s)\n");
5541b04b930SSujith 		sc->ps_flags |= PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON;
555cc65965cSJouni Malinen 		return;
556cc65965cSJouni Malinen 	}
557cc65965cSJouni Malinen 
5581b04b930SSujith 	if (sc->ps_flags & PS_WAIT_FOR_CAB) {
559cc65965cSJouni Malinen 		/*
560cc65965cSJouni Malinen 		 * This can happen if a broadcast frame is dropped or the AP
561cc65965cSJouni Malinen 		 * fails to send a frame indicating that all CAB frames have
562cc65965cSJouni Malinen 		 * been delivered.
563cc65965cSJouni Malinen 		 */
5641b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_CAB;
565d2182b69SJoe Perches 		ath_dbg(common, PS, "PS wait for CAB frames timed out\n");
566cc65965cSJouni Malinen 	}
567cc65965cSJouni Malinen }
568cc65965cSJouni Malinen 
569f73c604cSRajkumar Manoharan static void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb, bool mybeacon)
570cc65965cSJouni Malinen {
571cc65965cSJouni Malinen 	struct ieee80211_hdr *hdr;
572c46917bbSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
573cc65965cSJouni Malinen 
574cc65965cSJouni Malinen 	hdr = (struct ieee80211_hdr *)skb->data;
575cc65965cSJouni Malinen 
576cc65965cSJouni Malinen 	/* Process Beacon and CAB receive in PS state */
577ededf1f8SVasanthakumar Thiagarajan 	if (((sc->ps_flags & PS_WAIT_FOR_BEACON) || ath9k_check_auto_sleep(sc))
57807c15a3fSSujith Manoharan 	    && mybeacon) {
579cc65965cSJouni Malinen 		ath_rx_ps_beacon(sc, skb);
58007c15a3fSSujith Manoharan 	} else if ((sc->ps_flags & PS_WAIT_FOR_CAB) &&
581cc65965cSJouni Malinen 		   (ieee80211_is_data(hdr->frame_control) ||
582cc65965cSJouni Malinen 		    ieee80211_is_action(hdr->frame_control)) &&
583cc65965cSJouni Malinen 		   is_multicast_ether_addr(hdr->addr1) &&
584cc65965cSJouni Malinen 		   !ieee80211_has_moredata(hdr->frame_control)) {
585cc65965cSJouni Malinen 		/*
586cc65965cSJouni Malinen 		 * No more broadcast/multicast frames to be received at this
587cc65965cSJouni Malinen 		 * point.
588cc65965cSJouni Malinen 		 */
5893fac6dfdSSenthil Balasubramanian 		sc->ps_flags &= ~(PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON);
590d2182b69SJoe Perches 		ath_dbg(common, PS,
591c46917bbSLuis R. Rodriguez 			"All PS CAB frames received, back to sleep\n");
5921b04b930SSujith 	} else if ((sc->ps_flags & PS_WAIT_FOR_PSPOLL_DATA) &&
5939a23f9caSJouni Malinen 		   !is_multicast_ether_addr(hdr->addr1) &&
5949a23f9caSJouni Malinen 		   !ieee80211_has_morefrags(hdr->frame_control)) {
5951b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_PSPOLL_DATA;
596d2182b69SJoe Perches 		ath_dbg(common, PS,
597226afe68SJoe Perches 			"Going back to sleep after having received PS-Poll data (0x%lx)\n",
5981b04b930SSujith 			sc->ps_flags & (PS_WAIT_FOR_BEACON |
5991b04b930SSujith 					PS_WAIT_FOR_CAB |
6001b04b930SSujith 					PS_WAIT_FOR_PSPOLL_DATA |
6011b04b930SSujith 					PS_WAIT_FOR_TX_ACK));
602cc65965cSJouni Malinen 	}
603cc65965cSJouni Malinen }
604cc65965cSJouni Malinen 
605b5c80475SFelix Fietkau static bool ath_edma_get_buffers(struct ath_softc *sc,
6063a2923e8SFelix Fietkau 				 enum ath9k_rx_qtype qtype,
6073a2923e8SFelix Fietkau 				 struct ath_rx_status *rs,
6083a2923e8SFelix Fietkau 				 struct ath_buf **dest)
609203c4805SLuis R. Rodriguez {
610b5c80475SFelix Fietkau 	struct ath_rx_edma *rx_edma = &sc->rx.rx_edma[qtype];
611203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
61227c51f1aSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
613b5c80475SFelix Fietkau 	struct sk_buff *skb;
614b5c80475SFelix Fietkau 	struct ath_buf *bf;
615b5c80475SFelix Fietkau 	int ret;
616203c4805SLuis R. Rodriguez 
617b5c80475SFelix Fietkau 	skb = skb_peek(&rx_edma->rx_fifo);
618b5c80475SFelix Fietkau 	if (!skb)
619b5c80475SFelix Fietkau 		return false;
620203c4805SLuis R. Rodriguez 
621b5c80475SFelix Fietkau 	bf = SKB_CB_ATHBUF(skb);
622b5c80475SFelix Fietkau 	BUG_ON(!bf);
623b5c80475SFelix Fietkau 
624ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
625b5c80475SFelix Fietkau 				common->rx_bufsize, DMA_FROM_DEVICE);
626b5c80475SFelix Fietkau 
6273a2923e8SFelix Fietkau 	ret = ath9k_hw_process_rxdesc_edma(ah, rs, skb->data);
628ce9426d1SMing Lei 	if (ret == -EINPROGRESS) {
629ce9426d1SMing Lei 		/*let device gain the buffer again*/
630ce9426d1SMing Lei 		dma_sync_single_for_device(sc->dev, bf->bf_buf_addr,
631ce9426d1SMing Lei 				common->rx_bufsize, DMA_FROM_DEVICE);
632b5c80475SFelix Fietkau 		return false;
633ce9426d1SMing Lei 	}
634b5c80475SFelix Fietkau 
635b5c80475SFelix Fietkau 	__skb_unlink(skb, &rx_edma->rx_fifo);
636b5c80475SFelix Fietkau 	if (ret == -EINVAL) {
637b5c80475SFelix Fietkau 		/* corrupt descriptor, skip this one and the following one */
638b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
639b5c80475SFelix Fietkau 		ath_rx_edma_buf_link(sc, qtype);
640b5c80475SFelix Fietkau 
6413a2923e8SFelix Fietkau 		skb = skb_peek(&rx_edma->rx_fifo);
6423a2923e8SFelix Fietkau 		if (skb) {
643b5c80475SFelix Fietkau 			bf = SKB_CB_ATHBUF(skb);
644b5c80475SFelix Fietkau 			BUG_ON(!bf);
645b5c80475SFelix Fietkau 
646b5c80475SFelix Fietkau 			__skb_unlink(skb, &rx_edma->rx_fifo);
647b5c80475SFelix Fietkau 			list_add_tail(&bf->list, &sc->rx.rxbuf);
648b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
649b5c80475SFelix Fietkau 		}
6506bb51c70STom Hughes 
6516bb51c70STom Hughes 		bf = NULL;
6523a2923e8SFelix Fietkau 	}
653b5c80475SFelix Fietkau 
6543a2923e8SFelix Fietkau 	*dest = bf;
655b5c80475SFelix Fietkau 	return true;
656b5c80475SFelix Fietkau }
657b5c80475SFelix Fietkau 
658b5c80475SFelix Fietkau static struct ath_buf *ath_edma_get_next_rx_buf(struct ath_softc *sc,
659b5c80475SFelix Fietkau 						struct ath_rx_status *rs,
660b5c80475SFelix Fietkau 						enum ath9k_rx_qtype qtype)
661b5c80475SFelix Fietkau {
6623a2923e8SFelix Fietkau 	struct ath_buf *bf = NULL;
663b5c80475SFelix Fietkau 
6643a2923e8SFelix Fietkau 	while (ath_edma_get_buffers(sc, qtype, rs, &bf)) {
6653a2923e8SFelix Fietkau 		if (!bf)
6663a2923e8SFelix Fietkau 			continue;
667b5c80475SFelix Fietkau 
668b5c80475SFelix Fietkau 		return bf;
669b5c80475SFelix Fietkau 	}
6703a2923e8SFelix Fietkau 	return NULL;
6713a2923e8SFelix Fietkau }
672b5c80475SFelix Fietkau 
673b5c80475SFelix Fietkau static struct ath_buf *ath_get_next_rx_buf(struct ath_softc *sc,
674b5c80475SFelix Fietkau 					   struct ath_rx_status *rs)
675b5c80475SFelix Fietkau {
676b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
677b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
678b5c80475SFelix Fietkau 	struct ath_desc *ds;
679b5c80475SFelix Fietkau 	struct ath_buf *bf;
680b5c80475SFelix Fietkau 	int ret;
681203c4805SLuis R. Rodriguez 
682203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf)) {
683203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
684b5c80475SFelix Fietkau 		return NULL;
685203c4805SLuis R. Rodriguez 	}
686203c4805SLuis R. Rodriguez 
687203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
688203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
689203c4805SLuis R. Rodriguez 
690203c4805SLuis R. Rodriguez 	/*
691203c4805SLuis R. Rodriguez 	 * Must provide the virtual address of the current
692203c4805SLuis R. Rodriguez 	 * descriptor, the physical address, and the virtual
693203c4805SLuis R. Rodriguez 	 * address of the next descriptor in the h/w chain.
694203c4805SLuis R. Rodriguez 	 * This allows the HAL to look ahead to see if the
695203c4805SLuis R. Rodriguez 	 * hardware is done with a descriptor by checking the
696203c4805SLuis R. Rodriguez 	 * done bit in the following descriptor and the address
697203c4805SLuis R. Rodriguez 	 * of the current descriptor the DMA engine is working
698203c4805SLuis R. Rodriguez 	 * on.  All this is necessary because of our use of
699203c4805SLuis R. Rodriguez 	 * a self-linked list to avoid rx overruns.
700203c4805SLuis R. Rodriguez 	 */
7013de21116SRajkumar Manoharan 	ret = ath9k_hw_rxprocdesc(ah, ds, rs);
702b5c80475SFelix Fietkau 	if (ret == -EINPROGRESS) {
70329bffa96SFelix Fietkau 		struct ath_rx_status trs;
704203c4805SLuis R. Rodriguez 		struct ath_buf *tbf;
705203c4805SLuis R. Rodriguez 		struct ath_desc *tds;
706203c4805SLuis R. Rodriguez 
70729bffa96SFelix Fietkau 		memset(&trs, 0, sizeof(trs));
708203c4805SLuis R. Rodriguez 		if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
709203c4805SLuis R. Rodriguez 			sc->rx.rxlink = NULL;
710b5c80475SFelix Fietkau 			return NULL;
711203c4805SLuis R. Rodriguez 		}
712203c4805SLuis R. Rodriguez 
713203c4805SLuis R. Rodriguez 		tbf = list_entry(bf->list.next, struct ath_buf, list);
714203c4805SLuis R. Rodriguez 
715203c4805SLuis R. Rodriguez 		/*
716203c4805SLuis R. Rodriguez 		 * On some hardware the descriptor status words could
717203c4805SLuis R. Rodriguez 		 * get corrupted, including the done bit. Because of
718203c4805SLuis R. Rodriguez 		 * this, check if the next descriptor's done bit is
719203c4805SLuis R. Rodriguez 		 * set or not.
720203c4805SLuis R. Rodriguez 		 *
721203c4805SLuis R. Rodriguez 		 * If the next descriptor's done bit is set, the current
722203c4805SLuis R. Rodriguez 		 * descriptor has been corrupted. Force s/w to discard
723203c4805SLuis R. Rodriguez 		 * this descriptor and continue...
724203c4805SLuis R. Rodriguez 		 */
725203c4805SLuis R. Rodriguez 
726203c4805SLuis R. Rodriguez 		tds = tbf->bf_desc;
7273de21116SRajkumar Manoharan 		ret = ath9k_hw_rxprocdesc(ah, tds, &trs);
728b5c80475SFelix Fietkau 		if (ret == -EINPROGRESS)
729b5c80475SFelix Fietkau 			return NULL;
730203c4805SLuis R. Rodriguez 	}
731203c4805SLuis R. Rodriguez 
732a3dc48e8SFelix Fietkau 	list_del(&bf->list);
733b5c80475SFelix Fietkau 	if (!bf->bf_mpdu)
734b5c80475SFelix Fietkau 		return bf;
735203c4805SLuis R. Rodriguez 
736203c4805SLuis R. Rodriguez 	/*
737203c4805SLuis R. Rodriguez 	 * Synchronize the DMA transfer with CPU before
738203c4805SLuis R. Rodriguez 	 * 1. accessing the frame
739203c4805SLuis R. Rodriguez 	 * 2. requeueing the same buffer to h/w
740203c4805SLuis R. Rodriguez 	 */
741ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
742cc861f74SLuis R. Rodriguez 			common->rx_bufsize,
743203c4805SLuis R. Rodriguez 			DMA_FROM_DEVICE);
744203c4805SLuis R. Rodriguez 
745b5c80475SFelix Fietkau 	return bf;
746b5c80475SFelix Fietkau }
747b5c80475SFelix Fietkau 
748d435700fSSujith /* Assumes you've already done the endian to CPU conversion */
749d435700fSSujith static bool ath9k_rx_accept(struct ath_common *common,
7509f167f64SVasanthakumar Thiagarajan 			    struct ieee80211_hdr *hdr,
751d435700fSSujith 			    struct ieee80211_rx_status *rxs,
752d435700fSSujith 			    struct ath_rx_status *rx_stats,
753d435700fSSujith 			    bool *decrypt_error)
754d435700fSSujith {
755ec205999SFelix Fietkau 	struct ath_softc *sc = (struct ath_softc *) common->priv;
75666760eacSFelix Fietkau 	bool is_mc, is_valid_tkip, strip_mic, mic_error;
757d435700fSSujith 	struct ath_hw *ah = common->ah;
758d435700fSSujith 	__le16 fc;
759b7b1b512SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
760d435700fSSujith 
761d435700fSSujith 	fc = hdr->frame_control;
762d435700fSSujith 
76366760eacSFelix Fietkau 	is_mc = !!is_multicast_ether_addr(hdr->addr1);
76466760eacSFelix Fietkau 	is_valid_tkip = rx_stats->rs_keyix != ATH9K_RXKEYIX_INVALID &&
76566760eacSFelix Fietkau 		test_bit(rx_stats->rs_keyix, common->tkip_keymap);
766152e585dSBill Jordan 	strip_mic = is_valid_tkip && ieee80211_is_data(fc) &&
7672a5783b8SMichael Liang 		ieee80211_has_protected(fc) &&
768152e585dSBill Jordan 		!(rx_stats->rs_status &
769846d9363SFelix Fietkau 		(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_CRC | ATH9K_RXERR_MIC |
770846d9363SFelix Fietkau 		 ATH9K_RXERR_KEYMISS));
77166760eacSFelix Fietkau 
772f88373faSFelix Fietkau 	/*
773f88373faSFelix Fietkau 	 * Key miss events are only relevant for pairwise keys where the
774f88373faSFelix Fietkau 	 * descriptor does contain a valid key index. This has been observed
775f88373faSFelix Fietkau 	 * mostly with CCMP encryption.
776f88373faSFelix Fietkau 	 */
777bed3d9c0SFelix Fietkau 	if (rx_stats->rs_keyix == ATH9K_RXKEYIX_INVALID ||
778bed3d9c0SFelix Fietkau 	    !test_bit(rx_stats->rs_keyix, common->ccmp_keymap))
779f88373faSFelix Fietkau 		rx_stats->rs_status &= ~ATH9K_RXERR_KEYMISS;
780f88373faSFelix Fietkau 
78115072189SBen Greear 	if (!rx_stats->rs_datalen) {
78215072189SBen Greear 		RX_STAT_INC(rx_len_err);
783d435700fSSujith 		return false;
78415072189SBen Greear 	}
78515072189SBen Greear 
786d435700fSSujith         /*
787d435700fSSujith          * rs_status follows rs_datalen so if rs_datalen is too large
788d435700fSSujith          * we can take a hint that hardware corrupted it, so ignore
789d435700fSSujith          * those frames.
790d435700fSSujith          */
79115072189SBen Greear 	if (rx_stats->rs_datalen > (common->rx_bufsize - rx_status_len)) {
79215072189SBen Greear 		RX_STAT_INC(rx_len_err);
793d435700fSSujith 		return false;
79415072189SBen Greear 	}
795d435700fSSujith 
7960d95521eSFelix Fietkau 	/* Only use error bits from the last fragment */
797d435700fSSujith 	if (rx_stats->rs_more)
7980d95521eSFelix Fietkau 		return true;
799d435700fSSujith 
80066760eacSFelix Fietkau 	mic_error = is_valid_tkip && !ieee80211_is_ctl(fc) &&
80166760eacSFelix Fietkau 		!ieee80211_has_morefrags(fc) &&
80266760eacSFelix Fietkau 		!(le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG) &&
80366760eacSFelix Fietkau 		(rx_stats->rs_status & ATH9K_RXERR_MIC);
80466760eacSFelix Fietkau 
805d435700fSSujith 	/*
806d435700fSSujith 	 * The rx_stats->rs_status will not be set until the end of the
807d435700fSSujith 	 * chained descriptors so it can be ignored if rs_more is set. The
808d435700fSSujith 	 * rs_more will be false at the last element of the chained
809d435700fSSujith 	 * descriptors.
810d435700fSSujith 	 */
811d435700fSSujith 	if (rx_stats->rs_status != 0) {
812846d9363SFelix Fietkau 		u8 status_mask;
813846d9363SFelix Fietkau 
81466760eacSFelix Fietkau 		if (rx_stats->rs_status & ATH9K_RXERR_CRC) {
815d435700fSSujith 			rxs->flag |= RX_FLAG_FAILED_FCS_CRC;
81666760eacSFelix Fietkau 			mic_error = false;
81766760eacSFelix Fietkau 		}
818d435700fSSujith 		if (rx_stats->rs_status & ATH9K_RXERR_PHY)
819d435700fSSujith 			return false;
820d435700fSSujith 
821846d9363SFelix Fietkau 		if ((rx_stats->rs_status & ATH9K_RXERR_DECRYPT) ||
822846d9363SFelix Fietkau 		    (!is_mc && (rx_stats->rs_status & ATH9K_RXERR_KEYMISS))) {
823d435700fSSujith 			*decrypt_error = true;
82466760eacSFelix Fietkau 			mic_error = false;
825d435700fSSujith 		}
82666760eacSFelix Fietkau 
827d435700fSSujith 		/*
828d435700fSSujith 		 * Reject error frames with the exception of
829d435700fSSujith 		 * decryption and MIC failures. For monitor mode,
830d435700fSSujith 		 * we also ignore the CRC error.
831d435700fSSujith 		 */
832846d9363SFelix Fietkau 		status_mask = ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
833846d9363SFelix Fietkau 			      ATH9K_RXERR_KEYMISS;
834846d9363SFelix Fietkau 
835ec205999SFelix Fietkau 		if (ah->is_monitoring && (sc->rx.rxfilter & FIF_FCSFAIL))
836846d9363SFelix Fietkau 			status_mask |= ATH9K_RXERR_CRC;
837846d9363SFelix Fietkau 
838846d9363SFelix Fietkau 		if (rx_stats->rs_status & ~status_mask)
839d435700fSSujith 			return false;
840d435700fSSujith 	}
84166760eacSFelix Fietkau 
84266760eacSFelix Fietkau 	/*
84366760eacSFelix Fietkau 	 * For unicast frames the MIC error bit can have false positives,
84466760eacSFelix Fietkau 	 * so all MIC error reports need to be validated in software.
84566760eacSFelix Fietkau 	 * False negatives are not common, so skip software verification
84666760eacSFelix Fietkau 	 * if the hardware considers the MIC valid.
84766760eacSFelix Fietkau 	 */
84866760eacSFelix Fietkau 	if (strip_mic)
84966760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_STRIPPED;
85066760eacSFelix Fietkau 	else if (is_mc && mic_error)
85166760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_ERROR;
85266760eacSFelix Fietkau 
853d435700fSSujith 	return true;
854d435700fSSujith }
855d435700fSSujith 
856d435700fSSujith static int ath9k_process_rate(struct ath_common *common,
857d435700fSSujith 			      struct ieee80211_hw *hw,
858d435700fSSujith 			      struct ath_rx_status *rx_stats,
8599f167f64SVasanthakumar Thiagarajan 			      struct ieee80211_rx_status *rxs)
860d435700fSSujith {
861d435700fSSujith 	struct ieee80211_supported_band *sband;
862d435700fSSujith 	enum ieee80211_band band;
863d435700fSSujith 	unsigned int i = 0;
864990e08a0SBen Greear 	struct ath_softc __maybe_unused *sc = common->priv;
865d435700fSSujith 
866675a0b04SKarl Beldan 	band = hw->conf.chandef.chan->band;
867d435700fSSujith 	sband = hw->wiphy->bands[band];
868d435700fSSujith 
869d435700fSSujith 	if (rx_stats->rs_rate & 0x80) {
870d435700fSSujith 		/* HT rate */
871d435700fSSujith 		rxs->flag |= RX_FLAG_HT;
872d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_2040)
873d435700fSSujith 			rxs->flag |= RX_FLAG_40MHZ;
874d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_GI)
875d435700fSSujith 			rxs->flag |= RX_FLAG_SHORT_GI;
876d435700fSSujith 		rxs->rate_idx = rx_stats->rs_rate & 0x7f;
877d435700fSSujith 		return 0;
878d435700fSSujith 	}
879d435700fSSujith 
880d435700fSSujith 	for (i = 0; i < sband->n_bitrates; i++) {
881d435700fSSujith 		if (sband->bitrates[i].hw_value == rx_stats->rs_rate) {
882d435700fSSujith 			rxs->rate_idx = i;
883d435700fSSujith 			return 0;
884d435700fSSujith 		}
885d435700fSSujith 		if (sband->bitrates[i].hw_value_short == rx_stats->rs_rate) {
886d435700fSSujith 			rxs->flag |= RX_FLAG_SHORTPRE;
887d435700fSSujith 			rxs->rate_idx = i;
888d435700fSSujith 			return 0;
889d435700fSSujith 		}
890d435700fSSujith 	}
891d435700fSSujith 
892d435700fSSujith 	/*
893d435700fSSujith 	 * No valid hardware bitrate found -- we should not get here
894d435700fSSujith 	 * because hardware has already validated this frame as OK.
895d435700fSSujith 	 */
896d2182b69SJoe Perches 	ath_dbg(common, ANY,
897226afe68SJoe Perches 		"unsupported hw bitrate detected 0x%02x using 1 Mbit\n",
898226afe68SJoe Perches 		rx_stats->rs_rate);
89915072189SBen Greear 	RX_STAT_INC(rx_rate_err);
900d435700fSSujith 	return -EINVAL;
901d435700fSSujith }
902d435700fSSujith 
903d435700fSSujith static void ath9k_process_rssi(struct ath_common *common,
904d435700fSSujith 			       struct ieee80211_hw *hw,
9059f167f64SVasanthakumar Thiagarajan 			       struct ieee80211_hdr *hdr,
906d435700fSSujith 			       struct ath_rx_status *rx_stats)
907d435700fSSujith {
9089ac58615SFelix Fietkau 	struct ath_softc *sc = hw->priv;
909d435700fSSujith 	struct ath_hw *ah = common->ah;
9109fa23e17SFelix Fietkau 	int last_rssi;
9112ef16755SFelix Fietkau 	int rssi = rx_stats->rs_rssi;
912d435700fSSujith 
913cf3af748SRajkumar Manoharan 	if (!rx_stats->is_mybeacon ||
914cf3af748SRajkumar Manoharan 	    ((ah->opmode != NL80211_IFTYPE_STATION) &&
915cf3af748SRajkumar Manoharan 	     (ah->opmode != NL80211_IFTYPE_ADHOC)))
9169fa23e17SFelix Fietkau 		return;
9179fa23e17SFelix Fietkau 
9189fa23e17SFelix Fietkau 	if (rx_stats->rs_rssi != ATH9K_RSSI_BAD && !rx_stats->rs_moreaggr)
9199ac58615SFelix Fietkau 		ATH_RSSI_LPF(sc->last_rssi, rx_stats->rs_rssi);
920686b9cb9SBen Greear 
9219ac58615SFelix Fietkau 	last_rssi = sc->last_rssi;
922d435700fSSujith 	if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER))
9232ef16755SFelix Fietkau 		rssi = ATH_EP_RND(last_rssi, ATH_RSSI_EP_MULTIPLIER);
9242ef16755SFelix Fietkau 	if (rssi < 0)
9252ef16755SFelix Fietkau 		rssi = 0;
926d435700fSSujith 
927d435700fSSujith 	/* Update Beacon RSSI, this is used by ANI. */
9282ef16755SFelix Fietkau 	ah->stats.avgbrssi = rssi;
929d435700fSSujith }
930d435700fSSujith 
931d435700fSSujith /*
932d435700fSSujith  * For Decrypt or Demic errors, we only mark packet status here and always push
933d435700fSSujith  * up the frame up to let mac80211 handle the actual error case, be it no
934d435700fSSujith  * decryption key or real decryption error. This let us keep statistics there.
935d435700fSSujith  */
936d435700fSSujith static int ath9k_rx_skb_preprocess(struct ath_common *common,
937d435700fSSujith 				   struct ieee80211_hw *hw,
9389f167f64SVasanthakumar Thiagarajan 				   struct ieee80211_hdr *hdr,
939d435700fSSujith 				   struct ath_rx_status *rx_stats,
940d435700fSSujith 				   struct ieee80211_rx_status *rx_status,
941d435700fSSujith 				   bool *decrypt_error)
942d435700fSSujith {
943f749b946SFelix Fietkau 	struct ath_hw *ah = common->ah;
944f749b946SFelix Fietkau 
945d435700fSSujith 	/*
946d435700fSSujith 	 * everything but the rate is checked here, the rate check is done
947d435700fSSujith 	 * separately to avoid doing two lookups for a rate for each frame.
948d435700fSSujith 	 */
9499f167f64SVasanthakumar Thiagarajan 	if (!ath9k_rx_accept(common, hdr, rx_status, rx_stats, decrypt_error))
950d435700fSSujith 		return -EINVAL;
951d435700fSSujith 
9520d95521eSFelix Fietkau 	/* Only use status info from the last fragment */
9530d95521eSFelix Fietkau 	if (rx_stats->rs_more)
9540d95521eSFelix Fietkau 		return 0;
9550d95521eSFelix Fietkau 
9569f167f64SVasanthakumar Thiagarajan 	ath9k_process_rssi(common, hw, hdr, rx_stats);
957d435700fSSujith 
9589f167f64SVasanthakumar Thiagarajan 	if (ath9k_process_rate(common, hw, rx_stats, rx_status))
959d435700fSSujith 		return -EINVAL;
960d435700fSSujith 
961675a0b04SKarl Beldan 	rx_status->band = hw->conf.chandef.chan->band;
962675a0b04SKarl Beldan 	rx_status->freq = hw->conf.chandef.chan->center_freq;
963f749b946SFelix Fietkau 	rx_status->signal = ah->noise + rx_stats->rs_rssi;
964d435700fSSujith 	rx_status->antenna = rx_stats->rs_antenna;
96596d21371SThomas Pedersen 	rx_status->flag |= RX_FLAG_MACTIME_END;
9662ef16755SFelix Fietkau 	if (rx_stats->rs_moreaggr)
9672ef16755SFelix Fietkau 		rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
968d435700fSSujith 
969d435700fSSujith 	return 0;
970d435700fSSujith }
971d435700fSSujith 
972d435700fSSujith static void ath9k_rx_skb_postprocess(struct ath_common *common,
973d435700fSSujith 				     struct sk_buff *skb,
974d435700fSSujith 				     struct ath_rx_status *rx_stats,
975d435700fSSujith 				     struct ieee80211_rx_status *rxs,
976d435700fSSujith 				     bool decrypt_error)
977d435700fSSujith {
978d435700fSSujith 	struct ath_hw *ah = common->ah;
979d435700fSSujith 	struct ieee80211_hdr *hdr;
980d435700fSSujith 	int hdrlen, padpos, padsize;
981d435700fSSujith 	u8 keyix;
982d435700fSSujith 	__le16 fc;
983d435700fSSujith 
984d435700fSSujith 	/* see if any padding is done by the hw and remove it */
985d435700fSSujith 	hdr = (struct ieee80211_hdr *) skb->data;
986d435700fSSujith 	hdrlen = ieee80211_get_hdrlen_from_skb(skb);
987d435700fSSujith 	fc = hdr->frame_control;
988c60c9929SFelix Fietkau 	padpos = ieee80211_hdrlen(fc);
989d435700fSSujith 
990d435700fSSujith 	/* The MAC header is padded to have 32-bit boundary if the
991d435700fSSujith 	 * packet payload is non-zero. The general calculation for
992d435700fSSujith 	 * padsize would take into account odd header lengths:
993d435700fSSujith 	 * padsize = (4 - padpos % 4) % 4; However, since only
994d435700fSSujith 	 * even-length headers are used, padding can only be 0 or 2
995d435700fSSujith 	 * bytes and we can optimize this a bit. In addition, we must
996d435700fSSujith 	 * not try to remove padding from short control frames that do
997d435700fSSujith 	 * not have payload. */
998d435700fSSujith 	padsize = padpos & 3;
999d435700fSSujith 	if (padsize && skb->len>=padpos+padsize+FCS_LEN) {
1000d435700fSSujith 		memmove(skb->data + padsize, skb->data, padpos);
1001d435700fSSujith 		skb_pull(skb, padsize);
1002d435700fSSujith 	}
1003d435700fSSujith 
1004d435700fSSujith 	keyix = rx_stats->rs_keyix;
1005d435700fSSujith 
1006d435700fSSujith 	if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error &&
1007d435700fSSujith 	    ieee80211_has_protected(fc)) {
1008d435700fSSujith 		rxs->flag |= RX_FLAG_DECRYPTED;
1009d435700fSSujith 	} else if (ieee80211_has_protected(fc)
1010d435700fSSujith 		   && !decrypt_error && skb->len >= hdrlen + 4) {
1011d435700fSSujith 		keyix = skb->data[hdrlen + 3] >> 6;
1012d435700fSSujith 
1013d435700fSSujith 		if (test_bit(keyix, common->keymap))
1014d435700fSSujith 			rxs->flag |= RX_FLAG_DECRYPTED;
1015d435700fSSujith 	}
1016d435700fSSujith 	if (ah->sw_mgmt_crypto &&
1017d435700fSSujith 	    (rxs->flag & RX_FLAG_DECRYPTED) &&
1018d435700fSSujith 	    ieee80211_is_mgmt(fc))
1019d435700fSSujith 		/* Use software decrypt for management frames. */
1020d435700fSSujith 		rxs->flag &= ~RX_FLAG_DECRYPTED;
1021d435700fSSujith }
1022b5c80475SFelix Fietkau 
1023ab2e2fc8SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1024e93d083fSSimon Wunderlich static s8 fix_rssi_inv_only(u8 rssi_val)
1025e93d083fSSimon Wunderlich {
1026e93d083fSSimon Wunderlich 	if (rssi_val == 128)
1027e93d083fSSimon Wunderlich 		rssi_val = 0;
1028e93d083fSSimon Wunderlich 	return (s8) rssi_val;
1029e93d083fSSimon Wunderlich }
1030ab2e2fc8SSven Eckelmann #endif
1031e93d083fSSimon Wunderlich 
10329b99e665SSimon Wunderlich /* returns 1 if this was a spectral frame, even if not handled. */
10339b99e665SSimon Wunderlich static int ath_process_fft(struct ath_softc *sc, struct ieee80211_hdr *hdr,
1034e93d083fSSimon Wunderlich 			   struct ath_rx_status *rs, u64 tsf)
1035e93d083fSSimon Wunderlich {
1036bd2ffe14SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1037e93d083fSSimon Wunderlich 	struct ath_hw *ah = sc->sc_ah;
1038e93d083fSSimon Wunderlich 	u8 bins[SPECTRAL_HT20_NUM_BINS];
1039e93d083fSSimon Wunderlich 	u8 *vdata = (u8 *)hdr;
1040e93d083fSSimon Wunderlich 	struct fft_sample_ht20 fft_sample;
1041e93d083fSSimon Wunderlich 	struct ath_radar_info *radar_info;
1042e93d083fSSimon Wunderlich 	struct ath_ht20_mag_info *mag_info;
1043e93d083fSSimon Wunderlich 	int len = rs->rs_datalen;
10444ab0b0aaSSven Eckelmann 	int dc_pos;
104512824374SSven Eckelmann 	u16 length, max_magnitude;
1046e93d083fSSimon Wunderlich 
1047e93d083fSSimon Wunderlich 	/* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
1048e93d083fSSimon Wunderlich 	 * via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
1049e93d083fSSimon Wunderlich 	 * yet, but this is supposed to be possible as well.
1050e93d083fSSimon Wunderlich 	 */
1051e93d083fSSimon Wunderlich 	if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
1052e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
1053e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
10549b99e665SSimon Wunderlich 		return 0;
10559b99e665SSimon Wunderlich 
10569b99e665SSimon Wunderlich 	/* check if spectral scan bit is set. This does not have to be checked
10579b99e665SSimon Wunderlich 	 * if received through a SPECTRAL phy error, but shouldn't hurt.
10589b99e665SSimon Wunderlich 	 */
10599b99e665SSimon Wunderlich 	radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
10609b99e665SSimon Wunderlich 	if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
10619b99e665SSimon Wunderlich 		return 0;
1062e93d083fSSimon Wunderlich 
1063e93d083fSSimon Wunderlich 	/* Variation in the data length is possible and will be fixed later.
1064e93d083fSSimon Wunderlich 	 * Note that we only support HT20 for now.
1065e93d083fSSimon Wunderlich 	 *
1066e93d083fSSimon Wunderlich 	 * TODO: add HT20_40 support as well.
1067e93d083fSSimon Wunderlich 	 */
1068e93d083fSSimon Wunderlich 	if ((len > SPECTRAL_HT20_TOTAL_DATA_LEN + 2) ||
1069e93d083fSSimon Wunderlich 	    (len < SPECTRAL_HT20_TOTAL_DATA_LEN - 1))
10709b99e665SSimon Wunderlich 		return 1;
1071e93d083fSSimon Wunderlich 
1072e93d083fSSimon Wunderlich 	fft_sample.tlv.type = ATH_FFT_SAMPLE_HT20;
107312824374SSven Eckelmann 	length = sizeof(fft_sample) - sizeof(fft_sample.tlv);
107412824374SSven Eckelmann 	fft_sample.tlv.length = __cpu_to_be16(length);
1075e93d083fSSimon Wunderlich 
10764ab0b0aaSSven Eckelmann 	fft_sample.freq = __cpu_to_be16(ah->curchan->chan->center_freq);
1077e93d083fSSimon Wunderlich 	fft_sample.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl0);
1078e93d083fSSimon Wunderlich 	fft_sample.noise = ah->noise;
1079e93d083fSSimon Wunderlich 
1080e93d083fSSimon Wunderlich 	switch (len - SPECTRAL_HT20_TOTAL_DATA_LEN) {
1081e93d083fSSimon Wunderlich 	case 0:
1082e93d083fSSimon Wunderlich 		/* length correct, nothing to do. */
1083e93d083fSSimon Wunderlich 		memcpy(bins, vdata, SPECTRAL_HT20_NUM_BINS);
1084e93d083fSSimon Wunderlich 		break;
1085e93d083fSSimon Wunderlich 	case -1:
1086e93d083fSSimon Wunderlich 		/* first byte missing, duplicate it. */
1087e93d083fSSimon Wunderlich 		memcpy(&bins[1], vdata, SPECTRAL_HT20_NUM_BINS - 1);
1088e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1089e93d083fSSimon Wunderlich 		break;
1090e93d083fSSimon Wunderlich 	case 2:
1091e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes at bin 30 and 32, remove them. */
1092e93d083fSSimon Wunderlich 		memcpy(bins, vdata, 30);
1093e93d083fSSimon Wunderlich 		bins[30] = vdata[31];
1094e93d083fSSimon Wunderlich 		memcpy(&bins[31], &vdata[33], SPECTRAL_HT20_NUM_BINS - 31);
1095e93d083fSSimon Wunderlich 		break;
1096e93d083fSSimon Wunderlich 	case 1:
1097e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes AND first byte is missing. */
1098e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1099e93d083fSSimon Wunderlich 		memcpy(&bins[0], vdata, 30);
1100e93d083fSSimon Wunderlich 		bins[31] = vdata[31];
1101e93d083fSSimon Wunderlich 		memcpy(&bins[32], &vdata[33], SPECTRAL_HT20_NUM_BINS - 32);
1102e93d083fSSimon Wunderlich 		break;
1103e93d083fSSimon Wunderlich 	default:
11049b99e665SSimon Wunderlich 		return 1;
1105e93d083fSSimon Wunderlich 	}
1106e93d083fSSimon Wunderlich 
1107e93d083fSSimon Wunderlich 	/* DC value (value in the middle) is the blind spot of the spectral
1108e93d083fSSimon Wunderlich 	 * sample and invalid, interpolate it.
1109e93d083fSSimon Wunderlich 	 */
1110e93d083fSSimon Wunderlich 	dc_pos = SPECTRAL_HT20_NUM_BINS / 2;
1111e93d083fSSimon Wunderlich 	bins[dc_pos] = (bins[dc_pos + 1] + bins[dc_pos - 1]) / 2;
1112e93d083fSSimon Wunderlich 
1113e93d083fSSimon Wunderlich 	/* mag data is at the end of the frame, in front of radar_info */
1114e93d083fSSimon Wunderlich 	mag_info = ((struct ath_ht20_mag_info *)radar_info) - 1;
1115e93d083fSSimon Wunderlich 
11164ab0b0aaSSven Eckelmann 	/* copy raw bins without scaling them */
11174ab0b0aaSSven Eckelmann 	memcpy(fft_sample.data, bins, SPECTRAL_HT20_NUM_BINS);
11184ab0b0aaSSven Eckelmann 	fft_sample.max_exp = mag_info->max_exp & 0xf;
1119e93d083fSSimon Wunderlich 
112012824374SSven Eckelmann 	max_magnitude = spectral_max_magnitude(mag_info->all_bins);
112112824374SSven Eckelmann 	fft_sample.max_magnitude = __cpu_to_be16(max_magnitude);
1122e93d083fSSimon Wunderlich 	fft_sample.max_index = spectral_max_index(mag_info->all_bins);
1123e93d083fSSimon Wunderlich 	fft_sample.bitmap_weight = spectral_bitmap_weight(mag_info->all_bins);
11244ab0b0aaSSven Eckelmann 	fft_sample.tsf = __cpu_to_be64(tsf);
1125e93d083fSSimon Wunderlich 
1126e93d083fSSimon Wunderlich 	ath_debug_send_fft_sample(sc, &fft_sample.tlv);
11279b99e665SSimon Wunderlich 	return 1;
11289b99e665SSimon Wunderlich #else
11299b99e665SSimon Wunderlich 	return 0;
1130e93d083fSSimon Wunderlich #endif
1131e93d083fSSimon Wunderlich }
1132e93d083fSSimon Wunderlich 
113321fbbca3SChristian Lamparter static void ath9k_apply_ampdu_details(struct ath_softc *sc,
113421fbbca3SChristian Lamparter 	struct ath_rx_status *rs, struct ieee80211_rx_status *rxs)
113521fbbca3SChristian Lamparter {
113621fbbca3SChristian Lamparter 	if (rs->rs_isaggr) {
113721fbbca3SChristian Lamparter 		rxs->flag |= RX_FLAG_AMPDU_DETAILS | RX_FLAG_AMPDU_LAST_KNOWN;
113821fbbca3SChristian Lamparter 
113921fbbca3SChristian Lamparter 		rxs->ampdu_reference = sc->rx.ampdu_ref;
114021fbbca3SChristian Lamparter 
114121fbbca3SChristian Lamparter 		if (!rs->rs_moreaggr) {
114221fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_IS_LAST;
114321fbbca3SChristian Lamparter 			sc->rx.ampdu_ref++;
114421fbbca3SChristian Lamparter 		}
114521fbbca3SChristian Lamparter 
114621fbbca3SChristian Lamparter 		if (rs->rs_flags & ATH9K_RX_DELIM_CRC_PRE)
114721fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_DELIM_CRC_ERROR;
114821fbbca3SChristian Lamparter 	}
114921fbbca3SChristian Lamparter }
115021fbbca3SChristian Lamparter 
1151b5c80475SFelix Fietkau int ath_rx_tasklet(struct ath_softc *sc, int flush, bool hp)
1152b5c80475SFelix Fietkau {
1153b5c80475SFelix Fietkau 	struct ath_buf *bf;
11540d95521eSFelix Fietkau 	struct sk_buff *skb = NULL, *requeue_skb, *hdr_skb;
1155b5c80475SFelix Fietkau 	struct ieee80211_rx_status *rxs;
1156b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
1157b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
11587545daf4SFelix Fietkau 	struct ieee80211_hw *hw = sc->hw;
1159b5c80475SFelix Fietkau 	struct ieee80211_hdr *hdr;
1160b5c80475SFelix Fietkau 	int retval;
1161b5c80475SFelix Fietkau 	struct ath_rx_status rs;
1162b5c80475SFelix Fietkau 	enum ath9k_rx_qtype qtype;
1163b5c80475SFelix Fietkau 	bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
1164b5c80475SFelix Fietkau 	int dma_type;
11655c6dd921SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
1166a6d2055bSFelix Fietkau 	u64 tsf = 0;
1167a6d2055bSFelix Fietkau 	u32 tsf_lower = 0;
11688ab2cd09SLuis R. Rodriguez 	unsigned long flags;
1169*2e1cd495SFelix Fietkau 	dma_addr_t new_buf_addr;
1170b5c80475SFelix Fietkau 
1171b5c80475SFelix Fietkau 	if (edma)
1172b5c80475SFelix Fietkau 		dma_type = DMA_BIDIRECTIONAL;
117356824223SMing Lei 	else
117456824223SMing Lei 		dma_type = DMA_FROM_DEVICE;
1175b5c80475SFelix Fietkau 
1176b5c80475SFelix Fietkau 	qtype = hp ? ATH9K_RX_QUEUE_HP : ATH9K_RX_QUEUE_LP;
1177b5c80475SFelix Fietkau 
1178a6d2055bSFelix Fietkau 	tsf = ath9k_hw_gettsf64(ah);
1179a6d2055bSFelix Fietkau 	tsf_lower = tsf & 0xffffffff;
1180a6d2055bSFelix Fietkau 
1181b5c80475SFelix Fietkau 	do {
1182e1352fdeSLorenzo Bianconi 		bool decrypt_error = false;
1183b5c80475SFelix Fietkau 
1184b5c80475SFelix Fietkau 		memset(&rs, 0, sizeof(rs));
1185b5c80475SFelix Fietkau 		if (edma)
1186b5c80475SFelix Fietkau 			bf = ath_edma_get_next_rx_buf(sc, &rs, qtype);
1187b5c80475SFelix Fietkau 		else
1188b5c80475SFelix Fietkau 			bf = ath_get_next_rx_buf(sc, &rs);
1189b5c80475SFelix Fietkau 
1190b5c80475SFelix Fietkau 		if (!bf)
1191b5c80475SFelix Fietkau 			break;
1192b5c80475SFelix Fietkau 
1193b5c80475SFelix Fietkau 		skb = bf->bf_mpdu;
1194b5c80475SFelix Fietkau 		if (!skb)
1195b5c80475SFelix Fietkau 			continue;
1196b5c80475SFelix Fietkau 
11970d95521eSFelix Fietkau 		/*
11980d95521eSFelix Fietkau 		 * Take frame header from the first fragment and RX status from
11990d95521eSFelix Fietkau 		 * the last one.
12000d95521eSFelix Fietkau 		 */
12010d95521eSFelix Fietkau 		if (sc->rx.frag)
12020d95521eSFelix Fietkau 			hdr_skb = sc->rx.frag;
12030d95521eSFelix Fietkau 		else
12040d95521eSFelix Fietkau 			hdr_skb = skb;
12050d95521eSFelix Fietkau 
12060d95521eSFelix Fietkau 		hdr = (struct ieee80211_hdr *) (hdr_skb->data + rx_status_len);
12070d95521eSFelix Fietkau 		rxs = IEEE80211_SKB_RXCB(hdr_skb);
120815072189SBen Greear 		if (ieee80211_is_beacon(hdr->frame_control)) {
120915072189SBen Greear 			RX_STAT_INC(rx_beacons);
121015072189SBen Greear 			if (!is_zero_ether_addr(common->curbssid) &&
12112e42e474SJoe Perches 			    ether_addr_equal(hdr->addr3, common->curbssid))
1212cf3af748SRajkumar Manoharan 				rs.is_mybeacon = true;
1213cf3af748SRajkumar Manoharan 			else
1214cf3af748SRajkumar Manoharan 				rs.is_mybeacon = false;
121515072189SBen Greear 		}
121615072189SBen Greear 		else
121715072189SBen Greear 			rs.is_mybeacon = false;
12185ca42627SLuis R. Rodriguez 
1219be41b052SMohammed Shafi Shajakhan 		if (ieee80211_is_data_present(hdr->frame_control) &&
1220be41b052SMohammed Shafi Shajakhan 		    !ieee80211_is_qos_nullfunc(hdr->frame_control))
12216995fb80SRajkumar Manoharan 			sc->rx.num_pkts++;
1222be41b052SMohammed Shafi Shajakhan 
122329bffa96SFelix Fietkau 		ath_debug_stat_rx(sc, &rs);
12241395d3f0SSujith 
1225ffb1c56aSAshok Nagarajan 		memset(rxs, 0, sizeof(struct ieee80211_rx_status));
1226ffb1c56aSAshok Nagarajan 
1227a6d2055bSFelix Fietkau 		rxs->mactime = (tsf & ~0xffffffffULL) | rs.rs_tstamp;
1228a6d2055bSFelix Fietkau 		if (rs.rs_tstamp > tsf_lower &&
1229a6d2055bSFelix Fietkau 		    unlikely(rs.rs_tstamp - tsf_lower > 0x10000000))
1230a6d2055bSFelix Fietkau 			rxs->mactime -= 0x100000000ULL;
1231a6d2055bSFelix Fietkau 
1232a6d2055bSFelix Fietkau 		if (rs.rs_tstamp < tsf_lower &&
1233a6d2055bSFelix Fietkau 		    unlikely(tsf_lower - rs.rs_tstamp > 0x10000000))
1234a6d2055bSFelix Fietkau 			rxs->mactime += 0x100000000ULL;
1235a6d2055bSFelix Fietkau 
123673e4937dSZefir Kurtisi 		if (rs.rs_phyerr == ATH9K_PHYERR_RADAR)
123773e4937dSZefir Kurtisi 			ath9k_dfs_process_phyerr(sc, hdr, &rs, rxs->mactime);
123873e4937dSZefir Kurtisi 
12399b99e665SSimon Wunderlich 		if (rs.rs_status & ATH9K_RXERR_PHY) {
12409b99e665SSimon Wunderlich 			if (ath_process_fft(sc, hdr, &rs, rxs->mactime)) {
12419b99e665SSimon Wunderlich 				RX_STAT_INC(rx_spectral);
12429b99e665SSimon Wunderlich 				goto requeue_drop_frag;
12439b99e665SSimon Wunderlich 			}
12449b99e665SSimon Wunderlich 		}
1245e93d083fSSimon Wunderlich 
124683c76570SZefir Kurtisi 		retval = ath9k_rx_skb_preprocess(common, hw, hdr, &rs,
124783c76570SZefir Kurtisi 						 rxs, &decrypt_error);
124883c76570SZefir Kurtisi 		if (retval)
124983c76570SZefir Kurtisi 			goto requeue_drop_frag;
125083c76570SZefir Kurtisi 
125101e18918SRajkumar Manoharan 		if (rs.is_mybeacon) {
125201e18918SRajkumar Manoharan 			sc->hw_busy_count = 0;
125301e18918SRajkumar Manoharan 			ath_start_rx_poll(sc, 3);
125401e18918SRajkumar Manoharan 		}
1255203c4805SLuis R. Rodriguez 		/* Ensure we always have an skb to requeue once we are done
1256203c4805SLuis R. Rodriguez 		 * processing the current buffer's skb */
1257cc861f74SLuis R. Rodriguez 		requeue_skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_ATOMIC);
1258203c4805SLuis R. Rodriguez 
1259203c4805SLuis R. Rodriguez 		/* If there is no memory we ignore the current RX'd frame,
1260203c4805SLuis R. Rodriguez 		 * tell hardware it can give us a new frame using the old
1261203c4805SLuis R. Rodriguez 		 * skb and put it at the tail of the sc->rx.rxbuf list for
1262203c4805SLuis R. Rodriguez 		 * processing. */
126315072189SBen Greear 		if (!requeue_skb) {
126415072189SBen Greear 			RX_STAT_INC(rx_oom_err);
12650d95521eSFelix Fietkau 			goto requeue_drop_frag;
126615072189SBen Greear 		}
1267203c4805SLuis R. Rodriguez 
1268*2e1cd495SFelix Fietkau 		/* We will now give hardware our shiny new allocated skb */
1269*2e1cd495SFelix Fietkau 		new_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
1270*2e1cd495SFelix Fietkau 					      common->rx_bufsize, dma_type);
1271*2e1cd495SFelix Fietkau 		if (unlikely(dma_mapping_error(sc->dev, new_buf_addr))) {
1272*2e1cd495SFelix Fietkau 			dev_kfree_skb_any(requeue_skb);
1273*2e1cd495SFelix Fietkau 			goto requeue_drop_frag;
1274*2e1cd495SFelix Fietkau 		}
1275*2e1cd495SFelix Fietkau 
1276*2e1cd495SFelix Fietkau 		bf->bf_mpdu = requeue_skb;
1277*2e1cd495SFelix Fietkau 		bf->bf_buf_addr = new_buf_addr;
1278*2e1cd495SFelix Fietkau 
1279203c4805SLuis R. Rodriguez 		/* Unmap the frame */
1280203c4805SLuis R. Rodriguez 		dma_unmap_single(sc->dev, bf->bf_buf_addr,
1281*2e1cd495SFelix Fietkau 				 common->rx_bufsize, dma_type);
1282203c4805SLuis R. Rodriguez 
1283b5c80475SFelix Fietkau 		skb_put(skb, rs.rs_datalen + ah->caps.rx_status_len);
1284b5c80475SFelix Fietkau 		if (ah->caps.rx_status_len)
1285b5c80475SFelix Fietkau 			skb_pull(skb, ah->caps.rx_status_len);
1286203c4805SLuis R. Rodriguez 
12870d95521eSFelix Fietkau 		if (!rs.rs_more)
12880d95521eSFelix Fietkau 			ath9k_rx_skb_postprocess(common, hdr_skb, &rs,
1289c9b14170SLuis R. Rodriguez 						 rxs, decrypt_error);
1290203c4805SLuis R. Rodriguez 
12910d95521eSFelix Fietkau 		if (rs.rs_more) {
129215072189SBen Greear 			RX_STAT_INC(rx_frags);
12930d95521eSFelix Fietkau 			/*
12940d95521eSFelix Fietkau 			 * rs_more indicates chained descriptors which can be
12950d95521eSFelix Fietkau 			 * used to link buffers together for a sort of
12960d95521eSFelix Fietkau 			 * scatter-gather operation.
12970d95521eSFelix Fietkau 			 */
12980d95521eSFelix Fietkau 			if (sc->rx.frag) {
12990d95521eSFelix Fietkau 				/* too many fragments - cannot handle frame */
13000d95521eSFelix Fietkau 				dev_kfree_skb_any(sc->rx.frag);
13010d95521eSFelix Fietkau 				dev_kfree_skb_any(skb);
130215072189SBen Greear 				RX_STAT_INC(rx_too_many_frags_err);
13030d95521eSFelix Fietkau 				skb = NULL;
13040d95521eSFelix Fietkau 			}
13050d95521eSFelix Fietkau 			sc->rx.frag = skb;
13060d95521eSFelix Fietkau 			goto requeue;
13070d95521eSFelix Fietkau 		}
13080d95521eSFelix Fietkau 
13090d95521eSFelix Fietkau 		if (sc->rx.frag) {
13100d95521eSFelix Fietkau 			int space = skb->len - skb_tailroom(hdr_skb);
13110d95521eSFelix Fietkau 
13120d95521eSFelix Fietkau 			if (pskb_expand_head(hdr_skb, 0, space, GFP_ATOMIC) < 0) {
13130d95521eSFelix Fietkau 				dev_kfree_skb(skb);
131415072189SBen Greear 				RX_STAT_INC(rx_oom_err);
13150d95521eSFelix Fietkau 				goto requeue_drop_frag;
13160d95521eSFelix Fietkau 			}
13170d95521eSFelix Fietkau 
1318b5447ff9SEric Dumazet 			sc->rx.frag = NULL;
1319b5447ff9SEric Dumazet 
13200d95521eSFelix Fietkau 			skb_copy_from_linear_data(skb, skb_put(hdr_skb, skb->len),
13210d95521eSFelix Fietkau 						  skb->len);
13220d95521eSFelix Fietkau 			dev_kfree_skb_any(skb);
13230d95521eSFelix Fietkau 			skb = hdr_skb;
13240d95521eSFelix Fietkau 		}
13250d95521eSFelix Fietkau 
1326eb840a80SMohammed Shafi Shajakhan 
1327eb840a80SMohammed Shafi Shajakhan 		if (ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) {
1328eb840a80SMohammed Shafi Shajakhan 
1329203c4805SLuis R. Rodriguez 			/*
1330eb840a80SMohammed Shafi Shajakhan 			 * change the default rx antenna if rx diversity
1331eb840a80SMohammed Shafi Shajakhan 			 * chooses the other antenna 3 times in a row.
1332203c4805SLuis R. Rodriguez 			 */
133329bffa96SFelix Fietkau 			if (sc->rx.defant != rs.rs_antenna) {
1334203c4805SLuis R. Rodriguez 				if (++sc->rx.rxotherant >= 3)
133529bffa96SFelix Fietkau 					ath_setdefantenna(sc, rs.rs_antenna);
1336203c4805SLuis R. Rodriguez 			} else {
1337203c4805SLuis R. Rodriguez 				sc->rx.rxotherant = 0;
1338203c4805SLuis R. Rodriguez 			}
1339203c4805SLuis R. Rodriguez 
1340eb840a80SMohammed Shafi Shajakhan 		}
1341eb840a80SMohammed Shafi Shajakhan 
134266760eacSFelix Fietkau 		if (rxs->flag & RX_FLAG_MMIC_STRIPPED)
134366760eacSFelix Fietkau 			skb_trim(skb, skb->len - 8);
134466760eacSFelix Fietkau 
13458ab2cd09SLuis R. Rodriguez 		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1346aaef24b4SMohammed Shafi Shajakhan 		if ((sc->ps_flags & (PS_WAIT_FOR_BEACON |
13471b04b930SSujith 				     PS_WAIT_FOR_CAB |
1348aaef24b4SMohammed Shafi Shajakhan 				     PS_WAIT_FOR_PSPOLL_DATA)) ||
1349cedc7e3dSMohammed Shafi Shajakhan 		    ath9k_check_auto_sleep(sc))
1350f73c604cSRajkumar Manoharan 			ath_rx_ps(sc, skb, rs.is_mybeacon);
13518ab2cd09SLuis R. Rodriguez 		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1352cc65965cSJouni Malinen 
135343c35284SFelix Fietkau 		if ((ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) && sc->ant_rx == 3)
1354102885a5SVasanthakumar Thiagarajan 			ath_ant_comb_scan(sc, &rs);
1355102885a5SVasanthakumar Thiagarajan 
135621fbbca3SChristian Lamparter 		ath9k_apply_ampdu_details(sc, &rs, rxs);
135721fbbca3SChristian Lamparter 
13587545daf4SFelix Fietkau 		ieee80211_rx(hw, skb);
1359cc65965cSJouni Malinen 
13600d95521eSFelix Fietkau requeue_drop_frag:
13610d95521eSFelix Fietkau 		if (sc->rx.frag) {
13620d95521eSFelix Fietkau 			dev_kfree_skb_any(sc->rx.frag);
13630d95521eSFelix Fietkau 			sc->rx.frag = NULL;
13640d95521eSFelix Fietkau 		}
1365203c4805SLuis R. Rodriguez requeue:
1366b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
1367a3dc48e8SFelix Fietkau 		if (flush)
1368a3dc48e8SFelix Fietkau 			continue;
1369a3dc48e8SFelix Fietkau 
1370a3dc48e8SFelix Fietkau 		if (edma) {
1371b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
1372b5c80475SFelix Fietkau 		} else {
1373203c4805SLuis R. Rodriguez 			ath_rx_buf_link(sc, bf);
137495294973SFelix Fietkau 			ath9k_hw_rxena(ah);
1375b5c80475SFelix Fietkau 		}
1376203c4805SLuis R. Rodriguez 	} while (1);
1377203c4805SLuis R. Rodriguez 
137829ab0b36SRajkumar Manoharan 	if (!(ah->imask & ATH9K_INT_RXEOL)) {
137929ab0b36SRajkumar Manoharan 		ah->imask |= (ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
138072d874c6SFelix Fietkau 		ath9k_hw_set_interrupts(ah);
138129ab0b36SRajkumar Manoharan 	}
138229ab0b36SRajkumar Manoharan 
1383203c4805SLuis R. Rodriguez 	return 0;
1384203c4805SLuis R. Rodriguez }
1385