recv.c 23.7 KB
Newer Older
1
/*
2
 * Copyright (c) 2008-2009 Atheros Communications Inc.
3 4 5 6 7 8 9 10 11 12 13 14 15 16
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

S
Sujith 已提交
17
#include "ath9k.h"
18

19 20 21
static struct ieee80211_hw * ath_get_virt_hw(struct ath_softc *sc,
					     struct ieee80211_hdr *hdr)
{
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37
	struct ieee80211_hw *hw = sc->pri_wiphy->hw;
	int i;

	spin_lock_bh(&sc->wiphy_lock);
	for (i = 0; i < sc->num_sec_wiphy; i++) {
		struct ath_wiphy *aphy = sc->sec_wiphy[i];
		if (aphy == NULL)
			continue;
		if (compare_ether_addr(hdr->addr1, aphy->hw->wiphy->perm_addr)
		    == 0) {
			hw = aphy->hw;
			break;
		}
	}
	spin_unlock_bh(&sc->wiphy_lock);
	return hw;
38 39
}

40 41 42 43 44 45 46 47 48 49
/*
 * Setup and link descriptors.
 *
 * 11N: we can no longer afford to self link the last descriptor.
 * MAC acknowledges BA status as long as it copies frames to host
 * buffer (or rx fifo). This can incorrectly acknowledge packets
 * to a sender if last desc is self-linked.
 */
static void ath_rx_buf_link(struct ath_softc *sc, struct ath_buf *bf)
{
50
	struct ath_hw *ah = sc->sc_ah;
51 52 53 54 55 56
	struct ath_desc *ds;
	struct sk_buff *skb;

	ATH_RXBUF_RESET(bf);

	ds = bf->bf_desc;
S
Sujith 已提交
57
	ds->ds_link = 0; /* link to null */
58 59
	ds->ds_data = bf->bf_buf_addr;

S
Sujith 已提交
60
	/* virtual addr of the beginning of the buffer. */
61
	skb = bf->bf_mpdu;
62
	BUG_ON(skb == NULL);
63 64
	ds->ds_vdata = skb->data;

S
Sujith 已提交
65
	/* setup rx descriptors. The rx.bufsize here tells the harware
66 67
	 * how much data it can DMA to us and that we are prepared
	 * to process */
S
Sujith 已提交
68 69
	ath9k_hw_setuprxdesc(ah, ds,
			     sc->rx.bufsize,
70 71
			     0);

S
Sujith 已提交
72
	if (sc->rx.rxlink == NULL)
73 74
		ath9k_hw_putrxbuf(ah, bf->bf_daddr);
	else
S
Sujith 已提交
75
		*sc->rx.rxlink = bf->bf_daddr;
76

S
Sujith 已提交
77
	sc->rx.rxlink = &ds->ds_link;
78 79 80
	ath9k_hw_rxena(ah);
}

S
Sujith 已提交
81 82 83 84
static void ath_setdefantenna(struct ath_softc *sc, u32 antenna)
{
	/* XXX block beacon interrupts */
	ath9k_hw_setantenna(sc->sc_ah, antenna);
S
Sujith 已提交
85 86
	sc->rx.defant = antenna;
	sc->rx.rxotherant = 0;
S
Sujith 已提交
87 88
}

89
/*
S
Sujith 已提交
90 91 92
 * For Decrypt or Demic errors, we only mark packet status here and always push
 * up the frame up to let mac80211 handle the actual error case, be it no
 * decryption key or real decryption error. This let us keep statistics there.
93
 */
94
static int ath_rx_prepare(struct ieee80211_hw *hw,
95
			  struct sk_buff *skb, struct ath_rx_status *rx_stats,
S
Sujith 已提交
96 97
			  struct ieee80211_rx_status *rx_status, bool *decrypt_error,
			  struct ath_softc *sc)
