xref: /linux/drivers/net/wireless/ath/ath9k/recv.c (revision 7a8972037d8c8df0f93e4f7eed3d0202f9f244dc)
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,
133*7a897203SSujith 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);
253*7a897203SSujith Manoharan 	ath_rx_addbuffer_edma(sc, ATH9K_RX_QUEUE_HP);
254*7a897203SSujith 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 
277b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
278b5c80475SFelix Fietkau 		return ath_rx_edma_init(sc, nbufs);
279b5c80475SFelix Fietkau 	} else {
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;
318b5c80475SFelix Fietkau 	}
319203c4805SLuis R. Rodriguez 
320203c4805SLuis R. Rodriguez err:
321203c4805SLuis R. Rodriguez 	if (error)
322203c4805SLuis R. Rodriguez 		ath_rx_cleanup(sc);
323203c4805SLuis R. Rodriguez 
324203c4805SLuis R. Rodriguez 	return error;
325203c4805SLuis R. Rodriguez }
326203c4805SLuis R. Rodriguez 
327203c4805SLuis R. Rodriguez void ath_rx_cleanup(struct ath_softc *sc)
328203c4805SLuis R. Rodriguez {
329cc861f74SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
330cc861f74SLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
331203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
332203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
333203c4805SLuis R. Rodriguez 
334b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
335b5c80475SFelix Fietkau 		ath_rx_edma_cleanup(sc);
336b5c80475SFelix Fietkau 		return;
337b5c80475SFelix Fietkau 	} else {
338203c4805SLuis R. Rodriguez 		list_for_each_entry(bf, &sc->rx.rxbuf, list) {
339203c4805SLuis R. Rodriguez 			skb = bf->bf_mpdu;
340203c4805SLuis R. Rodriguez 			if (skb) {
341203c4805SLuis R. Rodriguez 				dma_unmap_single(sc->dev, bf->bf_buf_addr,
342b5c80475SFelix Fietkau 						common->rx_bufsize,
343b5c80475SFelix Fietkau 						DMA_FROM_DEVICE);
344203c4805SLuis R. Rodriguez 				dev_kfree_skb(skb);
3456cf9e995SBen Greear 				bf->bf_buf_addr = 0;
3466cf9e995SBen Greear 				bf->bf_mpdu = NULL;
347203c4805SLuis R. Rodriguez 			}
348203c4805SLuis R. Rodriguez 		}
349203c4805SLuis R. Rodriguez 	}
350b5c80475SFelix Fietkau }
351203c4805SLuis R. Rodriguez 
352203c4805SLuis R. Rodriguez /*
353203c4805SLuis R. Rodriguez  * Calculate the receive filter according to the
354203c4805SLuis R. Rodriguez  * operating mode and state:
355203c4805SLuis R. Rodriguez  *
356203c4805SLuis R. Rodriguez  * o always accept unicast, broadcast, and multicast traffic
357203c4805SLuis R. Rodriguez  * o maintain current state of phy error reception (the hal
358203c4805SLuis R. Rodriguez  *   may enable phy error frames for noise immunity work)
359203c4805SLuis R. Rodriguez  * o probe request frames are accepted only when operating in
360203c4805SLuis R. Rodriguez  *   hostap, adhoc, or monitor modes
361203c4805SLuis R. Rodriguez  * o enable promiscuous mode according to the interface state
362203c4805SLuis R. Rodriguez  * o accept beacons:
363203c4805SLuis R. Rodriguez  *   - when operating in adhoc mode so the 802.11 layer creates
364203c4805SLuis R. Rodriguez  *     node table entries for peers,
365203c4805SLuis R. Rodriguez  *   - when operating in station mode for collecting rssi data when
366203c4805SLuis R. Rodriguez  *     the station is otherwise quiet, or
367203c4805SLuis R. Rodriguez  *   - when operating as a repeater so we see repeater-sta beacons
368203c4805SLuis R. Rodriguez  *   - when scanning
369203c4805SLuis R. Rodriguez  */
370203c4805SLuis R. Rodriguez 
371203c4805SLuis R. Rodriguez u32 ath_calcrxfilter(struct ath_softc *sc)
372203c4805SLuis R. Rodriguez {
373203c4805SLuis R. Rodriguez 	u32 rfilt;
374203c4805SLuis R. Rodriguez 
375ac06697cSFelix Fietkau 	rfilt = ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
376203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_MCAST;
377203c4805SLuis R. Rodriguez 
37873e4937dSZefir Kurtisi 	/* if operating on a DFS channel, enable radar pulse detection */
37973e4937dSZefir Kurtisi 	if (sc->hw->conf.radar_enabled)
38073e4937dSZefir Kurtisi 		rfilt |= ATH9K_RX_FILTER_PHYRADAR | ATH9K_RX_FILTER_PHYERR;
38173e4937dSZefir Kurtisi 
3829c1d8e4aSJouni Malinen 	if (sc->rx.rxfilter & FIF_PROBE_REQ)
383203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROBEREQ;
384203c4805SLuis R. Rodriguez 
385203c4805SLuis R. Rodriguez 	/*
386203c4805SLuis R. Rodriguez 	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
387203c4805SLuis R. Rodriguez 	 * mode interface or when in monitor mode. AP mode does not need this
388203c4805SLuis R. Rodriguez 	 * since it receives all in-BSS frames anyway.
389203c4805SLuis R. Rodriguez 	 */
3902e286947SFelix Fietkau 	if (sc->sc_ah->is_monitoring)
391203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROM;
392203c4805SLuis R. Rodriguez 
393203c4805SLuis R. Rodriguez 	if (sc->rx.rxfilter & FIF_CONTROL)
394203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_CONTROL;
395203c4805SLuis R. Rodriguez 
396203c4805SLuis R. Rodriguez 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
397cfda6695SBen Greear 	    (sc->nvifs <= 1) &&
398203c4805SLuis R. Rodriguez 	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
399203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MYBEACON;
400203c4805SLuis R. Rodriguez 	else
401203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_BEACON;
402203c4805SLuis R. Rodriguez 
403264bbec8SFelix Fietkau 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_AP) ||
40466afad01SSenthil Balasubramanian 	    (sc->rx.rxfilter & FIF_PSPOLL))
405203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PSPOLL;
406203c4805SLuis R. Rodriguez 
4077ea310beSSujith 	if (conf_is_ht(&sc->hw->conf))
4087ea310beSSujith 		rfilt |= ATH9K_RX_FILTER_COMP_BAR;
4097ea310beSSujith 
4107545daf4SFelix Fietkau 	if (sc->nvifs > 1 || (sc->rx.rxfilter & FIF_OTHER_BSS)) {
411a549459cSThomas Wagner 		/* This is needed for older chips */
412a549459cSThomas Wagner 		if (sc->sc_ah->hw_version.macVersion <= AR_SREV_VERSION_9160)
4135eb6ba83SJavier Cardona 			rfilt |= ATH9K_RX_FILTER_PROM;
414203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
415203c4805SLuis R. Rodriguez 	}
416203c4805SLuis R. Rodriguez 
417b3d7aa43SGabor Juhos 	if (AR_SREV_9550(sc->sc_ah))
418b3d7aa43SGabor Juhos 		rfilt |= ATH9K_RX_FILTER_4ADDRESS;
419b3d7aa43SGabor Juhos 
420203c4805SLuis R. Rodriguez 	return rfilt;
421203c4805SLuis R. Rodriguez 
422203c4805SLuis R. Rodriguez }
423203c4805SLuis R. Rodriguez 
424203c4805SLuis R. Rodriguez int ath_startrecv(struct ath_softc *sc)
425203c4805SLuis R. Rodriguez {
426203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
427203c4805SLuis R. Rodriguez 	struct ath_buf *bf, *tbf;
428203c4805SLuis R. Rodriguez 
429b5c80475SFelix Fietkau 	if (ah->caps.hw_caps & ATH9K_HW_CAP_EDMA) {
430b5c80475SFelix Fietkau 		ath_edma_start_recv(sc);
431b5c80475SFelix Fietkau 		return 0;
432b5c80475SFelix Fietkau 	}
433b5c80475SFelix Fietkau 
434203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
435203c4805SLuis R. Rodriguez 		goto start_recv;
436203c4805SLuis R. Rodriguez 
437203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
438203c4805SLuis R. Rodriguez 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
439203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
440203c4805SLuis R. Rodriguez 	}
441203c4805SLuis R. Rodriguez 
442203c4805SLuis R. Rodriguez 	/* We could have deleted elements so the list may be empty now */
443203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
444203c4805SLuis R. Rodriguez 		goto start_recv;
445203c4805SLuis R. Rodriguez 
446203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
447203c4805SLuis R. Rodriguez 	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
448203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
449203c4805SLuis R. Rodriguez 
450203c4805SLuis R. Rodriguez start_recv:
451203c4805SLuis R. Rodriguez 	ath_opmode_init(sc);
4524cb54fa3SSujith Manoharan 	ath9k_hw_startpcureceive(ah, !!(sc->hw->conf.flags & IEEE80211_CONF_OFFCHANNEL));
453203c4805SLuis R. Rodriguez 
454203c4805SLuis R. Rodriguez 	return 0;
455203c4805SLuis R. Rodriguez }
456203c4805SLuis R. Rodriguez 
4574b883f02SFelix Fietkau static void ath_flushrecv(struct ath_softc *sc)
4584b883f02SFelix Fietkau {
4594b883f02SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
4604b883f02SFelix Fietkau 		ath_rx_tasklet(sc, 1, true);
4614b883f02SFelix Fietkau 	ath_rx_tasklet(sc, 1, false);
4624b883f02SFelix Fietkau }
4634b883f02SFelix Fietkau 
464203c4805SLuis R. Rodriguez bool ath_stoprecv(struct ath_softc *sc)
465203c4805SLuis R. Rodriguez {
466203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
4675882da02SFelix Fietkau 	bool stopped, reset = false;
468203c4805SLuis R. Rodriguez 
469d47844a0SFelix Fietkau 	ath9k_hw_abortpcurecv(ah);
470203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, 0);
4715882da02SFelix Fietkau 	stopped = ath9k_hw_stopdmarecv(ah, &reset);
472b5c80475SFelix Fietkau 
4734b883f02SFelix Fietkau 	ath_flushrecv(sc);
4744b883f02SFelix Fietkau 
475b5c80475SFelix Fietkau 	if (sc->sc_ah->caps.hw_caps & ATH9K_HW_CAP_EDMA)
476b5c80475SFelix Fietkau 		ath_edma_stop_recv(sc);
477b5c80475SFelix Fietkau 	else
478203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
479203c4805SLuis R. Rodriguez 
480d584747bSRajkumar Manoharan 	if (!(ah->ah_flags & AH_UNPLUGGED) &&
481d584747bSRajkumar Manoharan 	    unlikely(!stopped)) {
482d7fd1b50SBen Greear 		ath_err(ath9k_hw_common(sc->sc_ah),
483d7fd1b50SBen Greear 			"Could not stop RX, we could be "
48478a7685eSLuis R. Rodriguez 			"confusing the DMA engine when we start RX up\n");
485d7fd1b50SBen Greear 		ATH_DBG_WARN_ON_ONCE(!stopped);
486d7fd1b50SBen Greear 	}
4872232d31bSFelix Fietkau 	return stopped && !reset;
488203c4805SLuis R. Rodriguez }
489203c4805SLuis R. Rodriguez 
490cc65965cSJouni Malinen static bool ath_beacon_dtim_pending_cab(struct sk_buff *skb)
491cc65965cSJouni Malinen {
492cc65965cSJouni Malinen 	/* Check whether the Beacon frame has DTIM indicating buffered bc/mc */
493cc65965cSJouni Malinen 	struct ieee80211_mgmt *mgmt;
494cc65965cSJouni Malinen 	u8 *pos, *end, id, elen;
495cc65965cSJouni Malinen 	struct ieee80211_tim_ie *tim;
496cc65965cSJouni Malinen 
497cc65965cSJouni Malinen 	mgmt = (struct ieee80211_mgmt *)skb->data;
498cc65965cSJouni Malinen 	pos = mgmt->u.beacon.variable;
499cc65965cSJouni Malinen 	end = skb->data + skb->len;
500cc65965cSJouni Malinen 
501cc65965cSJouni Malinen 	while (pos + 2 < end) {
502cc65965cSJouni Malinen 		id = *pos++;
503cc65965cSJouni Malinen 		elen = *pos++;
504cc65965cSJouni Malinen 		if (pos + elen > end)
505cc65965cSJouni Malinen 			break;
506cc65965cSJouni Malinen 
507cc65965cSJouni Malinen 		if (id == WLAN_EID_TIM) {
508cc65965cSJouni Malinen 			if (elen < sizeof(*tim))
509cc65965cSJouni Malinen 				break;
510cc65965cSJouni Malinen 			tim = (struct ieee80211_tim_ie *) pos;
511cc65965cSJouni Malinen 			if (tim->dtim_count != 0)
512cc65965cSJouni Malinen 				break;
513cc65965cSJouni Malinen 			return tim->bitmap_ctrl & 0x01;
514cc65965cSJouni Malinen 		}
515cc65965cSJouni Malinen 
516cc65965cSJouni Malinen 		pos += elen;
517cc65965cSJouni Malinen 	}
518cc65965cSJouni Malinen 
519cc65965cSJouni Malinen 	return false;
520cc65965cSJouni Malinen }
521cc65965cSJouni Malinen 
522cc65965cSJouni Malinen static void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb)
523cc65965cSJouni Malinen {
5241510718dSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
525cc65965cSJouni Malinen 
526cc65965cSJouni Malinen 	if (skb->len < 24 + 8 + 2 + 2)
527cc65965cSJouni Malinen 		return;
528cc65965cSJouni Malinen 
5291b04b930SSujith 	sc->ps_flags &= ~PS_WAIT_FOR_BEACON;
530293dc5dfSGabor Juhos 
5311b04b930SSujith 	if (sc->ps_flags & PS_BEACON_SYNC) {
5321b04b930SSujith 		sc->ps_flags &= ~PS_BEACON_SYNC;
533d2182b69SJoe Perches 		ath_dbg(common, PS,
5341a6404a1SSujith Manoharan 			"Reconfigure beacon timers based on synchronized timestamp\n");
535ef4ad633SSujith Manoharan 		ath9k_set_beacon(sc);
536ccdfeab6SJouni Malinen 	}
537ccdfeab6SJouni Malinen 
538cc65965cSJouni Malinen 	if (ath_beacon_dtim_pending_cab(skb)) {
539cc65965cSJouni Malinen 		/*
540cc65965cSJouni Malinen 		 * Remain awake waiting for buffered broadcast/multicast
54158f5fffdSGabor Juhos 		 * frames. If the last broadcast/multicast frame is not
54258f5fffdSGabor Juhos 		 * received properly, the next beacon frame will work as
54358f5fffdSGabor Juhos 		 * a backup trigger for returning into NETWORK SLEEP state,
54458f5fffdSGabor Juhos 		 * so we are waiting for it as well.
545cc65965cSJouni Malinen 		 */
546d2182b69SJoe Perches 		ath_dbg(common, PS,
547226afe68SJoe Perches 			"Received DTIM beacon indicating buffered broadcast/multicast frame(s)\n");
5481b04b930SSujith 		sc->ps_flags |= PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON;
549cc65965cSJouni Malinen 		return;
550cc65965cSJouni Malinen 	}
551cc65965cSJouni Malinen 
5521b04b930SSujith 	if (sc->ps_flags & PS_WAIT_FOR_CAB) {
553cc65965cSJouni Malinen 		/*
554cc65965cSJouni Malinen 		 * This can happen if a broadcast frame is dropped or the AP
555cc65965cSJouni Malinen 		 * fails to send a frame indicating that all CAB frames have
556cc65965cSJouni Malinen 		 * been delivered.
557cc65965cSJouni Malinen 		 */
5581b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_CAB;
559d2182b69SJoe Perches 		ath_dbg(common, PS, "PS wait for CAB frames timed out\n");
560cc65965cSJouni Malinen 	}
561cc65965cSJouni Malinen }
562cc65965cSJouni Malinen 
563f73c604cSRajkumar Manoharan static void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb, bool mybeacon)
564cc65965cSJouni Malinen {
565cc65965cSJouni Malinen 	struct ieee80211_hdr *hdr;
566c46917bbSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
567cc65965cSJouni Malinen 
568cc65965cSJouni Malinen 	hdr = (struct ieee80211_hdr *)skb->data;
569cc65965cSJouni Malinen 
570cc65965cSJouni Malinen 	/* Process Beacon and CAB receive in PS state */
571ededf1f8SVasanthakumar Thiagarajan 	if (((sc->ps_flags & PS_WAIT_FOR_BEACON) || ath9k_check_auto_sleep(sc))
57207c15a3fSSujith Manoharan 	    && mybeacon) {
573cc65965cSJouni Malinen 		ath_rx_ps_beacon(sc, skb);
57407c15a3fSSujith Manoharan 	} else if ((sc->ps_flags & PS_WAIT_FOR_CAB) &&
575cc65965cSJouni Malinen 		   (ieee80211_is_data(hdr->frame_control) ||
576cc65965cSJouni Malinen 		    ieee80211_is_action(hdr->frame_control)) &&
577cc65965cSJouni Malinen 		   is_multicast_ether_addr(hdr->addr1) &&
578cc65965cSJouni Malinen 		   !ieee80211_has_moredata(hdr->frame_control)) {
579cc65965cSJouni Malinen 		/*
580cc65965cSJouni Malinen 		 * No more broadcast/multicast frames to be received at this
581cc65965cSJouni Malinen 		 * point.
582cc65965cSJouni Malinen 		 */
5833fac6dfdSSenthil Balasubramanian 		sc->ps_flags &= ~(PS_WAIT_FOR_CAB | PS_WAIT_FOR_BEACON);
584d2182b69SJoe Perches 		ath_dbg(common, PS,
585c46917bbSLuis R. Rodriguez 			"All PS CAB frames received, back to sleep\n");
5861b04b930SSujith 	} else if ((sc->ps_flags & PS_WAIT_FOR_PSPOLL_DATA) &&
5879a23f9caSJouni Malinen 		   !is_multicast_ether_addr(hdr->addr1) &&
5889a23f9caSJouni Malinen 		   !ieee80211_has_morefrags(hdr->frame_control)) {
5891b04b930SSujith 		sc->ps_flags &= ~PS_WAIT_FOR_PSPOLL_DATA;
590d2182b69SJoe Perches 		ath_dbg(common, PS,
591226afe68SJoe Perches 			"Going back to sleep after having received PS-Poll data (0x%lx)\n",
5921b04b930SSujith 			sc->ps_flags & (PS_WAIT_FOR_BEACON |
5931b04b930SSujith 					PS_WAIT_FOR_CAB |
5941b04b930SSujith 					PS_WAIT_FOR_PSPOLL_DATA |
5951b04b930SSujith 					PS_WAIT_FOR_TX_ACK));
596cc65965cSJouni Malinen 	}
597cc65965cSJouni Malinen }
598cc65965cSJouni Malinen 
599b5c80475SFelix Fietkau static bool ath_edma_get_buffers(struct ath_softc *sc,
6003a2923e8SFelix Fietkau 				 enum ath9k_rx_qtype qtype,
6013a2923e8SFelix Fietkau 				 struct ath_rx_status *rs,
6023a2923e8SFelix Fietkau 				 struct ath_buf **dest)
603203c4805SLuis R. Rodriguez {
604b5c80475SFelix Fietkau 	struct ath_rx_edma *rx_edma = &sc->rx.rx_edma[qtype];
605203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
60627c51f1aSLuis R. Rodriguez 	struct ath_common *common = ath9k_hw_common(ah);
607b5c80475SFelix Fietkau 	struct sk_buff *skb;
608b5c80475SFelix Fietkau 	struct ath_buf *bf;
609b5c80475SFelix Fietkau 	int ret;
610203c4805SLuis R. Rodriguez 
611b5c80475SFelix Fietkau 	skb = skb_peek(&rx_edma->rx_fifo);
612b5c80475SFelix Fietkau 	if (!skb)
613b5c80475SFelix Fietkau 		return false;
614203c4805SLuis R. Rodriguez 
615b5c80475SFelix Fietkau 	bf = SKB_CB_ATHBUF(skb);
616b5c80475SFelix Fietkau 	BUG_ON(!bf);
617b5c80475SFelix Fietkau 
618ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
619b5c80475SFelix Fietkau 				common->rx_bufsize, DMA_FROM_DEVICE);
620b5c80475SFelix Fietkau 
6213a2923e8SFelix Fietkau 	ret = ath9k_hw_process_rxdesc_edma(ah, rs, skb->data);
622ce9426d1SMing Lei 	if (ret == -EINPROGRESS) {
623ce9426d1SMing Lei 		/*let device gain the buffer again*/
624ce9426d1SMing Lei 		dma_sync_single_for_device(sc->dev, bf->bf_buf_addr,
625ce9426d1SMing Lei 				common->rx_bufsize, DMA_FROM_DEVICE);
626b5c80475SFelix Fietkau 		return false;
627ce9426d1SMing Lei 	}
628b5c80475SFelix Fietkau 
629b5c80475SFelix Fietkau 	__skb_unlink(skb, &rx_edma->rx_fifo);
630b5c80475SFelix Fietkau 	if (ret == -EINVAL) {
631b5c80475SFelix Fietkau 		/* corrupt descriptor, skip this one and the following one */
632b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
633b5c80475SFelix Fietkau 		ath_rx_edma_buf_link(sc, qtype);
634b5c80475SFelix Fietkau 
6353a2923e8SFelix Fietkau 		skb = skb_peek(&rx_edma->rx_fifo);
6363a2923e8SFelix Fietkau 		if (skb) {
637b5c80475SFelix Fietkau 			bf = SKB_CB_ATHBUF(skb);
638b5c80475SFelix Fietkau 			BUG_ON(!bf);
639b5c80475SFelix Fietkau 
640b5c80475SFelix Fietkau 			__skb_unlink(skb, &rx_edma->rx_fifo);
641b5c80475SFelix Fietkau 			list_add_tail(&bf->list, &sc->rx.rxbuf);
642b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
643b5c80475SFelix Fietkau 		}
6446bb51c70STom Hughes 
6456bb51c70STom Hughes 		bf = NULL;
6463a2923e8SFelix Fietkau 	}
647b5c80475SFelix Fietkau 
6483a2923e8SFelix Fietkau 	*dest = bf;
649b5c80475SFelix Fietkau 	return true;
650b5c80475SFelix Fietkau }
651b5c80475SFelix Fietkau 
652b5c80475SFelix Fietkau static struct ath_buf *ath_edma_get_next_rx_buf(struct ath_softc *sc,
653b5c80475SFelix Fietkau 						struct ath_rx_status *rs,
654b5c80475SFelix Fietkau 						enum ath9k_rx_qtype qtype)
655b5c80475SFelix Fietkau {
6563a2923e8SFelix Fietkau 	struct ath_buf *bf = NULL;
657b5c80475SFelix Fietkau 
6583a2923e8SFelix Fietkau 	while (ath_edma_get_buffers(sc, qtype, rs, &bf)) {
6593a2923e8SFelix Fietkau 		if (!bf)
6603a2923e8SFelix Fietkau 			continue;
661b5c80475SFelix Fietkau 
662b5c80475SFelix Fietkau 		return bf;
663b5c80475SFelix Fietkau 	}
6643a2923e8SFelix Fietkau 	return NULL;
6653a2923e8SFelix Fietkau }
666b5c80475SFelix Fietkau 
667b5c80475SFelix Fietkau static struct ath_buf *ath_get_next_rx_buf(struct ath_softc *sc,
668b5c80475SFelix Fietkau 					   struct ath_rx_status *rs)
669b5c80475SFelix Fietkau {
670b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
671b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
672b5c80475SFelix Fietkau 	struct ath_desc *ds;
673b5c80475SFelix Fietkau 	struct ath_buf *bf;
674b5c80475SFelix Fietkau 	int ret;
675203c4805SLuis R. Rodriguez 
676203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf)) {
677203c4805SLuis R. Rodriguez 		sc->rx.rxlink = NULL;
678b5c80475SFelix Fietkau 		return NULL;
679203c4805SLuis R. Rodriguez 	}
680203c4805SLuis R. Rodriguez 
681203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
682203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
683203c4805SLuis R. Rodriguez 
684203c4805SLuis R. Rodriguez 	/*
685203c4805SLuis R. Rodriguez 	 * Must provide the virtual address of the current
686203c4805SLuis R. Rodriguez 	 * descriptor, the physical address, and the virtual
687203c4805SLuis R. Rodriguez 	 * address of the next descriptor in the h/w chain.
688203c4805SLuis R. Rodriguez 	 * This allows the HAL to look ahead to see if the
689203c4805SLuis R. Rodriguez 	 * hardware is done with a descriptor by checking the
690203c4805SLuis R. Rodriguez 	 * done bit in the following descriptor and the address
691203c4805SLuis R. Rodriguez 	 * of the current descriptor the DMA engine is working
692203c4805SLuis R. Rodriguez 	 * on.  All this is necessary because of our use of
693203c4805SLuis R. Rodriguez 	 * a self-linked list to avoid rx overruns.
694203c4805SLuis R. Rodriguez 	 */
6953de21116SRajkumar Manoharan 	ret = ath9k_hw_rxprocdesc(ah, ds, rs);
696b5c80475SFelix Fietkau 	if (ret == -EINPROGRESS) {
69729bffa96SFelix Fietkau 		struct ath_rx_status trs;
698203c4805SLuis R. Rodriguez 		struct ath_buf *tbf;
699203c4805SLuis R. Rodriguez 		struct ath_desc *tds;
700203c4805SLuis R. Rodriguez 
70129bffa96SFelix Fietkau 		memset(&trs, 0, sizeof(trs));
702203c4805SLuis R. Rodriguez 		if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
703203c4805SLuis R. Rodriguez 			sc->rx.rxlink = NULL;
704b5c80475SFelix Fietkau 			return NULL;
705203c4805SLuis R. Rodriguez 		}
706203c4805SLuis R. Rodriguez 
707203c4805SLuis R. Rodriguez 		tbf = list_entry(bf->list.next, struct ath_buf, list);
708203c4805SLuis R. Rodriguez 
709203c4805SLuis R. Rodriguez 		/*
710203c4805SLuis R. Rodriguez 		 * On some hardware the descriptor status words could
711203c4805SLuis R. Rodriguez 		 * get corrupted, including the done bit. Because of
712203c4805SLuis R. Rodriguez 		 * this, check if the next descriptor's done bit is
713203c4805SLuis R. Rodriguez 		 * set or not.
714203c4805SLuis R. Rodriguez 		 *
715203c4805SLuis R. Rodriguez 		 * If the next descriptor's done bit is set, the current
716203c4805SLuis R. Rodriguez 		 * descriptor has been corrupted. Force s/w to discard
717203c4805SLuis R. Rodriguez 		 * this descriptor and continue...
718203c4805SLuis R. Rodriguez 		 */
719203c4805SLuis R. Rodriguez 
720203c4805SLuis R. Rodriguez 		tds = tbf->bf_desc;
7213de21116SRajkumar Manoharan 		ret = ath9k_hw_rxprocdesc(ah, tds, &trs);
722b5c80475SFelix Fietkau 		if (ret == -EINPROGRESS)
723b5c80475SFelix Fietkau 			return NULL;
724723e7113SFelix Fietkau 
725723e7113SFelix Fietkau 		/*
726723e7113SFelix Fietkau 		 * mark descriptor as zero-length and set the 'more'
727723e7113SFelix Fietkau 		 * flag to ensure that both buffers get discarded
728723e7113SFelix Fietkau 		 */
729723e7113SFelix Fietkau 		rs->rs_datalen = 0;
730723e7113SFelix Fietkau 		rs->rs_more = true;
731203c4805SLuis R. Rodriguez 	}
732203c4805SLuis R. Rodriguez 
733a3dc48e8SFelix Fietkau 	list_del(&bf->list);
734b5c80475SFelix Fietkau 	if (!bf->bf_mpdu)
735b5c80475SFelix Fietkau 		return bf;
736203c4805SLuis R. Rodriguez 
737203c4805SLuis R. Rodriguez 	/*
738203c4805SLuis R. Rodriguez 	 * Synchronize the DMA transfer with CPU before
739203c4805SLuis R. Rodriguez 	 * 1. accessing the frame
740203c4805SLuis R. Rodriguez 	 * 2. requeueing the same buffer to h/w
741203c4805SLuis R. Rodriguez 	 */
742ce9426d1SMing Lei 	dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
743cc861f74SLuis R. Rodriguez 			common->rx_bufsize,
744203c4805SLuis R. Rodriguez 			DMA_FROM_DEVICE);
745203c4805SLuis R. Rodriguez 
746b5c80475SFelix Fietkau 	return bf;
747b5c80475SFelix Fietkau }
748b5c80475SFelix Fietkau 
749d435700fSSujith /* Assumes you've already done the endian to CPU conversion */
750d435700fSSujith static bool ath9k_rx_accept(struct ath_common *common,
7519f167f64SVasanthakumar Thiagarajan 			    struct ieee80211_hdr *hdr,
752d435700fSSujith 			    struct ieee80211_rx_status *rxs,
753d435700fSSujith 			    struct ath_rx_status *rx_stats,
754d435700fSSujith 			    bool *decrypt_error)
755d435700fSSujith {
756ec205999SFelix Fietkau 	struct ath_softc *sc = (struct ath_softc *) common->priv;
75766760eacSFelix Fietkau 	bool is_mc, is_valid_tkip, strip_mic, mic_error;
758d435700fSSujith 	struct ath_hw *ah = common->ah;
759d435700fSSujith 	__le16 fc;
760b7b1b512SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
761d435700fSSujith 
762d435700fSSujith 	fc = hdr->frame_control;
763d435700fSSujith 
76466760eacSFelix Fietkau 	is_mc = !!is_multicast_ether_addr(hdr->addr1);
76566760eacSFelix Fietkau 	is_valid_tkip = rx_stats->rs_keyix != ATH9K_RXKEYIX_INVALID &&
76666760eacSFelix Fietkau 		test_bit(rx_stats->rs_keyix, common->tkip_keymap);
767152e585dSBill Jordan 	strip_mic = is_valid_tkip && ieee80211_is_data(fc) &&
7682a5783b8SMichael Liang 		ieee80211_has_protected(fc) &&
769152e585dSBill Jordan 		!(rx_stats->rs_status &
770846d9363SFelix Fietkau 		(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_CRC | ATH9K_RXERR_MIC |
771846d9363SFelix Fietkau 		 ATH9K_RXERR_KEYMISS));
77266760eacSFelix Fietkau 
773f88373faSFelix Fietkau 	/*
774f88373faSFelix Fietkau 	 * Key miss events are only relevant for pairwise keys where the
775f88373faSFelix Fietkau 	 * descriptor does contain a valid key index. This has been observed
776f88373faSFelix Fietkau 	 * mostly with CCMP encryption.
777f88373faSFelix Fietkau 	 */
778bed3d9c0SFelix Fietkau 	if (rx_stats->rs_keyix == ATH9K_RXKEYIX_INVALID ||
779bed3d9c0SFelix Fietkau 	    !test_bit(rx_stats->rs_keyix, common->ccmp_keymap))
780f88373faSFelix Fietkau 		rx_stats->rs_status &= ~ATH9K_RXERR_KEYMISS;
781f88373faSFelix Fietkau 
78215072189SBen Greear 	if (!rx_stats->rs_datalen) {
78315072189SBen Greear 		RX_STAT_INC(rx_len_err);
784d435700fSSujith 		return false;
78515072189SBen Greear 	}
78615072189SBen Greear 
787d435700fSSujith         /*
788d435700fSSujith          * rs_status follows rs_datalen so if rs_datalen is too large
789d435700fSSujith          * we can take a hint that hardware corrupted it, so ignore
790d435700fSSujith          * those frames.
791d435700fSSujith          */
79215072189SBen Greear 	if (rx_stats->rs_datalen > (common->rx_bufsize - rx_status_len)) {
79315072189SBen Greear 		RX_STAT_INC(rx_len_err);
794d435700fSSujith 		return false;
79515072189SBen Greear 	}
796d435700fSSujith 
7970d95521eSFelix Fietkau 	/* Only use error bits from the last fragment */
798d435700fSSujith 	if (rx_stats->rs_more)
7990d95521eSFelix Fietkau 		return true;
800d435700fSSujith 
80166760eacSFelix Fietkau 	mic_error = is_valid_tkip && !ieee80211_is_ctl(fc) &&
80266760eacSFelix Fietkau 		!ieee80211_has_morefrags(fc) &&
80366760eacSFelix Fietkau 		!(le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG) &&
80466760eacSFelix Fietkau 		(rx_stats->rs_status & ATH9K_RXERR_MIC);
80566760eacSFelix Fietkau 
806d435700fSSujith 	/*
807d435700fSSujith 	 * The rx_stats->rs_status will not be set until the end of the
808d435700fSSujith 	 * chained descriptors so it can be ignored if rs_more is set. The
809d435700fSSujith 	 * rs_more will be false at the last element of the chained
810d435700fSSujith 	 * descriptors.
811d435700fSSujith 	 */
812d435700fSSujith 	if (rx_stats->rs_status != 0) {
813846d9363SFelix Fietkau 		u8 status_mask;
814846d9363SFelix Fietkau 
81566760eacSFelix Fietkau 		if (rx_stats->rs_status & ATH9K_RXERR_CRC) {
816d435700fSSujith 			rxs->flag |= RX_FLAG_FAILED_FCS_CRC;
81766760eacSFelix Fietkau 			mic_error = false;
81866760eacSFelix Fietkau 		}
819d435700fSSujith 		if (rx_stats->rs_status & ATH9K_RXERR_PHY)
820d435700fSSujith 			return false;
821d435700fSSujith 
822846d9363SFelix Fietkau 		if ((rx_stats->rs_status & ATH9K_RXERR_DECRYPT) ||
823846d9363SFelix Fietkau 		    (!is_mc && (rx_stats->rs_status & ATH9K_RXERR_KEYMISS))) {
824d435700fSSujith 			*decrypt_error = true;
82566760eacSFelix Fietkau 			mic_error = false;
826d435700fSSujith 		}
82766760eacSFelix Fietkau 
828d435700fSSujith 		/*
829d435700fSSujith 		 * Reject error frames with the exception of
830d435700fSSujith 		 * decryption and MIC failures. For monitor mode,
831d435700fSSujith 		 * we also ignore the CRC error.
832d435700fSSujith 		 */
833846d9363SFelix Fietkau 		status_mask = ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
834846d9363SFelix Fietkau 			      ATH9K_RXERR_KEYMISS;
835846d9363SFelix Fietkau 
836ec205999SFelix Fietkau 		if (ah->is_monitoring && (sc->rx.rxfilter & FIF_FCSFAIL))
837846d9363SFelix Fietkau 			status_mask |= ATH9K_RXERR_CRC;
838846d9363SFelix Fietkau 
839846d9363SFelix Fietkau 		if (rx_stats->rs_status & ~status_mask)
840d435700fSSujith 			return false;
841d435700fSSujith 	}
84266760eacSFelix Fietkau 
84366760eacSFelix Fietkau 	/*
84466760eacSFelix Fietkau 	 * For unicast frames the MIC error bit can have false positives,
84566760eacSFelix Fietkau 	 * so all MIC error reports need to be validated in software.
84666760eacSFelix Fietkau 	 * False negatives are not common, so skip software verification
84766760eacSFelix Fietkau 	 * if the hardware considers the MIC valid.
84866760eacSFelix Fietkau 	 */
84966760eacSFelix Fietkau 	if (strip_mic)
85066760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_STRIPPED;
85166760eacSFelix Fietkau 	else if (is_mc && mic_error)
85266760eacSFelix Fietkau 		rxs->flag |= RX_FLAG_MMIC_ERROR;
85366760eacSFelix Fietkau 
854d435700fSSujith 	return true;
855d435700fSSujith }
856d435700fSSujith 
857d435700fSSujith static int ath9k_process_rate(struct ath_common *common,
858d435700fSSujith 			      struct ieee80211_hw *hw,
859d435700fSSujith 			      struct ath_rx_status *rx_stats,
8609f167f64SVasanthakumar Thiagarajan 			      struct ieee80211_rx_status *rxs)
861d435700fSSujith {
862d435700fSSujith 	struct ieee80211_supported_band *sband;
863d435700fSSujith 	enum ieee80211_band band;
864d435700fSSujith 	unsigned int i = 0;
865990e08a0SBen Greear 	struct ath_softc __maybe_unused *sc = common->priv;
866d435700fSSujith 
867675a0b04SKarl Beldan 	band = hw->conf.chandef.chan->band;
868d435700fSSujith 	sband = hw->wiphy->bands[band];
869d435700fSSujith 
870d435700fSSujith 	if (rx_stats->rs_rate & 0x80) {
871d435700fSSujith 		/* HT rate */
872d435700fSSujith 		rxs->flag |= RX_FLAG_HT;
873d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_2040)
874d435700fSSujith 			rxs->flag |= RX_FLAG_40MHZ;
875d435700fSSujith 		if (rx_stats->rs_flags & ATH9K_RX_GI)
876d435700fSSujith 			rxs->flag |= RX_FLAG_SHORT_GI;
877d435700fSSujith 		rxs->rate_idx = rx_stats->rs_rate & 0x7f;
878d435700fSSujith 		return 0;
879d435700fSSujith 	}
880d435700fSSujith 
881d435700fSSujith 	for (i = 0; i < sband->n_bitrates; i++) {
882d435700fSSujith 		if (sband->bitrates[i].hw_value == rx_stats->rs_rate) {
883d435700fSSujith 			rxs->rate_idx = i;
884d435700fSSujith 			return 0;
885d435700fSSujith 		}
886d435700fSSujith 		if (sband->bitrates[i].hw_value_short == rx_stats->rs_rate) {
887d435700fSSujith 			rxs->flag |= RX_FLAG_SHORTPRE;
888d435700fSSujith 			rxs->rate_idx = i;
889d435700fSSujith 			return 0;
890d435700fSSujith 		}
891d435700fSSujith 	}
892d435700fSSujith 
893d435700fSSujith 	/*
894d435700fSSujith 	 * No valid hardware bitrate found -- we should not get here
895d435700fSSujith 	 * because hardware has already validated this frame as OK.
896d435700fSSujith 	 */
897d2182b69SJoe Perches 	ath_dbg(common, ANY,
898226afe68SJoe Perches 		"unsupported hw bitrate detected 0x%02x using 1 Mbit\n",
899226afe68SJoe Perches 		rx_stats->rs_rate);
90015072189SBen Greear 	RX_STAT_INC(rx_rate_err);
901d435700fSSujith 	return -EINVAL;
902d435700fSSujith }
903d435700fSSujith 
904d435700fSSujith static void ath9k_process_rssi(struct ath_common *common,
905d435700fSSujith 			       struct ieee80211_hw *hw,
9069f167f64SVasanthakumar Thiagarajan 			       struct ieee80211_hdr *hdr,
907d435700fSSujith 			       struct ath_rx_status *rx_stats)
908d435700fSSujith {
9099ac58615SFelix Fietkau 	struct ath_softc *sc = hw->priv;
910d435700fSSujith 	struct ath_hw *ah = common->ah;
9119fa23e17SFelix Fietkau 	int last_rssi;
9122ef16755SFelix Fietkau 	int rssi = rx_stats->rs_rssi;
913d435700fSSujith 
914cf3af748SRajkumar Manoharan 	if (!rx_stats->is_mybeacon ||
915cf3af748SRajkumar Manoharan 	    ((ah->opmode != NL80211_IFTYPE_STATION) &&
916cf3af748SRajkumar Manoharan 	     (ah->opmode != NL80211_IFTYPE_ADHOC)))
9179fa23e17SFelix Fietkau 		return;
9189fa23e17SFelix Fietkau 
9199fa23e17SFelix Fietkau 	if (rx_stats->rs_rssi != ATH9K_RSSI_BAD && !rx_stats->rs_moreaggr)
9209ac58615SFelix Fietkau 		ATH_RSSI_LPF(sc->last_rssi, rx_stats->rs_rssi);
921686b9cb9SBen Greear 
9229ac58615SFelix Fietkau 	last_rssi = sc->last_rssi;
923d435700fSSujith 	if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER))
9242ef16755SFelix Fietkau 		rssi = ATH_EP_RND(last_rssi, ATH_RSSI_EP_MULTIPLIER);
9252ef16755SFelix Fietkau 	if (rssi < 0)
9262ef16755SFelix Fietkau 		rssi = 0;
927d435700fSSujith 
928d435700fSSujith 	/* Update Beacon RSSI, this is used by ANI. */
9292ef16755SFelix Fietkau 	ah->stats.avgbrssi = rssi;
930d435700fSSujith }
931d435700fSSujith 
932d435700fSSujith /*
933d435700fSSujith  * For Decrypt or Demic errors, we only mark packet status here and always push
934d435700fSSujith  * up the frame up to let mac80211 handle the actual error case, be it no
935d435700fSSujith  * decryption key or real decryption error. This let us keep statistics there.
936d435700fSSujith  */
937723e7113SFelix Fietkau static int ath9k_rx_skb_preprocess(struct ath_softc *sc,
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 {
943723e7113SFelix Fietkau 	struct ieee80211_hw *hw = sc->hw;
944723e7113SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
945723e7113SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
946723e7113SFelix Fietkau 	bool discard_current = sc->rx.discard_next;
947723e7113SFelix Fietkau 
948723e7113SFelix Fietkau 	sc->rx.discard_next = rx_stats->rs_more;
949723e7113SFelix Fietkau 	if (discard_current)
950723e7113SFelix Fietkau 		return -EINVAL;
951f749b946SFelix Fietkau 
952d435700fSSujith 	/*
953d435700fSSujith 	 * everything but the rate is checked here, the rate check is done
954d435700fSSujith 	 * separately to avoid doing two lookups for a rate for each frame.
955d435700fSSujith 	 */
9569f167f64SVasanthakumar Thiagarajan 	if (!ath9k_rx_accept(common, hdr, rx_status, rx_stats, decrypt_error))
957d435700fSSujith 		return -EINVAL;
958d435700fSSujith 
9590d95521eSFelix Fietkau 	/* Only use status info from the last fragment */
9600d95521eSFelix Fietkau 	if (rx_stats->rs_more)
9610d95521eSFelix Fietkau 		return 0;
9620d95521eSFelix Fietkau 
9639f167f64SVasanthakumar Thiagarajan 	ath9k_process_rssi(common, hw, hdr, rx_stats);
964d435700fSSujith 
9659f167f64SVasanthakumar Thiagarajan 	if (ath9k_process_rate(common, hw, rx_stats, rx_status))
966d435700fSSujith 		return -EINVAL;
967d435700fSSujith 
968675a0b04SKarl Beldan 	rx_status->band = hw->conf.chandef.chan->band;
969675a0b04SKarl Beldan 	rx_status->freq = hw->conf.chandef.chan->center_freq;
970f749b946SFelix Fietkau 	rx_status->signal = ah->noise + rx_stats->rs_rssi;
971d435700fSSujith 	rx_status->antenna = rx_stats->rs_antenna;
97296d21371SThomas Pedersen 	rx_status->flag |= RX_FLAG_MACTIME_END;
9732ef16755SFelix Fietkau 	if (rx_stats->rs_moreaggr)
9742ef16755SFelix Fietkau 		rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
975d435700fSSujith 
976723e7113SFelix Fietkau 	sc->rx.discard_next = false;
977d435700fSSujith 	return 0;
978d435700fSSujith }
979d435700fSSujith 
980d435700fSSujith static void ath9k_rx_skb_postprocess(struct ath_common *common,
981d435700fSSujith 				     struct sk_buff *skb,
982d435700fSSujith 				     struct ath_rx_status *rx_stats,
983d435700fSSujith 				     struct ieee80211_rx_status *rxs,
984d435700fSSujith 				     bool decrypt_error)
985d435700fSSujith {
986d435700fSSujith 	struct ath_hw *ah = common->ah;
987d435700fSSujith 	struct ieee80211_hdr *hdr;
988d435700fSSujith 	int hdrlen, padpos, padsize;
989d435700fSSujith 	u8 keyix;
990d435700fSSujith 	__le16 fc;
991d435700fSSujith 
992d435700fSSujith 	/* see if any padding is done by the hw and remove it */
993d435700fSSujith 	hdr = (struct ieee80211_hdr *) skb->data;
994d435700fSSujith 	hdrlen = ieee80211_get_hdrlen_from_skb(skb);
995d435700fSSujith 	fc = hdr->frame_control;
996c60c9929SFelix Fietkau 	padpos = ieee80211_hdrlen(fc);
997d435700fSSujith 
998d435700fSSujith 	/* The MAC header is padded to have 32-bit boundary if the
999d435700fSSujith 	 * packet payload is non-zero. The general calculation for
1000d435700fSSujith 	 * padsize would take into account odd header lengths:
1001d435700fSSujith 	 * padsize = (4 - padpos % 4) % 4; However, since only
1002d435700fSSujith 	 * even-length headers are used, padding can only be 0 or 2
1003d435700fSSujith 	 * bytes and we can optimize this a bit. In addition, we must
1004d435700fSSujith 	 * not try to remove padding from short control frames that do
1005d435700fSSujith 	 * not have payload. */
1006d435700fSSujith 	padsize = padpos & 3;
1007d435700fSSujith 	if (padsize && skb->len>=padpos+padsize+FCS_LEN) {
1008d435700fSSujith 		memmove(skb->data + padsize, skb->data, padpos);
1009d435700fSSujith 		skb_pull(skb, padsize);
1010d435700fSSujith 	}
1011d435700fSSujith 
1012d435700fSSujith 	keyix = rx_stats->rs_keyix;
1013d435700fSSujith 
1014d435700fSSujith 	if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error &&
1015d435700fSSujith 	    ieee80211_has_protected(fc)) {
1016d435700fSSujith 		rxs->flag |= RX_FLAG_DECRYPTED;
1017d435700fSSujith 	} else if (ieee80211_has_protected(fc)
1018d435700fSSujith 		   && !decrypt_error && skb->len >= hdrlen + 4) {
1019d435700fSSujith 		keyix = skb->data[hdrlen + 3] >> 6;
1020d435700fSSujith 
1021d435700fSSujith 		if (test_bit(keyix, common->keymap))
1022d435700fSSujith 			rxs->flag |= RX_FLAG_DECRYPTED;
1023d435700fSSujith 	}
1024d435700fSSujith 	if (ah->sw_mgmt_crypto &&
1025d435700fSSujith 	    (rxs->flag & RX_FLAG_DECRYPTED) &&
1026d435700fSSujith 	    ieee80211_is_mgmt(fc))
1027d435700fSSujith 		/* Use software decrypt for management frames. */
1028d435700fSSujith 		rxs->flag &= ~RX_FLAG_DECRYPTED;
1029d435700fSSujith }
1030b5c80475SFelix Fietkau 
1031ab2e2fc8SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1032e93d083fSSimon Wunderlich static s8 fix_rssi_inv_only(u8 rssi_val)
1033e93d083fSSimon Wunderlich {
1034e93d083fSSimon Wunderlich 	if (rssi_val == 128)
1035e93d083fSSimon Wunderlich 		rssi_val = 0;
1036e93d083fSSimon Wunderlich 	return (s8) rssi_val;
1037e93d083fSSimon Wunderlich }
1038ab2e2fc8SSven Eckelmann #endif
1039e93d083fSSimon Wunderlich 
10409b99e665SSimon Wunderlich /* returns 1 if this was a spectral frame, even if not handled. */
10419b99e665SSimon Wunderlich static int ath_process_fft(struct ath_softc *sc, struct ieee80211_hdr *hdr,
1042e93d083fSSimon Wunderlich 			   struct ath_rx_status *rs, u64 tsf)
1043e93d083fSSimon Wunderlich {
1044bd2ffe14SSven Eckelmann #ifdef CONFIG_ATH9K_DEBUGFS
1045e93d083fSSimon Wunderlich 	struct ath_hw *ah = sc->sc_ah;
1046e93d083fSSimon Wunderlich 	u8 bins[SPECTRAL_HT20_NUM_BINS];
1047e93d083fSSimon Wunderlich 	u8 *vdata = (u8 *)hdr;
1048e93d083fSSimon Wunderlich 	struct fft_sample_ht20 fft_sample;
1049e93d083fSSimon Wunderlich 	struct ath_radar_info *radar_info;
1050e93d083fSSimon Wunderlich 	struct ath_ht20_mag_info *mag_info;
1051e93d083fSSimon Wunderlich 	int len = rs->rs_datalen;
10524ab0b0aaSSven Eckelmann 	int dc_pos;
105312824374SSven Eckelmann 	u16 length, max_magnitude;
1054e93d083fSSimon Wunderlich 
1055e93d083fSSimon Wunderlich 	/* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
1056e93d083fSSimon Wunderlich 	 * via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
1057e93d083fSSimon Wunderlich 	 * yet, but this is supposed to be possible as well.
1058e93d083fSSimon Wunderlich 	 */
1059e93d083fSSimon Wunderlich 	if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
1060e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
1061e93d083fSSimon Wunderlich 	    rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
10629b99e665SSimon Wunderlich 		return 0;
10639b99e665SSimon Wunderlich 
10649b99e665SSimon Wunderlich 	/* check if spectral scan bit is set. This does not have to be checked
10659b99e665SSimon Wunderlich 	 * if received through a SPECTRAL phy error, but shouldn't hurt.
10669b99e665SSimon Wunderlich 	 */
10679b99e665SSimon Wunderlich 	radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
10689b99e665SSimon Wunderlich 	if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
10699b99e665SSimon Wunderlich 		return 0;
1070e93d083fSSimon Wunderlich 
1071e93d083fSSimon Wunderlich 	/* Variation in the data length is possible and will be fixed later.
1072e93d083fSSimon Wunderlich 	 * Note that we only support HT20 for now.
1073e93d083fSSimon Wunderlich 	 *
1074e93d083fSSimon Wunderlich 	 * TODO: add HT20_40 support as well.
1075e93d083fSSimon Wunderlich 	 */
1076e93d083fSSimon Wunderlich 	if ((len > SPECTRAL_HT20_TOTAL_DATA_LEN + 2) ||
1077e93d083fSSimon Wunderlich 	    (len < SPECTRAL_HT20_TOTAL_DATA_LEN - 1))
10789b99e665SSimon Wunderlich 		return 1;
1079e93d083fSSimon Wunderlich 
1080e93d083fSSimon Wunderlich 	fft_sample.tlv.type = ATH_FFT_SAMPLE_HT20;
108112824374SSven Eckelmann 	length = sizeof(fft_sample) - sizeof(fft_sample.tlv);
108212824374SSven Eckelmann 	fft_sample.tlv.length = __cpu_to_be16(length);
1083e93d083fSSimon Wunderlich 
10844ab0b0aaSSven Eckelmann 	fft_sample.freq = __cpu_to_be16(ah->curchan->chan->center_freq);
1085e93d083fSSimon Wunderlich 	fft_sample.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl0);
1086e93d083fSSimon Wunderlich 	fft_sample.noise = ah->noise;
1087e93d083fSSimon Wunderlich 
1088e93d083fSSimon Wunderlich 	switch (len - SPECTRAL_HT20_TOTAL_DATA_LEN) {
1089e93d083fSSimon Wunderlich 	case 0:
1090e93d083fSSimon Wunderlich 		/* length correct, nothing to do. */
1091e93d083fSSimon Wunderlich 		memcpy(bins, vdata, SPECTRAL_HT20_NUM_BINS);
1092e93d083fSSimon Wunderlich 		break;
1093e93d083fSSimon Wunderlich 	case -1:
1094e93d083fSSimon Wunderlich 		/* first byte missing, duplicate it. */
1095e93d083fSSimon Wunderlich 		memcpy(&bins[1], vdata, SPECTRAL_HT20_NUM_BINS - 1);
1096e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1097e93d083fSSimon Wunderlich 		break;
1098e93d083fSSimon Wunderlich 	case 2:
1099e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes at bin 30 and 32, remove them. */
1100e93d083fSSimon Wunderlich 		memcpy(bins, vdata, 30);
1101e93d083fSSimon Wunderlich 		bins[30] = vdata[31];
1102e93d083fSSimon Wunderlich 		memcpy(&bins[31], &vdata[33], SPECTRAL_HT20_NUM_BINS - 31);
1103e93d083fSSimon Wunderlich 		break;
1104e93d083fSSimon Wunderlich 	case 1:
1105e93d083fSSimon Wunderlich 		/* MAC added 2 extra bytes AND first byte is missing. */
1106e93d083fSSimon Wunderlich 		bins[0] = vdata[0];
1107e93d083fSSimon Wunderlich 		memcpy(&bins[0], vdata, 30);
1108e93d083fSSimon Wunderlich 		bins[31] = vdata[31];
1109e93d083fSSimon Wunderlich 		memcpy(&bins[32], &vdata[33], SPECTRAL_HT20_NUM_BINS - 32);
1110e93d083fSSimon Wunderlich 		break;
1111e93d083fSSimon Wunderlich 	default:
11129b99e665SSimon Wunderlich 		return 1;
1113e93d083fSSimon Wunderlich 	}
1114e93d083fSSimon Wunderlich 
1115e93d083fSSimon Wunderlich 	/* DC value (value in the middle) is the blind spot of the spectral
1116e93d083fSSimon Wunderlich 	 * sample and invalid, interpolate it.
1117e93d083fSSimon Wunderlich 	 */
1118e93d083fSSimon Wunderlich 	dc_pos = SPECTRAL_HT20_NUM_BINS / 2;
1119e93d083fSSimon Wunderlich 	bins[dc_pos] = (bins[dc_pos + 1] + bins[dc_pos - 1]) / 2;
1120e93d083fSSimon Wunderlich 
1121e93d083fSSimon Wunderlich 	/* mag data is at the end of the frame, in front of radar_info */
1122e93d083fSSimon Wunderlich 	mag_info = ((struct ath_ht20_mag_info *)radar_info) - 1;
1123e93d083fSSimon Wunderlich 
11244ab0b0aaSSven Eckelmann 	/* copy raw bins without scaling them */
11254ab0b0aaSSven Eckelmann 	memcpy(fft_sample.data, bins, SPECTRAL_HT20_NUM_BINS);
11264ab0b0aaSSven Eckelmann 	fft_sample.max_exp = mag_info->max_exp & 0xf;
1127e93d083fSSimon Wunderlich 
112812824374SSven Eckelmann 	max_magnitude = spectral_max_magnitude(mag_info->all_bins);
112912824374SSven Eckelmann 	fft_sample.max_magnitude = __cpu_to_be16(max_magnitude);
1130e93d083fSSimon Wunderlich 	fft_sample.max_index = spectral_max_index(mag_info->all_bins);
1131e93d083fSSimon Wunderlich 	fft_sample.bitmap_weight = spectral_bitmap_weight(mag_info->all_bins);
11324ab0b0aaSSven Eckelmann 	fft_sample.tsf = __cpu_to_be64(tsf);
1133e93d083fSSimon Wunderlich 
1134e93d083fSSimon Wunderlich 	ath_debug_send_fft_sample(sc, &fft_sample.tlv);
11359b99e665SSimon Wunderlich 	return 1;
11369b99e665SSimon Wunderlich #else
11379b99e665SSimon Wunderlich 	return 0;
1138e93d083fSSimon Wunderlich #endif
1139e93d083fSSimon Wunderlich }
1140e93d083fSSimon Wunderlich 
114121fbbca3SChristian Lamparter static void ath9k_apply_ampdu_details(struct ath_softc *sc,
114221fbbca3SChristian Lamparter 	struct ath_rx_status *rs, struct ieee80211_rx_status *rxs)
114321fbbca3SChristian Lamparter {
114421fbbca3SChristian Lamparter 	if (rs->rs_isaggr) {
114521fbbca3SChristian Lamparter 		rxs->flag |= RX_FLAG_AMPDU_DETAILS | RX_FLAG_AMPDU_LAST_KNOWN;
114621fbbca3SChristian Lamparter 
114721fbbca3SChristian Lamparter 		rxs->ampdu_reference = sc->rx.ampdu_ref;
114821fbbca3SChristian Lamparter 
114921fbbca3SChristian Lamparter 		if (!rs->rs_moreaggr) {
115021fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_IS_LAST;
115121fbbca3SChristian Lamparter 			sc->rx.ampdu_ref++;
115221fbbca3SChristian Lamparter 		}
115321fbbca3SChristian Lamparter 
115421fbbca3SChristian Lamparter 		if (rs->rs_flags & ATH9K_RX_DELIM_CRC_PRE)
115521fbbca3SChristian Lamparter 			rxs->flag |= RX_FLAG_AMPDU_DELIM_CRC_ERROR;
115621fbbca3SChristian Lamparter 	}
115721fbbca3SChristian Lamparter }
115821fbbca3SChristian Lamparter 
1159b5c80475SFelix Fietkau int ath_rx_tasklet(struct ath_softc *sc, int flush, bool hp)
1160b5c80475SFelix Fietkau {
1161b5c80475SFelix Fietkau 	struct ath_buf *bf;
11620d95521eSFelix Fietkau 	struct sk_buff *skb = NULL, *requeue_skb, *hdr_skb;
1163b5c80475SFelix Fietkau 	struct ieee80211_rx_status *rxs;
1164b5c80475SFelix Fietkau 	struct ath_hw *ah = sc->sc_ah;
1165b5c80475SFelix Fietkau 	struct ath_common *common = ath9k_hw_common(ah);
11667545daf4SFelix Fietkau 	struct ieee80211_hw *hw = sc->hw;
1167b5c80475SFelix Fietkau 	struct ieee80211_hdr *hdr;
1168b5c80475SFelix Fietkau 	int retval;
1169b5c80475SFelix Fietkau 	struct ath_rx_status rs;
1170b5c80475SFelix Fietkau 	enum ath9k_rx_qtype qtype;
1171b5c80475SFelix Fietkau 	bool edma = !!(ah->caps.hw_caps & ATH9K_HW_CAP_EDMA);
1172b5c80475SFelix Fietkau 	int dma_type;
11735c6dd921SVasanthakumar Thiagarajan 	u8 rx_status_len = ah->caps.rx_status_len;
1174a6d2055bSFelix Fietkau 	u64 tsf = 0;
1175a6d2055bSFelix Fietkau 	u32 tsf_lower = 0;
11768ab2cd09SLuis R. Rodriguez 	unsigned long flags;
11772e1cd495SFelix Fietkau 	dma_addr_t new_buf_addr;
1178b5c80475SFelix Fietkau 
1179b5c80475SFelix Fietkau 	if (edma)
1180b5c80475SFelix Fietkau 		dma_type = DMA_BIDIRECTIONAL;
118156824223SMing Lei 	else
118256824223SMing Lei 		dma_type = DMA_FROM_DEVICE;
1183b5c80475SFelix Fietkau 
1184b5c80475SFelix Fietkau 	qtype = hp ? ATH9K_RX_QUEUE_HP : ATH9K_RX_QUEUE_LP;
1185b5c80475SFelix Fietkau 
1186a6d2055bSFelix Fietkau 	tsf = ath9k_hw_gettsf64(ah);
1187a6d2055bSFelix Fietkau 	tsf_lower = tsf & 0xffffffff;
1188a6d2055bSFelix Fietkau 
1189b5c80475SFelix Fietkau 	do {
1190e1352fdeSLorenzo Bianconi 		bool decrypt_error = false;
1191b5c80475SFelix Fietkau 
1192b5c80475SFelix Fietkau 		memset(&rs, 0, sizeof(rs));
1193b5c80475SFelix Fietkau 		if (edma)
1194b5c80475SFelix Fietkau 			bf = ath_edma_get_next_rx_buf(sc, &rs, qtype);
1195b5c80475SFelix Fietkau 		else
1196b5c80475SFelix Fietkau 			bf = ath_get_next_rx_buf(sc, &rs);
1197b5c80475SFelix Fietkau 
1198b5c80475SFelix Fietkau 		if (!bf)
1199b5c80475SFelix Fietkau 			break;
1200b5c80475SFelix Fietkau 
1201b5c80475SFelix Fietkau 		skb = bf->bf_mpdu;
1202b5c80475SFelix Fietkau 		if (!skb)
1203b5c80475SFelix Fietkau 			continue;
1204b5c80475SFelix Fietkau 
12050d95521eSFelix Fietkau 		/*
12060d95521eSFelix Fietkau 		 * Take frame header from the first fragment and RX status from
12070d95521eSFelix Fietkau 		 * the last one.
12080d95521eSFelix Fietkau 		 */
12090d95521eSFelix Fietkau 		if (sc->rx.frag)
12100d95521eSFelix Fietkau 			hdr_skb = sc->rx.frag;
12110d95521eSFelix Fietkau 		else
12120d95521eSFelix Fietkau 			hdr_skb = skb;
12130d95521eSFelix Fietkau 
12140d95521eSFelix Fietkau 		hdr = (struct ieee80211_hdr *) (hdr_skb->data + rx_status_len);
12150d95521eSFelix Fietkau 		rxs = IEEE80211_SKB_RXCB(hdr_skb);
121615072189SBen Greear 		if (ieee80211_is_beacon(hdr->frame_control)) {
121715072189SBen Greear 			RX_STAT_INC(rx_beacons);
121815072189SBen Greear 			if (!is_zero_ether_addr(common->curbssid) &&
12192e42e474SJoe Perches 			    ether_addr_equal(hdr->addr3, common->curbssid))
1220cf3af748SRajkumar Manoharan 				rs.is_mybeacon = true;
1221cf3af748SRajkumar Manoharan 			else
1222cf3af748SRajkumar Manoharan 				rs.is_mybeacon = false;
122315072189SBen Greear 		}
122415072189SBen Greear 		else
122515072189SBen Greear 			rs.is_mybeacon = false;
12265ca42627SLuis R. Rodriguez 
1227be41b052SMohammed Shafi Shajakhan 		if (ieee80211_is_data_present(hdr->frame_control) &&
1228be41b052SMohammed Shafi Shajakhan 		    !ieee80211_is_qos_nullfunc(hdr->frame_control))
12296995fb80SRajkumar Manoharan 			sc->rx.num_pkts++;
1230be41b052SMohammed Shafi Shajakhan 
123129bffa96SFelix Fietkau 		ath_debug_stat_rx(sc, &rs);
12321395d3f0SSujith 
1233ffb1c56aSAshok Nagarajan 		memset(rxs, 0, sizeof(struct ieee80211_rx_status));
1234ffb1c56aSAshok Nagarajan 
1235a6d2055bSFelix Fietkau 		rxs->mactime = (tsf & ~0xffffffffULL) | rs.rs_tstamp;
1236a6d2055bSFelix Fietkau 		if (rs.rs_tstamp > tsf_lower &&
1237a6d2055bSFelix Fietkau 		    unlikely(rs.rs_tstamp - tsf_lower > 0x10000000))
1238a6d2055bSFelix Fietkau 			rxs->mactime -= 0x100000000ULL;
1239a6d2055bSFelix Fietkau 
1240a6d2055bSFelix Fietkau 		if (rs.rs_tstamp < tsf_lower &&
1241a6d2055bSFelix Fietkau 		    unlikely(tsf_lower - rs.rs_tstamp > 0x10000000))
1242a6d2055bSFelix Fietkau 			rxs->mactime += 0x100000000ULL;
1243a6d2055bSFelix Fietkau 
124473e4937dSZefir Kurtisi 		if (rs.rs_phyerr == ATH9K_PHYERR_RADAR)
124573e4937dSZefir Kurtisi 			ath9k_dfs_process_phyerr(sc, hdr, &rs, rxs->mactime);
124673e4937dSZefir Kurtisi 
12479b99e665SSimon Wunderlich 		if (rs.rs_status & ATH9K_RXERR_PHY) {
12489b99e665SSimon Wunderlich 			if (ath_process_fft(sc, hdr, &rs, rxs->mactime)) {
12499b99e665SSimon Wunderlich 				RX_STAT_INC(rx_spectral);
12509b99e665SSimon Wunderlich 				goto requeue_drop_frag;
12519b99e665SSimon Wunderlich 			}
12529b99e665SSimon Wunderlich 		}
1253e93d083fSSimon Wunderlich 
1254723e7113SFelix Fietkau 		retval = ath9k_rx_skb_preprocess(sc, hdr, &rs, rxs,
1255723e7113SFelix Fietkau 						 &decrypt_error);
125683c76570SZefir Kurtisi 		if (retval)
125783c76570SZefir Kurtisi 			goto requeue_drop_frag;
125883c76570SZefir Kurtisi 
125901e18918SRajkumar Manoharan 		if (rs.is_mybeacon) {
126001e18918SRajkumar Manoharan 			sc->hw_busy_count = 0;
126101e18918SRajkumar Manoharan 			ath_start_rx_poll(sc, 3);
126201e18918SRajkumar Manoharan 		}
1263203c4805SLuis R. Rodriguez 		/* Ensure we always have an skb to requeue once we are done
1264203c4805SLuis R. Rodriguez 		 * processing the current buffer's skb */
1265cc861f74SLuis R. Rodriguez 		requeue_skb = ath_rxbuf_alloc(common, common->rx_bufsize, GFP_ATOMIC);
1266203c4805SLuis R. Rodriguez 
1267203c4805SLuis R. Rodriguez 		/* If there is no memory we ignore the current RX'd frame,
1268203c4805SLuis R. Rodriguez 		 * tell hardware it can give us a new frame using the old
1269203c4805SLuis R. Rodriguez 		 * skb and put it at the tail of the sc->rx.rxbuf list for
1270203c4805SLuis R. Rodriguez 		 * processing. */
127115072189SBen Greear 		if (!requeue_skb) {
127215072189SBen Greear 			RX_STAT_INC(rx_oom_err);
12730d95521eSFelix Fietkau 			goto requeue_drop_frag;
127415072189SBen Greear 		}
1275203c4805SLuis R. Rodriguez 
12762e1cd495SFelix Fietkau 		/* We will now give hardware our shiny new allocated skb */
12772e1cd495SFelix Fietkau 		new_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
12782e1cd495SFelix Fietkau 					      common->rx_bufsize, dma_type);
12792e1cd495SFelix Fietkau 		if (unlikely(dma_mapping_error(sc->dev, new_buf_addr))) {
12802e1cd495SFelix Fietkau 			dev_kfree_skb_any(requeue_skb);
12812e1cd495SFelix Fietkau 			goto requeue_drop_frag;
12822e1cd495SFelix Fietkau 		}
12832e1cd495SFelix Fietkau 
12842e1cd495SFelix Fietkau 		bf->bf_mpdu = requeue_skb;
12852e1cd495SFelix Fietkau 		bf->bf_buf_addr = new_buf_addr;
12862e1cd495SFelix Fietkau 
1287203c4805SLuis R. Rodriguez 		/* Unmap the frame */
1288203c4805SLuis R. Rodriguez 		dma_unmap_single(sc->dev, bf->bf_buf_addr,
12892e1cd495SFelix Fietkau 				 common->rx_bufsize, dma_type);
1290203c4805SLuis R. Rodriguez 
1291b5c80475SFelix Fietkau 		skb_put(skb, rs.rs_datalen + ah->caps.rx_status_len);
1292b5c80475SFelix Fietkau 		if (ah->caps.rx_status_len)
1293b5c80475SFelix Fietkau 			skb_pull(skb, ah->caps.rx_status_len);
1294203c4805SLuis R. Rodriguez 
12950d95521eSFelix Fietkau 		if (!rs.rs_more)
12960d95521eSFelix Fietkau 			ath9k_rx_skb_postprocess(common, hdr_skb, &rs,
1297c9b14170SLuis R. Rodriguez 						 rxs, decrypt_error);
1298203c4805SLuis R. Rodriguez 
12990d95521eSFelix Fietkau 		if (rs.rs_more) {
130015072189SBen Greear 			RX_STAT_INC(rx_frags);
13010d95521eSFelix Fietkau 			/*
13020d95521eSFelix Fietkau 			 * rs_more indicates chained descriptors which can be
13030d95521eSFelix Fietkau 			 * used to link buffers together for a sort of
13040d95521eSFelix Fietkau 			 * scatter-gather operation.
13050d95521eSFelix Fietkau 			 */
13060d95521eSFelix Fietkau 			if (sc->rx.frag) {
13070d95521eSFelix Fietkau 				/* too many fragments - cannot handle frame */
13080d95521eSFelix Fietkau 				dev_kfree_skb_any(sc->rx.frag);
13090d95521eSFelix Fietkau 				dev_kfree_skb_any(skb);
131015072189SBen Greear 				RX_STAT_INC(rx_too_many_frags_err);
13110d95521eSFelix Fietkau 				skb = NULL;
13120d95521eSFelix Fietkau 			}
13130d95521eSFelix Fietkau 			sc->rx.frag = skb;
13140d95521eSFelix Fietkau 			goto requeue;
13150d95521eSFelix Fietkau 		}
13163747c3eeSFelix Fietkau 		if (rs.rs_status & ATH9K_RXERR_CORRUPT_DESC)
13173747c3eeSFelix Fietkau 			goto requeue_drop_frag;
13180d95521eSFelix Fietkau 
13190d95521eSFelix Fietkau 		if (sc->rx.frag) {
13200d95521eSFelix Fietkau 			int space = skb->len - skb_tailroom(hdr_skb);
13210d95521eSFelix Fietkau 
13220d95521eSFelix Fietkau 			if (pskb_expand_head(hdr_skb, 0, space, GFP_ATOMIC) < 0) {
13230d95521eSFelix Fietkau 				dev_kfree_skb(skb);
132415072189SBen Greear 				RX_STAT_INC(rx_oom_err);
13250d95521eSFelix Fietkau 				goto requeue_drop_frag;
13260d95521eSFelix Fietkau 			}
13270d95521eSFelix Fietkau 
1328b5447ff9SEric Dumazet 			sc->rx.frag = NULL;
1329b5447ff9SEric Dumazet 
13300d95521eSFelix Fietkau 			skb_copy_from_linear_data(skb, skb_put(hdr_skb, skb->len),
13310d95521eSFelix Fietkau 						  skb->len);
13320d95521eSFelix Fietkau 			dev_kfree_skb_any(skb);
13330d95521eSFelix Fietkau 			skb = hdr_skb;
13340d95521eSFelix Fietkau 		}
13350d95521eSFelix Fietkau 
1336eb840a80SMohammed Shafi Shajakhan 
1337eb840a80SMohammed Shafi Shajakhan 		if (ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) {
1338eb840a80SMohammed Shafi Shajakhan 
1339203c4805SLuis R. Rodriguez 			/*
1340eb840a80SMohammed Shafi Shajakhan 			 * change the default rx antenna if rx diversity
1341eb840a80SMohammed Shafi Shajakhan 			 * chooses the other antenna 3 times in a row.
1342203c4805SLuis R. Rodriguez 			 */
134329bffa96SFelix Fietkau 			if (sc->rx.defant != rs.rs_antenna) {
1344203c4805SLuis R. Rodriguez 				if (++sc->rx.rxotherant >= 3)
134529bffa96SFelix Fietkau 					ath_setdefantenna(sc, rs.rs_antenna);
1346203c4805SLuis R. Rodriguez 			} else {
1347203c4805SLuis R. Rodriguez 				sc->rx.rxotherant = 0;
1348203c4805SLuis R. Rodriguez 			}
1349203c4805SLuis R. Rodriguez 
1350eb840a80SMohammed Shafi Shajakhan 		}
1351eb840a80SMohammed Shafi Shajakhan 
135266760eacSFelix Fietkau 		if (rxs->flag & RX_FLAG_MMIC_STRIPPED)
135366760eacSFelix Fietkau 			skb_trim(skb, skb->len - 8);
135466760eacSFelix Fietkau 
13558ab2cd09SLuis R. Rodriguez 		spin_lock_irqsave(&sc->sc_pm_lock, flags);
1356aaef24b4SMohammed Shafi Shajakhan 		if ((sc->ps_flags & (PS_WAIT_FOR_BEACON |
13571b04b930SSujith 				     PS_WAIT_FOR_CAB |
1358aaef24b4SMohammed Shafi Shajakhan 				     PS_WAIT_FOR_PSPOLL_DATA)) ||
1359cedc7e3dSMohammed Shafi Shajakhan 		    ath9k_check_auto_sleep(sc))
1360f73c604cSRajkumar Manoharan 			ath_rx_ps(sc, skb, rs.is_mybeacon);
13618ab2cd09SLuis R. Rodriguez 		spin_unlock_irqrestore(&sc->sc_pm_lock, flags);
1362cc65965cSJouni Malinen 
136343c35284SFelix Fietkau 		if ((ah->caps.hw_caps & ATH9K_HW_CAP_ANT_DIV_COMB) && sc->ant_rx == 3)
1364102885a5SVasanthakumar Thiagarajan 			ath_ant_comb_scan(sc, &rs);
1365102885a5SVasanthakumar Thiagarajan 
136621fbbca3SChristian Lamparter 		ath9k_apply_ampdu_details(sc, &rs, rxs);
136721fbbca3SChristian Lamparter 
13687545daf4SFelix Fietkau 		ieee80211_rx(hw, skb);
1369cc65965cSJouni Malinen 
13700d95521eSFelix Fietkau requeue_drop_frag:
13710d95521eSFelix Fietkau 		if (sc->rx.frag) {
13720d95521eSFelix Fietkau 			dev_kfree_skb_any(sc->rx.frag);
13730d95521eSFelix Fietkau 			sc->rx.frag = NULL;
13740d95521eSFelix Fietkau 		}
1375203c4805SLuis R. Rodriguez requeue:
1376b5c80475SFelix Fietkau 		list_add_tail(&bf->list, &sc->rx.rxbuf);
1377a3dc48e8SFelix Fietkau 		if (flush)
1378a3dc48e8SFelix Fietkau 			continue;
1379a3dc48e8SFelix Fietkau 
1380a3dc48e8SFelix Fietkau 		if (edma) {
1381b5c80475SFelix Fietkau 			ath_rx_edma_buf_link(sc, qtype);
1382b5c80475SFelix Fietkau 		} else {
1383203c4805SLuis R. Rodriguez 			ath_rx_buf_link(sc, bf);
138495294973SFelix Fietkau 			ath9k_hw_rxena(ah);
1385b5c80475SFelix Fietkau 		}
1386203c4805SLuis R. Rodriguez 	} while (1);
1387203c4805SLuis R. Rodriguez 
138829ab0b36SRajkumar Manoharan 	if (!(ah->imask & ATH9K_INT_RXEOL)) {
138929ab0b36SRajkumar Manoharan 		ah->imask |= (ATH9K_INT_RXEOL | ATH9K_INT_RXORN);
139072d874c6SFelix Fietkau 		ath9k_hw_set_interrupts(ah);
139129ab0b36SRajkumar Manoharan 	}
139229ab0b36SRajkumar Manoharan 
1393203c4805SLuis R. Rodriguez 	return 0;
1394203c4805SLuis R. Rodriguez }
1395