xref: /linux/drivers/net/wireless/ath/ath9k/recv.c (revision e87f3d538e5c3a561ddd97eab02706ff3973e7da)
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,
1337a897203SSujith Manoharan 				  enum ath9k_rx_qtype qtype)
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);
2537a897203SSujith Manoharan 	ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_HP);
2547a897203SSujith Manoharan 	ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_LP);
255b5c80475SFelix Fietkau 	ath_opmode_init(sc);
2564cb54fa3SSujith Manoharan 	ath9k_hw_startpcureceive(sc->sc_ah, !!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL));
257b5c80475SFelix Fietkau }
258b5c80475SFelix Fietkau 
259b5c80475SFelix Fietkau static void ath_edma_stop_recv(struct ath_softc *sc)
260b5c80475SFelix Fietkau {
261b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_HP);
262b5c80475SFelix Fietkau 	ath_rx_remove_buffer(sc, ATH9K_RX_QUEUE_LP);
263b5c80475SFelix Fietkau }
264b5c80475SFelix Fietkau 
265203c4805SLuis R. Rodriguez int ath_rx_init(struct ath_softc *sc, int nbufs)
266203c4805SLuis R. Rodriguez {
26727c51f1aSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
268203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
269203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
270203c4805SLuis R. Rodriguez 	int error = 0;
271203c4805SLuis R. Rodriguez 
2724bdd1e97SLuis R. Rodriguez 	spin_lock_init(&sc->sc_pcu_lock);
273203c4805SLuis R. Rodriguez 
2740d95521eSFelix Fietkau 	common->rx_bufsize = IEEE80211_MAX_MPDU_LEN / 2 +
2750d95521eSFelix Fietkau 			     sc->sc_ah->caps.rx_status_len;
2760d95521eSFelix Fietkau 
277*e87f3d53SSujith Manoharan 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
278b5c80475SFelix Fietkau 		return ath_rx_edma_init(sc, nbufs);
279*e87f3d53SSujith Manoharan 
280d2182b69SJoe Perches 	ath_dbg(common, CONFIG, "cachelsz %u rxbufsize %u\n",
281cc861f74SLuis R. Rodriguez 		common->cachelsz, common->rx_bufsize);
282203c4805SLuis R. Rodriguez 
283203c4805SLuis R. Rodriguez 	/* Initialize rx descriptors */
284203c4805SLuis R. Rodriguez 
285203c4805SLuis R. Rodriguez 	error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
2864adfcdedSVasanthakumar Thiagarajan 				  "rx", nbufs, 1, 0);
287203c4805SLuis R. Rodriguez 	if (error != 0) {
2883800276aSJoe Perches 		ath_err(common,
289b5c80475SFelix Fietkau 			"failed to allocate rx descriptors: %d\n",
290b5c80475SFelix Fietkau 			error);
291203c4805SLuis R. Rodriguez 		goto err;
292203c4805SLuis R. Rodriguez 	}
293203c4805SLuis R. Rodriguez 
294203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
295b5c80475SFelix Fietkau 		skb = ath_rxbuf_alloc(common, common->rx_bufsize,
296b5c80475SFelix Fietkau 				      GFP_KERNEL);
297203c4805SLuis R. Rodriguez 		if (skb == NULL) {
298203c4805SLuis R. Rodriguez 			error = -ENOMEM;
299203c4805SLuis R. Rodriguez 			goto err;
300203c4805SLuis R. Rodriguez 		}
301203c4805SLuis R. Rodriguez 
302203c4805SLuis R. Rodriguez 		bf->bf_mpdu = skb;
303203c4805SLuis R. Rodriguez 		bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
304cc861f74SLuis R. Rodriguez 						 common->rx_bufsize,
305203c4805SLuis R. Rodriguez 						 DMA_FROM_DEVICE);
306203c4805SLuis R. Rodriguez 		if (unlikely(dma_mapping_error(sc->dev,
307203c4805SLuis R. Rodriguez 					       bf->bf_buf_addr))) {
308203c4805SLuis R. Rodriguez 			dev_kfree_skb_any(skb);
309203c4805SLuis R. Rodriguez 			bf->bf_mpdu = NULL;
3106cf9e995SBen Greear 			bf->bf_buf_addr = 0;
3113800276aSJoe Perches 			ath_err(common,
312203c4805SLuis R. Rodriguez 				"dma_mapping_error() on RX init\n");
313203c4805SLuis R. Rodriguez 			error = -ENOMEM;
314203c4805SLuis R. Rodriguez 			goto err;
315203c4805SLuis R. Rodriguez 		}
316203c4805SLuis R. Rodriguez 	}
317203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
318203c4805SLuis R. Rodriguez err:
319203c4805SLuis R. Rodriguez 	if (error)
320203c4805SLuis R. Rodriguez 		ath_rx_cleanup(sc);
321203c4805SLuis R. Rodriguez 
322203c4805SLuis R. Rodriguez 	return error;
323203c4805SLuis R. Rodriguez }
324203c4805SLuis R. Rodriguez 
325203c4805SLuis R. Rodriguez void ath_rx_cleanup(struct ath_softc *sc)
326203c4805SLuis R. Rodriguez {
327cc861f74SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
328cc861f74SLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
329203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
330203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
331203c4805SLuis R. Rodriguez 
332b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
333b5c80475SFelix Fietkau 		ath_rx_edma_cleanup(sc);
334b5c80475SFelix Fietkau 		return;
335*e87f3d53SSujith Manoharan 	}
336*e87f3d53SSujith Manoharan 
337203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
338203c4805SLuis R. Rodriguez 		skb = bf->bf_mpdu;
339203c4805SLuis R. Rodriguez 		if (skb) {
340203c4805SLuis R. Rodriguez 			dma_unmap_single(sc->dev, bf->bf_buf_addr,
341b5c80475SFelix Fietkau 					 common->rx_bufsize,
342b5c80475SFelix Fietkau 					 DMA_FROM_DEVICE);
343203c4805SLuis R. Rodriguez 			dev_kfree_skb(skb);
3446cf9e995SBen Greear 			bf->bf_buf_addr = 0;
3456cf9e995SBen Greear 			bf->bf_mpdu = NULL;
346203c4805SLuis R. Rodriguez 		}
347203c4805SLuis R. Rodriguez 	}
348203c4805SLuis R. Rodriguez }
349203c4805SLuis R. Rodriguez 
350203c4805SLuis R. Rodriguez /*
351203c4805SLuis R. Rodriguez  * Calculate the receive filter according to the
352203c4805SLuis R. Rodriguez  * operating mode and state:
353203c4805SLuis R. Rodriguez  *
354203c4805SLuis R. Rodriguez  * o always accept unicast, broadcast, and multicast traffic
355203c4805SLuis R. Rodriguez  * o maintain current state of phy error reception (the hal
356203c4805SLuis R. Rodriguez  *   may enable phy error frames for noise immunity work)
357203c4805SLuis R. Rodriguez  * o probe request frames are accepted only when operating in
358203c4805SLuis R. Rodriguez  *   hostap, adhoc, or monitor modes
359203c4805SLuis R. Rodriguez  * o enable promiscuous mode according to the interface state
360203c4805SLuis R. Rodriguez  * o accept beacons:
361203c4805SLuis R. Rodriguez  *   - when operating in adhoc mode so the 802.11 layer creates
362203c4805SLuis R. Rodriguez  *     node table entries for peers,
363203c4805SLuis R. Rodriguez  *   - when operating in station mode for collecting rssi data when
364203c4805SLuis R. Rodriguez  *     the station is otherwise quiet, or
365203c4805SLuis R. Rodriguez  *   - when operating as a repeater so we see repeater-sta beacons
366203c4805SLuis R. Rodriguez  *   - when scanning
367203c4805SLuis R. Rodriguez  */
368203c4805SLuis R. Rodriguez 
369203c4805SLuis R. Rodriguez u32 ath_calcrxfilter(struct ath_softc *sc)
370203c4805SLuis R. Rodriguez {
371203c4805SLuis R. Rodriguez 	u32 rfilt;
372203c4805SLuis R. Rodriguez 
373ac06697cSFelix Fietkau 	rfilt = ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
374203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_MCAST;
375203c4805SLuis R. Rodriguez 
37673e4937dSZefir Kurtisi 	/* if operating on a DFS channel, enable radar pulse detection */
37773e4937dSZefir Kurtisi 	if (sc->hw->conf.radar_enabled)
37873e4937dSZefir Kurtisi 		rfilt |= ATH9K_RX_FILTER_PHYRADAR | ATH9K_RX_FILTER_PHYERR;
37973e4937dSZefir Kurtisi 
3809c1d8e4aSJouni Malinen 	if (sc->rx.rxfilter & FIF_PROBE_REQ)
381203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROBEREQ;
382203c4805SLuis R. Rodriguez 
383203c4805SLuis R. Rodriguez 	/*
384203c4805SLuis R. Rodriguez 	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
385203c4805SLuis R. Rodriguez 	 * mode interface or when in monitor mode. AP mode does not need this
386203c4805SLuis R. Rodriguez 	 * since it receives all in-BSS frames anyway.
387203c4805SLuis R. Rodriguez 	 */
3882e286947SFelix Fietkau 	if (sc->sc_ah->is_monitoring)
389203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROM;
390203c4805SLuis R. Rodriguez 
391203c4805SLuis R. Rodriguez 	if (sc->rx.rxfilter & FIF_CONTROL)
392203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_CONTROL;
393203c4805SLuis R. Rodriguez 
394203c4805SLuis R. Rodriguez 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
395cfda6695SBen Greear 	    (sc->nvifs <= 1) &&
396203c4805SLuis R. Rodriguez 	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
397203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MYBEACON;
398203c4805SLuis R. Rodriguez 	else
399203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_BEACON;
400203c4805SLuis R. Rodriguez 
401264bbec8SFelix Fietkau 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
40266afad01SSenthil Balasubramanian 	    (sc->rx.rxfilter & FIF_PSPOLL))
403203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PSPOLL;
404203c4805SLuis R. Rodriguez 
4057ea310beSSujith 	if (conf_is_ht(&sc->hw->conf))
4067ea310beSSujith 		rfilt |= ATH9K_RX_FILTER_COMP_BAR;
4077ea310beSSujith 
4087545daf4SFelix Fietkau 	if (sc->nvifs > 1 || (sc->rx.rxfilter & FIF_OTHER_BSS)) {
409a549459cSThomas Wagner 		/* This is needed for older chips */
410a549459cSThomas Wagner 		if (sc->sc_ah->hw_version.macVersion <= AR_SREV_VERSION_9160)
4115eb6ba83SJavier Cardona 			rfilt |= ATH9K_RX_FILTER_PROM;
412203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
413203c4805SLuis R. Rodriguez 	}
414203c4805SLuis R. Rodriguez 
415b3d7aa43SGabor Juhos 	if (AR_SREV_9550(sc->sc_ah))
416b3d7aa43SGabor Juhos 		rfilt |= ATH9K_RX_FILTER_4ADDRESS;
417b3d7aa43SGabor Juhos 
418203c4805SLuis R. Rodriguez 	return rfilt;
419203c4805SLuis R. Rodriguez 
420203c4805SLuis R. Rodriguez }
421203c4805SLuis R. Rodriguez 
422203c4805SLuis R. Rodriguez int ath_startrecv(struct ath_softc *sc)
423203c4805SLuis R. Rodriguez {
424203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
425203c4805SLuis R. Rodriguez 	struct ath_buf *bf, *tbf;
426203c4805SLuis R. Rodriguez 
427b5c80475SFelix Fietkau 	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
428b5c80475SFelix Fietkau 		ath_edma_start_recv(sc);
429b5c80475SFelix Fietkau 		return 0;
430b5c80475SFelix Fietkau 	}
431b5c80475SFelix Fietkau 
432203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
433203c4805SLuis R. Rodriguez 		goto start_recv;
434203c4805SLuis R. Rodriguez 
435203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
436203c4805SLuis R. Rodriguez 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
437203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
438203c4805SLuis R. Rodriguez 	}
439203c4805SLuis R. Rodriguez 
440203c4805SLuis R. Rodriguez 	/* We could have deleted elements so the list may be empty now */
441203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
442203c4805SLuis R. Rodriguez 		goto start_recv;
443203c4805SLuis R. Rodriguez 
444203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
445203c4805SLuis R. Rodriguez 	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
446203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
447203c4805SLuis R. Rodriguez 
448203c4805SLuis R. Rodriguez start_recv:
449203c4805SLuis R. Rodriguez 	ath_opmode_init(sc);
4504cb54fa3SSujith Manoharan 	ath9k_hw_startpcureceive(ah, !!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL));
451203c4805SLuis R. Rodriguez 
452203c4805SLuis R. Rodriguez 	return 0;
453203c4805SLuis R. Rodriguez }
454203c4805SLuis R. Rodriguez 
4554b883f02SFelix Fietkau static void ath_flushrecv(struct ath_softc *sc)
4564b883f02SFelix Fietkau {
4574b883f02SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
4584b883f02SFelix Fietkau 		ath_rx_tasklet(sc, 1, true);
4594b883f02SFelix Fietkau 	ath_rx_tasklet(sc, 1, false);
4604b883f02SFelix Fietkau }
4614b883f02SFelix Fietkau 
462203c4805SLuis R. Rodriguez bool ath_stoprecv(struct ath_softc *sc)
463203c4805SLuis R. Rodriguez {
464203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
4655882da02SFelix Fietkau 	bool stopped, reset = false;
466203c4805SLuis R. Rodriguez 
467d47844a0SFelix Fietkau 	ath9k_hw_abortpcurecv(ah);
468203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, 0);
4695882da02SFelix Fietkau 	stopped = ath9k_hw_stopdmarecv(ah, &reset);
470b5c80475SFelix Fietkau 
4714b883f02SFelix Fietkau 	ath_flushrecv(sc);
4724b883f02SFelix Fietkau 
473b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
474b5c80475SFelix Fietkau 		ath_edma_stop_recv(sc);
475b5c80475SFelix Fietkau 	else
476203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
477203c4805SLuis R. Rodriguez 
478d584747bSRajkumar Manoharan 	if (!(ah->ah_flags & AH_UNPLUGGED) &&
479d584747bSRajkumar Manoharan 	    unlikely(!stopped)) {
480d7fd1b50SBen Greear 		ath_err(ath9k_hw_common(sc->sc_ah),
481d7fd1b50SBen Greear 			"Could not stop RX, we could be "
48278a7685eSLuis R. Rodriguez 			"confusing the DMA engine when we start RX up\n");
483d7fd1b50SBen Greear 		ATH_DBG_WARN_ON_ONCE(!stopped);
484d7fd1b50SBen Greear 	}
4852232d31bSFelix Fietkau 	return stopped && !reset;
486203c4805SLuis R. Rodriguez }
487203c4805SLuis R. Rodriguez 
488cc65965cSJouni Malinen static bool ath_beacon_dtim_pending_cab(struct sk_buff *skb)
489cc65965cSJouni Malinen {
490cc65965cSJouni Malinen 	/* Check whether the Beacon frame has DTIM indicating buffered bc/mc */
491cc65965cSJouni Malinen 	struct ieee80211_mgmt *mgmt;
492cc65965cSJouni Malinen 	u8 *pos, *end, id, elen;
493cc65965cSJouni Malinen 	struct ieee80211_tim_ie *tim;
494cc65965cSJouni Malinen 
495cc65965cSJouni Malinen 	mgmt = (struct ieee80211_mgmt *)skb->data;
496cc65965cSJouni Malinen 	pos = mgmt->u.beacon.variable;
497cc65965cSJouni Malinen 	end = skb->data + skb->len;
498cc65965cSJouni Malinen 
499cc65965cSJouni Malinen 	while (pos + 2 < end) {
500cc65965cSJouni Malinen 		id = *pos++;
501cc65965cSJouni Malinen 		elen = *pos++;
502cc65965cSJouni Malinen 		if (pos + elen > end)
503cc65965cSJouni Malinen 			break;
504cc65965cSJouni Malinen 
505cc65965cSJouni Malinen 		if (id == WLAN_EID_TIM) {
506cc65965cSJouni Malinen 			if (elen < sizeof(*tim))
507cc65965cSJouni Malinen 				break;
508cc65965cSJouni Malinen 			tim = (struct ieee80211_tim_ie *) pos;
509cc65965cSJouni Malinen 			if (tim->dtim_count != 0)
510cc65965cSJouni Malinen 				break;
511cc65965cSJouni Malinen 			return tim->bitmap_ctrl & 0x01;
512cc65965cSJouni Malinen 		}
513cc65965cSJouni Malinen 
514cc65965cSJouni Malinen 		pos += elen;
515cc65965cSJouni Malinen 	}
516cc65965cSJouni Malinen 
517cc65965cSJouni Malinen 	return false;
518cc65965cSJouni Malinen }
519cc65965cSJouni Malinen 
520cc65965cSJouni Malinen static void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb)
521cc65965cSJouni Malinen {
5221510718dSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
523cc65965cSJouni Malinen 
524cc65965cSJouni Malinen 	if (skb->len < 24 + 8 + 2 + 2)
525cc65965cSJouni Malinen 		return;
526cc65965cSJouni Malinen 
5271b04b930SSujith 	sc->ps_flags &= ~PS_WAIT_FOR_BEACON;
528293dc5dfSGabor Juhos 
5291b04b930SSujith 	if (sc->ps_flags & PS_BEACON_SYNC) {
5301b04b930SSujith 		sc->ps_flags &= ~PS_BEACON_SYNC;
531d2182b69SJoe Perches 		ath_dbg(common, PS,
5321a6404a1SSujith Manoharan 			"Reconfigure beacon timers based on synchronized timestamp\n");
533ef4ad633SSujith Manoharan 		ath9k_set_beacon(sc);
534ccdfeab6SJouni Malinen 	}
535ccdfeab6SJouni Malinen 
536cc65965cSJouni Malinen 	if (ath_beacon_dtim_pending_cab(skb)) {
537cc65965cSJouni Malinen 		/*
538cc65965cSJouni Malinen 		 * Remain awake waiting for buffered broadcast/multicast
53958f5fffdSGabor Juhos 		 * frames. If the last broadcast/multicast frame is not
54058f5fffdSGabor Juhos 		 * received properly, the next beacon frame will work as
54158f5fffdSGabor Juhos 		 * a backup trigger for returning into NETWORK SLEEP state,
54258f5fffdSGabor Juhos 		 * so we are waiting for it as well.
543cc65965cSJouni Malinen 		 */
544d2182b69SJoe Perches 		ath_dbg(common, PS,
545226afe68SJoe Perches 			"Received DTIM beacon indicating buffered broadcast/multicast frame(s)\n");
5461b04b930SSujith 		sc->ps_flags |= PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON;
547cc65965cSJouni Malinen 		return;
548cc65965cSJouni Malinen 	}
549cc65965cSJouni Malinen 
5501b04b930SSujith 	if (sc->ps_flags & PS_WAIT_FOR_CAB) {
551cc65965cSJouni Malinen 		/*
552cc65965cSJouni Malinen 		 * This can happen if a broadcast frame is dropped or the AP
553cc65965cSJouni Malinen 		 * fails to send a frame indicating that all CAB frames have
554cc65965cSJouni Malinen 		 * been delivered.
555cc65965cSJouni Malinen 		 */
5561b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_CAB;
557d2182b69SJoe Perches 		ath_dbg(common, PS, "PS wait for CAB frames timed out\n");
558cc65965cSJouni Malinen 	}
559cc65965cSJouni Malinen }
560cc65965cSJouni Malinen 
561f73c604cSRajkumar Manoharan static void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb, bool mybeacon)
562cc65965cSJouni Malinen {
563cc65965cSJouni Malinen 	struct ieee80211_hdr *hdr;
564c46917bbSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
565cc65965cSJouni Malinen 
566cc65965cSJouni Malinen 	hdr = (struct ieee80211_hdr *)skb->data;
567cc65965cSJouni Malinen 
568cc65965cSJouni Malinen 	/* Process Beacon and CAB receive in PS state */
569ededf1f8SVasanthakumar Thiagarajan 	if (((sc->ps_flags & PS_WAIT_FOR_BEACON) || ath9k_check_auto_sleep(sc))
57007c15a3fSSujith Manoharan 	    && mybeacon) {
571cc65965cSJouni Malinen 		ath_rx_ps_beacon(sc, skb);
57207c15a3fSSujith Manoharan 	} else if ((sc->ps_flags & PS_WAIT_FOR_CAB) &&
573cc65965cSJouni Malinen 		   (ieee80211_is_data(hdr->frame_control) ||
574cc65965cSJouni Malinen 		    ieee80211_is_action(hdr->frame_control)) &&
575cc65965cSJouni Malinen 		   is_multicast_ether_addr(hdr->addr1) &&
576cc65965cSJouni Malinen 		   !ieee80211_has_moredata(hdr->frame_control)) {
577cc65965cSJouni Malinen 		/*
578cc65965cSJouni Malinen 		 * No more broadcast/multicast frames to be received at this
579cc65965cSJouni Malinen 		 * point.
580cc65965cSJouni Malinen 		 */
5813fac6dfdSSenthil Balasubramanian 		sc->ps_flags &= ~(PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON);
582d2182b69SJoe Perches 		ath_dbg(common, PS,
583c46917bbSLuis R. Rodriguez 			"All PS CAB frames received, back to sleep\n");
5841b04b930SSujith 	} else if ((sc->ps_flags & PS_WAIT_FOR_PSPOLL_DATA) &&
5859a23f9caSJouni Malinen 		   !is_multicast_ether_addr(hdr->addr1) &&
5869a23f9caSJouni Malinen 		   !ieee80211_has_morefrags(hdr->frame_control)) {
5871b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_PSPOLL_DATA;
588d2182b69SJoe Perches 		ath_dbg(common, PS,
589226afe68SJoe Perches 			"Going back to sleep after having received PS-Poll data (0x%lx)\n",
5901b04b930SSujith 			sc->ps_flags & (PS_WAIT_FOR_BEACON |
5911b04b930SSujith 					PS_WAIT_FOR_CAB |
5921b04b930SSujith 					PS_WAIT_FOR_PSPOLL_DATA |
5931b04b930SSujith 					PS_WAIT_FOR_TX_ACK));
594cc65965cSJouni Malinen 	}
595cc65965cSJouni Malinen }
596cc65965cSJouni Malinen 
597b5c80475SFelix Fietkau static bool ath_edma_get_buffers(struct ath_softc *sc,
5983a2923e8SFelix Fietkau 				 enum ath9k_rx_qtype qtype,
5993a2923e8SFelix Fietkau 				 struct ath_rx_status *rs,
6003a2923e8SFelix Fietkau 				 struct ath_buf **dest)
601203c4805SLuis R. Rodriguez {
602b5c80475SFelix Fietkau 	struct ath_rx_edma *rx_edma = &sc->rx.rx_edma[qtype];
603203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
60427c51f1aSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
605b5c80475SFelix Fietkau 	struct sk_buff *skb;
606b5c80475SFelix Fietkau 	struct ath_buf *bf;
607b5c80475SFelix Fietkau 	int ret;
608203c4805SLuis R. Rodriguez 
609b5c80475SFelix Fietkau 	skb = skb_peek(&rx_edma->rx_fifo);
610b5c80475SFelix Fietkau 	if (!skb)
611b5c80475SFelix Fietkau 		return false;
612203c4805SLuis R. Rodriguez 
613b5c80475SFelix Fietkau 	bf = SKB_CB_ATHBUF(skb);
614b5c80475SFelix Fietkau 	BUG_ON(!bf);
615b5c80475SFelix Fietkau 
616ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
617b5c80475SFelix Fietkau 				common->rx_bufsize, DMA_FROM_DEVICE);
618b5c80475SFelix Fietkau 
6193a2923e8SFelix Fietkau 	ret = ath9k_hw_process_rxdesc_edma(ah, rs, skb->data);
620ce9426d1SMing Lei 	if (ret == -EINPROGRESS) {
621ce9426d1SMing Lei 		/*let device gain the buffer again*/
622ce9426d1SMing Lei 		dma_sync_single_for_device(sc->dev, bf->bf_buf_addr,
623ce9426d1SMing Lei 				common->rx_bufsize, DMA_FROM_DEVICE);
624b5c80475SFelix Fietkau 		return false;
625ce9426d1SMing Lei 	}
626b5c80475SFelix Fietkau 
627b5c80475SFelix Fietkau 	__skb_unlink(skb, &rx_edma->rx_fifo);
628b5c80475SFelix Fietkau 	if (ret == -EINVAL) {
629b5c80475SFelix Fietkau 		/* corrupt descriptor, skip this one and the following one */
630b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
631b5c80475SFelix Fietkau 		ath_rx_edma_buf_link(sc, qtype);
632b5c80475SFelix Fietkau 
6333a2923e8SFelix Fietkau 		skb = skb_peek(&rx_edma->rx_fifo);
6343a2923e8SFelix Fietkau 		if (skb) {
635b5c80475SFelix Fietkau 			bf = SKB_CB_ATHBUF(skb);
636b5c80475SFelix Fietkau 			BUG_ON(!bf);
637b5c80475SFelix Fietkau 
638b5c80475SFelix Fietkau 			__skb_unlink(skb, &rx_edma->rx_fifo);
639b5c80475SFelix Fietkau 			list_add_tail(&bf->list, &sc->rx.rxbuf);
640b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
641b5c80475SFelix Fietkau 		}
6426bb51c70STom Hughes 
6436bb51c70STom Hughes 		bf = NULL;
6443a2923e8SFelix Fietkau 	}
645b5c80475SFelix Fietkau 
6463a2923e8SFelix Fietkau 	*dest = bf;
647b5c80475SFelix Fietkau 	return true;
648b5c80475SFelix Fietkau }
649b5c80475SFelix Fietkau 
650b5c80475SFelix Fietkau static struct ath_buf *ath_edma_get_next_rx_buf(struct ath_softc *sc,
651b5c80475SFelix Fietkau 						struct ath_rx_status *rs,
652b5c80475SFelix Fietkau 						enum ath9k_rx_qtype qtype)
653b5c80475SFelix Fietkau {
6543a2923e8SFelix Fietkau 	struct ath_buf *bf = NULL;
655b5c80475SFelix Fietkau 
6563a2923e8SFelix Fietkau 	while (ath_edma_get_buffers(sc, qtype, rs, &bf)) {
6573a2923e8SFelix Fietkau 		if (!bf)
6583a2923e8SFelix Fietkau 			continue;
659b5c80475SFelix Fietkau 
660b5c80475SFelix Fietkau 		return bf;
661b5c80475SFelix Fietkau 	}
6623a2923e8SFelix Fietkau 	return NULL;
6633a2923e8SFelix Fietkau }
664b5c80475SFelix Fietkau 
665b5c80475SFelix Fietkau static struct ath_buf *ath_get_next_rx_buf(struct ath_softc *sc,
666b5c80475SFelix Fietkau 					   struct ath_rx_status *rs)
667b5c80475SFelix Fietkau {
668b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
669b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
670b5c80475SFelix Fietkau 	struct ath_desc *ds;
671b5c80475SFelix Fietkau 	struct ath_buf *bf;
672b5c80475SFelix Fietkau 	int ret;
673203c4805SLuis R. Rodriguez 
674203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf)) {
675203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
676b5c80475SFelix Fietkau 		return NULL;
677203c4805SLuis R. Rodriguez 	}
678203c4805SLuis R. Rodriguez 
679203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
680203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
681203c4805SLuis R. Rodriguez 
682203c4805SLuis R. Rodriguez 	/*
683203c4805SLuis R. Rodriguez 	 * Must provide the virtual address of the current
684203c4805SLuis R. Rodriguez 	 * descriptor, the physical address, and the virtual
685203c4805SLuis R. Rodriguez 	 * address of the next descriptor in the h/w chain.
686203c4805SLuis R. Rodriguez 	 * This allows the HAL to look ahead to see if the
687203c4805SLuis R. Rodriguez 	 * hardware is done with a descriptor by checking the
688203c4805SLuis R. Rodriguez 	 * done bit in the following descriptor and the address
689203c4805SLuis R. Rodriguez 	 * of the current descriptor the DMA engine is working
690203c4805SLuis R. Rodriguez 	 * on.  All this is necessary because of our use of
691203c4805SLuis R. Rodriguez 	 * a self-linked list to avoid rx overruns.
692203c4805SLuis R. Rodriguez 	 */
6933de21116SRajkumar Manoharan 	ret = ath9k_hw_rxprocdesc(ah, ds, rs);
694b5c80475SFelix Fietkau 	if (ret == -EINPROGRESS) {
69529bffa96SFelix Fietkau 		struct ath_rx_status trs;
696203c4805SLuis R. Rodriguez 		struct ath_buf *tbf;
697203c4805SLuis R. Rodriguez 		struct ath_desc *tds;
698203c4805SLuis R. Rodriguez 
69929bffa96SFelix Fietkau 		memset(&trs, 0, sizeof(trs));
700203c4805SLuis R. Rodriguez 		if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
701203c4805SLuis R. Rodriguez 			sc->rx.rxlink = NULL;
702b5c80475SFelix Fietkau 			return NULL;
703203c4805SLuis R. Rodriguez 		}
704203c4805SLuis R. Rodriguez 
705203c4805SLuis R. Rodriguez 		tbf = list_entry(bf->list.next, struct ath_buf, list);
706203c4805SLuis R. Rodriguez 
707203c4805SLuis R. Rodriguez 		/*
708203c4805SLuis R. Rodriguez 		 * On some hardware the descriptor status words could
709203c4805SLuis R. Rodriguez 		 * get corrupted, including the done bit. Because of
710203c4805SLuis R. Rodriguez 		 * this, check if the next descriptor's done bit is
711203c4805SLuis R. Rodriguez 		 * set or not.
712203c4805SLuis R. Rodriguez 		 *
713203c4805SLuis R. Rodriguez 		 * If the next descriptor's done bit is set, the current
714203c4805SLuis R. Rodriguez 		 * descriptor has been corrupted. Force s/w to discard
715203c4805SLuis R. Rodriguez 		 * this descriptor and continue...
716203c4805SLuis R. Rodriguez 		 */
717203c4805SLuis R. Rodriguez 
718203c4805SLuis R. Rodriguez 		tds = tbf->bf_desc;
7193de21116SRajkumar Manoharan 		ret = ath9k_hw_rxprocdesc(ah, tds, &trs);
720b5c80475SFelix Fietkau 		if (ret == -EINPROGRESS)
721b5c80475SFelix Fietkau 			return NULL;
722723e7113SFelix Fietkau 
723723e7113SFelix Fietkau 		/*
724723e7113SFelix Fietkau 		 * mark descriptor as zero-length and set the 'more'
725723e7113SFelix Fietkau 		 * flag to ensure that both buffers get discarded
726723e7113SFelix Fietkau 		 */
727723e7113SFelix Fietkau 		rs->rs_datalen = 0;
728723e7113SFelix Fietkau 		rs->rs_more = true;
729203c4805SLuis R. Rodriguez 	}
730203c4805SLuis R. Rodriguez 
731a3dc48e8SFelix Fietkau 	list_del(&bf->list);
732b5c80475SFelix Fietkau 	if (!bf->bf_mpdu)
733b5c80475SFelix Fietkau 		return bf;
734203c4805SLuis R. Rodriguez 
735203c4805SLuis R. Rodriguez 	/*
736203c4805SLuis R. Rodriguez 	 * Synchronize the DMA transfer with CPU before
737203c4805SLuis R. Rodriguez 	 * 1. accessing the frame
738203c4805SLuis R. Rodriguez 	 * 2. requeueing the same buffer to h/w
739203c4805SLuis R. Rodriguez 	 */
740ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
741cc861f74SLuis R. Rodriguez 			common->rx_bufsize,
742203c4805SLuis R. Rodriguez 			DMA_FROM_DEVICE);
743203c4805SLuis R. Rodriguez 
744b5c80475SFelix Fietkau 	return bf;
745b5c80475SFelix Fietkau }
746b5c80475SFelix Fietkau 
747d435700fSSujith /* Assumes you've already done the endian to CPU conversion */
748d435700fSSujith static bool ath9k_rx_accept(struct ath_common *common,
7499f167f64SVasanthakumar Thiagarajan 			    struct ieee80211_hdr *hdr,
750d435700fSSujith 			    struct ieee80211_rx_status *rxs,
751d435700fSSujith 			    struct ath_rx_status *rx_stats,
752d435700fSSujith 			    bool *decrypt_error)
753d435700fSSujith {
754ec205999SFelix Fietkau 	struct ath_softc *sc = (struct ath_softc *) common->priv;
75566760eacSFelix Fietkau 	bool is_mc, is_valid_tkip, strip_mic, mic_error;
756d435700fSSujith 	struct ath_hw *ah = common->ah;
757d435700fSSujith 	__le16 fc;
758b7b1b512SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
759d435700fSSujith 
760d435700fSSujith 	fc = hdr->frame_control;
761d435700fSSujith 
76266760eacSFelix Fietkau 	is_mc = !!is_multicast_ether_addr(hdr->addr1);
76366760eacSFelix Fietkau 	is_valid_tkip = rx_stats->rs_keyix != ATH9K_RXKEYIX_INVALID &&
76466760eacSFelix Fietkau 		test_bit(rx_stats->rs_keyix, common->tkip_keymap);
765152e585dSBill Jordan 	strip_mic = is_valid_tkip && ieee80211_is_data(fc) &&
7662a5783b8SMichael Liang 		ieee80211_has_protected(fc) &&
767152e585dSBill Jordan 		!(rx_stats->rs_status &
768846d9363SFelix Fietkau 		(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_CRC | ATH9K_RXERR_MIC |
769846d9363SFelix Fietkau 		 ATH9K_RXERR_KEYMISS));
77066760eacSFelix Fietkau 
771f88373faSFelix Fietkau 	/*
772f88373faSFelix Fietkau 	 * Key miss events are only relevant for pairwise keys where the
773f88373faSFelix Fietkau 	 * descriptor does contain a valid key index. This has been observed
774f88373faSFelix Fietkau 	 * mostly with CCMP encryption.
775f88373faSFelix Fietkau 	 */
776bed3d9c0SFelix Fietkau 	if (rx_stats->rs_keyix == ATH9K_RXKEYIX_INVALID ||
777bed3d9c0SFelix Fietkau 	    !test_bit(rx_stats->rs_keyix, common->ccmp_keymap))
778f88373faSFelix Fietkau 		rx_stats->rs_status &= ~ATH9K_RXERR_KEYMISS;
779f88373faSFelix Fietkau 
78015072189SBen Greear 	if (!rx_stats->rs_datalen) {
78115072189SBen Greear 		RX_STAT_INC(rx_len_err);
782d435700fSSujith 		return false;
78315072189SBen Greear 	}
78415072189SBen Greear 
785d435700fSSujith         /*
786d435700fSSujith          * rs_status follows rs_datalen so if rs_datalen is too large
787d435700fSSujith          * we can take a hint that hardware corrupted it, so ignore
788d435700fSSujith          * those frames.
789d435700fSSujith          */
79015072189SBen Greear 	if (rx_stats->rs_datalen > (common->rx_bufsize - rx_status_len)) {
79115072189SBen Greear 		RX_STAT_INC(rx_len_err);
792d435700fSSujith 		return false;
79315072189SBen Greear 	}
794d435700fSSujith 
7950d95521eSFelix Fietkau 	/* Only use error bits from the last fragment */
796d435700fSSujith 	if (rx_stats->rs_more)
7970d95521eSFelix Fietkau 		return true;
798d435700fSSujith 
79966760eacSFelix Fietkau 	mic_error = is_valid_tkip && !ieee80211_is_ctl(fc) &&
80066760eacSFelix Fietkau 		!ieee80211_has_morefrags(fc) &&
80166760eacSFelix Fietkau 		!(le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG) &&
80266760eacSFelix Fietkau 		(rx_stats->rs_status & ATH9K_RXERR_MIC);
80366760eacSFelix Fietkau 
804d435700fSSujith 	/*
805d435700fSSujith 	 * The rx_stats->rs_status will not be set until the end of the
806d435700fSSujith 	 * chained descriptors so it can be ignored if rs_more is set. The
807d435700fSSujith 	 * rs_more will be false at the last element of the chained
808d435700fSSujith 	 * descriptors.
809d435700fSSujith 	 */
810d435700fSSujith 	if (rx_stats->rs_status != 0) {
811846d9363SFelix Fietkau 		u8 status_mask;
812846d9363SFelix Fietkau 
81366760eacSFelix Fietkau 		if (rx_stats->rs_status & ATH9K_RXERR_CRC) {
814d435700fSSujith 			rxs->flag |= RX_FLAG_FAILED_FCS_CRC;
81566760eacSFelix Fietkau 			mic_error = false;
81666760eacSFelix Fietkau 		}
817d435700fSSujith 		if (rx_stats->rs_status & ATH9K_RXERR_PHY)
818d435700fSSujith 			return false;
819d435700fSSujith 
820846d9363SFelix Fietkau 		if ((rx_stats->rs_status & ATH9K_RXERR_DECRYPT) ||
821846d9363SFelix Fietkau 		    (!is_mc && (rx_stats->rs_status & ATH9K_RXERR_KEYMISS))) {
822d435700fSSujith 			*decrypt_error = true;
82366760eacSFelix Fietkau 			mic_error = false;
824d435700fSSujith 		}
82566760eacSFelix Fietkau 
826d435700fSSujith 		/*
827d435700fSSujith 		 * Reject error frames with the exception of
828d435700fSSujith 		 * decryption and MIC failures. For monitor mode,
829d435700fSSujith 		 * we also ignore the CRC error.
830d435700fSSujith 		 */
831846d9363SFelix Fietkau 		status_mask = ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
832846d9363SFelix Fietkau 			      ATH9K_RXERR_KEYMISS;
833846d9363SFelix Fietkau 
834ec205999SFelix Fietkau 		if (ah->is_monitoring && (sc->rx.rxfilter & FIF_FCSFAIL))
835846d9363SFelix Fietkau 			status_mask |= ATH9K_RXERR_CRC;
836846d9363SFelix Fietkau 
837846d9363SFelix Fietkau 		if (rx_stats->rs_status & ~status_mask)
838d435700fSSujith 			return false;
839d435700fSSujith 	}
84066760eacSFelix Fietkau 
84166760eacSFelix Fietkau 	/*
84266760eacSFelix Fietkau 	 * For unicast frames the MIC error bit can have false positives,
84366760eacSFelix Fietkau 	 * so all MIC error reports need to be validated in software.
84466760eacSFelix Fietkau 	 * False negatives are not common, so skip software verification
84566760eacSFelix Fietkau 	 * if the hardware considers the MIC valid.
84666760eacSFelix Fietkau 	 */
84766760eacSFelix Fietkau 	if (strip_mic)
84866760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_STRIPPED;
84966760eacSFelix Fietkau 	else if (is_mc && mic_error)
85066760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_ERROR;
85166760eacSFelix Fietkau 
852d435700fSSujith 	return true;
853d435700fSSujith }
854d435700fSSujith 
855d435700fSSujith static int ath9k_process_rate(struct ath_common *common,
856d435700fSSujith 			      struct ieee80211_hw *hw,
857d435700fSSujith 			      struct ath_rx_status *rx_stats,
8589f167f64SVasanthakumar Thiagarajan 			      struct ieee80211_rx_status *rxs)
859d435700fSSujith {
860d435700fSSujith 	struct ieee80211_supported_band *sband;
861d435700fSSujith 	enum ieee80211_band band;
862d435700fSSujith 	unsigned int i = 0;
863990e08a0SBen Greear 	struct ath_softc __maybe_unused *sc = common->priv;
864d435700fSSujith 
865675a0b04SKarl Beldan 	band = hw->conf.chandef.chan->band;
866d435700fSSujith 	sband = hw->wiphy->bands[band];
867d435700fSSujith 
868d435700fSSujith 	if (rx_stats->rs_rate & 0x80) {
869d435700fSSujith 		/* HT rate */
870d435700fSSujith 		rxs->flag |= RX_FLAG_HT;
871d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_2040)
872d435700fSSujith 			rxs->flag |= RX_FLAG_40MHZ;
873d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_GI)
874d435700fSSujith 			rxs->flag |= RX_FLAG_SHORT_GI;
875d435700fSSujith 		rxs->rate_idx = rx_stats->rs_rate & 0x7f;
876d435700fSSujith 		return 0;
877d435700fSSujith 	}
878d435700fSSujith 
879d435700fSSujith 	for (i = 0; i < sband->n_bitrates; i++) {
880d435700fSSujith 		if (sband->bitrates[i].hw_value == rx_stats->rs_rate) {
881d435700fSSujith 			rxs->rate_idx = i;
882d435700fSSujith 			return 0;
883d435700fSSujith 		}
884d435700fSSujith 		if (sband->bitrates[i].hw_value_short == rx_stats->rs_rate) {
885d435700fSSujith 			rxs->flag |= RX_FLAG_SHORTPRE;
886d435700fSSujith 			rxs->rate_idx = i;
887d435700fSSujith 			return 0;
888d435700fSSujith 		}
889d435700fSSujith 	}
890d435700fSSujith 
891d435700fSSujith 	/*
892d435700fSSujith 	 * No valid hardware bitrate found -- we should not get here
893d435700fSSujith 	 * because hardware has already validated this frame as OK.
894d435700fSSujith 	 */
895d2182b69SJoe Perches 	ath_dbg(common, ANY,
896226afe68SJoe Perches 		"unsupported hw bitrate detected 0x%02x using 1 Mbit\n",
897226afe68SJoe Perches 		rx_stats->rs_rate);
89815072189SBen Greear 	RX_STAT_INC(rx_rate_err);
899d435700fSSujith 	return -EINVAL;
900d435700fSSujith }
901d435700fSSujith 
902d435700fSSujith static void ath9k_process_rssi(struct ath_common *common,
903d435700fSSujith 			       struct ieee80211_hw *hw,
9049f167f64SVasanthakumar Thiagarajan 			       struct ieee80211_hdr *hdr,
905d435700fSSujith 			       struct ath_rx_status *rx_stats)
906d435700fSSujith {
9079ac58615SFelix Fietkau 	struct ath_softc *sc = hw->priv;
908d435700fSSujith 	struct ath_hw *ah = common->ah;
9099fa23e17SFelix Fietkau 	int last_rssi;
9102ef16755SFelix Fietkau 	int rssi = rx_stats->rs_rssi;
911d435700fSSujith 
912cf3af748SRajkumar Manoharan 	if (!rx_stats->is_mybeacon ||
913cf3af748SRajkumar Manoharan 	    ((ah->opmode != NL80211_IFTYPE_STATION) &&
914cf3af748SRajkumar Manoharan 	     (ah->opmode != NL80211_IFTYPE_ADHOC)))
9159fa23e17SFelix Fietkau 		return;
9169fa23e17SFelix Fietkau 
9179fa23e17SFelix Fietkau 	if (rx_stats->rs_rssi != ATH9K_RSSI_BAD && !rx_stats->rs_moreaggr)
9189ac58615SFelix Fietkau 		ATH_RSSI_LPF(sc->last_rssi, rx_stats->rs_rssi);
919686b9cb9SBen Greear 
9209ac58615SFelix Fietkau 	last_rssi = sc->last_rssi;
921d435700fSSujith 	if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER))
9222ef16755SFelix Fietkau 		rssi = ATH_EP_RND(last_rssi, ATH_RSSI_EP_MULTIPLIER);
9232ef16755SFelix Fietkau 	if (rssi < 0)
9242ef16755SFelix Fietkau 		rssi = 0;
925d435700fSSujith 
926d435700fSSujith 	/* Update Beacon RSSI, this is used by ANI. */
9272ef16755SFelix Fietkau 	ah->stats.avgbrssi = rssi;
928d435700fSSujith }
929d435700fSSujith 
930d435700fSSujith /*
931d435700fSSujith  * For Decrypt or Demic errors, we only mark packet status here and always push
932d435700fSSujith  * up the frame up to let mac80211 handle the actual error case, be it no
933d435700fSSujith  * decryption key or real decryption error. This let us keep statistics there.
934d435700fSSujith  */
935723e7113SFelix Fietkau static int ath9k_rx_skb_preprocess(struct ath_softc *sc,
9369f167f64SVasanthakumar Thiagarajan 				   struct ieee80211_hdr *hdr,
937d435700fSSujith 				   struct ath_rx_status *rx_stats,
938d435700fSSujith 				   struct ieee80211_rx_status *rx_status,
939d435700fSSujith 				   bool *decrypt_error)
940d435700fSSujith {
941723e7113SFelix Fietkau 	struct ieee80211_hw *hw = sc->hw;
942723e7113SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
943723e7113SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
944723e7113SFelix Fietkau 	bool discard_current = sc->rx.discard_next;
945723e7113SFelix Fietkau 
946723e7113SFelix Fietkau 	sc->rx.discard_next = rx_stats->rs_more;
947723e7113SFelix Fietkau 	if (discard_current)
948723e7113SFelix Fietkau 		return -EINVAL;
949f749b946SFelix Fietkau 
950d435700fSSujith 	/*
951d435700fSSujith 	 * everything but the rate is checked here, the rate check is done
952d435700fSSujith 	 * separately to avoid doing two lookups for a rate for each frame.
953d435700fSSujith 	 */
9549f167f64SVasanthakumar Thiagarajan 	if (!ath9k_rx_accept(common, hdr, rx_status, rx_stats, decrypt_error))
955d435700fSSujith 		return -EINVAL;
956d435700fSSujith 
9570d95521eSFelix Fietkau 	/* Only use status info from the last fragment */
9580d95521eSFelix Fietkau 	if (rx_stats->rs_more)
9590d95521eSFelix Fietkau 		return 0;
9600d95521eSFelix Fietkau 
9619f167f64SVasanthakumar Thiagarajan 	ath9k_process_rssi(common, hw, hdr, rx_stats);
962d435700fSSujith 
9639f167f64SVasanthakumar Thiagarajan 	if (ath9k_process_rate(common, hw, rx_stats, rx_status))
964d435700fSSujith 		return -EINVAL;
965d435700fSSujith 
966675a0b04SKarl Beldan 	rx_status->band = hw->conf.chandef.chan->band;
967675a0b04SKarl Beldan 	rx_status->freq = hw->conf.chandef.chan->center_freq;
968f749b946SFelix Fietkau 	rx_status->signal = ah->noise + rx_stats->rs_rssi;
969d435700fSSujith 	rx_status->antenna = rx_stats->rs_antenna;
97096d21371SThomas Pedersen 	rx_status->flag |= RX_FLAG_MACTIME_END;
9712ef16755SFelix Fietkau 	if (rx_stats->rs_moreaggr)
9722ef16755SFelix Fietkau 		rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
973d435700fSSujith 
974723e7113SFelix Fietkau 	sc->rx.discard_next = false;
975d435700fSSujith 	return 0;
976d435700fSSujith }
977d435700fSSujith 
978d435700fSSujith static void ath9k_rx_skb_postprocess(struct ath_common *common,
979d435700fSSujith 				     struct sk_buff *skb,
980d435700fSSujith 				     struct ath_rx_status *rx_stats,
981d435700fSSujith 				     struct ieee80211_rx_status *rxs,
982d435700fSSujith 				     bool decrypt_error)
983d435700fSSujith {
984d435700fSSujith 	struct ath_hw *ah = common->ah;
985d435700fSSujith 	struct ieee80211_hdr *hdr;
986d435700fSSujith 	int hdrlen, padpos, padsize;
987d435700fSSujith 	u8 keyix;
988d435700fSSujith 	__le16 fc;
989d435700fSSujith 
990d435700fSSujith 	/* see if any padding is done by the hw and remove it */
991d435700fSSujith 	hdr = (struct ieee80211_hdr *) skb->data;
992d435700fSSujith 	hdrlen = ieee80211_get_hdrlen_from_skb(skb);
993d435700fSSujith 	fc = hdr->frame_control;
994c60c9929SFelix Fietkau 	padpos = ieee80211_hdrlen(fc);
995d435700fSSujith 
996d435700fSSujith 	/* The MAC header is padded to have 32-bit boundary if the
997d435700fSSujith 	 * packet payload is non-zero. The general calculation for
998d435700fSSujith 	 * padsize would take into account odd header lengths:
999d435700fSSujith 	 * padsize = (4 - padpos % 4) % 4; However, since only
1000d435700fSSujith 	 * even-length headers are used, padding can only be 0 or 2
1001d435700fSSujith 	 * bytes and we can optimize this a bit. In addition, we must
1002d435700fSSujith 	 * not try to remove padding from short control frames that do
1003d435700fSSujith 	 * not have payload. */
1004d435700fSSujith 	padsize = padpos & 3;
1005d435700fSSujith 	if (padsize && skb->len>=padpos+padsize+FCS_LEN) {
1006d435700fSSujith 		memmove(skb->data + padsize, skb->data, padpos);
1007d435700fSSujith 		skb_pull(skb, padsize);
1008d435700fSSujith 	}
1009d435700fSSujith 
1010d435700fSSujith 	keyix = rx_stats->rs_keyix;
1011d435700fSSujith 
1012d435700fSSujith 	if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error &&
1013d435700fSSujith 	    ieee80211_has_protected(fc)) {
1014d435700fSSujith 		rxs->flag |= RX_FLAG_DECRYPTED;
1015d435700fSSujith 	} else if (ieee80211_has_protected(fc)
1016d435700fSSujith 		   && !decrypt_error && skb->len >= hdrlen + 4) {
1017d435700fSSujith 		keyix = skb->data[hdrlen + 3] >> 6;
1018d435700fSSujith 
1019d435700fSSujith 		if (test_bit(keyix, common->keymap))
1020d435700fSSujith 			rxs->flag |= RX_FLAG_DECRYPTED;
1021d435700fSSujith 	}
1022d435700fSSujith 	if (ah->sw_mgmt_crypto &&
1023d435700fSSujith 	    (rxs->flag & RX_FLAG_DECRYPTED) &&
1024d435700fSSujith 	    ieee80211_is_mgmt(fc))
1025d435700fSSujith 		/* Use software decrypt for management frames. */
1026d435700fSSujith 		rxs->flag &= ~RX_FLAG_DECRYPTED;
1027d435700fSSujith }
1028b5c80475SFelix Fietkau 
1029ab2e2fc8SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1030e93d083fSSimon Wunderlich static s8 fix_rssi_inv_only(u8 rssi_val)
1031e93d083fSSimon Wunderlich {
1032e93d083fSSimon Wunderlich 	if (rssi_val == 128)
1033e93d083fSSimon Wunderlich 		rssi_val = 0;
1034e93d083fSSimon Wunderlich 	return (s8) rssi_val;
1035e93d083fSSimon Wunderlich }
1036ab2e2fc8SSven Eckelmann #endif
1037e93d083fSSimon Wunderlich 
10389b99e665SSimon Wunderlich /* returns 1 if this was a spectral frame, even if not handled. */
10399b99e665SSimon Wunderlich static int ath_process_fft(struct ath_softc *sc, struct ieee80211_hdr *hdr,
1040e93d083fSSimon Wunderlich 			   struct ath_rx_status *rs, u64 tsf)
1041e93d083fSSimon Wunderlich {
1042bd2ffe14SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1043e93d083fSSimon Wunderlich 	struct ath_hw *ah = sc->sc_ah;
1044e93d083fSSimon Wunderlich 	u8 bins[SPECTRAL_HT20_NUM_BINS];
1045e93d083fSSimon Wunderlich 	u8 *vdata = (u8 *)hdr;
1046e93d083fSSimon Wunderlich 	struct fft_sample_ht20 fft_sample;
1047e93d083fSSimon Wunderlich 	struct ath_radar_info *radar_info;
1048e93d083fSSimon Wunderlich 	struct ath_ht20_mag_info *mag_info;
1049e93d083fSSimon Wunderlich 	int len = rs->rs_datalen;
10504ab0b0aaSSven Eckelmann 	int dc_pos;
105112824374SSven Eckelmann 	u16 length, max_magnitude;
1052e93d083fSSimon Wunderlich 
1053e93d083fSSimon Wunderlich 	/* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
1054e93d083fSSimon Wunderlich 	 * via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
1055e93d083fSSimon Wunderlich 	 * yet, but this is supposed to be possible as well.
1056e93d083fSSimon Wunderlich 	 */
1057e93d083fSSimon Wunderlich 	if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
1058e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
1059e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
10609b99e665SSimon Wunderlich 		return 0;
10619b99e665SSimon Wunderlich 
10629b99e665SSimon Wunderlich 	/* check if spectral scan bit is set. This does not have to be checked
10639b99e665SSimon Wunderlich 	 * if received through a SPECTRAL phy error, but shouldn't hurt.
10649b99e665SSimon Wunderlich 	 */
10659b99e665SSimon Wunderlich 	radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
10669b99e665SSimon Wunderlich 	if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
10679b99e665SSimon Wunderlich 		return 0;
1068e93d083fSSimon Wunderlich 
1069e93d083fSSimon Wunderlich 	/* Variation in the data length is possible and will be fixed later.
1070e93d083fSSimon Wunderlich 	 * Note that we only support HT20 for now.
1071e93d083fSSimon Wunderlich 	 *
1072e93d083fSSimon Wunderlich 	 * TODO: add HT20_40 support as well.
1073e93d083fSSimon Wunderlich 	 */
1074e93d083fSSimon Wunderlich 	if ((len > SPECTRAL_HT20_TOTAL_DATA_LEN + 2) ||
1075e93d083fSSimon Wunderlich 	    (len < SPECTRAL_HT20_TOTAL_DATA_LEN - 1))
10769b99e665SSimon Wunderlich 		return 1;
1077e93d083fSSimon Wunderlich 
1078e93d083fSSimon Wunderlich 	fft_sample.tlv.type = ATH_FFT_SAMPLE_HT20;
107912824374SSven Eckelmann 	length = sizeof(fft_sample) - sizeof(fft_sample.tlv);
108012824374SSven Eckelmann 	fft_sample.tlv.length = __cpu_to_be16(length);
1081e93d083fSSimon Wunderlich 
10824ab0b0aaSSven Eckelmann 	fft_sample.freq = __cpu_to_be16(ah->curchan->chan->center_freq);
1083e93d083fSSimon Wunderlich 	fft_sample.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl0);
1084e93d083fSSimon Wunderlich 	fft_sample.noise = ah->noise;
1085e93d083fSSimon Wunderlich 
1086e93d083fSSimon Wunderlich 	switch (len - SPECTRAL_HT20_TOTAL_DATA_LEN) {
1087e93d083fSSimon Wunderlich 	case 0:
1088e93d083fSSimon Wunderlich 		/* length correct, nothing to do. */
1089e93d083fSSimon Wunderlich 		memcpy(bins, vdata, SPECTRAL_HT20_NUM_BINS);
1090e93d083fSSimon Wunderlich 		break;
1091e93d083fSSimon Wunderlich 	case -1:
1092e93d083fSSimon Wunderlich 		/* first byte missing, duplicate it. */
1093e93d083fSSimon Wunderlich 		memcpy(&bins[1], vdata, SPECTRAL_HT20_NUM_BINS - 1);
1094e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1095e93d083fSSimon Wunderlich 		break;
1096e93d083fSSimon Wunderlich 	case 2:
1097e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes at bin 30 and 32, remove them. */
1098e93d083fSSimon Wunderlich 		memcpy(bins, vdata, 30);
1099e93d083fSSimon Wunderlich 		bins[30] = vdata[31];
1100e93d083fSSimon Wunderlich 		memcpy(&bins[31], &vdata[33], SPECTRAL_HT20_NUM_BINS - 31);
1101e93d083fSSimon Wunderlich 		break;
1102e93d083fSSimon Wunderlich 	case 1:
1103e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes AND first byte is missing. */
1104e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1105e93d083fSSimon Wunderlich 		memcpy(&bins[0], vdata, 30);
1106e93d083fSSimon Wunderlich 		bins[31] = vdata[31];
1107e93d083fSSimon Wunderlich 		memcpy(&bins[32], &vdata[33], SPECTRAL_HT20_NUM_BINS - 32);
1108e93d083fSSimon Wunderlich 		break;
1109e93d083fSSimon Wunderlich 	default:
11109b99e665SSimon Wunderlich 		return 1;
1111e93d083fSSimon Wunderlich 	}
1112e93d083fSSimon Wunderlich 
1113e93d083fSSimon Wunderlich 	/* DC value (value in the middle) is the blind spot of the spectral
1114e93d083fSSimon Wunderlich 	 * sample and invalid, interpolate it.
1115e93d083fSSimon Wunderlich 	 */
1116e93d083fSSimon Wunderlich 	dc_pos = SPECTRAL_HT20_NUM_BINS / 2;
1117e93d083fSSimon Wunderlich 	bins[dc_pos] = (bins[dc_pos + 1] + bins[dc_pos - 1]) / 2;
1118e93d083fSSimon Wunderlich 
1119e93d083fSSimon Wunderlich 	/* mag data is at the end of the frame, in front of radar_info */
1120e93d083fSSimon Wunderlich 	mag_info = ((struct ath_ht20_mag_info *)radar_info) - 1;
1121e93d083fSSimon Wunderlich 
11224ab0b0aaSSven Eckelmann 	/* copy raw bins without scaling them */
11234ab0b0aaSSven Eckelmann 	memcpy(fft_sample.data, bins, SPECTRAL_HT20_NUM_BINS);
11244ab0b0aaSSven Eckelmann 	fft_sample.max_exp = mag_info->max_exp & 0xf;
1125e93d083fSSimon Wunderlich 
112612824374SSven Eckelmann 	max_magnitude = spectral_max_magnitude(mag_info->all_bins);
112712824374SSven Eckelmann 	fft_sample.max_magnitude = __cpu_to_be16(max_magnitude);
1128e93d083fSSimon Wunderlich 	fft_sample.max_index = spectral_max_index(mag_info->all_bins);
1129e93d083fSSimon Wunderlich 	fft_sample.bitmap_weight = spectral_bitmap_weight(mag_info->all_bins);
11304ab0b0aaSSven Eckelmann 	fft_sample.tsf = __cpu_to_be64(tsf);
1131e93d083fSSimon Wunderlich 
1132e93d083fSSimon Wunderlich 	ath_debug_send_fft_sample(sc, &fft_sample.tlv);
11339b99e665SSimon Wunderlich 	return 1;
11349b99e665SSimon Wunderlich #else
11359b99e665SSimon Wunderlich 	return 0;
1136e93d083fSSimon Wunderlich #endif
1137e93d083fSSimon Wunderlich }
1138e93d083fSSimon Wunderlich 
113921fbbca3SChristian Lamparter static void ath9k_apply_ampdu_details(struct ath_softc *sc,
114021fbbca3SChristian Lamparter 	struct ath_rx_status *rs, struct ieee80211_rx_status *rxs)
114121fbbca3SChristian Lamparter {
114221fbbca3SChristian Lamparter 	if (rs->rs_isaggr) {
114321fbbca3SChristian Lamparter 		rxs->flag |= RX_FLAG_AMPDU_DETAILS | RX_FLAG_AMPDU_LAST_KNOWN;
114421fbbca3SChristian Lamparter 
114521fbbca3SChristian Lamparter 		rxs->ampdu_reference = sc->rx.ampdu_ref;
114621fbbca3SChristian Lamparter 
114721fbbca3SChristian Lamparter 		if (!rs->rs_moreaggr) {
114821fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_IS_LAST;
114921fbbca3SChristian Lamparter 			sc->rx.ampdu_ref++;
115021fbbca3SChristian Lamparter 		}
115121fbbca3SChristian Lamparter 
115221fbbca3SChristian Lamparter 		if (rs->rs_flags & ATH9K_RX_DELIM_CRC_PRE)
115321fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_DELIM_CRC_ERROR;
115421fbbca3SChristian Lamparter 	}
115521fbbca3SChristian Lamparter }
115621fbbca3SChristian Lamparter 
1157b5c80475SFelix Fietkau int ath_rx_tasklet(struct ath_softc *sc, int flush, bool hp)
1158b5c80475SFelix Fietkau {
1159b5c80475SFelix Fietkau 	struct ath_buf *bf;
11600d95521eSFelix Fietkau 	struct sk_buff *skb = NULL, *requeue_skb, *hdr_skb;
1161b5c80475SFelix Fietkau 	struct ieee80211_rx_status *rxs;
1162b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
1163b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
11647545daf4SFelix Fietkau 	struct ieee80211_hw *hw = sc->hw;
1165b5c80475SFelix Fietkau 	struct ieee80211_hdr *hdr;
1166b5c80475SFelix Fietkau 	int retval;
1167b5c80475SFelix Fietkau 	struct ath_rx_status rs;
1168b5c80475SFelix Fietkau 	enum ath9k_rx_qtype qtype;
1169b5c80475SFelix Fietkau 	bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
1170b5c80475SFelix Fietkau 	int dma_type;
11715c6dd921SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
1172a6d2055bSFelix Fietkau 	u64 tsf = 0;
1173a6d2055bSFelix Fietkau 	u32 tsf_lower = 0;
11748ab2cd09SLuis R. Rodriguez 	unsigned long flags;
11752e1cd495SFelix Fietkau 	dma_addr_t new_buf_addr;
1176b5c80475SFelix Fietkau 
1177b5c80475SFelix Fietkau 	if (edma)
1178b5c80475SFelix Fietkau 		dma_type = DMA_BIDIRECTIONAL;
117956824223SMing Lei 	else
118056824223SMing Lei 		dma_type = DMA_FROM_DEVICE;
1181b5c80475SFelix Fietkau 
1182b5c80475SFelix Fietkau 	qtype = hp ? ATH9K_RX_QUEUE_HP : ATH9K_RX_QUEUE_LP;
1183b5c80475SFelix Fietkau 
1184a6d2055bSFelix Fietkau 	tsf = ath9k_hw_gettsf64(ah);
1185a6d2055bSFelix Fietkau 	tsf_lower = tsf & 0xffffffff;
1186a6d2055bSFelix Fietkau 
1187b5c80475SFelix Fietkau 	do {
1188e1352fdeSLorenzo Bianconi 		bool decrypt_error = false;
1189b5c80475SFelix Fietkau 
1190b5c80475SFelix Fietkau 		memset(&rs, 0, sizeof(rs));
1191b5c80475SFelix Fietkau 		if (edma)
1192b5c80475SFelix Fietkau 			bf = ath_edma_get_next_rx_buf(sc, &rs, qtype);
1193b5c80475SFelix Fietkau 		else
1194b5c80475SFelix Fietkau 			bf = ath_get_next_rx_buf(sc, &rs);
1195b5c80475SFelix Fietkau 
1196b5c80475SFelix Fietkau 		if (!bf)
1197b5c80475SFelix Fietkau 			break;
1198b5c80475SFelix Fietkau 
1199b5c80475SFelix Fietkau 		skb = bf->bf_mpdu;
1200b5c80475SFelix Fietkau 		if (!skb)
1201b5c80475SFelix Fietkau 			continue;
1202b5c80475SFelix Fietkau 
12030d95521eSFelix Fietkau 		/*
12040d95521eSFelix Fietkau 		 * Take frame header from the first fragment and RX status from
12050d95521eSFelix Fietkau 		 * the last one.
12060d95521eSFelix Fietkau 		 */
12070d95521eSFelix Fietkau 		if (sc->rx.frag)
12080d95521eSFelix Fietkau 			hdr_skb = sc->rx.frag;
12090d95521eSFelix Fietkau 		else
12100d95521eSFelix Fietkau 			hdr_skb = skb;
12110d95521eSFelix Fietkau 
12120d95521eSFelix Fietkau 		hdr = (struct ieee80211_hdr *) (hdr_skb->data + rx_status_len);
12130d95521eSFelix Fietkau 		rxs = IEEE80211_SKB_RXCB(hdr_skb);
121415072189SBen Greear 		if (ieee80211_is_beacon(hdr->frame_control)) {
121515072189SBen Greear 			RX_STAT_INC(rx_beacons);
121615072189SBen Greear 			if (!is_zero_ether_addr(common->curbssid) &&
12172e42e474SJoe Perches 			    ether_addr_equal(hdr->addr3, common->curbssid))
1218cf3af748SRajkumar Manoharan 				rs.is_mybeacon = true;
1219cf3af748SRajkumar Manoharan 			else
1220cf3af748SRajkumar Manoharan 				rs.is_mybeacon = false;
122115072189SBen Greear 		}
122215072189SBen Greear 		else
122315072189SBen Greear 			rs.is_mybeacon = false;
12245ca42627SLuis R. Rodriguez 
1225be41b052SMohammed Shafi Shajakhan 		if (ieee80211_is_data_present(hdr->frame_control) &&
1226be41b052SMohammed Shafi Shajakhan 		    !ieee80211_is_qos_nullfunc(hdr->frame_control))
12276995fb80SRajkumar Manoharan 			sc->rx.num_pkts++;
1228be41b052SMohammed Shafi Shajakhan 
122929bffa96SFelix Fietkau 		ath_debug_stat_rx(sc, &rs);
12301395d3f0SSujith 
1231ffb1c56aSAshok Nagarajan 		memset(rxs, 0, sizeof(struct ieee80211_rx_status));
1232ffb1c56aSAshok Nagarajan 
1233a6d2055bSFelix Fietkau 		rxs->mactime = (tsf & ~0xffffffffULL) | rs.rs_tstamp;
1234a6d2055bSFelix Fietkau 		if (rs.rs_tstamp > tsf_lower &&
1235a6d2055bSFelix Fietkau 		    unlikely(rs.rs_tstamp - tsf_lower > 0x10000000))
1236a6d2055bSFelix Fietkau 			rxs->mactime -= 0x100000000ULL;
1237a6d2055bSFelix Fietkau 
1238a6d2055bSFelix Fietkau 		if (rs.rs_tstamp < tsf_lower &&
1239a6d2055bSFelix Fietkau 		    unlikely(tsf_lower - rs.rs_tstamp > 0x10000000))
1240a6d2055bSFelix Fietkau 			rxs->mactime += 0x100000000ULL;
1241a6d2055bSFelix Fietkau 
124273e4937dSZefir Kurtisi 		if (rs.rs_phyerr == ATH9K_PHYERR_RADAR)
124373e4937dSZefir Kurtisi 			ath9k_dfs_process_phyerr(sc, hdr, &rs, rxs->mactime);
124473e4937dSZefir Kurtisi 
12459b99e665SSimon Wunderlich 		if (rs.rs_status & ATH9K_RXERR_PHY) {
12469b99e665SSimon Wunderlich 			if (ath_process_fft(sc, hdr, &rs, rxs->mactime)) {
12479b99e665SSimon Wunderlich 				RX_STAT_INC(rx_spectral);
12489b99e665SSimon Wunderlich 				goto requeue_drop_frag;
12499b99e665SSimon Wunderlich 			}
12509b99e665SSimon Wunderlich 		}
1251e93d083fSSimon Wunderlich 
1252723e7113SFelix Fietkau 		retval = ath9k_rx_skb_preprocess(sc, hdr, &rs, rxs,
1253723e7113SFelix Fietkau 						 &decrypt_error);
125483c76570SZefir Kurtisi 		if (retval)
125583c76570SZefir Kurtisi 			goto requeue_drop_frag;
125683c76570SZefir Kurtisi 
125701e18918SRajkumar Manoharan 		if (rs.is_mybeacon) {
125801e18918SRajkumar Manoharan 			sc->hw_busy_count = 0;
125901e18918SRajkumar Manoharan 			ath_start_rx_poll(sc, 3);
126001e18918SRajkumar Manoharan 		}
1261203c4805SLuis R. Rodriguez 		/* Ensure we always have an skb to requeue once we are done
1262203c4805SLuis R. Rodriguez 		 * processing the current buffer's skb */
1263cc861f74SLuis R. Rodriguez 		requeue_skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_ATOMIC);
1264203c4805SLuis R. Rodriguez 
1265203c4805SLuis R. Rodriguez 		/* If there is no memory we ignore the current RX'd frame,
1266203c4805SLuis R. Rodriguez 		 * tell hardware it can give us a new frame using the old
1267203c4805SLuis R. Rodriguez 		 * skb and put it at the tail of the sc->rx.rxbuf list for
1268203c4805SLuis R. Rodriguez 		 * processing. */
126915072189SBen Greear 		if (!requeue_skb) {
127015072189SBen Greear 			RX_STAT_INC(rx_oom_err);
12710d95521eSFelix Fietkau 			goto requeue_drop_frag;
127215072189SBen Greear 		}
1273203c4805SLuis R. Rodriguez 
12742e1cd495SFelix Fietkau 		/* We will now give hardware our shiny new allocated skb */
12752e1cd495SFelix Fietkau 		new_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
12762e1cd495SFelix Fietkau 					      common->rx_bufsize, dma_type);
12772e1cd495SFelix Fietkau 		if (unlikely(dma_mapping_error(sc->dev, new_buf_addr))) {
12782e1cd495SFelix Fietkau 			dev_kfree_skb_any(requeue_skb);
12792e1cd495SFelix Fietkau 			goto requeue_drop_frag;
12802e1cd495SFelix Fietkau 		}
12812e1cd495SFelix Fietkau 
12822e1cd495SFelix Fietkau 		bf->bf_mpdu = requeue_skb;
12832e1cd495SFelix Fietkau 		bf->bf_buf_addr = new_buf_addr;
12842e1cd495SFelix Fietkau 
1285203c4805SLuis R. Rodriguez 		/* Unmap the frame */
1286203c4805SLuis R. Rodriguez 		dma_unmap_single(sc->dev, bf->bf_buf_addr,
12872e1cd495SFelix Fietkau 				 common->rx_bufsize, dma_type);
1288203c4805SLuis R. Rodriguez 
1289b5c80475SFelix Fietkau 		skb_put(skb, rs.rs_datalen + ah->caps.rx_status_len);
1290b5c80475SFelix Fietkau 		if (ah->caps.rx_status_len)
1291b5c80475SFelix Fietkau 			skb_pull(skb, ah->caps.rx_status_len);
1292203c4805SLuis R. Rodriguez 
12930d95521eSFelix Fietkau 		if (!rs.rs_more)
12940d95521eSFelix Fietkau 			ath9k_rx_skb_postprocess(common, hdr_skb, &rs,
1295c9b14170SLuis R. Rodriguez 						 rxs, decrypt_error);
1296203c4805SLuis R. Rodriguez 
12970d95521eSFelix Fietkau 		if (rs.rs_more) {
129815072189SBen Greear 			RX_STAT_INC(rx_frags);
12990d95521eSFelix Fietkau 			/*
13000d95521eSFelix Fietkau 			 * rs_more indicates chained descriptors which can be
13010d95521eSFelix Fietkau 			 * used to link buffers together for a sort of
13020d95521eSFelix Fietkau 			 * scatter-gather operation.
13030d95521eSFelix Fietkau 			 */
13040d95521eSFelix Fietkau 			if (sc->rx.frag) {
13050d95521eSFelix Fietkau 				/* too many fragments - cannot handle frame */
13060d95521eSFelix Fietkau 				dev_kfree_skb_any(sc->rx.frag);
13070d95521eSFelix Fietkau 				dev_kfree_skb_any(skb);
130815072189SBen Greear 				RX_STAT_INC(rx_too_many_frags_err);
13090d95521eSFelix Fietkau 				skb = NULL;
13100d95521eSFelix Fietkau 			}
13110d95521eSFelix Fietkau 			sc->rx.frag = skb;
13120d95521eSFelix Fietkau 			goto requeue;
13130d95521eSFelix Fietkau 		}
13143747c3eeSFelix Fietkau 		if (rs.rs_status & ATH9K_RXERR_CORRUPT_DESC)
13153747c3eeSFelix Fietkau 			goto requeue_drop_frag;
13160d95521eSFelix Fietkau 
13170d95521eSFelix Fietkau 		if (sc->rx.frag) {
13180d95521eSFelix Fietkau 			int space = skb->len - skb_tailroom(hdr_skb);
13190d95521eSFelix Fietkau 
13200d95521eSFelix Fietkau 			if (pskb_expand_head(hdr_skb, 0, space, GFP_ATOMIC) < 0) {
13210d95521eSFelix Fietkau 				dev_kfree_skb(skb);
132215072189SBen Greear 				RX_STAT_INC(rx_oom_err);
13230d95521eSFelix Fietkau 				goto requeue_drop_frag;
13240d95521eSFelix Fietkau 			}
13250d95521eSFelix Fietkau 
1326b5447ff9SEric Dumazet 			sc->rx.frag = NULL;
1327b5447ff9SEric Dumazet 
13280d95521eSFelix Fietkau 			skb_copy_from_linear_data(skb, skb_put(hdr_skb, skb->len),
13290d95521eSFelix Fietkau 						  skb->len);
13300d95521eSFelix Fietkau 			dev_kfree_skb_any(skb);
13310d95521eSFelix Fietkau 			skb = hdr_skb;
13320d95521eSFelix Fietkau 		}
13330d95521eSFelix Fietkau 
1334eb840a80SMohammed Shafi Shajakhan 
1335eb840a80SMohammed Shafi Shajakhan 		if (ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) {
1336eb840a80SMohammed Shafi Shajakhan 
1337203c4805SLuis R. Rodriguez 			/*
1338eb840a80SMohammed Shafi Shajakhan 			 * change the default rx antenna if rx diversity
1339eb840a80SMohammed Shafi Shajakhan 			 * chooses the other antenna 3 times in a row.
1340203c4805SLuis R. Rodriguez 			 */
134129bffa96SFelix Fietkau 			if (sc->rx.defant != rs.rs_antenna) {
1342203c4805SLuis R. Rodriguez 				if (++sc->rx.rxotherant >= 3)
134329bffa96SFelix Fietkau 					ath_setdefantenna(sc, rs.rs_antenna);
1344203c4805SLuis R. Rodriguez 			} else {
1345203c4805SLuis R. Rodriguez 				sc->rx.rxotherant = 0;
1346203c4805SLuis R. Rodriguez 			}
1347203c4805SLuis R. Rodriguez 
1348eb840a80SMohammed Shafi Shajakhan 		}
1349eb840a80SMohammed Shafi Shajakhan 
135066760eacSFelix Fietkau 		if (rxs->flag & RX_FLAG_MMIC_STRIPPED)
135166760eacSFelix Fietkau 			skb_trim(skb, skb->len - 8);
135266760eacSFelix Fietkau 
13538ab2cd09SLuis R. Rodriguez 		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1354aaef24b4SMohammed Shafi Shajakhan 		if ((sc->ps_flags & (PS_WAIT_FOR_BEACON |
13551b04b930SSujith 				     PS_WAIT_FOR_CAB |
1356aaef24b4SMohammed Shafi Shajakhan 				     PS_WAIT_FOR_PSPOLL_DATA)) ||
1357cedc7e3dSMohammed Shafi Shajakhan 		    ath9k_check_auto_sleep(sc))
1358f73c604cSRajkumar Manoharan 			ath_rx_ps(sc, skb, rs.is_mybeacon);
13598ab2cd09SLuis R. Rodriguez 		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1360cc65965cSJouni Malinen 
136143c35284SFelix Fietkau 		if ((ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) && sc->ant_rx == 3)
1362102885a5SVasanthakumar Thiagarajan 			ath_ant_comb_scan(sc, &rs);
1363102885a5SVasanthakumar Thiagarajan 
136421fbbca3SChristian Lamparter 		ath9k_apply_ampdu_details(sc, &rs, rxs);
136521fbbca3SChristian Lamparter 
13667545daf4SFelix Fietkau 		ieee80211_rx(hw, skb);
1367cc65965cSJouni Malinen 
13680d95521eSFelix Fietkau requeue_drop_frag:
13690d95521eSFelix Fietkau 		if (sc->rx.frag) {
13700d95521eSFelix Fietkau 			dev_kfree_skb_any(sc->rx.frag);
13710d95521eSFelix Fietkau 			sc->rx.frag = NULL;
13720d95521eSFelix Fietkau 		}
1373203c4805SLuis R. Rodriguez requeue:
1374b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
1375a3dc48e8SFelix Fietkau 		if (flush)
1376a3dc48e8SFelix Fietkau 			continue;
1377a3dc48e8SFelix Fietkau 
1378a3dc48e8SFelix Fietkau 		if (edma) {
1379b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
1380b5c80475SFelix Fietkau 		} else {
1381203c4805SLuis R. Rodriguez 			ath_rx_buf_link(sc, bf);
138295294973SFelix Fietkau 			ath9k_hw_rxena(ah);
1383b5c80475SFelix Fietkau 		}
1384203c4805SLuis R. Rodriguez 	} while (1);
1385203c4805SLuis R. Rodriguez 
138629ab0b36SRajkumar Manoharan 	if (!(ah->imask & ATH9K_INT_RXEOL)) {
138729ab0b36SRajkumar Manoharan 		ah->imask |= (ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
138872d874c6SFelix Fietkau 		ath9k_hw_set_interrupts(ah);
138929ab0b36SRajkumar Manoharan 	}
139029ab0b36SRajkumar Manoharan 
1391203c4805SLuis R. Rodriguez 	return 0;
1392203c4805SLuis R. Rodriguez }
1393