98
{
S
Sujith 已提交
99 100 101
	struct ieee80211_hdr *hdr;
	u8 ratecode;
	__le16 fc;
102 103 104 105
	struct ieee80211_sta *sta;
	struct ath_node *an;
	int last_rssi = ATH_RSSI_DUMMY_MARKER;

S
Sujith 已提交
106 107 108 109
	hdr = (struct ieee80211_hdr *)skb->data;
	fc = hdr->frame_control;
	memset(rx_status, 0, sizeof(struct ieee80211_rx_status));

110
	if (rx_stats->rs_more) {
S
Sujith 已提交
111 112 113 114 115 116
		/*
		 * Frame spans multiple descriptors; this cannot happen yet
		 * as we don't support jumbograms. If not in monitor mode,
		 * discard the frame. Enable this if you want to see
		 * error frames in Monitor mode.
		 */
117
		if (sc->sc_ah->opmode != NL80211_IFTYPE_MONITOR)
S
Sujith 已提交
118
			goto rx_next;
119 120
	} else if (rx_stats->rs_status != 0) {
		if (rx_stats->rs_status & ATH9K_RXERR_CRC)
S
Sujith 已提交
121
			rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
122
		if (rx_stats->rs_status & ATH9K_RXERR_PHY)
S
Sujith 已提交
123
			goto rx_next;
124

125
		if (rx_stats->rs_status & ATH9K_RXERR_DECRYPT) {
S
Sujith 已提交
126
			*decrypt_error = true;
127
		} else if (rx_stats->rs_status & ATH9K_RXERR_MIC) {
S
Sujith 已提交
128 129 130 131 132 133
			if (ieee80211_is_ctl(fc))
				/*
				 * Sometimes, we get invalid
				 * MIC failures on valid control frames.
				 * Remove these mic errors.
				 */
134
				rx_stats->rs_status &= ~ATH9K_RXERR_MIC;
S
Sujith 已提交
135 136 137 138 139 140 141 142
			else
				rx_status->flag |= RX_FLAG_MMIC_ERROR;
		}
		/*
		 * Reject error frames with the exception of
		 * decryption and MIC failures. For monitor mode,
		 * we also ignore the CRC error.
		 */
143
		if (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR) {
144
			if (rx_stats->rs_status &
S
Sujith 已提交
145 146 147 148
			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC |
			      ATH9K_RXERR_CRC))
				goto rx_next;
		} else {
149
			if (rx_stats->rs_status &
S
Sujith 已提交
150 151 152 153
			    ~(ATH9K_RXERR_DECRYPT | ATH9K_RXERR_MIC)) {
				goto rx_next;
			}
		}
154 155
	}

156
	ratecode = rx_stats->rs_rate;
S
Sujith 已提交
157 158

	if (ratecode & 0x80) {
159 160
		/* HT rate */
		rx_status->flag |= RX_FLAG_HT;
161
		if (rx_stats->rs_flags & ATH9K_RX_2040)
162
			rx_status->flag |= RX_FLAG_40MHZ;
163
		if (rx_stats->rs_flags & ATH9K_RX_GI)
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
			rx_status->flag |= RX_FLAG_SHORT_GI;
		rx_status->rate_idx = ratecode & 0x7f;
	} else {
		int i = 0, cur_band, n_rates;

		cur_band = hw->conf.channel->band;
		n_rates = sc->sbands[cur_band].n_bitrates;

		for (i = 0; i < n_rates; i++) {
			if (sc->sbands[cur_band].bitrates[i].hw_value ==
			    ratecode) {
				rx_status->rate_idx = i;
				break;
			}

			if (sc->sbands[cur_band].bitrates[i].hw_value_short ==
			    ratecode) {
				rx_status->rate_idx = i;
				rx_status->flag |= RX_FLAG_SHORTPRE;
				break;
			}
		}
S
Sujith 已提交
186 187
	}

188
	rcu_read_lock();
189
	/* XXX: use ieee80211_find_sta! */
190
	sta = ieee80211_find_sta_by_hw(hw, hdr->addr2);
191 192
	if (sta) {
		an = (struct ath_node *) sta->drv_priv;
193 194 195
		if (rx_stats->rs_rssi != ATH9K_RSSI_BAD &&
		   !rx_stats->rs_moreaggr)
			ATH_RSSI_LPF(an->last_rssi, rx_stats->rs_rssi);
196 197 198 199 200
		last_rssi = an->last_rssi;
	}
	rcu_read_unlock();

	if (likely(last_rssi != ATH_RSSI_DUMMY_MARKER))
201 202 203 204 205 206
		rx_stats->rs_rssi = ATH_EP_RND(last_rssi,
					      ATH_RSSI_EP_MULTIPLIER);
	if (rx_stats->rs_rssi < 0)
		rx_stats->rs_rssi = 0;
	else if (rx_stats->rs_rssi > 127)
		rx_stats->rs_rssi = 127;
207

S
Sujith 已提交
208 209
	/* Update Beacon RSSI, this is used by ANI. */
	if (ieee80211_is_beacon(fc))
210
		sc->sc_ah->stats.avgbrssi = rx_stats->rs_rssi;
S
Sujith 已提交
211

212
	rx_status->mactime = ath9k_hw_extend_tsf(sc->sc_ah, rx_stats->rs_tstamp);
213 214
	rx_status->band = hw->conf.channel->band;
	rx_status->freq = hw->conf.channel->center_freq;
S
Sujith 已提交
215
	rx_status->noise = sc->ani.noise_floor;
216 217
	rx_status->signal = ATH_DEFAULT_NOISE_FLOOR + rx_stats->rs_rssi;
	rx_status->antenna = rx_stats->rs_antenna;
