xref: /openbmc/linux/drivers/net/wireless/ath/ath9k/recv.c (revision 203c4805e91786f9a010bc7945a0fde70c9da28e)
1*203c4805SLuis R. Rodriguez /*
2*203c4805SLuis R. Rodriguez  * Copyright (c) 2008-2009 Atheros Communications Inc.
3*203c4805SLuis R. Rodriguez  *
4*203c4805SLuis R. Rodriguez  * Permission to use, copy, modify, and/or distribute this software for any
5*203c4805SLuis R. Rodriguez  * purpose with or without fee is hereby granted, provided that the above
6*203c4805SLuis R. Rodriguez  * copyright notice and this permission notice appear in all copies.
7*203c4805SLuis R. Rodriguez  *
8*203c4805SLuis R. Rodriguez  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9*203c4805SLuis R. Rodriguez  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10*203c4805SLuis R. Rodriguez  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11*203c4805SLuis R. Rodriguez  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12*203c4805SLuis R. Rodriguez  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13*203c4805SLuis R. Rodriguez  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14*203c4805SLuis R. Rodriguez  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15*203c4805SLuis R. Rodriguez  */
16*203c4805SLuis R. Rodriguez 
17*203c4805SLuis R. Rodriguez #include "ath9k.h"
18*203c4805SLuis R. Rodriguez 
19*203c4805SLuis R. Rodriguez static struct ieee80211_hw * ath_get_virt_hw(struct ath_softc *sc,
20*203c4805SLuis R. Rodriguez 					     struct ieee80211_hdr *hdr)
21*203c4805SLuis R. Rodriguez {
22*203c4805SLuis R. Rodriguez 	struct ieee80211_hw *hw = sc->pri_wiphy->hw;
23*203c4805SLuis R. Rodriguez 	int i;
24*203c4805SLuis R. Rodriguez 
25*203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->wiphy_lock);
26*203c4805SLuis R. Rodriguez 	for (i = 0; i < sc->num_sec_wiphy; i++) {
27*203c4805SLuis R. Rodriguez 		struct ath_wiphy *aphy = sc->sec_wiphy[i];
28*203c4805SLuis R. Rodriguez 		if (aphy == NULL)
29*203c4805SLuis R. Rodriguez 			continue;
30*203c4805SLuis R. Rodriguez 		if (compare_ether_addr(hdr->addr1, aphy->hw->wiphy->perm_addr)
31*203c4805SLuis R. Rodriguez 		    == 0) {
32*203c4805SLuis R. Rodriguez 			hw = aphy->hw;
33*203c4805SLuis R. Rodriguez 			break;
34*203c4805SLuis R. Rodriguez 		}
35*203c4805SLuis R. Rodriguez 	}
36*203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->wiphy_lock);
37*203c4805SLuis R. Rodriguez 	return hw;
38*203c4805SLuis R. Rodriguez }
39*203c4805SLuis R. Rodriguez 
40*203c4805SLuis R. Rodriguez /*
41*203c4805SLuis R. Rodriguez  * Setup and link descriptors.
42*203c4805SLuis R. Rodriguez  *
43*203c4805SLuis R. Rodriguez  * 11N: we can no longer afford to self link the last descriptor.
44*203c4805SLuis R. Rodriguez  * MAC acknowledges BA status as long as it copies frames to host
45*203c4805SLuis R. Rodriguez  * buffer (or rx fifo). This can incorrectly acknowledge packets
46*203c4805SLuis R. Rodriguez  * to a sender if last desc is self-linked.
47*203c4805SLuis R. Rodriguez  */
48*203c4805SLuis R. Rodriguez static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf)
49*203c4805SLuis R. Rodriguez {
50*203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
51*203c4805SLuis R. Rodriguez 	struct ath_desc *ds;
52*203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
53*203c4805SLuis R. Rodriguez 
54*203c4805SLuis R. Rodriguez 	ATH_RXBUF_RESET(bf);
55*203c4805SLuis R. Rodriguez 
56*203c4805SLuis R. Rodriguez 	ds = bf->bf_desc;
57*203c4805SLuis R. Rodriguez 	ds->ds_link = 0; /* link to null */
58*203c4805SLuis R. Rodriguez 	ds->ds_data = bf->bf_buf_addr;
59*203c4805SLuis R. Rodriguez 
60*203c4805SLuis R. Rodriguez 	/* virtual addr of the beginning of the buffer. */
61*203c4805SLuis R. Rodriguez 	skb = bf->bf_mpdu;
62*203c4805SLuis R. Rodriguez 	ASSERT(skb != NULL);
63*203c4805SLuis R. Rodriguez 	ds->ds_vdata = skb->data;
64*203c4805SLuis R. Rodriguez 
65*203c4805SLuis R. Rodriguez 	/* setup rx descriptors. The rx.bufsize here tells the harware
66*203c4805SLuis R. Rodriguez 	 * how much data it can DMA to us and that we are prepared
67*203c4805SLuis R. Rodriguez 	 * to process */
68*203c4805SLuis R. Rodriguez 	ath9k_hw_setuprxdesc(ah, ds,
69*203c4805SLuis R. Rodriguez 			     sc->rx.bufsize,
70*203c4805SLuis R. Rodriguez 			     0);
71*203c4805SLuis R. Rodriguez 
72*203c4805SLuis R. Rodriguez 	if (sc->rx.rxlink == NULL)
73*203c4805SLuis R. Rodriguez 		ath9k_hw_putrxbuf(ah, bf->bf_daddr);
74*203c4805SLuis R. Rodriguez 	else
75*203c4805SLuis R. Rodriguez 		*sc->rx.rxlink = bf->bf_daddr;
76*203c4805SLuis R. Rodriguez 
77*203c4805SLuis R. Rodriguez 	sc->rx.rxlink = &ds->ds_link;
78*203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
79*203c4805SLuis R. Rodriguez }
80*203c4805SLuis R. Rodriguez 
81*203c4805SLuis R. Rodriguez static void ath_setdefantenna(struct ath_softc *sc, u32 antenna)
82*203c4805SLuis R. Rodriguez {
83*203c4805SLuis R. Rodriguez 	/* XXX block beacon interrupts */
84*203c4805SLuis R. Rodriguez 	ath9k_hw_setantenna(sc->sc_ah, antenna);
85*203c4805SLuis R. Rodriguez 	sc->rx.defant = antenna;
86*203c4805SLuis R. Rodriguez 	sc->rx.rxotherant = 0;
87*203c4805SLuis R. Rodriguez }
88*203c4805SLuis R. Rodriguez 
89*203c4805SLuis R. Rodriguez /*
90*203c4805SLuis R. Rodriguez  *  Extend 15-bit time stamp from rx descriptor to
91*203c4805SLuis R. Rodriguez  *  a full 64-bit TSF using the current h/w TSF.
92*203c4805SLuis R. Rodriguez */
93*203c4805SLuis R. Rodriguez static u64 ath_extend_tsf(struct ath_softc *sc, u32 rstamp)
94*203c4805SLuis R. Rodriguez {
95*203c4805SLuis R. Rodriguez 	u64 tsf;
96*203c4805SLuis R. Rodriguez 
97*203c4805SLuis R. Rodriguez 	tsf = ath9k_hw_gettsf64(sc->sc_ah);
98*203c4805SLuis R. Rodriguez 	if ((tsf & 0x7fff) < rstamp)
99*203c4805SLuis R. Rodriguez 		tsf -= 0x8000;
100*203c4805SLuis R. Rodriguez 	return (tsf & ~0x7fff) | rstamp;
101*203c4805SLuis R. Rodriguez }
102*203c4805SLuis R. Rodriguez 
103*203c4805SLuis R. Rodriguez static struct sk_buff *ath_rxbuf_alloc(struct ath_softc *sc, u32 len, gfp_t gfp_mask)
104*203c4805SLuis R. Rodriguez {
105*203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
106*203c4805SLuis R. Rodriguez 	u32 off;
107*203c4805SLuis R. Rodriguez 
108*203c4805SLuis R. Rodriguez 	/*
109*203c4805SLuis R. Rodriguez 	 * Cache-line-align.  This is important (for the
110*203c4805SLuis R. Rodriguez 	 * 5210 at least) as not doing so causes bogus data
111*203c4805SLuis R. Rodriguez 	 * in rx'd frames.
112*203c4805SLuis R. Rodriguez 	 */
113*203c4805SLuis R. Rodriguez 
114*203c4805SLuis R. Rodriguez 	/* Note: the kernel can allocate a value greater than
115*203c4805SLuis R. Rodriguez 	 * what we ask it to give us. We really only need 4 KB as that
116*203c4805SLuis R. Rodriguez 	 * is this hardware supports and in fact we need at least 3849
117*203c4805SLuis R. Rodriguez 	 * as that is the MAX AMSDU size this hardware supports.
118*203c4805SLuis R. Rodriguez 	 * Unfortunately this means we may get 8 KB here from the
119*203c4805SLuis R. Rodriguez 	 * kernel... and that is actually what is observed on some
120*203c4805SLuis R. Rodriguez 	 * systems :( */
121*203c4805SLuis R. Rodriguez 	skb = __dev_alloc_skb(len + sc->cachelsz - 1, gfp_mask);
122*203c4805SLuis R. Rodriguez 	if (skb != NULL) {
123*203c4805SLuis R. Rodriguez 		off = ((unsigned long) skb->data) % sc->cachelsz;
124*203c4805SLuis R. Rodriguez 		if (off != 0)
125*203c4805SLuis R. Rodriguez 			skb_reserve(skb, sc->cachelsz - off);
126*203c4805SLuis R. Rodriguez 	} else {
127*203c4805SLuis R. Rodriguez 		DPRINTF(sc, ATH_DBG_FATAL,
128*203c4805SLuis R. Rodriguez 			"skbuff alloc of size %u failed\n", len);
129*203c4805SLuis R. Rodriguez 		return NULL;
130*203c4805SLuis R. Rodriguez 	}
131*203c4805SLuis R. Rodriguez 
132*203c4805SLuis R. Rodriguez 	return skb;
133*203c4805SLuis R. Rodriguez }
134*203c4805SLuis R. Rodriguez 
135*203c4805SLuis R. Rodriguez /*
136*203c4805SLuis R. Rodriguez  * For Decrypt or Demic errors, we only mark packet status here and always push
137*203c4805SLuis R. Rodriguez  * up the frame up to let mac80211 handle the actual error case, be it no
138*203c4805SLuis R. Rodriguez  * decryption key or real decryption error. This let us keep statistics there.
139*203c4805SLuis R. Rodriguez  */
140*203c4805SLuis R. Rodriguez static int ath_rx_prepare(struct sk_buff *skb, struct ath_desc *ds,
141*203c4805SLuis R. Rodriguez 			  struct ieee80211_rx_status *rx_status, bool *decrypt_error,
142*203c4805SLuis R. Rodriguez 			  struct ath_softc *sc)
143*203c4805SLuis R. Rodriguez {
144*203c4805SLuis R. Rodriguez 	struct ieee80211_hdr *hdr;
145*203c4805SLuis R. Rodriguez 	u8 ratecode;
146*203c4805SLuis R. Rodriguez 	__le16 fc;
147*203c4805SLuis R. Rodriguez 	struct ieee80211_hw *hw;
148*203c4805SLuis R. Rodriguez 
149*203c4805SLuis R. Rodriguez 	hdr = (struct ieee80211_hdr *)skb->data;
150*203c4805SLuis R. Rodriguez 	fc = hdr->frame_control;
151*203c4805SLuis R. Rodriguez 	memset(rx_status, 0, sizeof(struct ieee80211_rx_status));
152*203c4805SLuis R. Rodriguez 	hw = ath_get_virt_hw(sc, hdr);
153*203c4805SLuis R. Rodriguez 
154*203c4805SLuis R. Rodriguez 	if (ds->ds_rxstat.rs_more) {
155*203c4805SLuis R. Rodriguez 		/*
156*203c4805SLuis R. Rodriguez 		 * Frame spans multiple descriptors; this cannot happen yet
157*203c4805SLuis R. Rodriguez 		 * as we don't support jumbograms. If not in monitor mode,
158*203c4805SLuis R. Rodriguez 		 * discard the frame. Enable this if you want to see
159*203c4805SLuis R. Rodriguez 		 * error frames in Monitor mode.
160*203c4805SLuis R. Rodriguez 		 */
161*203c4805SLuis R. Rodriguez 		if (sc->sc_ah->opmode != NL80211_IFTYPE_MONITOR)
162*203c4805SLuis R. Rodriguez 			goto rx_next;
163*203c4805SLuis R. Rodriguez 	} else if (ds->ds_rxstat.rs_status != 0) {
164*203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_CRC)
165*203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
166*203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_PHY)
167*203c4805SLuis R. Rodriguez 			goto rx_next;
168*203c4805SLuis R. Rodriguez 
169*203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_status & ATH9K_RXERR_DECRYPT) {
170*203c4805SLuis R. Rodriguez 			*decrypt_error = true;
171*203c4805SLuis R. Rodriguez 		} else if (ds->ds_rxstat.rs_status & ATH9K_RXERR_MIC) {
172*203c4805SLuis R. Rodriguez 			if (ieee80211_is_ctl(fc))
173*203c4805SLuis R. Rodriguez 				/*
174*203c4805SLuis R. Rodriguez 				 * Sometimes, we get invalid
175*203c4805SLuis R. Rodriguez 				 * MIC failures on valid control frames.
176*203c4805SLuis R. Rodriguez 				 * Remove these mic errors.
177*203c4805SLuis R. Rodriguez 				 */
178*203c4805SLuis R. Rodriguez 				ds->ds_rxstat.rs_status &= ~ATH9K_RXERR_MIC;
179*203c4805SLuis R. Rodriguez 			else
180*203c4805SLuis R. Rodriguez 				rx_status->flag |= RX_FLAG_MMIC_ERROR;
181*203c4805SLuis R. Rodriguez 		}
182*203c4805SLuis R. Rodriguez 		/*
183*203c4805SLuis R. Rodriguez 		 * Reject error frames with the exception of
184*203c4805SLuis R. Rodriguez 		 * decryption and MIC failures. For monitor mode,
185*203c4805SLuis R. Rodriguez 		 * we also ignore the CRC error.
186*203c4805SLuis R. Rodriguez 		 */
187*203c4805SLuis R. Rodriguez 		if (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR) {
188*203c4805SLuis R. Rodriguez 			if (ds->ds_rxstat.rs_status &
189*203c4805SLuis R. Rodriguez 			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
190*203c4805SLuis R. Rodriguez 			      ATH9K_RXERR_CRC))
191*203c4805SLuis R. Rodriguez 				goto rx_next;
192*203c4805SLuis R. Rodriguez 		} else {
193*203c4805SLuis R. Rodriguez 			if (ds->ds_rxstat.rs_status &
194*203c4805SLuis R. Rodriguez 			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) {
195*203c4805SLuis R. Rodriguez 				goto rx_next;
196*203c4805SLuis R. Rodriguez 			}
197*203c4805SLuis R. Rodriguez 		}
198*203c4805SLuis R. Rodriguez 	}
199*203c4805SLuis R. Rodriguez 
200*203c4805SLuis R. Rodriguez 	ratecode = ds->ds_rxstat.rs_rate;
201*203c4805SLuis R. Rodriguez 
202*203c4805SLuis R. Rodriguez 	if (ratecode & 0x80) {
203*203c4805SLuis R. Rodriguez 		/* HT rate */
204*203c4805SLuis R. Rodriguez 		rx_status->flag |= RX_FLAG_HT;
205*203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_flags & ATH9K_RX_2040)
206*203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_40MHZ;
207*203c4805SLuis R. Rodriguez 		if (ds->ds_rxstat.rs_flags & ATH9K_RX_GI)
208*203c4805SLuis R. Rodriguez 			rx_status->flag |= RX_FLAG_SHORT_GI;
209*203c4805SLuis R. Rodriguez 		rx_status->rate_idx = ratecode & 0x7f;
210*203c4805SLuis R. Rodriguez 	} else {
211*203c4805SLuis R. Rodriguez 		int i = 0, cur_band, n_rates;
212*203c4805SLuis R. Rodriguez 
213*203c4805SLuis R. Rodriguez 		cur_band = hw->conf.channel->band;
214*203c4805SLuis R. Rodriguez 		n_rates = sc->sbands[cur_band].n_bitrates;
215*203c4805SLuis R. Rodriguez 
216*203c4805SLuis R. Rodriguez 		for (i = 0; i < n_rates; i++) {
217*203c4805SLuis R. Rodriguez 			if (sc->sbands[cur_band].bitrates[i].hw_value ==
218*203c4805SLuis R. Rodriguez 			    ratecode) {
219*203c4805SLuis R. Rodriguez 				rx_status->rate_idx = i;
220*203c4805SLuis R. Rodriguez 				break;
221*203c4805SLuis R. Rodriguez 			}
222*203c4805SLuis R. Rodriguez 
223*203c4805SLuis R. Rodriguez 			if (sc->sbands[cur_band].bitrates[i].hw_value_short ==
224*203c4805SLuis R. Rodriguez 			    ratecode) {
225*203c4805SLuis R. Rodriguez 				rx_status->rate_idx = i;
226*203c4805SLuis R. Rodriguez 				rx_status->flag |= RX_FLAG_SHORTPRE;
227*203c4805SLuis R. Rodriguez 				break;
228*203c4805SLuis R. Rodriguez 			}
229*203c4805SLuis R. Rodriguez 		}
230*203c4805SLuis R. Rodriguez 	}
231*203c4805SLuis R. Rodriguez 
232*203c4805SLuis R. Rodriguez 	rx_status->mactime = ath_extend_tsf(sc, ds->ds_rxstat.rs_tstamp);
233*203c4805SLuis R. Rodriguez 	rx_status->band = hw->conf.channel->band;
234*203c4805SLuis R. Rodriguez 	rx_status->freq = hw->conf.channel->center_freq;
235*203c4805SLuis R. Rodriguez 	rx_status->noise = sc->ani.noise_floor;
236*203c4805SLuis R. Rodriguez 	rx_status->signal = rx_status->noise + ds->ds_rxstat.rs_rssi;
237*203c4805SLuis R. Rodriguez 	rx_status->antenna = ds->ds_rxstat.rs_antenna;
238*203c4805SLuis R. Rodriguez 
239*203c4805SLuis R. Rodriguez 	/* at 45 you will be able to use MCS 15 reliably. A more elaborate
240*203c4805SLuis R. Rodriguez 	 * scheme can be used here but it requires tables of SNR/throughput for
241*203c4805SLuis R. Rodriguez 	 * each possible mode used. */
242*203c4805SLuis R. Rodriguez 	rx_status->qual =  ds->ds_rxstat.rs_rssi * 100 / 45;
243*203c4805SLuis R. Rodriguez 
244*203c4805SLuis R. Rodriguez 	/* rssi can be more than 45 though, anything above that
245*203c4805SLuis R. Rodriguez 	 * should be considered at 100% */
246*203c4805SLuis R. Rodriguez 	if (rx_status->qual > 100)
247*203c4805SLuis R. Rodriguez 		rx_status->qual = 100;
248*203c4805SLuis R. Rodriguez 
249*203c4805SLuis R. Rodriguez 	rx_status->flag |= RX_FLAG_TSFT;
250*203c4805SLuis R. Rodriguez 
251*203c4805SLuis R. Rodriguez 	return 1;
252*203c4805SLuis R. Rodriguez rx_next:
253*203c4805SLuis R. Rodriguez 	return 0;
254*203c4805SLuis R. Rodriguez }
255*203c4805SLuis R. Rodriguez 
256*203c4805SLuis R. Rodriguez static void ath_opmode_init(struct ath_softc *sc)
257*203c4805SLuis R. Rodriguez {
258*203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
259*203c4805SLuis R. Rodriguez 	u32 rfilt, mfilt[2];
260*203c4805SLuis R. Rodriguez 
261*203c4805SLuis R. Rodriguez 	/* configure rx filter */
262*203c4805SLuis R. Rodriguez 	rfilt = ath_calcrxfilter(sc);
263*203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, rfilt);
264*203c4805SLuis R. Rodriguez 
265*203c4805SLuis R. Rodriguez 	/* configure bssid mask */
266*203c4805SLuis R. Rodriguez 	if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
267*203c4805SLuis R. Rodriguez 		ath9k_hw_setbssidmask(sc);
268*203c4805SLuis R. Rodriguez 
269*203c4805SLuis R. Rodriguez 	/* configure operational mode */
270*203c4805SLuis R. Rodriguez 	ath9k_hw_setopmode(ah);
271*203c4805SLuis R. Rodriguez 
272*203c4805SLuis R. Rodriguez 	/* Handle any link-level address change. */
273*203c4805SLuis R. Rodriguez 	ath9k_hw_setmac(ah, sc->sc_ah->macaddr);
274*203c4805SLuis R. Rodriguez 
275*203c4805SLuis R. Rodriguez 	/* calculate and install multicast filter */
276*203c4805SLuis R. Rodriguez 	mfilt[0] = mfilt[1] = ~0;
277*203c4805SLuis R. Rodriguez 	ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]);
278*203c4805SLuis R. Rodriguez }
279*203c4805SLuis R. Rodriguez 
280*203c4805SLuis R. Rodriguez int ath_rx_init(struct ath_softc *sc, int nbufs)
281*203c4805SLuis R. Rodriguez {
282*203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
283*203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
284*203c4805SLuis R. Rodriguez 	int error = 0;
285*203c4805SLuis R. Rodriguez 
286*203c4805SLuis R. Rodriguez 	spin_lock_init(&sc->rx.rxflushlock);
287*203c4805SLuis R. Rodriguez 	sc->sc_flags &= ~SC_OP_RXFLUSH;
288*203c4805SLuis R. Rodriguez 	spin_lock_init(&sc->rx.rxbuflock);
289*203c4805SLuis R. Rodriguez 
290*203c4805SLuis R. Rodriguez 	sc->rx.bufsize = roundup(IEEE80211_MAX_MPDU_LEN,
291*203c4805SLuis R. Rodriguez 				 min(sc->cachelsz, (u16)64));
292*203c4805SLuis R. Rodriguez 
293*203c4805SLuis R. Rodriguez 	DPRINTF(sc, ATH_DBG_CONFIG, "cachelsz %u rxbufsize %u\n",
294*203c4805SLuis R. Rodriguez 		sc->cachelsz, sc->rx.bufsize);
295*203c4805SLuis R. Rodriguez 
296*203c4805SLuis R. Rodriguez 	/* Initialize rx descriptors */
297*203c4805SLuis R. Rodriguez 
298*203c4805SLuis R. Rodriguez 	error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
299*203c4805SLuis R. Rodriguez 				  "rx", nbufs, 1);
300*203c4805SLuis R. Rodriguez 	if (error != 0) {
301*203c4805SLuis R. Rodriguez 		DPRINTF(sc, ATH_DBG_FATAL,
302*203c4805SLuis R. Rodriguez 			"failed to allocate rx descriptors: %d\n", error);
303*203c4805SLuis R. Rodriguez 		goto err;
304*203c4805SLuis R. Rodriguez 	}
305*203c4805SLuis R. Rodriguez 
306*203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
307*203c4805SLuis R. Rodriguez 		skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_KERNEL);
308*203c4805SLuis R. Rodriguez 		if (skb == NULL) {
309*203c4805SLuis R. Rodriguez 			error = -ENOMEM;
310*203c4805SLuis R. Rodriguez 			goto err;
311*203c4805SLuis R. Rodriguez 		}
312*203c4805SLuis R. Rodriguez 
313*203c4805SLuis R. Rodriguez 		bf->bf_mpdu = skb;
314*203c4805SLuis R. Rodriguez 		bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
315*203c4805SLuis R. Rodriguez 						 sc->rx.bufsize,
316*203c4805SLuis R. Rodriguez 						 DMA_FROM_DEVICE);
317*203c4805SLuis R. Rodriguez 		if (unlikely(dma_mapping_error(sc->dev,
318*203c4805SLuis R. Rodriguez 					       bf->bf_buf_addr))) {
319*203c4805SLuis R. Rodriguez 			dev_kfree_skb_any(skb);
320*203c4805SLuis R. Rodriguez 			bf->bf_mpdu = NULL;
321*203c4805SLuis R. Rodriguez 			DPRINTF(sc, ATH_DBG_FATAL,
322*203c4805SLuis R. Rodriguez 				"dma_mapping_error() on RX init\n");
323*203c4805SLuis R. Rodriguez 			error = -ENOMEM;
324*203c4805SLuis R. Rodriguez 			goto err;
325*203c4805SLuis R. Rodriguez 		}
326*203c4805SLuis R. Rodriguez 		bf->bf_dmacontext = bf->bf_buf_addr;
327*203c4805SLuis R. Rodriguez 	}
328*203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
329*203c4805SLuis R. Rodriguez 
330*203c4805SLuis R. Rodriguez err:
331*203c4805SLuis R. Rodriguez 	if (error)
332*203c4805SLuis R. Rodriguez 		ath_rx_cleanup(sc);
333*203c4805SLuis R. Rodriguez 
334*203c4805SLuis R. Rodriguez 	return error;
335*203c4805SLuis R. Rodriguez }
336*203c4805SLuis R. Rodriguez 
337*203c4805SLuis R. Rodriguez void ath_rx_cleanup(struct ath_softc *sc)
338*203c4805SLuis R. Rodriguez {
339*203c4805SLuis R. Rodriguez 	struct sk_buff *skb;
340*203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
341*203c4805SLuis R. Rodriguez 
342*203c4805SLuis R. Rodriguez 	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
343*203c4805SLuis R. Rodriguez 		skb = bf->bf_mpdu;
344*203c4805SLuis R. Rodriguez 		if (skb) {
345*203c4805SLuis R. Rodriguez 			dma_unmap_single(sc->dev, bf->bf_buf_addr,
346*203c4805SLuis R. Rodriguez 					 sc->rx.bufsize, DMA_FROM_DEVICE);
347*203c4805SLuis R. Rodriguez 			dev_kfree_skb(skb);
348*203c4805SLuis R. Rodriguez 		}
349*203c4805SLuis R. Rodriguez 	}
350*203c4805SLuis R. Rodriguez 
351*203c4805SLuis R. Rodriguez 	if (sc->rx.rxdma.dd_desc_len != 0)
352*203c4805SLuis R. Rodriguez 		ath_descdma_cleanup(sc, &sc->rx.rxdma, &sc->rx.rxbuf);
353*203c4805SLuis R. Rodriguez }
354*203c4805SLuis R. Rodriguez 
355*203c4805SLuis R. Rodriguez /*
356*203c4805SLuis R. Rodriguez  * Calculate the receive filter according to the
357*203c4805SLuis R. Rodriguez  * operating mode and state:
358*203c4805SLuis R. Rodriguez  *
359*203c4805SLuis R. Rodriguez  * o always accept unicast, broadcast, and multicast traffic
360*203c4805SLuis R. Rodriguez  * o maintain current state of phy error reception (the hal
361*203c4805SLuis R. Rodriguez  *   may enable phy error frames for noise immunity work)
362*203c4805SLuis R. Rodriguez  * o probe request frames are accepted only when operating in
363*203c4805SLuis R. Rodriguez  *   hostap, adhoc, or monitor modes
364*203c4805SLuis R. Rodriguez  * o enable promiscuous mode according to the interface state
365*203c4805SLuis R. Rodriguez  * o accept beacons:
366*203c4805SLuis R. Rodriguez  *   - when operating in adhoc mode so the 802.11 layer creates
367*203c4805SLuis R. Rodriguez  *     node table entries for peers,
368*203c4805SLuis R. Rodriguez  *   - when operating in station mode for collecting rssi data when
369*203c4805SLuis R. Rodriguez  *     the station is otherwise quiet, or
370*203c4805SLuis R. Rodriguez  *   - when operating as a repeater so we see repeater-sta beacons
371*203c4805SLuis R. Rodriguez  *   - when scanning
372*203c4805SLuis R. Rodriguez  */
373*203c4805SLuis R. Rodriguez 
374*203c4805SLuis R. Rodriguez u32 ath_calcrxfilter(struct ath_softc *sc)
375*203c4805SLuis R. Rodriguez {
376*203c4805SLuis R. Rodriguez #define	RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR)
377*203c4805SLuis R. Rodriguez 
378*203c4805SLuis R. Rodriguez 	u32 rfilt;
379*203c4805SLuis R. Rodriguez 
380*203c4805SLuis R. Rodriguez 	rfilt = (ath9k_hw_getrxfilter(sc->sc_ah) & RX_FILTER_PRESERVE)
381*203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
382*203c4805SLuis R. Rodriguez 		| ATH9K_RX_FILTER_MCAST;
383*203c4805SLuis R. Rodriguez 
384*203c4805SLuis R. Rodriguez 	/* If not a STA, enable processing of Probe Requests */
385*203c4805SLuis R. Rodriguez 	if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
386*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROBEREQ;
387*203c4805SLuis R. Rodriguez 
388*203c4805SLuis R. Rodriguez 	/*
389*203c4805SLuis R. Rodriguez 	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
390*203c4805SLuis R. Rodriguez 	 * mode interface or when in monitor mode. AP mode does not need this
391*203c4805SLuis R. Rodriguez 	 * since it receives all in-BSS frames anyway.
392*203c4805SLuis R. Rodriguez 	 */
393*203c4805SLuis R. Rodriguez 	if (((sc->sc_ah->opmode != NL80211_IFTYPE_AP) &&
394*203c4805SLuis R. Rodriguez 	     (sc->rx.rxfilter & FIF_PROMISC_IN_BSS)) ||
395*203c4805SLuis R. Rodriguez 	    (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR))
396*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PROM;
397*203c4805SLuis R. Rodriguez 
398*203c4805SLuis R. Rodriguez 	if (sc->rx.rxfilter & FIF_CONTROL)
399*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_CONTROL;
400*203c4805SLuis R. Rodriguez 
401*203c4805SLuis R. Rodriguez 	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
402*203c4805SLuis R. Rodriguez 	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
403*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MYBEACON;
404*203c4805SLuis R. Rodriguez 	else
405*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_BEACON;
406*203c4805SLuis R. Rodriguez 
407*203c4805SLuis R. Rodriguez 	/* If in HOSTAP mode, want to enable reception of PSPOLL frames */
408*203c4805SLuis R. Rodriguez 	if (sc->sc_ah->opmode == NL80211_IFTYPE_AP)
409*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_PSPOLL;
410*203c4805SLuis R. Rodriguez 
411*203c4805SLuis R. Rodriguez 	if (sc->sec_wiphy) {
412*203c4805SLuis R. Rodriguez 		/* TODO: only needed if more than one BSSID is in use in
413*203c4805SLuis R. Rodriguez 		 * station/adhoc mode */
414*203c4805SLuis R. Rodriguez 		/* TODO: for older chips, may need to add ATH9K_RX_FILTER_PROM
415*203c4805SLuis R. Rodriguez 		 */
416*203c4805SLuis R. Rodriguez 		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
417*203c4805SLuis R. Rodriguez 	}
418*203c4805SLuis R. Rodriguez 
419*203c4805SLuis R. Rodriguez 	return rfilt;
420*203c4805SLuis R. Rodriguez 
421*203c4805SLuis R. Rodriguez #undef RX_FILTER_PRESERVE
422*203c4805SLuis R. Rodriguez }
423*203c4805SLuis R. Rodriguez 
424*203c4805SLuis R. Rodriguez int ath_startrecv(struct ath_softc *sc)
425*203c4805SLuis R. Rodriguez {
426*203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
427*203c4805SLuis R. Rodriguez 	struct ath_buf *bf, *tbf;
428*203c4805SLuis R. Rodriguez 
429*203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxbuflock);
430*203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
431*203c4805SLuis R. Rodriguez 		goto start_recv;
432*203c4805SLuis R. Rodriguez 
433*203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
434*203c4805SLuis R. Rodriguez 	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
435*203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
436*203c4805SLuis R. Rodriguez 	}
437*203c4805SLuis R. Rodriguez 
438*203c4805SLuis R. Rodriguez 	/* We could have deleted elements so the list may be empty now */
439*203c4805SLuis R. Rodriguez 	if (list_empty(&sc->rx.rxbuf))
440*203c4805SLuis R. Rodriguez 		goto start_recv;
441*203c4805SLuis R. Rodriguez 
442*203c4805SLuis R. Rodriguez 	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
443*203c4805SLuis R. Rodriguez 	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
444*203c4805SLuis R. Rodriguez 	ath9k_hw_rxena(ah);
445*203c4805SLuis R. Rodriguez 
446*203c4805SLuis R. Rodriguez start_recv:
447*203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxbuflock);
448*203c4805SLuis R. Rodriguez 	ath_opmode_init(sc);
449*203c4805SLuis R. Rodriguez 	ath9k_hw_startpcureceive(ah);
450*203c4805SLuis R. Rodriguez 
451*203c4805SLuis R. Rodriguez 	return 0;
452*203c4805SLuis R. Rodriguez }
453*203c4805SLuis R. Rodriguez 
454*203c4805SLuis R. Rodriguez bool ath_stoprecv(struct ath_softc *sc)
455*203c4805SLuis R. Rodriguez {
456*203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
457*203c4805SLuis R. Rodriguez 	bool stopped;
458*203c4805SLuis R. Rodriguez 
459*203c4805SLuis R. Rodriguez 	ath9k_hw_stoppcurecv(ah);
460*203c4805SLuis R. Rodriguez 	ath9k_hw_setrxfilter(ah, 0);
461*203c4805SLuis R. Rodriguez 	stopped = ath9k_hw_stopdmarecv(ah);
462*203c4805SLuis R. Rodriguez 	sc->rx.rxlink = NULL;
463*203c4805SLuis R. Rodriguez 
464*203c4805SLuis R. Rodriguez 	return stopped;
465*203c4805SLuis R. Rodriguez }
466*203c4805SLuis R. Rodriguez 
467*203c4805SLuis R. Rodriguez void ath_flushrecv(struct ath_softc *sc)
468*203c4805SLuis R. Rodriguez {
469*203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxflushlock);
470*203c4805SLuis R. Rodriguez 	sc->sc_flags |= SC_OP_RXFLUSH;
471*203c4805SLuis R. Rodriguez 	ath_rx_tasklet(sc, 1);
472*203c4805SLuis R. Rodriguez 	sc->sc_flags &= ~SC_OP_RXFLUSH;
473*203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxflushlock);
474*203c4805SLuis R. Rodriguez }
475*203c4805SLuis R. Rodriguez 
476*203c4805SLuis R. Rodriguez int ath_rx_tasklet(struct ath_softc *sc, int flush)
477*203c4805SLuis R. Rodriguez {
478*203c4805SLuis R. Rodriguez #define PA2DESC(_sc, _pa)                                               \
479*203c4805SLuis R. Rodriguez 	((struct ath_desc *)((caddr_t)(_sc)->rx.rxdma.dd_desc +		\
480*203c4805SLuis R. Rodriguez 			     ((_pa) - (_sc)->rx.rxdma.dd_desc_paddr)))
481*203c4805SLuis R. Rodriguez 
482*203c4805SLuis R. Rodriguez 	struct ath_buf *bf;
483*203c4805SLuis R. Rodriguez 	struct ath_desc *ds;
484*203c4805SLuis R. Rodriguez 	struct sk_buff *skb = NULL, *requeue_skb;
485*203c4805SLuis R. Rodriguez 	struct ieee80211_rx_status rx_status;
486*203c4805SLuis R. Rodriguez 	struct ath_hw *ah = sc->sc_ah;
487*203c4805SLuis R. Rodriguez 	struct ieee80211_hdr *hdr;
488*203c4805SLuis R. Rodriguez 	int hdrlen, padsize, retval;
489*203c4805SLuis R. Rodriguez 	bool decrypt_error = false;
490*203c4805SLuis R. Rodriguez 	u8 keyix;
491*203c4805SLuis R. Rodriguez 	__le16 fc;
492*203c4805SLuis R. Rodriguez 
493*203c4805SLuis R. Rodriguez 	spin_lock_bh(&sc->rx.rxbuflock);
494*203c4805SLuis R. Rodriguez 
495*203c4805SLuis R. Rodriguez 	do {
496*203c4805SLuis R. Rodriguez 		/* If handling rx interrupt and flush is in progress => exit */
497*203c4805SLuis R. Rodriguez 		if ((sc->sc_flags & SC_OP_RXFLUSH) && (flush == 0))
498*203c4805SLuis R. Rodriguez 			break;
499*203c4805SLuis R. Rodriguez 
500*203c4805SLuis R. Rodriguez 		if (list_empty(&sc->rx.rxbuf)) {
501*203c4805SLuis R. Rodriguez 			sc->rx.rxlink = NULL;
502*203c4805SLuis R. Rodriguez 			break;
503*203c4805SLuis R. Rodriguez 		}
504*203c4805SLuis R. Rodriguez 
505*203c4805SLuis R. Rodriguez 		bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
506*203c4805SLuis R. Rodriguez 		ds = bf->bf_desc;
507*203c4805SLuis R. Rodriguez 
508*203c4805SLuis R. Rodriguez 		/*
509*203c4805SLuis R. Rodriguez 		 * Must provide the virtual address of the current
510*203c4805SLuis R. Rodriguez 		 * descriptor, the physical address, and the virtual
511*203c4805SLuis R. Rodriguez 		 * address of the next descriptor in the h/w chain.
512*203c4805SLuis R. Rodriguez 		 * This allows the HAL to look ahead to see if the
513*203c4805SLuis R. Rodriguez 		 * hardware is done with a descriptor by checking the
514*203c4805SLuis R. Rodriguez 		 * done bit in the following descriptor and the address
515*203c4805SLuis R. Rodriguez 		 * of the current descriptor the DMA engine is working
516*203c4805SLuis R. Rodriguez 		 * on.  All this is necessary because of our use of
517*203c4805SLuis R. Rodriguez 		 * a self-linked list to avoid rx overruns.
518*203c4805SLuis R. Rodriguez 		 */
519*203c4805SLuis R. Rodriguez 		retval = ath9k_hw_rxprocdesc(ah, ds,
520*203c4805SLuis R. Rodriguez 					     bf->bf_daddr,
521*203c4805SLuis R. Rodriguez 					     PA2DESC(sc, ds->ds_link),
522*203c4805SLuis R. Rodriguez 					     0);
523*203c4805SLuis R. Rodriguez 		if (retval == -EINPROGRESS) {
524*203c4805SLuis R. Rodriguez 			struct ath_buf *tbf;
525*203c4805SLuis R. Rodriguez 			struct ath_desc *tds;
526*203c4805SLuis R. Rodriguez 
527*203c4805SLuis R. Rodriguez 			if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
528*203c4805SLuis R. Rodriguez 				sc->rx.rxlink = NULL;
529*203c4805SLuis R. Rodriguez 				break;
530*203c4805SLuis R. Rodriguez 			}
531*203c4805SLuis R. Rodriguez 
532*203c4805SLuis R. Rodriguez 			tbf = list_entry(bf->list.next, struct ath_buf, list);
533*203c4805SLuis R. Rodriguez 
534*203c4805SLuis R. Rodriguez 			/*
535*203c4805SLuis R. Rodriguez 			 * On some hardware the descriptor status words could
536*203c4805SLuis R. Rodriguez 			 * get corrupted, including the done bit. Because of
537*203c4805SLuis R. Rodriguez 			 * this, check if the next descriptor's done bit is
538*203c4805SLuis R. Rodriguez 			 * set or not.
539*203c4805SLuis R. Rodriguez 			 *
540*203c4805SLuis R. Rodriguez 			 * If the next descriptor's done bit is set, the current
541*203c4805SLuis R. Rodriguez 			 * descriptor has been corrupted. Force s/w to discard
542*203c4805SLuis R. Rodriguez 			 * this descriptor and continue...
543*203c4805SLuis R. Rodriguez 			 */
544*203c4805SLuis R. Rodriguez 
545*203c4805SLuis R. Rodriguez 			tds = tbf->bf_desc;
546*203c4805SLuis R. Rodriguez 			retval = ath9k_hw_rxprocdesc(ah, tds, tbf->bf_daddr,
547*203c4805SLuis R. Rodriguez 					     PA2DESC(sc, tds->ds_link), 0);
548*203c4805SLuis R. Rodriguez 			if (retval == -EINPROGRESS) {
549*203c4805SLuis R. Rodriguez 				break;
550*203c4805SLuis R. Rodriguez 			}
551*203c4805SLuis R. Rodriguez 		}
552*203c4805SLuis R. Rodriguez 
553*203c4805SLuis R. Rodriguez 		skb = bf->bf_mpdu;
554*203c4805SLuis R. Rodriguez 		if (!skb)
555*203c4805SLuis R. Rodriguez 			continue;
556*203c4805SLuis R. Rodriguez 
557*203c4805SLuis R. Rodriguez 		/*
558*203c4805SLuis R. Rodriguez 		 * Synchronize the DMA transfer with CPU before
559*203c4805SLuis R. Rodriguez 		 * 1. accessing the frame
560*203c4805SLuis R. Rodriguez 		 * 2. requeueing the same buffer to h/w
561*203c4805SLuis R. Rodriguez 		 */
562*203c4805SLuis R. Rodriguez 		dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
563*203c4805SLuis R. Rodriguez 				sc->rx.bufsize,
564*203c4805SLuis R. Rodriguez 				DMA_FROM_DEVICE);
565*203c4805SLuis R. Rodriguez 
566*203c4805SLuis R. Rodriguez 		/*
567*203c4805SLuis R. Rodriguez 		 * If we're asked to flush receive queue, directly
568*203c4805SLuis R. Rodriguez 		 * chain it back at the queue without processing it.
569*203c4805SLuis R. Rodriguez 		 */
570*203c4805SLuis R. Rodriguez 		if (flush)
571*203c4805SLuis R. Rodriguez 			goto requeue;
572*203c4805SLuis R. Rodriguez 
573*203c4805SLuis R. Rodriguez 		if (!ds->ds_rxstat.rs_datalen)
574*203c4805SLuis R. Rodriguez 			goto requeue;
575*203c4805SLuis R. Rodriguez 
576*203c4805SLuis R. Rodriguez 		/* The status portion of the descriptor could get corrupted. */
577*203c4805SLuis R. Rodriguez 		if (sc->rx.bufsize < ds->ds_rxstat.rs_datalen)
578*203c4805SLuis R. Rodriguez 			goto requeue;
579*203c4805SLuis R. Rodriguez 
580*203c4805SLuis R. Rodriguez 		if (!ath_rx_prepare(skb, ds, &rx_status, &decrypt_error, sc))
581*203c4805SLuis R. Rodriguez 			goto requeue;
582*203c4805SLuis R. Rodriguez 
583*203c4805SLuis R. Rodriguez 		/* Ensure we always have an skb to requeue once we are done
584*203c4805SLuis R. Rodriguez 		 * processing the current buffer's skb */
585*203c4805SLuis R. Rodriguez 		requeue_skb = ath_rxbuf_alloc(sc, sc->rx.bufsize, GFP_ATOMIC);
586*203c4805SLuis R. Rodriguez 
587*203c4805SLuis R. Rodriguez 		/* If there is no memory we ignore the current RX'd frame,
588*203c4805SLuis R. Rodriguez 		 * tell hardware it can give us a new frame using the old
589*203c4805SLuis R. Rodriguez 		 * skb and put it at the tail of the sc->rx.rxbuf list for
590*203c4805SLuis R. Rodriguez 		 * processing. */
591*203c4805SLuis R. Rodriguez 		if (!requeue_skb)
592*203c4805SLuis R. Rodriguez 			goto requeue;
593*203c4805SLuis R. Rodriguez 
594*203c4805SLuis R. Rodriguez 		/* Unmap the frame */
595*203c4805SLuis R. Rodriguez 		dma_unmap_single(sc->dev, bf->bf_buf_addr,
596*203c4805SLuis R. Rodriguez 				 sc->rx.bufsize,
597*203c4805SLuis R. Rodriguez 				 DMA_FROM_DEVICE);
598*203c4805SLuis R. Rodriguez 
599*203c4805SLuis R. Rodriguez 		skb_put(skb, ds->ds_rxstat.rs_datalen);
600*203c4805SLuis R. Rodriguez 		skb->protocol = cpu_to_be16(ETH_P_CONTROL);
601*203c4805SLuis R. Rodriguez 
602*203c4805SLuis R. Rodriguez 		/* see if any padding is done by the hw and remove it */
603*203c4805SLuis R. Rodriguez 		hdr = (struct ieee80211_hdr *)skb->data;
604*203c4805SLuis R. Rodriguez 		hdrlen = ieee80211_get_hdrlen_from_skb(skb);
605*203c4805SLuis R. Rodriguez 		fc = hdr->frame_control;
606*203c4805SLuis R. Rodriguez 
607*203c4805SLuis R. Rodriguez 		/* The MAC header is padded to have 32-bit boundary if the
608*203c4805SLuis R. Rodriguez 		 * packet payload is non-zero. The general calculation for
609*203c4805SLuis R. Rodriguez 		 * padsize would take into account odd header lengths:
610*203c4805SLuis R. Rodriguez 		 * padsize = (4 - hdrlen % 4) % 4; However, since only
611*203c4805SLuis R. Rodriguez 		 * even-length headers are used, padding can only be 0 or 2
612*203c4805SLuis R. Rodriguez 		 * bytes and we can optimize this a bit. In addition, we must
613*203c4805SLuis R. Rodriguez 		 * not try to remove padding from short control frames that do
614*203c4805SLuis R. Rodriguez 		 * not have payload. */
615*203c4805SLuis R. Rodriguez 		padsize = hdrlen & 3;
616*203c4805SLuis R. Rodriguez 		if (padsize && hdrlen >= 24) {
617*203c4805SLuis R. Rodriguez 			memmove(skb->data + padsize, skb->data, hdrlen);
618*203c4805SLuis R. Rodriguez 			skb_pull(skb, padsize);
619*203c4805SLuis R. Rodriguez 		}
620*203c4805SLuis R. Rodriguez 
621*203c4805SLuis R. Rodriguez 		keyix = ds->ds_rxstat.rs_keyix;
622*203c4805SLuis R. Rodriguez 
623*203c4805SLuis R. Rodriguez 		if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error) {
624*203c4805SLuis R. Rodriguez 			rx_status.flag |= RX_FLAG_DECRYPTED;
625*203c4805SLuis R. Rodriguez 		} else if ((le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_PROTECTED)
626*203c4805SLuis R. Rodriguez 			   && !decrypt_error && skb->len >= hdrlen + 4) {
627*203c4805SLuis R. Rodriguez 			keyix = skb->data[hdrlen + 3] >> 6;
628*203c4805SLuis R. Rodriguez 
629*203c4805SLuis R. Rodriguez 			if (test_bit(keyix, sc->keymap))
630*203c4805SLuis R. Rodriguez 				rx_status.flag |= RX_FLAG_DECRYPTED;
631*203c4805SLuis R. Rodriguez 		}
632*203c4805SLuis R. Rodriguez 		if (ah->sw_mgmt_crypto &&
633*203c4805SLuis R. Rodriguez 		    (rx_status.flag & RX_FLAG_DECRYPTED) &&
634*203c4805SLuis R. Rodriguez 		    ieee80211_is_mgmt(hdr->frame_control)) {
635*203c4805SLuis R. Rodriguez 			/* Use software decrypt for management frames. */
636*203c4805SLuis R. Rodriguez 			rx_status.flag &= ~RX_FLAG_DECRYPTED;
637*203c4805SLuis R. Rodriguez 		}
638*203c4805SLuis R. Rodriguez 
639*203c4805SLuis R. Rodriguez 		/* Send the frame to mac80211 */
640*203c4805SLuis R. Rodriguez 		if (hdr->addr1[5] & 0x01) {
641*203c4805SLuis R. Rodriguez 			int i;
642*203c4805SLuis R. Rodriguez 			/*
643*203c4805SLuis R. Rodriguez 			 * Deliver broadcast/multicast frames to all suitable
644*203c4805SLuis R. Rodriguez 			 * virtual wiphys.
645*203c4805SLuis R. Rodriguez 			 */
646*203c4805SLuis R. Rodriguez 			/* TODO: filter based on channel configuration */
647*203c4805SLuis R. Rodriguez 			for (i = 0; i < sc->num_sec_wiphy; i++) {
648*203c4805SLuis R. Rodriguez 				struct ath_wiphy *aphy = sc->sec_wiphy[i];
649*203c4805SLuis R. Rodriguez 				struct sk_buff *nskb;
650*203c4805SLuis R. Rodriguez 				if (aphy == NULL)
651*203c4805SLuis R. Rodriguez 					continue;
652*203c4805SLuis R. Rodriguez 				nskb = skb_copy(skb, GFP_ATOMIC);
653*203c4805SLuis R. Rodriguez 				if (nskb)
654*203c4805SLuis R. Rodriguez 					__ieee80211_rx(aphy->hw, nskb,
655*203c4805SLuis R. Rodriguez 						       &rx_status);
656*203c4805SLuis R. Rodriguez 			}
657*203c4805SLuis R. Rodriguez 			__ieee80211_rx(sc->hw, skb, &rx_status);
658*203c4805SLuis R. Rodriguez 		} else {
659*203c4805SLuis R. Rodriguez 			/* Deliver unicast frames based on receiver address */
660*203c4805SLuis R. Rodriguez 			__ieee80211_rx(ath_get_virt_hw(sc, hdr), skb,
661*203c4805SLuis R. Rodriguez 				       &rx_status);
662*203c4805SLuis R. Rodriguez 		}
663*203c4805SLuis R. Rodriguez 
664*203c4805SLuis R. Rodriguez 		/* We will now give hardware our shiny new allocated skb */
665*203c4805SLuis R. Rodriguez 		bf->bf_mpdu = requeue_skb;
666*203c4805SLuis R. Rodriguez 		bf->bf_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
667*203c4805SLuis R. Rodriguez 					 sc->rx.bufsize,
668*203c4805SLuis R. Rodriguez 					 DMA_FROM_DEVICE);
669*203c4805SLuis R. Rodriguez 		if (unlikely(dma_mapping_error(sc->dev,
670*203c4805SLuis R. Rodriguez 			  bf->bf_buf_addr))) {
671*203c4805SLuis R. Rodriguez 			dev_kfree_skb_any(requeue_skb);
672*203c4805SLuis R. Rodriguez 			bf->bf_mpdu = NULL;
673*203c4805SLuis R. Rodriguez 			DPRINTF(sc, ATH_DBG_FATAL,
674*203c4805SLuis R. Rodriguez 				"dma_mapping_error() on RX\n");
675*203c4805SLuis R. Rodriguez 			break;
676*203c4805SLuis R. Rodriguez 		}
677*203c4805SLuis R. Rodriguez 		bf->bf_dmacontext = bf->bf_buf_addr;
678*203c4805SLuis R. Rodriguez 
679*203c4805SLuis R. Rodriguez 		/*
680*203c4805SLuis R. Rodriguez 		 * change the default rx antenna if rx diversity chooses the
681*203c4805SLuis R. Rodriguez 		 * other antenna 3 times in a row.
682*203c4805SLuis R. Rodriguez 		 */
683*203c4805SLuis R. Rodriguez 		if (sc->rx.defant != ds->ds_rxstat.rs_antenna) {
684*203c4805SLuis R. Rodriguez 			if (++sc->rx.rxotherant >= 3)
685*203c4805SLuis R. Rodriguez 				ath_setdefantenna(sc, ds->ds_rxstat.rs_antenna);
686*203c4805SLuis R. Rodriguez 		} else {
687*203c4805SLuis R. Rodriguez 			sc->rx.rxotherant = 0;
688*203c4805SLuis R. Rodriguez 		}
689*203c4805SLuis R. Rodriguez 
690*203c4805SLuis R. Rodriguez 		if (ieee80211_is_beacon(fc) &&
691*203c4805SLuis R. Rodriguez 				(sc->sc_flags & SC_OP_WAIT_FOR_BEACON)) {
692*203c4805SLuis R. Rodriguez 			sc->sc_flags &= ~SC_OP_WAIT_FOR_BEACON;
693*203c4805SLuis R. Rodriguez 			ath9k_hw_setpower(sc->sc_ah, ATH9K_PM_NETWORK_SLEEP);
694*203c4805SLuis R. Rodriguez 		}
695*203c4805SLuis R. Rodriguez requeue:
696*203c4805SLuis R. Rodriguez 		list_move_tail(&bf->list, &sc->rx.rxbuf);
697*203c4805SLuis R. Rodriguez 		ath_rx_buf_link(sc, bf);
698*203c4805SLuis R. Rodriguez 	} while (1);
699*203c4805SLuis R. Rodriguez 
700*203c4805SLuis R. Rodriguez 	spin_unlock_bh(&sc->rx.rxbuflock);
701*203c4805SLuis R. Rodriguez 
702*203c4805SLuis R. Rodriguez 	return 0;
703*203c4805SLuis R. Rodriguez #undef PA2DESC
704*203c4805SLuis R. Rodriguez }
705