S
Sujith 已提交
218

219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240
	/*
	 * Theory for reporting quality:
	 *
	 * At a hardware RSSI of 45 you will be able to use MCS 7  reliably.
	 * At a hardware RSSI of 45 you will be able to use MCS 15 reliably.
	 * At a hardware RSSI of 35 you should be able use 54 Mbps reliably.
	 *
	 * MCS 7  is the highets MCS index usable by a 1-stream device.
	 * MCS 15 is the highest MCS index usable by a 2-stream device.
	 *
	 * All ath9k devices are either 1-stream or 2-stream.
	 *
	 * How many bars you see is derived from the qual reporting.
	 *
	 * A more elaborate scheme can be used here but it requires tables
	 * of SNR/throughput for each possible mode used. For the MCS table
	 * you can refer to the wireless wiki:
	 *
	 * http://wireless.kernel.org/en/developers/Documentation/ieee80211/802.11n
	 *
	 */
	if (conf_is_ht(&hw->conf))
241
		rx_status->qual =  rx_stats->rs_rssi * 100 / 45;
242
	else
243
		rx_status->qual =  rx_stats->rs_rssi * 100 / 35;
S
Sujith 已提交
244 245 246 247 248 249 250 251 252 253 254

	/* rssi can be more than 45 though, anything above that
	 * should be considered at 100% */
	if (rx_status->qual > 100)
		rx_status->qual = 100;

	rx_status->flag |= RX_FLAG_TSFT;

	return 1;
rx_next:
	return 0;
255 256 257 258
}

static void ath_opmode_init(struct ath_softc *sc)
{
259
	struct ath_hw *ah = sc->sc_ah;
260 261
	struct ath_common *common = ath9k_hw_common(ah);

262 263 264 265 266 267 268
	u32 rfilt, mfilt[2];

	/* configure rx filter */
	rfilt = ath_calcrxfilter(sc);
	ath9k_hw_setrxfilter(ah, rfilt);

	/* configure bssid mask */
269
	if (ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
270
		ath_hw_setbssidmask(common);
271 272 273 274 275

	/* configure operational mode */
	ath9k_hw_setopmode(ah);

	/* Handle any link-level address change. */
276
	ath9k_hw_setmac(ah, common->macaddr);
277 278 279 280 281 282 283 284

	/* calculate and install multicast filter */
	mfilt[0] = mfilt[1] = ~0;
	ath9k_hw_setmcastfilter(ah, mfilt[0], mfilt[1]);
}

int ath_rx_init(struct ath_softc *sc, int nbufs)
{
285
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
286 287 288 289
	struct sk_buff *skb;
	struct ath_buf *bf;
	int error = 0;

290 291 292
	spin_lock_init(&sc->rx.rxflushlock);
	sc->sc_flags &= ~SC_OP_RXFLUSH;
	spin_lock_init(&sc->rx.rxbuflock);
293

294
	sc->rx.bufsize = roundup(IEEE80211_MAX_MPDU_LEN,
295
				 min(common->cachelsz, (u16)64));
296

297 298
	ath_print(common, ATH_DBG_CONFIG, "cachelsz %u rxbufsize %u\n",
		  common->cachelsz, sc->rx.bufsize);
299

300
	/* Initialize rx descriptors */
301

302 303 304
	error = ath_descdma_setup(sc, &sc->rx.rxdma, &sc->rx.rxbuf,
				  "rx", nbufs, 1);
	if (error != 0) {
305 306
		ath_print(common, ATH_DBG_FATAL,
			  "failed to allocate rx descriptors: %d\n", error);
307 308
		goto err;
	}
309

310
	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
311
		skb = ath_rxbuf_alloc(common, sc->rx.bufsize, GFP_KERNEL);
312 313 314
		if (skb == NULL) {
			error = -ENOMEM;
			goto err;
315 316
		}

317 318 319 320 321 322 323 324
		bf->bf_mpdu = skb;
		bf->bf_buf_addr = dma_map_single(sc->dev, skb->data,
						 sc->rx.bufsize,
						 DMA_FROM_DEVICE);
		if (unlikely(dma_mapping_error(sc->dev,
					       bf->bf_buf_addr))) {
			dev_kfree_skb_any(skb);
			bf->bf_mpdu = NULL;
325 326
			ath_print(common, ATH_DBG_FATAL,
				  "dma_mapping_error() on RX init\n");
327 328 329 330 331 332
			error = -ENOMEM;
			goto err;
		}
		bf->bf_dmacontext = bf->bf_buf_addr;
	}
	sc->rx.rxlink = NULL;
333

334
err:
335 336 337 338 339 340 341 342 343 344 345
	if (error)
		ath_rx_cleanup(sc);

	return error;
}

void ath_rx_cleanup(struct ath_softc *sc)
{
	struct sk_buff *skb;
	struct ath_buf *bf;

S
Sujith 已提交
346
	list_for_each_entry(bf, &sc->rx.rxbuf, list) {
347
		skb = bf->bf_mpdu;
348
		if (skb) {
349 350
			dma_unmap_single(sc->dev, bf->bf_buf_addr,
					 sc->rx.bufsize, DMA_FROM_DEVICE);
351
			dev_kfree_skb(skb);
352
		}
353 354
	}

S
Sujith 已提交
355 356
	if (sc->rx.rxdma.dd_desc_len != 0)
		ath_descdma_cleanup(sc, &sc->rx.rxdma, &sc->rx.rxbuf);
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380
}

/*
 * Calculate the receive filter according to the
 * operating mode and state:
 *
 * o always accept unicast, broadcast, and multicast traffic
 * o maintain current state of phy error reception (the hal
 *   may enable phy error frames for noise immunity work)
 * o probe request frames are accepted only when operating in
 *   hostap, adhoc, or monitor modes
 * o enable promiscuous mode according to the interface state
 * o accept beacons:
 *   - when operating in adhoc mode so the 802.11 layer creates
 *     node table entries for peers,
 *   - when operating in station mode for collecting rssi data when
 *     the station is otherwise quiet, or
 *   - when operating as a repeater so we see repeater-sta beacons
 *   - when scanning
 */

u32 ath_calcrxfilter(struct ath_softc *sc)
{
#define	RX_FILTER_PRESERVE (ATH9K_RX_FILTER_PHYERR | ATH9K_RX_FILTER_PHYRADAR)
S
Sujith 已提交
381

382 383 384 385 386 387 388
	u32 rfilt;

	rfilt = (ath9k_hw_getrxfilter(sc->sc_ah) & RX_FILTER_PRESERVE)
		| ATH9K_RX_FILTER_UCAST | ATH9K_RX_FILTER_BCAST
		| ATH9K_RX_FILTER_MCAST;

	/* If not a STA, enable processing of Probe Requests */
389
	if (sc->sc_ah->opmode != NL80211_IFTYPE_STATION)
390 391
		rfilt |= ATH9K_RX_FILTER_PROBEREQ;

392 393 394 395 396
	/*
	 * Set promiscuous mode when FIF_PROMISC_IN_BSS is enabled for station
	 * mode interface or when in monitor mode. AP mode does not need this
	 * since it receives all in-BSS frames anyway.
	 */
397
	if (((sc->sc_ah->opmode != NL80211_IFTYPE_AP) &&
S
Sujith 已提交
398
	     (sc->rx.rxfilter & FIF_PROMISC_IN_BSS)) ||
399
	    (sc->sc_ah->opmode == NL80211_IFTYPE_MONITOR))
400 401
		rfilt |= ATH9K_RX_FILTER_PROM;

402 403 404
	if (sc->rx.rxfilter & FIF_CONTROL)
		rfilt |= ATH9K_RX_FILTER_CONTROL;

405 406 407 408
	if ((sc->sc_ah->opmode == NL80211_IFTYPE_STATION) &&
	    !(sc->rx.rxfilter & FIF_BCN_PRBRESP_PROMISC))
		rfilt |= ATH9K_RX_FILTER_MYBEACON;
	else
409 410
		rfilt |= ATH9K_RX_FILTER_BEACON;

411 412 413 414
	if ((AR_SREV_9280_10_OR_LATER(sc->sc_ah) ||
	    AR_SREV_9285_10_OR_LATER(sc->sc_ah)) &&
	    (sc->sc_ah->opmode == NL80211_IFTYPE_AP) &&
	    (sc->rx.rxfilter & FIF_PSPOLL))
415
		rfilt |= ATH9K_RX_FILTER_PSPOLL;
S
Sujith 已提交
416

S
Sujith 已提交
417 418 419
	if (conf_is_ht(&sc->hw->conf))
		rfilt |= ATH9K_RX_FILTER_COMP_BAR;

420
	if (sc->sec_wiphy || (sc->rx.rxfilter & FIF_OTHER_BSS)) {
421 422
		/* TODO: only needed if more than one BSSID is in use in
		 * station/adhoc mode */
423 424 425
		/* The following may also be needed for other older chips */
		if (sc->sc_ah->hw_version.macVersion == AR_SREV_VERSION_9160)
			rfilt |= ATH9K_RX_FILTER_PROM;
426 427 428
		rfilt |= ATH9K_RX_FILTER_MCAST_BCAST_ALL;
	}

429
	return rfilt;
S
Sujith 已提交
430

431 432 433 434 435
#undef RX_FILTER_PRESERVE
}

int ath_startrecv(struct ath_softc *sc)
{
436
	struct ath_hw *ah = sc->sc_ah;
437 438
	struct ath_buf *bf, *tbf;

S
Sujith 已提交
439 440
	spin_lock_bh(&sc->rx.rxbuflock);
	if (list_empty(&sc->rx.rxbuf))
441 442
		goto start_recv;

S
Sujith 已提交
443 444
	sc->rx.rxlink = NULL;
	list_for_each_entry_safe(bf, tbf, &sc->rx.rxbuf, list) {
445 446 447 448
		ath_rx_buf_link(sc, bf);
	}

	/* We could have deleted elements so the list may be empty now */
S
Sujith 已提交
449
	if (list_empty(&sc->rx.rxbuf))
450 451
		goto start_recv;

S
Sujith 已提交
452
	bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
453
	ath9k_hw_putrxbuf(ah, bf->bf_daddr);
S
Sujith 已提交
454
	ath9k_hw_rxena(ah);
455 456

start_recv:
S
Sujith 已提交
457
	spin_unlock_bh(&sc->rx.rxbuflock);
S
Sujith 已提交
458 459 460
	ath_opmode_init(sc);
	ath9k_hw_startpcureceive(ah);

461 462 463 464 465
	return 0;
}

bool ath_stoprecv(struct ath_softc *sc)
{
466
	struct ath_hw *ah = sc->sc_ah;
467 468
	bool stopped;

S
Sujith 已提交
469 470 471
	ath9k_hw_stoppcurecv(ah);
	ath9k_hw_setrxfilter(ah, 0);
	stopped = ath9k_hw_stopdmarecv(ah);
S
Sujith 已提交
472
	sc->rx.rxlink = NULL;
S
Sujith 已提交
473

474 475 476 477 478
	return stopped;
}

void ath_flushrecv(struct ath_softc *sc)
{
S
Sujith 已提交
479
	spin_lock_bh(&sc->rx.rxflushlock);
S
Sujith 已提交
480
	sc->sc_flags |= SC_OP_RXFLUSH;
481
	ath_rx_tasklet(sc, 1);
S
Sujith 已提交
482
	sc->sc_flags &= ~SC_OP_RXFLUSH;
S
Sujith 已提交
483
	spin_unlock_bh(&sc->rx.rxflushlock);
484 485
}

486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520
static bool ath_beacon_dtim_pending_cab(struct sk_buff *skb)
{
	/* Check whether the Beacon frame has DTIM indicating buffered bc/mc */
	struct ieee80211_mgmt *mgmt;
	u8 *pos, *end, id, elen;
	struct ieee80211_tim_ie *tim;

	mgmt = (struct ieee80211_mgmt *)skb->data;
	pos = mgmt->u.beacon.variable;
	end = skb->data + skb->len;

	while (pos + 2 < end) {
		id = *pos++;
		elen = *pos++;
		if (pos + elen > end)
			break;

		if (id == WLAN_EID_TIM) {
			if (elen < sizeof(*tim))
				break;
			tim = (struct ieee80211_tim_ie *) pos;
			if (tim->dtim_count != 0)
				break;
			return tim->bitmap_ctrl & 0x01;
		}

		pos += elen;
	}

	return false;
}

static void ath_rx_ps_beacon(struct ath_softc *sc, struct sk_buff *skb)
{
	struct ieee80211_mgmt *mgmt;
521
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
522 523 524 525 526

	if (skb->len < 24 + 8 + 2 + 2)
		return;

	mgmt = (struct ieee80211_mgmt *)skb->data;
527
	if (memcmp(common->curbssid, mgmt->bssid, ETH_ALEN) != 0)
528 529
		return; /* not from our current AP */

530 531
	sc->sc_flags &= ~SC_OP_WAIT_FOR_BEACON;

532 533
	if (sc->sc_flags & SC_OP_BEACON_SYNC) {
		sc->sc_flags &= ~SC_OP_BEACON_SYNC;
534 535 536
		ath_print(common, ATH_DBG_PS,
			  "Reconfigure Beacon timers based on "
			  "timestamp from the AP\n");
537 538 539
		ath_beacon_config(sc, NULL);
	}

540 541 542
	if (ath_beacon_dtim_pending_cab(skb)) {
		/*
		 * Remain awake waiting for buffered broadcast/multicast
543 544 545 546
		 * frames. If the last broadcast/multicast frame is not
		 * received properly, the next beacon frame will work as
		 * a backup trigger for returning into NETWORK SLEEP state,
		 * so we are waiting for it as well.
547
		 */
548 549
		ath_print(common, ATH_DBG_PS, "Received DTIM beacon indicating "
			  "buffered broadcast/multicast frame(s)\n");
550
		sc->sc_flags |= SC_OP_WAIT_FOR_CAB | SC_OP_WAIT_FOR_BEACON;
551 552 553 554 555 556 557 558 559
		return;
	}

	if (sc->sc_flags & SC_OP_WAIT_FOR_CAB) {
		/*
		 * This can happen if a broadcast frame is dropped or the AP
		 * fails to send a frame indicating that all CAB frames have
		 * been delivered.
		 */
560
		sc->sc_flags &= ~SC_OP_WAIT_FOR_CAB;
561 562
		ath_print(common, ATH_DBG_PS,
			  "PS wait for CAB frames timed out\n");
563 564 565 566 567 568
	}
}

static void ath_rx_ps(struct ath_softc *sc, struct sk_buff *skb)
{
	struct ieee80211_hdr *hdr;
569
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
570 571 572 573

	hdr = (struct ieee80211_hdr *)skb->data;

	/* Process Beacon and CAB receive in PS state */
574 575
	if ((sc->sc_flags & SC_OP_WAIT_FOR_BEACON) &&
	    ieee80211_is_beacon(hdr->frame_control))
576 577 578 579 580 581 582 583 584 585
		ath_rx_ps_beacon(sc, skb);
	else if ((sc->sc_flags & SC_OP_WAIT_FOR_CAB) &&
		 (ieee80211_is_data(hdr->frame_control) ||
		  ieee80211_is_action(hdr->frame_control)) &&
		 is_multicast_ether_addr(hdr->addr1) &&
		 !ieee80211_has_moredata(hdr->frame_control)) {
		/*
		 * No more broadcast/multicast frames to be received at this
		 * point.
		 */
586
		sc->sc_flags &= ~SC_OP_WAIT_FOR_CAB;
587 588
		ath_print(common, ATH_DBG_PS,
			  "All PS CAB frames received, back to sleep\n");
589 590 591 592
	} else if ((sc->sc_flags & SC_OP_WAIT_FOR_PSPOLL_DATA) &&
		   !is_multicast_ether_addr(hdr->addr1) &&
		   !ieee80211_has_morefrags(hdr->frame_control)) {
		sc->sc_flags &= ~SC_OP_WAIT_FOR_PSPOLL_DATA;
593 594 595
		ath_print(common, ATH_DBG_PS,
			  "Going back to sleep after having received "
			  "PS-Poll data (0x%x)\n",
596 597 598 599
			sc->sc_flags & (SC_OP_WAIT_FOR_BEACON |
					SC_OP_WAIT_FOR_CAB |
					SC_OP_WAIT_FOR_PSPOLL_DATA |
					SC_OP_WAIT_FOR_TX_ACK));
600 601 602
	}
}

603 604
static void ath_rx_send_to_mac80211(struct ieee80211_hw *hw,
				    struct ath_softc *sc, struct sk_buff *skb,
605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624
				    struct ieee80211_rx_status *rx_status)
{
	struct ieee80211_hdr *hdr;

	hdr = (struct ieee80211_hdr *)skb->data;

	/* Send the frame to mac80211 */
	if (is_multicast_ether_addr(hdr->addr1)) {
		int i;
		/*
		 * Deliver broadcast/multicast frames to all suitable
		 * virtual wiphys.
		 */
		/* TODO: filter based on channel configuration */
		for (i = 0; i < sc->num_sec_wiphy; i++) {
			struct ath_wiphy *aphy = sc->sec_wiphy[i];
			struct sk_buff *nskb;
			if (aphy == NULL)
				continue;
			nskb = skb_copy(skb, GFP_ATOMIC);
625 626 627 628 629
			if (nskb) {
				memcpy(IEEE80211_SKB_RXCB(nskb), rx_status,
					sizeof(*rx_status));
				ieee80211_rx(aphy->hw, nskb);
			}
630
		}
631 632
		memcpy(IEEE80211_SKB_RXCB(skb), rx_status, sizeof(*rx_status));
		ieee80211_rx(sc->hw, skb);
633 634
	} else {
		/* Deliver unicast frames based on receiver address */
635
		memcpy(IEEE80211_SKB_RXCB(skb), rx_status, sizeof(*rx_status));
636
		ieee80211_rx(hw, skb);
637 638 639
	}
}

640 641 642
int ath_rx_tasklet(struct ath_softc *sc, int flush)
{
#define PA2DESC(_sc, _pa)                                               \
S
Sujith 已提交
643 644
	((struct ath_desc *)((caddr_t)(_sc)->rx.rxdma.dd_desc +		\
			     ((_pa) - (_sc)->rx.rxdma.dd_desc_paddr)))
645

S
Sujith 已提交
646
	struct ath_buf *bf;
647
	struct ath_desc *ds;
648
	struct ath_rx_status *rx_stats;
649
	struct sk_buff *skb = NULL, *requeue_skb;
S
Sujith 已提交
650
	struct ieee80211_rx_status rx_status;
651
	struct ath_hw *ah = sc->sc_ah;
652
	struct ath_common *common = ath9k_hw_common(ah);
653 654 655 656 657 658
	/*
	 * The hw can techncically differ from common->hw when using ath9k
	 * virtual wiphy so to account for that we iterate over the active
	 * wiphys and find the appropriate wiphy and therefore hw.
	 */
	struct ieee80211_hw *hw = NULL;
S
Sujith 已提交
659 660 661 662
	struct ieee80211_hdr *hdr;
	int hdrlen, padsize, retval;
	bool decrypt_error = false;
	u8 keyix;
663
	__le16 fc;
S
Sujith 已提交
664

S
Sujith 已提交
665
	spin_lock_bh(&sc->rx.rxbuflock);
666 667 668

	do {
		/* If handling rx interrupt and flush is in progress => exit */
S
Sujith 已提交
669
		if ((sc->sc_flags & SC_OP_RXFLUSH) && (flush == 0))
670 671
			break;

S
Sujith 已提交
672 673
		if (list_empty(&sc->rx.rxbuf)) {
			sc->rx.rxlink = NULL;
674 675 676
			break;
		}

S
Sujith 已提交
677
		bf = list_first_entry(&sc->rx.rxbuf, struct ath_buf, list);
678 679 680 681 682 683 684 685 686 687 688 689 690
		ds = bf->bf_desc;

		/*
		 * Must provide the virtual address of the current
		 * descriptor, the physical address, and the virtual
		 * address of the next descriptor in the h/w chain.
		 * This allows the HAL to look ahead to see if the
		 * hardware is done with a descriptor by checking the
		 * done bit in the following descriptor and the address
		 * of the current descriptor the DMA engine is working
		 * on.  All this is necessary because of our use of
		 * a self-linked list to avoid rx overruns.
		 */
S
Sujith 已提交
691
		retval = ath9k_hw_rxprocdesc(ah, ds,
692 693 694 695 696 697 698
					     bf->bf_daddr,
					     PA2DESC(sc, ds->ds_link),
					     0);
		if (retval == -EINPROGRESS) {
			struct ath_buf *tbf;
			struct ath_desc *tds;

S
Sujith 已提交
699 700
			if (list_is_last(&bf->list, &sc->rx.rxbuf)) {
				sc->rx.rxlink = NULL;
701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717
				break;
			}

			tbf = list_entry(bf->list.next, struct ath_buf, list);

			/*
			 * On some hardware the descriptor status words could
			 * get corrupted, including the done bit. Because of
			 * this, check if the next descriptor's done bit is
			 * set or not.
			 *
			 * If the next descriptor's done bit is set, the current
			 * descriptor has been corrupted. Force s/w to discard
			 * this descriptor and continue...
			 */

			tds = tbf->bf_desc;
S
Sujith 已提交
718 719
			retval = ath9k_hw_rxprocdesc(ah, tds, tbf->bf_daddr,
					     PA2DESC(sc, tds->ds_link), 0);
720 721 722 723 724 725
			if (retval == -EINPROGRESS) {
				break;
			}
		}

		skb = bf->bf_mpdu;
S
Sujith 已提交
726
		if (!skb)
727 728
			continue;

729 730 731 732 733
		/*
		 * Synchronize the DMA transfer with CPU before
		 * 1. accessing the frame
		 * 2. requeueing the same buffer to h/w
		 */
734
		dma_sync_single_for_cpu(sc->dev, bf->bf_buf_addr,
735
				sc->rx.bufsize,
736
				DMA_FROM_DEVICE);
737

738 739
		hdr = (struct ieee80211_hdr *) skb->data;
		hw = ath_get_virt_hw(sc, hdr);
740
		rx_stats = &ds->ds_rxstat;
741

742
		/*
S
Sujith 已提交
743 744
		 * If we're asked to flush receive queue, directly
		 * chain it back at the queue without processing it.
745
		 */
S
Sujith 已提交
746
		if (flush)
747
			goto requeue;
748

749
		if (!rx_stats->rs_datalen)
750
			goto requeue;
751

S
Sujith 已提交
752
		/* The status portion of the descriptor could get corrupted. */
753
		if (sc->rx.bufsize < rx_stats->rs_datalen)
754
			goto requeue;
755

756
		if (!ath_rx_prepare(hw, skb, rx_stats,
757
				    &rx_status, &decrypt_error, sc))
758 759 760 761
			goto requeue;

		/* Ensure we always have an skb to requeue once we are done
		 * processing the current buffer's skb */
762
		requeue_skb = ath_rxbuf_alloc(common, sc->rx.bufsize, GFP_ATOMIC);
763 764 765

		/* If there is no memory we ignore the current RX'd frame,
		 * tell hardware it can give us a new frame using the old
S
Sujith 已提交
766
		 * skb and put it at the tail of the sc->rx.rxbuf list for
767 768 769
		 * processing. */
		if (!requeue_skb)
			goto requeue;
770

771
		/* Unmap the frame */
772
		dma_unmap_single(sc->dev, bf->bf_buf_addr,
S
Sujith 已提交
773
				 sc->rx.bufsize,
774
				 DMA_FROM_DEVICE);
775

776
		skb_put(skb, rx_stats->rs_datalen);
S
Sujith 已提交
777 778 779

		/* see if any padding is done by the hw and remove it */
		hdrlen = ieee80211_get_hdrlen_from_skb(skb);
780
		fc = hdr->frame_control;
S
Sujith 已提交
781

782 783 784 785 786 787 788 789 790 791
		/* The MAC header is padded to have 32-bit boundary if the
		 * packet payload is non-zero. The general calculation for
		 * padsize would take into account odd header lengths:
		 * padsize = (4 - hdrlen % 4) % 4; However, since only
		 * even-length headers are used, padding can only be 0 or 2
		 * bytes and we can optimize this a bit. In addition, we must
		 * not try to remove padding from short control frames that do
		 * not have payload. */
		padsize = hdrlen & 3;
		if (padsize && hdrlen >= 24) {
S
Sujith 已提交
792 793
			memmove(skb->data + padsize, skb->data, hdrlen);
			skb_pull(skb, padsize);
794 795
		}

796
		keyix = rx_stats->rs_keyix;
797

S
Sujith 已提交
798 799
		if (!(keyix == ATH9K_RXKEYIX_INVALID) && !decrypt_error) {
			rx_status.flag |= RX_FLAG_DECRYPTED;
800
		} else if (ieee80211_has_protected(fc)
S
Sujith 已提交
801 802 803
			   && !decrypt_error && skb->len >= hdrlen + 4) {
			keyix = skb->data[hdrlen + 3] >> 6;

S
Sujith 已提交
804
			if (test_bit(keyix, sc->keymap))
S
Sujith 已提交
805 806
				rx_status.flag |= RX_FLAG_DECRYPTED;
		}
807 808
		if (ah->sw_mgmt_crypto &&
		    (rx_status.flag & RX_FLAG_DECRYPTED) &&
809
		    ieee80211_is_mgmt(fc)) {
810 811 812
			/* Use software decrypt for management frames. */
			rx_status.flag &= ~RX_FLAG_DECRYPTED;
		}
S
Sujith 已提交
813

814 815
		/* We will now give hardware our shiny new allocated skb */
		bf->bf_mpdu = requeue_skb;
816
		bf->bf_buf_addr = dma_map_single(sc->dev, requeue_skb->data,
S
Sujith 已提交
817
					 sc->rx.bufsize,
818 819
					 DMA_FROM_DEVICE);
		if (unlikely(dma_mapping_error(sc->dev,
820 821 822
			  bf->bf_buf_addr))) {
			dev_kfree_skb_any(requeue_skb);
			bf->bf_mpdu = NULL;
823 824
			ath_print(common, ATH_DBG_FATAL,
				  "dma_mapping_error() on RX\n");
825
			ath_rx_send_to_mac80211(hw, sc, skb, &rx_status);
826 827
			break;
		}
828
		bf->bf_dmacontext = bf->bf_buf_addr;
829 830 831 832 833

		/*
		 * change the default rx antenna if rx diversity chooses the
		 * other antenna 3 times in a row.
		 */
S
Sujith 已提交
834 835
		if (sc->rx.defant != ds->ds_rxstat.rs_antenna) {
			if (++sc->rx.rxotherant >= 3)
836
				ath_setdefantenna(sc, rx_stats->rs_antenna);
837
		} else {
S
Sujith 已提交
838
			sc->rx.rxotherant = 0;
839
		}
840

841
		if (unlikely(sc->sc_flags & (SC_OP_WAIT_FOR_BEACON |
842
					     SC_OP_WAIT_FOR_CAB |
843
					     SC_OP_WAIT_FOR_PSPOLL_DATA)))
844 845
			ath_rx_ps(sc, skb);

846
		ath_rx_send_to_mac80211(hw, sc, skb, &rx_status);
847

848
requeue:
S
Sujith 已提交
849
		list_move_tail(&bf->list, &sc->rx.rxbuf);
850
		ath_rx_buf_link(sc, bf);
S
Sujith 已提交
851 852
	} while (1);

S
Sujith 已提交
853
	spin_unlock_bh(&sc->rx.rxbuflock);
854 855 856 857

	return 0;
#undef PA2DESC
}