txrx.c 55.3 KB
Newer Older
1
/*
2
 * Copyright (c) 2012-2016 Qualcomm Atheros, Inc.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
 *
 * 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.
 */

#include <linux/etherdevice.h>
#include <net/ieee80211_radiotap.h>
#include <linux/if_arp.h>
#include <linux/moduleparam.h>
21 22 23
#include <linux/ip.h>
#include <linux/ipv6.h>
#include <net/ipv6.h>
24
#include <linux/prefetch.h>
25 26 27 28

#include "wil6210.h"
#include "wmi.h"
#include "txrx.h"
V
Vladimir Kondratiev 已提交
29
#include "trace.h"
30 31 32 33 34 35

static bool rtap_include_phy_info;
module_param(rtap_include_phy_info, bool, S_IRUGO);
MODULE_PARM_DESC(rtap_include_phy_info,
		 " Include PHY info in the radiotap header, default - no");

36 37 38 39 40 41 42 43 44
bool rx_align_2;
module_param(rx_align_2, bool, S_IRUGO);
MODULE_PARM_DESC(rx_align_2, " align Rx buffers on 4*n+2, default - no");

static inline uint wil_rx_snaplen(void)
{
	return rx_align_2 ? 6 : 0;
}

45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63
static inline int wil_vring_is_empty(struct vring *vring)
{
	return vring->swhead == vring->swtail;
}

static inline u32 wil_vring_next_tail(struct vring *vring)
{
	return (vring->swtail + 1) % vring->size;
}

static inline void wil_vring_advance_head(struct vring *vring, int n)
{
	vring->swhead = (vring->swhead + n) % vring->size;
}

static inline int wil_vring_is_full(struct vring *vring)
{
	return wil_vring_next_tail(vring) == vring->swhead;
}
64

65 66
/* Used space in Tx Vring */
static inline int wil_vring_used_tx(struct vring *vring)
67 68 69
{
	u32 swhead = vring->swhead;
	u32 swtail = vring->swtail;
70 71
	return (vring->size + swhead - swtail) % vring->size;
}
72

73 74 75 76
/* Available space in Tx Vring */
static inline int wil_vring_avail_tx(struct vring *vring)
{
	return vring->size - wil_vring_used_tx(vring) - 1;
77 78
}

79
/* wil_vring_wmark_low - low watermark for available descriptor space */
80 81 82 83 84
static inline int wil_vring_wmark_low(struct vring *vring)
{
	return vring->size/8;
}

85
/* wil_vring_wmark_high - high watermark for available descriptor space */
86 87 88 89 90
static inline int wil_vring_wmark_high(struct vring *vring)
{
	return vring->size/4;
}

D
Dedy Lansky 已提交
91 92 93 94 95 96 97 98 99 100 101 102
/* returns true if num avail descriptors is lower than wmark_low */
static inline int wil_vring_avail_low(struct vring *vring)
{
	return wil_vring_avail_tx(vring) < wil_vring_wmark_low(vring);
}

/* returns true if num avail descriptors is higher than wmark_high */
static inline int wil_vring_avail_high(struct vring *vring)
{
	return wil_vring_avail_tx(vring) > wil_vring_wmark_high(vring);
}

103 104 105 106 107 108
/* wil_val_in_range - check if value in [min,max) */
static inline bool wil_val_in_range(int val, int min, int max)
{
	return val >= min && val < max;
}

109 110 111 112 113 114
static int wil_vring_alloc(struct wil6210_priv *wil, struct vring *vring)
{
	struct device *dev = wil_to_dev(wil);
	size_t sz = vring->size * sizeof(vring->va[0]);
	uint i;

115 116
	wil_dbg_misc(wil, "%s()\n", __func__);

117 118 119 120
	BUILD_BUG_ON(sizeof(vring->va[0]) != 32);

	vring->swhead = 0;
	vring->swtail = 0;
121
	vring->ctx = kcalloc(vring->size, sizeof(vring->ctx[0]), GFP_KERNEL);
122 123 124 125
	if (!vring->ctx) {
		vring->va = NULL;
		return -ENOMEM;
	}
126
	/* vring->va should be aligned on its size rounded up to power of 2
127 128 129 130 131 132 133 134 135 136 137 138 139
	 * This is granted by the dma_alloc_coherent
	 */
	vring->va = dma_alloc_coherent(dev, sz, &vring->pa, GFP_KERNEL);
	if (!vring->va) {
		kfree(vring->ctx);
		vring->ctx = NULL;
		return -ENOMEM;
	}
	/* initially, all descriptors are SW owned
	 * For Tx and Rx, ownership bit is at the same location, thus
	 * we can use any
	 */
	for (i = 0; i < vring->size; i++) {
140 141
		volatile struct vring_tx_desc *_d = &vring->va[i].tx;

142
		_d->dma.status = TX_DMA_STATUS_DU;
143 144
	}

145 146
	wil_dbg_misc(wil, "vring[%d] 0x%p:%pad 0x%p\n", vring->size,
		     vring->va, &vring->pa, vring->ctx);
147 148 149 150

	return 0;
}

151 152 153 154 155
static void wil_txdesc_unmap(struct device *dev, struct vring_tx_desc *d,
			     struct wil_ctx *ctx)
{
	dma_addr_t pa = wil_desc_addr(&d->dma.addr);
	u16 dmalen = le16_to_cpu(d->dma.length);
156

157 158 159 160 161 162 163 164 165 166 167 168
	switch (ctx->mapped_as) {
	case wil_mapped_as_single:
		dma_unmap_single(dev, pa, dmalen, DMA_TO_DEVICE);
		break;
	case wil_mapped_as_page:
		dma_unmap_page(dev, pa, dmalen, DMA_TO_DEVICE);
		break;
	default:
		break;
	}
}

169 170 171 172 173 174
static void wil_vring_free(struct wil6210_priv *wil, struct vring *vring,
			   int tx)
{
	struct device *dev = wil_to_dev(wil);
	size_t sz = vring->size * sizeof(vring->va[0]);

175
	lockdep_assert_held(&wil->mutex);
176 177 178 179 180 181 182 183 184 185 186 187
	if (tx) {
		int vring_index = vring - wil->vring_tx;

		wil_dbg_misc(wil, "free Tx vring %d [%d] 0x%p:%pad 0x%p\n",
			     vring_index, vring->size, vring->va,
			     &vring->pa, vring->ctx);
	} else {
		wil_dbg_misc(wil, "free Rx vring [%d] 0x%p:%pad 0x%p\n",
			     vring->size, vring->va,
			     &vring->pa, vring->ctx);
	}

188
	while (!wil_vring_is_empty(vring)) {
189
		dma_addr_t pa;
190
		u16 dmalen;
191
		struct wil_ctx *ctx;
192

193
		if (tx) {
194 195
			struct vring_tx_desc dd, *d = &dd;
			volatile struct vring_tx_desc *_d =
196
					&vring->va[vring->swtail].tx;
197

198
			ctx = &vring->ctx[vring->swtail];
199 200 201 202 203 204 205
			if (!ctx) {
				wil_dbg_txrx(wil,
					     "ctx(%d) was already completed\n",
					     vring->swtail);
				vring->swtail = wil_vring_next_tail(vring);
				continue;
			}
206
			*d = *_d;
207
			wil_txdesc_unmap(dev, d, ctx);
208 209
			if (ctx->skb)
				dev_kfree_skb_any(ctx->skb);
210 211
			vring->swtail = wil_vring_next_tail(vring);
		} else { /* rx */
212 213
			struct vring_rx_desc dd, *d = &dd;
			volatile struct vring_rx_desc *_d =
214
					&vring->va[vring->swhead].rx;
215

216
			ctx = &vring->ctx[vring->swhead];
217 218
			*d = *_d;
			pa = wil_desc_addr(&d->dma.addr);
219 220
			dmalen = le16_to_cpu(d->dma.length);
			dma_unmap_single(dev, pa, dmalen, DMA_FROM_DEVICE);
221
			kfree_skb(ctx->skb);
222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240
			wil_vring_advance_head(vring, 1);
		}
	}
	dma_free_coherent(dev, sz, (void *)vring->va, vring->pa);
	kfree(vring->ctx);
	vring->pa = 0;
	vring->va = NULL;
	vring->ctx = NULL;
}

/**
 * Allocate one skb for Rx VRING
 *
 * Safe to call from IRQ
 */
static int wil_vring_alloc_skb(struct wil6210_priv *wil, struct vring *vring,
			       u32 i, int headroom)
{
	struct device *dev = wil_to_dev(wil);
241
	unsigned int sz = mtu_max + ETH_HLEN + wil_rx_snaplen();
242
	struct vring_rx_desc dd, *d = &dd;
243
	volatile struct vring_rx_desc *_d = &vring->va[i].rx;
244 245
	dma_addr_t pa;
	struct sk_buff *skb = dev_alloc_skb(sz + headroom);
246

247 248 249 250 251 252 253 254 255 256 257 258
	if (unlikely(!skb))
		return -ENOMEM;

	skb_reserve(skb, headroom);
	skb_put(skb, sz);

	pa = dma_map_single(dev, skb->data, skb->len, DMA_FROM_DEVICE);
	if (unlikely(dma_mapping_error(dev, pa))) {
		kfree_skb(skb);
		return -ENOMEM;
	}

259
	d->dma.d0 = RX_DMA_D0_CMD_DMA_RT | RX_DMA_D0_CMD_DMA_IT;
260
	wil_desc_addr_set(&d->dma.addr, pa);
261 262 263 264
	/* ip_length don't care */
	/* b11 don't care */
	/* error don't care */
	d->dma.status = 0; /* BIT(0) should be 0 for HW_OWNED */
265
	d->dma.length = cpu_to_le16(sz);
266
	*_d = *d;
267
	vring->ctx[i].skb = skb;
268 269 270 271 272 273 274 275 276 277 278 279 280 281

	return 0;
}

/**
 * Adds radiotap header
 *
 * Any error indicated as "Bad FCS"
 *
 * Vendor data for 04:ce:14-1 (Wilocity-1) consists of:
 *  - Rx descriptor: 32 bytes
 *  - Phy info
 */
static void wil_rx_add_radiotap_header(struct wil6210_priv *wil,
282
				       struct sk_buff *skb)
283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
{
	struct wireless_dev *wdev = wil->wdev;
	struct wil6210_rtap {
		struct ieee80211_radiotap_header rthdr;
		/* fields should be in the order of bits in rthdr.it_present */
		/* flags */
		u8 flags;
		/* channel */
		__le16 chnl_freq __aligned(2);
		__le16 chnl_flags;
		/* MCS */
		u8 mcs_present;
		u8 mcs_flags;
		u8 mcs_index;
	} __packed;
	struct wil6210_rtap_vendor {
		struct wil6210_rtap rtap;
		/* vendor */
		u8 vendor_oui[3] __aligned(2);
		u8 vendor_ns;
		__le16 vendor_skip;
		u8 vendor_data[0];
	} __packed;
306
	struct vring_rx_desc *d = wil_skb_rxdesc(skb);
307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324
	struct wil6210_rtap_vendor *rtap_vendor;
	int rtap_len = sizeof(struct wil6210_rtap);
	int phy_length = 0; /* phy info header size, bytes */
	static char phy_data[128];
	struct ieee80211_channel *ch = wdev->preset_chandef.chan;

	if (rtap_include_phy_info) {
		rtap_len = sizeof(*rtap_vendor) + sizeof(*d);
		/* calculate additional length */
		if (d->dma.status & RX_DMA_STATUS_PHY_INFO) {
			/**
			 * PHY info starts from 8-byte boundary
			 * there are 8-byte lines, last line may be partially
			 * written (HW bug), thus FW configures for last line
			 * to be excessive. Driver skips this last line.
			 */
			int len = min_t(int, 8 + sizeof(phy_data),
					wil_rxdesc_phy_length(d));
325

326 327 328
			if (len > 8) {
				void *p = skb_tail_pointer(skb);
				void *pa = PTR_ALIGN(p, 8);
329

330 331 332 333 334 335 336 337 338 339 340
				if (skb_tailroom(skb) >= len + (pa - p)) {
					phy_length = len - 8;
					memcpy(phy_data, pa, phy_length);
				}
			}
		}
		rtap_len += phy_length;
	}

	if (skb_headroom(skb) < rtap_len &&
	    pskb_expand_head(skb, rtap_len, 0, GFP_ATOMIC)) {
341
		wil_err(wil, "Unable to expand headroom to %d\n", rtap_len);
342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380
		return;
	}

	rtap_vendor = (void *)skb_push(skb, rtap_len);
	memset(rtap_vendor, 0, rtap_len);

	rtap_vendor->rtap.rthdr.it_version = PKTHDR_RADIOTAP_VERSION;
	rtap_vendor->rtap.rthdr.it_len = cpu_to_le16(rtap_len);
	rtap_vendor->rtap.rthdr.it_present = cpu_to_le32(
			(1 << IEEE80211_RADIOTAP_FLAGS) |
			(1 << IEEE80211_RADIOTAP_CHANNEL) |
			(1 << IEEE80211_RADIOTAP_MCS));
	if (d->dma.status & RX_DMA_STATUS_ERROR)
		rtap_vendor->rtap.flags |= IEEE80211_RADIOTAP_F_BADFCS;

	rtap_vendor->rtap.chnl_freq = cpu_to_le16(ch ? ch->center_freq : 58320);
	rtap_vendor->rtap.chnl_flags = cpu_to_le16(0);

	rtap_vendor->rtap.mcs_present = IEEE80211_RADIOTAP_MCS_HAVE_MCS;
	rtap_vendor->rtap.mcs_flags = 0;
	rtap_vendor->rtap.mcs_index = wil_rxdesc_mcs(d);

	if (rtap_include_phy_info) {
		rtap_vendor->rtap.rthdr.it_present |= cpu_to_le32(1 <<
				IEEE80211_RADIOTAP_VENDOR_NAMESPACE);
		/* OUI for Wilocity 04:ce:14 */
		rtap_vendor->vendor_oui[0] = 0x04;
		rtap_vendor->vendor_oui[1] = 0xce;
		rtap_vendor->vendor_oui[2] = 0x14;
		rtap_vendor->vendor_ns = 1;
		/* Rx descriptor + PHY data  */
		rtap_vendor->vendor_skip = cpu_to_le16(sizeof(*d) +
						       phy_length);
		memcpy(rtap_vendor->vendor_data, (void *)d, sizeof(*d));
		memcpy(rtap_vendor->vendor_data + sizeof(*d), phy_data,
		       phy_length);
	}
}

381 382 383 384 385 386 387
/* similar to ieee80211_ version, but FC contain only 1-st byte */
static inline int wil_is_back_req(u8 fc)
{
	return (fc & (IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE)) ==
	       (IEEE80211_FTYPE_CTL | IEEE80211_STYPE_BACK_REQ);
}

388 389 390
/**
 * reap 1 frame from @swhead
 *
391 392
 * Rx descriptor copied to skb->cb
 *
393 394 395 396 397 398 399
 * Safe to call from IRQ
 */
static struct sk_buff *wil_vring_reap_rx(struct wil6210_priv *wil,
					 struct vring *vring)
{
	struct device *dev = wil_to_dev(wil);
	struct net_device *ndev = wil_to_ndev(wil);
400 401
	volatile struct vring_rx_desc *_d;
	struct vring_rx_desc *d;
402 403
	struct sk_buff *skb;
	dma_addr_t pa;
404 405
	unsigned int snaplen = wil_rx_snaplen();
	unsigned int sz = mtu_max + ETH_HLEN + snaplen;
406
	u16 dmalen;
407
	u8 ftype;
408
	int cid;
409
	int i;
410 411
	struct wil_net_stats *stats;

412 413
	BUILD_BUG_ON(sizeof(struct vring_rx_desc) > sizeof(skb->cb));

414
again:
415
	if (unlikely(wil_vring_is_empty(vring)))
416 417
		return NULL;

418
	i = (int)vring->swhead;
419
	_d = &vring->va[i].rx;
420
	if (unlikely(!(_d->dma.status & RX_DMA_STATUS_DU))) {
421 422 423 424
		/* it is not error, we just reached end of Rx done area */
		return NULL;
	}

425 426 427 428 429
	skb = vring->ctx[i].skb;
	vring->ctx[i].skb = NULL;
	wil_vring_advance_head(vring, 1);
	if (!skb) {
		wil_err(wil, "No Rx skb at [%d]\n", i);
430
		goto again;
431
	}
432 433 434 435
	d = wil_skb_rxdesc(skb);
	*d = *_d;
	pa = wil_desc_addr(&d->dma.addr);

436
	dma_unmap_single(dev, pa, sz, DMA_FROM_DEVICE);
437 438
	dmalen = le16_to_cpu(d->dma.length);

439 440
	trace_wil6210_rx(i, d);
	wil_dbg_txrx(wil, "Rx[%3d] : %d bytes\n", i, dmalen);
441
	wil_hex_dump_txrx("RxD ", DUMP_PREFIX_NONE, 32, 4,
442
			  (const void *)d, sizeof(*d), false);
443

444 445 446
	cid = wil_rxdesc_cid(d);
	stats = &wil->sta[cid].stats;

447
	if (unlikely(dmalen > sz)) {
448
		wil_err(wil, "Rx size too large: %d bytes!\n", dmalen);
449
		stats->rx_large_frame++;
450
		kfree_skb(skb);
451
		goto again;
452
	}
453
	skb_trim(skb, dmalen);
454

455 456
	prefetch(skb->data);

457 458 459
	wil_hex_dump_txrx("Rx ", DUMP_PREFIX_OFFSET, 16, 1,
			  skb->data, skb_headlen(skb), false);

460
	stats->last_mcs_rx = wil_rxdesc_mcs(d);
461 462
	if (stats->last_mcs_rx < ARRAY_SIZE(stats->rx_per_mcs))
		stats->rx_per_mcs[stats->last_mcs_rx]++;
463 464 465

	/* use radiotap header only if required */
	if (ndev->type == ARPHRD_IEEE80211_RADIOTAP)
466
		wil_rx_add_radiotap_header(wil, skb);
467 468 469 470

	/* no extra checks if in sniffer mode */
	if (ndev->type != ARPHRD_ETHER)
		return skb;
471
	/* Non-data frames may be delivered through Rx DMA channel (ex: BAR)
472 473 474
	 * Driver should recognize it by frame type, that is found
	 * in Rx descriptor. If type is not data, it is 802.11 frame as is
	 */
475
	ftype = wil_rxdesc_ftype(d) << 2;
476
	if (unlikely(ftype != IEEE80211_FTYPE_DATA)) {
477 478 479 480 481 482 483 484
		u8 fc1 = wil_rxdesc_fc1(d);
		int mid = wil_rxdesc_mid(d);
		int tid = wil_rxdesc_tid(d);
		u16 seq = wil_rxdesc_seq(d);

		wil_dbg_txrx(wil,
			     "Non-data frame FC[7:0] 0x%02x MID %d CID %d TID %d Seq 0x%03x\n",
			     fc1, mid, cid, tid, seq);
485
		stats->rx_non_data_frame++;
486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
		if (wil_is_back_req(fc1)) {
			wil_dbg_txrx(wil,
				     "BAR: MID %d CID %d TID %d Seq 0x%03x\n",
				     mid, cid, tid, seq);
			wil_rx_bar(wil, cid, tid, seq);
		} else {
			/* print again all info. One can enable only this
			 * without overhead for printing every Rx frame
			 */
			wil_dbg_txrx(wil,
				     "Unhandled non-data frame FC[7:0] 0x%02x MID %d CID %d TID %d Seq 0x%03x\n",
				     fc1, mid, cid, tid, seq);
			wil_hex_dump_txrx("RxD ", DUMP_PREFIX_NONE, 32, 4,
					  (const void *)d, sizeof(*d), false);
			wil_hex_dump_txrx("Rx ", DUMP_PREFIX_OFFSET, 16, 1,
					  skb->data, skb_headlen(skb), false);
		}
503
		kfree_skb(skb);
504
		goto again;
505 506
	}

507
	if (unlikely(skb->len < ETH_HLEN + snaplen)) {
508
		wil_err(wil, "Short frame, len = %d\n", skb->len);
509
		stats->rx_short_frame++;
510
		kfree_skb(skb);
511
		goto again;
512 513
	}

514 515 516 517
	/* L4 IDENT is on when HW calculated checksum, check status
	 * and in case of error drop the packet
	 * higher stack layers will handle retransmission (if required)
	 */
518
	if (likely(d->dma.status & RX_DMA_STATUS_L4I)) {
519
		/* L4 protocol identified, csum calculated */
520
		if (likely((d->dma.error & RX_DMA_ERROR_L4_ERR) == 0))
521
			skb->ip_summed = CHECKSUM_UNNECESSARY;
522 523 524 525 526
		/* If HW reports bad checksum, let IP stack re-check it
		 * For example, HW don't understand Microsoft IP stack that
		 * mis-calculates TCP checksum - if it should be 0x0,
		 * it writes 0xffff in violation of RFC 1624
		 */
527 528
	}

529 530 531 532 533 534 535 536 537 538 539
	if (snaplen) {
		/* Packet layout
		 * +-------+-------+---------+------------+------+
		 * | SA(6) | DA(6) | SNAP(6) | ETHTYPE(2) | DATA |
		 * +-------+-------+---------+------------+------+
		 * Need to remove SNAP, shifting SA and DA forward
		 */
		memmove(skb->data + snaplen, skb->data, 2 * ETH_ALEN);
		skb_pull(skb, snaplen);
	}

540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
	return skb;
}

/**
 * allocate and fill up to @count buffers in rx ring
 * buffers posted at @swtail
 */
static int wil_rx_refill(struct wil6210_priv *wil, int count)
{
	struct net_device *ndev = wil_to_ndev(wil);
	struct vring *v = &wil->vring_rx;
	u32 next_tail;
	int rc = 0;
	int headroom = ndev->type == ARPHRD_IEEE80211_RADIOTAP ?
			WIL6210_RTAP_SIZE : 0;

	for (; next_tail = wil_vring_next_tail(v),
			(next_tail != v->swhead) && (count-- > 0);
			v->swtail = next_tail) {
		rc = wil_vring_alloc_skb(wil, v, v->swtail, headroom);
560
		if (unlikely(rc)) {
561 562 563 564 565
			wil_err(wil, "Error %d in wil_rx_refill[%d]\n",
				rc, v->swtail);
			break;
		}
	}
566 567 568 569 570 571

	/* make sure all writes to descriptors (shared memory) are done before
	 * committing them to HW
	 */
	wmb();

572
	wil_w(wil, v->hwtail, v->swtail);
573 574 575 576

	return rc;
}

577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630
/**
 * reverse_memcmp - Compare two areas of memory, in reverse order
 * @cs: One area of memory
 * @ct: Another area of memory
 * @count: The size of the area.
 *
 * Cut'n'paste from original memcmp (see lib/string.c)
 * with minimal modifications
 */
static int reverse_memcmp(const void *cs, const void *ct, size_t count)
{
	const unsigned char *su1, *su2;
	int res = 0;

	for (su1 = cs + count - 1, su2 = ct + count - 1; count > 0;
	     --su1, --su2, count--) {
		res = *su1 - *su2;
		if (res)
			break;
	}
	return res;
}

static int wil_rx_crypto_check(struct wil6210_priv *wil, struct sk_buff *skb)
{
	struct vring_rx_desc *d = wil_skb_rxdesc(skb);
	int cid = wil_rxdesc_cid(d);
	int tid = wil_rxdesc_tid(d);
	int key_id = wil_rxdesc_key_id(d);
	int mc = wil_rxdesc_mcast(d);
	struct wil_sta_info *s = &wil->sta[cid];
	struct wil_tid_crypto_rx *c = mc ? &s->group_crypto_rx :
				      &s->tid_crypto_rx[tid];
	struct wil_tid_crypto_rx_single *cc = &c->key_id[key_id];
	const u8 *pn = (u8 *)&d->mac.pn_15_0;

	if (!cc->key_set) {
		wil_err_ratelimited(wil,
				    "Key missing. CID %d TID %d MCast %d KEY_ID %d\n",
				    cid, tid, mc, key_id);
		return -EINVAL;
	}

	if (reverse_memcmp(pn, cc->pn, IEEE80211_GCMP_PN_LEN) <= 0) {
		wil_err_ratelimited(wil,
				    "Replay attack. CID %d TID %d MCast %d KEY_ID %d PN %6phN last %6phN\n",
				    cid, tid, mc, key_id, pn, cc->pn);
		return -EINVAL;
	}
	memcpy(cc->pn, pn, IEEE80211_GCMP_PN_LEN);

	return 0;
}

631 632
/*
 * Pass Rx packet to the netif. Update statistics.
V
Vladimir Kondratiev 已提交
633
 * Called in softirq context (NAPI poll).
634
 */
V
Vladimir Kondratiev 已提交
635
void wil_netif_rx_any(struct sk_buff *skb, struct net_device *ndev)
636
{
637
	gro_result_t rc = GRO_NORMAL;
638
	struct wil6210_priv *wil = ndev_to_wil(ndev);
639
	struct wireless_dev *wdev = wil_to_wdev(wil);
640
	unsigned int len = skb->len;
641
	struct vring_rx_desc *d = wil_skb_rxdesc(skb);
642
	int cid = wil_rxdesc_cid(d); /* always 0..7, no need to check */
643
	int security = wil_rxdesc_security(d);
644 645 646 647 648
	struct ethhdr *eth = (void *)skb->data;
	/* here looking for DA, not A1, thus Rxdesc's 'mcast' indication
	 * is not suitable, need to look at data
	 */
	int mcast = is_multicast_ether_addr(eth->h_dest);
649
	struct wil_net_stats *stats = &wil->sta[cid].stats;
650 651 652 653 654 655 656 657
	struct sk_buff *xmit_skb = NULL;
	static const char * const gro_res_str[] = {
		[GRO_MERGED]		= "GRO_MERGED",
		[GRO_MERGED_FREE]	= "GRO_MERGED_FREE",
		[GRO_HELD]		= "GRO_HELD",
		[GRO_NORMAL]		= "GRO_NORMAL",
		[GRO_DROP]		= "GRO_DROP",
	};
658

659 660 661 662 663 664 665 666
	if (ndev->features & NETIF_F_RXHASH)
		/* fake L4 to ensure it won't be re-calculated later
		 * set hash to any non-zero value to activate rps
		 * mechanism, core will be chosen according
		 * to user-level rps configuration.
		 */
		skb_set_hash(skb, 1, PKT_HASH_TYPE_L4);

667 668
	skb_orphan(skb);

669 670 671 672 673 674 675
	if (security && (wil_rx_crypto_check(wil, skb) != 0)) {
		rc = GRO_DROP;
		dev_kfree_skb(skb);
		stats->rx_replay++;
		goto stats;
	}

676
	if (wdev->iftype == NL80211_IFTYPE_AP && !wil->ap_isolate) {
677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
		if (mcast) {
			/* send multicast frames both to higher layers in
			 * local net stack and back to the wireless medium
			 */
			xmit_skb = skb_copy(skb, GFP_ATOMIC);
		} else {
			int xmit_cid = wil_find_cid(wil, eth->h_dest);

			if (xmit_cid >= 0) {
				/* The destination station is associated to
				 * this AP (in this VLAN), so send the frame
				 * directly to it and do not pass it to local
				 * net stack.
				 */
				xmit_skb = skb;
				skb = NULL;
			}
		}
	}
	if (xmit_skb) {
		/* Send to wireless media and increase priority by 256 to
		 * keep the received priority instead of reclassifying
		 * the frame (see cfg80211_classify8021d).
		 */
		xmit_skb->dev = ndev;
		xmit_skb->priority += 256;
		xmit_skb->protocol = htons(ETH_P_802_3);
		skb_reset_network_header(xmit_skb);
		skb_reset_mac_header(xmit_skb);
		wil_dbg_txrx(wil, "Rx -> Tx %d bytes\n", len);
		dev_queue_xmit(xmit_skb);
	}
709

710 711 712 713 714 715 716
	if (skb) { /* deliver to local stack */

		skb->protocol = eth_type_trans(skb, ndev);
		rc = napi_gro_receive(&wil->napi_rx, skb);
		wil_dbg_txrx(wil, "Rx complete %d bytes => %s\n",
			     len, gro_res_str[rc]);
	}
717
stats:
718
	/* statistics. rc set to GRO_NORMAL for AP bridging */
V
Vladimir Kondratiev 已提交
719 720 721 722 723
	if (unlikely(rc == GRO_DROP)) {
		ndev->stats.rx_dropped++;
		stats->rx_dropped++;
		wil_dbg_txrx(wil, "Rx drop %d bytes\n", len);
	} else {
724
		ndev->stats.rx_packets++;
725
		stats->rx_packets++;
726
		ndev->stats.rx_bytes += len;
727
		stats->rx_bytes += len;
728 729
		if (mcast)
			ndev->stats.multicast++;
730
	}
731 732 733 734 735
}

/**
 * Proceed all completed skb's from Rx VRING
 *
V
Vladimir Kondratiev 已提交
736
 * Safe to call from NAPI poll, i.e. softirq with interrupts enabled
737
 */
V
Vladimir Kondratiev 已提交
738
void wil_rx_handle(struct wil6210_priv *wil, int *quota)
739 740 741 742 743
{
	struct net_device *ndev = wil_to_ndev(wil);
	struct vring *v = &wil->vring_rx;
	struct sk_buff *skb;

744
	if (unlikely(!v->va)) {
745 746 747
		wil_err(wil, "Rx IRQ while Rx not yet initialized\n");
		return;
	}
748
	wil_dbg_txrx(wil, "%s()\n", __func__);
V
Vladimir Kondratiev 已提交
749 750
	while ((*quota > 0) && (NULL != (skb = wil_vring_reap_rx(wil, v)))) {
		(*quota)--;
751 752 753 754 755 756 757

		if (wil->wdev->iftype == NL80211_IFTYPE_MONITOR) {
			skb->dev = ndev;
			skb_reset_mac_header(skb);
			skb->ip_summed = CHECKSUM_UNNECESSARY;
			skb->pkt_type = PACKET_OTHERHOST;
			skb->protocol = htons(ETH_P_802_2);
V
Vladimir Kondratiev 已提交
758
			wil_netif_rx_any(skb, ndev);
759
		} else {
760
			wil_rx_reorder(wil, skb);
761 762 763 764 765
		}
	}
	wil_rx_refill(wil, v->size);
}

766
int wil_rx_init(struct wil6210_priv *wil, u16 size)
767 768 769 770
{
	struct vring *vring = &wil->vring_rx;
	int rc;

771 772
	wil_dbg_misc(wil, "%s()\n", __func__);

773 774 775 776 777
	if (vring->va) {
		wil_err(wil, "Rx ring already allocated\n");
		return -EINVAL;
	}

778
	vring->size = size;
779 780 781 782
	rc = wil_vring_alloc(wil, vring);
	if (rc)
		return rc;

783
	rc = wmi_rx_chain_add(wil, vring);
784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801
	if (rc)
		goto err_free;

	rc = wil_rx_refill(wil, vring->size);
	if (rc)
		goto err_free;

	return 0;
 err_free:
	wil_vring_free(wil, vring, 0);

	return rc;
}

void wil_rx_fini(struct wil6210_priv *wil)
{
	struct vring *vring = &wil->vring_rx;

802 803
	wil_dbg_misc(wil, "%s()\n", __func__);

804
	if (vring->va)
805 806 807
		wil_vring_free(wil, vring, 0);
}

808 809 810 811 812 813 814 815 816 817 818 819 820 821 822
static inline void wil_tx_data_init(struct vring_tx_data *txdata)
{
	spin_lock_bh(&txdata->lock);
	txdata->dot1x_open = 0;
	txdata->enabled = 0;
	txdata->idle = 0;
	txdata->last_idle = 0;
	txdata->begin = 0;
	txdata->agg_wsize = 0;
	txdata->agg_timeout = 0;
	txdata->agg_amsdu = 0;
	txdata->addba_in_progress = false;
	spin_unlock_bh(&txdata->lock);
}

823 824 825 826 827 828 829 830
int wil_vring_init_tx(struct wil6210_priv *wil, int id, int size,
		      int cid, int tid)
{
	int rc;
	struct wmi_vring_cfg_cmd cmd = {
		.action = cpu_to_le32(WMI_VRING_CMD_ADD),
		.vring_cfg = {
			.tx_sw_ring = {
831
				.max_mpdu_size =
832
					cpu_to_le16(wil_mtu2macbuf(mtu_max)),
833
				.ring_size = cpu_to_le16(size),
834 835
			},
			.ringid = id,
836
			.cidxtid = mk_cidxtid(cid, tid),
837 838 839
			.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
			.mac_ctrl = 0,
			.to_resolution = 0,
V
Vladimir Kondratiev 已提交
840
			.agg_max_wsize = 0,
841 842 843 844 845 846 847
			.schd_params = {
				.priority = cpu_to_le16(0),
				.timeslot_us = cpu_to_le16(0xfff),
			},
		},
	};
	struct {
L
Lior David 已提交
848
		struct wmi_cmd_hdr wmi;
849 850 851
		struct wmi_vring_cfg_done_event cmd;
	} __packed reply;
	struct vring *vring = &wil->vring_tx[id];
852
	struct vring_tx_data *txdata = &wil->vring_tx_data[id];
853

854 855
	wil_dbg_misc(wil, "%s() max_mpdu_size %d\n", __func__,
		     cmd.vring_cfg.tx_sw_ring.max_mpdu_size);
856
	lockdep_assert_held(&wil->mutex);
857

858 859 860 861 862 863
	if (vring->va) {
		wil_err(wil, "Tx ring [%d] already allocated\n", id);
		rc = -EINVAL;
		goto out;
	}

864
	wil_tx_data_init(txdata);
865 866 867 868 869
	vring->size = size;
	rc = wil_vring_alloc(wil, vring);
	if (rc)
		goto out;

870 871 872
	wil->vring2cid_tid[id][0] = cid;
	wil->vring2cid_tid[id][1] = tid;

873 874
	cmd.vring_cfg.tx_sw_ring.ring_mem_base = cpu_to_le64(vring->pa);

875 876
	if (!wil->privacy)
		txdata->dot1x_open = true;
877 878 879 880 881
	rc = wmi_call(wil, WMI_VRING_CFG_CMDID, &cmd, sizeof(cmd),
		      WMI_VRING_CFG_DONE_EVENTID, &reply, sizeof(reply), 100);
	if (rc)
		goto out_free;

882
	if (reply.cmd.status != WMI_FW_STATUS_SUCCESS) {
883 884
		wil_err(wil, "Tx config failed, status 0x%02x\n",
			reply.cmd.status);
885
		rc = -EINVAL;
886 887 888
		goto out_free;
	}

889 890
	spin_lock_bh(&txdata->lock);
	vring->hwtail = le32_to_cpu(reply.cmd.tx_vring_tail_ptr);
891
	txdata->enabled = 1;
892 893
	spin_unlock_bh(&txdata->lock);

894
	if (txdata->dot1x_open && (agg_wsize >= 0))
895
		wil_addba_tx_request(wil, id, agg_wsize);
896

897 898
	return 0;
 out_free:
899
	spin_lock_bh(&txdata->lock);
900 901
	txdata->dot1x_open = false;
	txdata->enabled = 0;
902
	spin_unlock_bh(&txdata->lock);
903
	wil_vring_free(wil, vring, 1);
904 905 906
	wil->vring2cid_tid[id][0] = WIL6210_MAX_CID;
	wil->vring2cid_tid[id][1] = 0;

907 908 909 910 911
 out:

	return rc;
}

912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927
int wil_vring_init_bcast(struct wil6210_priv *wil, int id, int size)
{
	int rc;
	struct wmi_bcast_vring_cfg_cmd cmd = {
		.action = cpu_to_le32(WMI_VRING_CMD_ADD),
		.vring_cfg = {
			.tx_sw_ring = {
				.max_mpdu_size =
					cpu_to_le16(wil_mtu2macbuf(mtu_max)),
				.ring_size = cpu_to_le16(size),
			},
			.ringid = id,
			.encap_trans_type = WMI_VRING_ENC_TYPE_802_3,
		},
	};
	struct {
L
Lior David 已提交
928
		struct wmi_cmd_hdr wmi;
929 930 931 932 933 934 935
		struct wmi_vring_cfg_done_event cmd;
	} __packed reply;
	struct vring *vring = &wil->vring_tx[id];
	struct vring_tx_data *txdata = &wil->vring_tx_data[id];

	wil_dbg_misc(wil, "%s() max_mpdu_size %d\n", __func__,
		     cmd.vring_cfg.tx_sw_ring.max_mpdu_size);
936
	lockdep_assert_held(&wil->mutex);
937 938 939 940 941 942 943

	if (vring->va) {
		wil_err(wil, "Tx ring [%d] already allocated\n", id);
		rc = -EINVAL;
		goto out;
	}

944
	wil_tx_data_init(txdata);
945 946 947 948 949 950 951 952 953 954
	vring->size = size;
	rc = wil_vring_alloc(wil, vring);
	if (rc)
		goto out;

	wil->vring2cid_tid[id][0] = WIL6210_MAX_CID; /* CID */
	wil->vring2cid_tid[id][1] = 0; /* TID */

	cmd.vring_cfg.tx_sw_ring.ring_mem_base = cpu_to_le64(vring->pa);

955 956
	if (!wil->privacy)
		txdata->dot1x_open = true;
957 958 959 960 961 962 963 964 965 966 967 968
	rc = wmi_call(wil, WMI_BCAST_VRING_CFG_CMDID, &cmd, sizeof(cmd),
		      WMI_VRING_CFG_DONE_EVENTID, &reply, sizeof(reply), 100);
	if (rc)
		goto out_free;

	if (reply.cmd.status != WMI_FW_STATUS_SUCCESS) {
		wil_err(wil, "Tx config failed, status 0x%02x\n",
			reply.cmd.status);
		rc = -EINVAL;
		goto out_free;
	}

969 970
	spin_lock_bh(&txdata->lock);
	vring->hwtail = le32_to_cpu(reply.cmd.tx_vring_tail_ptr);
971
	txdata->enabled = 1;
972
	spin_unlock_bh(&txdata->lock);
973 974 975

	return 0;
 out_free:
976
	spin_lock_bh(&txdata->lock);
977 978
	txdata->enabled = 0;
	txdata->dot1x_open = false;
979
	spin_unlock_bh(&txdata->lock);
980 981 982 983 984 985
	wil_vring_free(wil, vring, 1);
 out:

	return rc;
}

986 987 988
void wil_vring_fini_tx(struct wil6210_priv *wil, int id)
{
	struct vring *vring = &wil->vring_tx[id];
989
	struct vring_tx_data *txdata = &wil->vring_tx_data[id];
990

991
	lockdep_assert_held(&wil->mutex);
992

993 994 995
	if (!vring->va)
		return;

996 997
	wil_dbg_misc(wil, "%s() id=%d\n", __func__, id);

998
	spin_lock_bh(&txdata->lock);
999
	txdata->dot1x_open = false;
1000 1001
	txdata->enabled = 0; /* no Tx can be in progress or start anew */
	spin_unlock_bh(&txdata->lock);
1002 1003 1004 1005 1006 1007 1008
	/* napi_synchronize waits for completion of the current NAPI but will
	 * not prevent the next NAPI run.
	 * Add a memory barrier to guarantee that txdata->enabled is zeroed
	 * before napi_synchronize so that the next scheduled NAPI will not
	 * handle this vring
	 */
	wmb();
1009
	/* make sure NAPI won't touch this vring */
1010
	if (test_bit(wil_status_napi_en, wil->status))
1011 1012
		napi_synchronize(&wil->napi_tx);

1013 1014 1015
	wil_vring_free(wil, vring, 1);
}

1016
static struct vring *wil_find_tx_ucast(struct wil6210_priv *wil,
1017 1018
				       struct sk_buff *skb)
{
1019 1020 1021 1022 1023 1024
	int i;
	struct ethhdr *eth = (void *)skb->data;
	int cid = wil_find_cid(wil, eth->h_dest);

	if (cid < 0)
		return NULL;
1025

1026 1027
	/* TODO: fix for multiple TID */
	for (i = 0; i < ARRAY_SIZE(wil->vring2cid_tid); i++) {
1028 1029 1030
		if (!wil->vring_tx_data[i].dot1x_open &&
		    (skb->protocol != cpu_to_be16(ETH_P_PAE)))
			continue;
1031 1032
		if (wil->vring2cid_tid[i][0] == cid) {
			struct vring *v = &wil->vring_tx[i];
1033
			struct vring_tx_data *txdata = &wil->vring_tx_data[i];
1034

1035 1036
			wil_dbg_txrx(wil, "%s(%pM) -> [%d]\n",
				     __func__, eth->h_dest, i);
1037
			if (v->va && txdata->enabled) {
1038 1039 1040 1041 1042 1043 1044
				return v;
			} else {
				wil_dbg_txrx(wil, "vring[%d] not valid\n", i);
				return NULL;
			}
		}
	}
1045 1046 1047 1048

	return NULL;
}

V
Vladimir Kondratiev 已提交
1049 1050
static int wil_tx_vring(struct wil6210_priv *wil, struct vring *vring,
			struct sk_buff *skb);
1051 1052 1053 1054 1055 1056 1057

static struct vring *wil_find_tx_vring_sta(struct wil6210_priv *wil,
					   struct sk_buff *skb)
{
	struct vring *v;
	int i;
	u8 cid;
1058
	struct vring_tx_data *txdata;
1059 1060 1061

	/* In the STA mode, it is expected to have only 1 VRING
	 * for the AP we connected to.
1062
	 * find 1-st vring eligible for this skb and use it.
1063 1064 1065
	 */
	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
		v = &wil->vring_tx[i];
1066 1067
		txdata = &wil->vring_tx_data[i];
		if (!v->va || !txdata->enabled)
1068 1069 1070
			continue;

		cid = wil->vring2cid_tid[i][0];
1071 1072 1073
		if (cid >= WIL6210_MAX_CID) /* skip BCAST */
			continue;

1074
		if (!wil->vring_tx_data[i].dot1x_open &&
1075
		    (skb->protocol != cpu_to_be16(ETH_P_PAE)))
1076
			continue;
1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087

		wil_dbg_txrx(wil, "Tx -> ring %d\n", i);

		return v;
	}

	wil_dbg_txrx(wil, "Tx while no vrings active?\n");

	return NULL;
}

1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100
/* Use one of 2 strategies:
 *
 * 1. New (real broadcast):
 *    use dedicated broadcast vring
 * 2. Old (pseudo-DMS):
 *    Find 1-st vring and return it;
 *    duplicate skb and send it to other active vrings;
 *    in all cases override dest address to unicast peer's address
 * Use old strategy when new is not supported yet:
 *  - for PBSS
 */
static struct vring *wil_find_tx_bcast_1(struct wil6210_priv *wil,
					 struct sk_buff *skb)
V
Vladimir Kondratiev 已提交
1101
{
1102
	struct vring *v;
1103
	struct vring_tx_data *txdata;
1104
	int i = wil->bcast_vring;
1105

1106 1107 1108
	if (i < 0)
		return NULL;
	v = &wil->vring_tx[i];
1109 1110
	txdata = &wil->vring_tx_data[i];
	if (!v->va || !txdata->enabled)
1111
		return NULL;
1112 1113 1114
	if (!wil->vring_tx_data[i].dot1x_open &&
	    (skb->protocol != cpu_to_be16(ETH_P_PAE)))
		return NULL;
V
Vladimir Kondratiev 已提交
1115 1116 1117 1118

	return v;
}

1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136
static void wil_set_da_for_vring(struct wil6210_priv *wil,
				 struct sk_buff *skb, int vring_index)
{
	struct ethhdr *eth = (void *)skb->data;
	int cid = wil->vring2cid_tid[vring_index][0];

	ether_addr_copy(eth->h_dest, wil->sta[cid].addr);
}

static struct vring *wil_find_tx_bcast_2(struct wil6210_priv *wil,
					 struct sk_buff *skb)
{
	struct vring *v, *v2;
	struct sk_buff *skb2;
	int i;
	u8 cid;
	struct ethhdr *eth = (void *)skb->data;
	char *src = eth->h_source;
1137
	struct vring_tx_data *txdata;
1138 1139 1140 1141

	/* find 1-st vring eligible for data */
	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
		v = &wil->vring_tx[i];
1142 1143
		txdata = &wil->vring_tx_data[i];
		if (!v->va || !txdata->enabled)
1144 1145 1146 1147 1148
			continue;

		cid = wil->vring2cid_tid[i][0];
		if (cid >= WIL6210_MAX_CID) /* skip BCAST */
			continue;
1149 1150
		if (!wil->vring_tx_data[i].dot1x_open &&
		    (skb->protocol != cpu_to_be16(ETH_P_PAE)))
1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
			continue;

		/* don't Tx back to source when re-routing Rx->Tx at the AP */
		if (0 == memcmp(wil->sta[cid].addr, src, ETH_ALEN))
			continue;

		goto found;
	}

	wil_dbg_txrx(wil, "Tx while no vrings active?\n");

	return NULL;

found:
	wil_dbg_txrx(wil, "BCAST -> ring %d\n", i);
	wil_set_da_for_vring(wil, skb, i);

	/* find other active vrings and duplicate skb for each */
	for (i++; i < WIL6210_MAX_TX_RINGS; i++) {
		v2 = &wil->vring_tx[i];
		if (!v2->va)
			continue;
		cid = wil->vring2cid_tid[i][0];
		if (cid >= WIL6210_MAX_CID) /* skip BCAST */
			continue;
1176 1177
		if (!wil->vring_tx_data[i].dot1x_open &&
		    (skb->protocol != cpu_to_be16(ETH_P_PAE)))
1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206
			continue;

		if (0 == memcmp(wil->sta[cid].addr, src, ETH_ALEN))
			continue;

		skb2 = skb_copy(skb, GFP_ATOMIC);
		if (skb2) {
			wil_dbg_txrx(wil, "BCAST DUP -> ring %d\n", i);
			wil_set_da_for_vring(wil, skb2, i);
			wil_tx_vring(wil, v2, skb2);
		} else {
			wil_err(wil, "skb_copy failed\n");
		}
	}

	return v;
}

static struct vring *wil_find_tx_bcast(struct wil6210_priv *wil,
				       struct sk_buff *skb)
{
	struct wireless_dev *wdev = wil->wdev;

	if (wdev->iftype != NL80211_IFTYPE_AP)
		return wil_find_tx_bcast_2(wil, skb);

	return wil_find_tx_bcast_1(wil, skb);
}

1207 1208
static int wil_tx_desc_map(struct vring_tx_desc *d, dma_addr_t pa, u32 len,
			   int vring_index)
1209
{
1210
	wil_desc_addr_set(&d->dma.addr, pa);
1211 1212 1213 1214 1215
	d->dma.ip_length = 0;
	/* 0..6: mac_length; 7:ip_version 0-IP6 1-IP4*/
	d->dma.b11 = 0/*14 | BIT(7)*/;
	d->dma.error = 0;
	d->dma.status = 0; /* BIT(0) should be 0 for HW_OWNED */
1216
	d->dma.length = cpu_to_le16((u16)len);
1217
	d->dma.d0 = (vring_index << DMA_CFG_DESC_TX_0_QID_POS);
1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228
	d->mac.d[0] = 0;
	d->mac.d[1] = 0;
	d->mac.d[2] = 0;
	d->mac.ucode_cmd = 0;
	/* translation type:  0 - bypass; 1 - 802.3; 2 - native wifi */
	d->mac.d[2] = BIT(MAC_CFG_DESC_TX_2_SNAP_HDR_INSERTION_EN_POS) |
		      (1 << MAC_CFG_DESC_TX_2_L2_TRANSLATION_TYPE_POS);

	return 0;
}

1229 1230 1231
static inline
void wil_tx_desc_set_nr_frags(struct vring_tx_desc *d, int nr_frags)
{
1232
	d->mac.d[2] |= (nr_frags << MAC_CFG_DESC_TX_2_NUM_OF_DESCRIPTORS_POS);
1233 1234
}

1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
/**
 * Sets the descriptor @d up for csum and/or TSO offloading. The corresponding
 * @skb is used to obtain the protocol and headers length.
 * @tso_desc_type is a descriptor type for TSO: 0 - a header, 1 - first data,
 * 2 - middle, 3 - last descriptor.
 */

static void wil_tx_desc_offload_setup_tso(struct vring_tx_desc *d,
					  struct sk_buff *skb,
					  int tso_desc_type, bool is_ipv4,
					  int tcp_hdr_len, int skb_net_hdr_len)
1246
{
1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
	d->dma.b11 = ETH_HLEN; /* MAC header length */
	d->dma.b11 |= is_ipv4 << DMA_CFG_DESC_TX_OFFLOAD_CFG_L3T_IPV4_POS;

	d->dma.d0 |= (2 << DMA_CFG_DESC_TX_0_L4_TYPE_POS);
	/* L4 header len: TCP header length */
	d->dma.d0 |= (tcp_hdr_len & DMA_CFG_DESC_TX_0_L4_LENGTH_MSK);

	/* Setup TSO: bit and desc type */
	d->dma.d0 |= (BIT(DMA_CFG_DESC_TX_0_TCP_SEG_EN_POS)) |
		(tso_desc_type << DMA_CFG_DESC_TX_0_SEGMENT_BUF_DETAILS_POS);
	d->dma.d0 |= (is_ipv4 << DMA_CFG_DESC_TX_0_IPV4_CHECKSUM_EN_POS);

	d->dma.ip_length = skb_net_hdr_len;
	/* Enable TCP/UDP checksum */
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_TCP_UDP_CHECKSUM_EN_POS);
	/* Calculate pseudo-header */
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_PSEUDO_HEADER_CALC_EN_POS);
}

/**
 * Sets the descriptor @d up for csum. The corresponding
 * @skb is used to obtain the protocol and headers length.
 * Returns the protocol: 0 - not TCP, 1 - TCPv4, 2 - TCPv6.
 * Note, if d==NULL, the function only returns the protocol result.
 *
 * It is very similar to previous wil_tx_desc_offload_setup_tso. This
 * is "if unrolling" to optimize the critical path.
 */

static int wil_tx_desc_offload_setup(struct vring_tx_desc *d,
				     struct sk_buff *skb){
1278 1279 1280 1281 1282
	int protocol;

	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return 0;

1283 1284
	d->dma.b11 = ETH_HLEN; /* MAC header length */

1285 1286 1287
	switch (skb->protocol) {
	case cpu_to_be16(ETH_P_IP):
		protocol = ip_hdr(skb)->protocol;
1288
		d->dma.b11 |= BIT(DMA_CFG_DESC_TX_OFFLOAD_CFG_L3T_IPV4_POS);
1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
		break;
	case cpu_to_be16(ETH_P_IPV6):
		protocol = ipv6_hdr(skb)->nexthdr;
		break;
	default:
		return -EINVAL;
	}

	switch (protocol) {
	case IPPROTO_TCP:
		d->dma.d0 |= (2 << DMA_CFG_DESC_TX_0_L4_TYPE_POS);
		/* L4 header len: TCP header length */
		d->dma.d0 |=
		(tcp_hdrlen(skb) & DMA_CFG_DESC_TX_0_L4_LENGTH_MSK);
		break;
	case IPPROTO_UDP:
		/* L4 header len: UDP header length */
		d->dma.d0 |=
		(sizeof(struct udphdr) & DMA_CFG_DESC_TX_0_L4_LENGTH_MSK);
		break;
	default:
		return -EINVAL;
	}

	d->dma.ip_length = skb_network_header_len(skb);
	/* Enable TCP/UDP checksum */
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_TCP_UDP_CHECKSUM_EN_POS);
	/* Calculate pseudo-header */
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_PSEUDO_HEADER_CALC_EN_POS);

	return 0;
}

1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
static inline void wil_tx_last_desc(struct vring_tx_desc *d)
{
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_CMD_EOP_POS) |
	      BIT(DMA_CFG_DESC_TX_0_CMD_MARK_WB_POS) |
	      BIT(DMA_CFG_DESC_TX_0_CMD_DMA_IT_POS);
}

static inline void wil_set_tx_desc_last_tso(volatile struct vring_tx_desc *d)
{
	d->dma.d0 |= wil_tso_type_lst <<
		  DMA_CFG_DESC_TX_0_SEGMENT_BUF_DETAILS_POS;
}

static int __wil_tx_vring_tso(struct wil6210_priv *wil, struct vring *vring,
			      struct sk_buff *skb)
{
	struct device *dev = wil_to_dev(wil);

	/* point to descriptors in shared memory */
	volatile struct vring_tx_desc *_desc = NULL, *_hdr_desc,
				      *_first_desc = NULL;

	/* pointers to shadow descriptors */
	struct vring_tx_desc desc_mem, hdr_desc_mem, first_desc_mem,
			     *d = &hdr_desc_mem, *hdr_desc = &hdr_desc_mem,
			     *first_desc = &first_desc_mem;

	/* pointer to shadow descriptors' context */
	struct wil_ctx *hdr_ctx, *first_ctx = NULL;

	int descs_used = 0; /* total number of used descriptors */
	int sg_desc_cnt = 0; /* number of descriptors for current mss*/

	u32 swhead = vring->swhead;
	int used, avail = wil_vring_avail_tx(vring);
	int nr_frags = skb_shinfo(skb)->nr_frags;
	int min_desc_required = nr_frags + 1;
	int mss = skb_shinfo(skb)->gso_size;	/* payload size w/o headers */
	int f, len, hdrlen, headlen;
	int vring_index = vring - wil->vring_tx;
	struct vring_tx_data *txdata = &wil->vring_tx_data[vring_index];
	uint i = swhead;
	dma_addr_t pa;
	const skb_frag_t *frag = NULL;
	int rem_data = mss;
	int lenmss;
	int hdr_compensation_need = true;
	int desc_tso_type = wil_tso_type_first;
	bool is_ipv4;
	int tcp_hdr_len;
	int skb_net_hdr_len;
	int gso_type;
H
Hamad Kadmany 已提交
1374
	int rc = -EINVAL;
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465

	wil_dbg_txrx(wil, "%s() %d bytes to vring %d\n",
		     __func__, skb->len, vring_index);

	if (unlikely(!txdata->enabled))
		return -EINVAL;

	/* A typical page 4K is 3-4 payloads, we assume each fragment
	 * is a full payload, that's how min_desc_required has been
	 * calculated. In real we might need more or less descriptors,
	 * this is the initial check only.
	 */
	if (unlikely(avail < min_desc_required)) {
		wil_err_ratelimited(wil,
				    "TSO: Tx ring[%2d] full. No space for %d fragments\n",
				    vring_index, min_desc_required);
		return -ENOMEM;
	}

	/* Header Length = MAC header len + IP header len + TCP header len*/
	hdrlen = ETH_HLEN +
		(int)skb_network_header_len(skb) +
		tcp_hdrlen(skb);

	gso_type = skb_shinfo(skb)->gso_type & (SKB_GSO_TCPV6 | SKB_GSO_TCPV4);
	switch (gso_type) {
	case SKB_GSO_TCPV4:
		/* TCP v4, zero out the IP length and IPv4 checksum fields
		 * as required by the offloading doc
		 */
		ip_hdr(skb)->tot_len = 0;
		ip_hdr(skb)->check = 0;
		is_ipv4 = true;
		break;
	case SKB_GSO_TCPV6:
		/* TCP v6, zero out the payload length */
		ipv6_hdr(skb)->payload_len = 0;
		is_ipv4 = false;
		break;
	default:
		/* other than TCPv4 or TCPv6 types are not supported for TSO.
		 * It is also illegal for both to be set simultaneously
		 */
		return -EINVAL;
	}

	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return -EINVAL;

	/* tcp header length and skb network header length are fixed for all
	 * packet's descriptors - read then once here
	 */
	tcp_hdr_len = tcp_hdrlen(skb);
	skb_net_hdr_len = skb_network_header_len(skb);

	_hdr_desc = &vring->va[i].tx;

	pa = dma_map_single(dev, skb->data, hdrlen, DMA_TO_DEVICE);
	if (unlikely(dma_mapping_error(dev, pa))) {
		wil_err(wil, "TSO: Skb head DMA map error\n");
		goto err_exit;
	}

	wil_tx_desc_map(hdr_desc, pa, hdrlen, vring_index);
	wil_tx_desc_offload_setup_tso(hdr_desc, skb, wil_tso_type_hdr, is_ipv4,
				      tcp_hdr_len, skb_net_hdr_len);
	wil_tx_last_desc(hdr_desc);

	vring->ctx[i].mapped_as = wil_mapped_as_single;
	hdr_ctx = &vring->ctx[i];

	descs_used++;
	headlen = skb_headlen(skb) - hdrlen;

	for (f = headlen ? -1 : 0; f < nr_frags; f++)  {
		if (headlen) {
			len = headlen;
			wil_dbg_txrx(wil, "TSO: process skb head, len %u\n",
				     len);
		} else {
			frag = &skb_shinfo(skb)->frags[f];
			len = frag->size;
			wil_dbg_txrx(wil, "TSO: frag[%d]: len %u\n", f, len);
		}

		while (len) {
			wil_dbg_txrx(wil,
				     "TSO: len %d, rem_data %d, descs_used %d\n",
				     len, rem_data, descs_used);

			if (descs_used == avail)  {
H
Hamad Kadmany 已提交
1466 1467 1468
				wil_err_ratelimited(wil, "TSO: ring overflow\n");
				rc = -ENOMEM;
				goto mem_error;
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489
			}

			lenmss = min_t(int, rem_data, len);
			i = (swhead + descs_used) % vring->size;
			wil_dbg_txrx(wil, "TSO: lenmss %d, i %d\n", lenmss, i);

			if (!headlen) {
				pa = skb_frag_dma_map(dev, frag,
						      frag->size - len, lenmss,
						      DMA_TO_DEVICE);
				vring->ctx[i].mapped_as = wil_mapped_as_page;
			} else {
				pa = dma_map_single(dev,
						    skb->data +
						    skb_headlen(skb) - headlen,
						    lenmss,
						    DMA_TO_DEVICE);
				vring->ctx[i].mapped_as = wil_mapped_as_single;
				headlen -= lenmss;
			}

H
Hamad Kadmany 已提交
1490 1491 1492 1493
			if (unlikely(dma_mapping_error(dev, pa))) {
				wil_err(wil, "TSO: DMA map page error\n");
				goto mem_error;
			}
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590

			_desc = &vring->va[i].tx;

			if (!_first_desc) {
				_first_desc = _desc;
				first_ctx = &vring->ctx[i];
				d = first_desc;
			} else {
				d = &desc_mem;
			}

			wil_tx_desc_map(d, pa, lenmss, vring_index);
			wil_tx_desc_offload_setup_tso(d, skb, desc_tso_type,
						      is_ipv4, tcp_hdr_len,
						      skb_net_hdr_len);

			/* use tso_type_first only once */
			desc_tso_type = wil_tso_type_mid;

			descs_used++;  /* desc used so far */
			sg_desc_cnt++; /* desc used for this segment */
			len -= lenmss;
			rem_data -= lenmss;

			wil_dbg_txrx(wil,
				     "TSO: len %d, rem_data %d, descs_used %d, sg_desc_cnt %d,\n",
				     len, rem_data, descs_used, sg_desc_cnt);

			/* Close the segment if reached mss size or last frag*/
			if (rem_data == 0 || (f == nr_frags - 1 && len == 0)) {
				if (hdr_compensation_need) {
					/* first segment include hdr desc for
					 * release
					 */
					hdr_ctx->nr_frags = sg_desc_cnt;
					wil_tx_desc_set_nr_frags(first_desc,
								 sg_desc_cnt +
								 1);
					hdr_compensation_need = false;
				} else {
					wil_tx_desc_set_nr_frags(first_desc,
								 sg_desc_cnt);
				}
				first_ctx->nr_frags = sg_desc_cnt - 1;

				wil_tx_last_desc(d);

				/* first descriptor may also be the last
				 * for this mss - make sure not to copy
				 * it twice
				 */
				if (first_desc != d)
					*_first_desc = *first_desc;

				/*last descriptor will be copied at the end
				 * of this TS processing
				 */
				if (f < nr_frags - 1 || len > 0)
					*_desc = *d;

				rem_data = mss;
				_first_desc = NULL;
				sg_desc_cnt = 0;
			} else if (first_desc != d) /* update mid descriptor */
					*_desc = *d;
		}
	}

	/* first descriptor may also be the last.
	 * in this case d pointer is invalid
	 */
	if (_first_desc == _desc)
		d = first_desc;

	/* Last data descriptor */
	wil_set_tx_desc_last_tso(d);
	*_desc = *d;

	/* Fill the total number of descriptors in first desc (hdr)*/
	wil_tx_desc_set_nr_frags(hdr_desc, descs_used);
	*_hdr_desc = *hdr_desc;

	/* hold reference to skb
	 * to prevent skb release before accounting
	 * in case of immediate "tx done"
	 */
	vring->ctx[i].skb = skb_get(skb);

	/* performance monitoring */
	used = wil_vring_used_tx(vring);
	if (wil_val_in_range(vring_idle_trsh,
			     used, used + descs_used)) {
		txdata->idle += get_cycles() - txdata->last_idle;
		wil_dbg_txrx(wil,  "Ring[%2d] not idle %d -> %d\n",
			     vring_index, used, used + descs_used);
	}

1591 1592 1593 1594 1595 1596 1597
	/* Make sure to advance the head only after descriptor update is done.
	 * This will prevent a race condition where the completion thread
	 * will see the DU bit set from previous run and will handle the
	 * skb before it was completed.
	 */
	wmb();

1598 1599
	/* advance swhead */
	wil_vring_advance_head(vring, descs_used);
H
Hamad Kadmany 已提交
1600
	wil_dbg_txrx(wil, "TSO: Tx swhead %d -> %d\n", swhead, vring->swhead);
1601 1602 1603 1604 1605 1606

	/* make sure all writes to descriptors (shared memory) are done before
	 * committing them to HW
	 */
	wmb();

1607
	wil_w(wil, vring->hwtail, vring->swhead);
1608 1609
	return 0;

H
Hamad Kadmany 已提交
1610
mem_error:
1611 1612 1613
	while (descs_used > 0) {
		struct wil_ctx *ctx;

1614
		i = (swhead + descs_used - 1) % vring->size;
1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
		d = (struct vring_tx_desc *)&vring->va[i].tx;
		_desc = &vring->va[i].tx;
		*d = *_desc;
		_desc->dma.status = TX_DMA_STATUS_DU;
		ctx = &vring->ctx[i];
		wil_txdesc_unmap(dev, d, ctx);
		memset(ctx, 0, sizeof(*ctx));
		descs_used--;
	}
err_exit:
H
Hamad Kadmany 已提交
1625
	return rc;
1626 1627
}

1628 1629
static int __wil_tx_vring(struct wil6210_priv *wil, struct vring *vring,
			  struct sk_buff *skb)
1630 1631
{
	struct device *dev = wil_to_dev(wil);
1632 1633
	struct vring_tx_desc dd, *d = &dd;
	volatile struct vring_tx_desc *_d;
1634 1635 1636
	u32 swhead = vring->swhead;
	int avail = wil_vring_avail_tx(vring);
	int nr_frags = skb_shinfo(skb)->nr_frags;
1637
	uint f = 0;
1638
	int vring_index = vring - wil->vring_tx;
1639
	struct vring_tx_data *txdata = &wil->vring_tx_data[vring_index];
1640 1641
	uint i = swhead;
	dma_addr_t pa;
1642
	int used;
1643 1644
	bool mcast = (vring_index == wil->bcast_vring);
	uint len = skb_headlen(skb);
1645

1646 1647
	wil_dbg_txrx(wil, "%s() %d bytes to vring %d\n",
		     __func__, skb->len, vring_index);
1648

1649 1650 1651
	if (unlikely(!txdata->enabled))
		return -EINVAL;

1652
	if (unlikely(avail < 1 + nr_frags)) {
1653
		wil_err_ratelimited(wil,
V
Vladimir Kondratiev 已提交
1654 1655
				    "Tx ring[%2d] full. No space for %d fragments\n",
				    vring_index, 1 + nr_frags);
1656 1657
		return -ENOMEM;
	}
1658
	_d = &vring->va[i].tx;
1659

1660
	pa = dma_map_single(dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
1661

V
Vladimir Kondratiev 已提交
1662 1663
	wil_dbg_txrx(wil, "Tx[%2d] skb %d bytes 0x%p -> %pad\n", vring_index,
		     skb_headlen(skb), skb->data, &pa);
1664
	wil_hex_dump_txrx("Tx ", DUMP_PREFIX_OFFSET, 16, 1,
1665 1666 1667 1668
			  skb->data, skb_headlen(skb), false);

	if (unlikely(dma_mapping_error(dev, pa)))
		return -EINVAL;
1669
	vring->ctx[i].mapped_as = wil_mapped_as_single;
1670
	/* 1-st segment */
1671 1672 1673
	wil_tx_desc_map(d, pa, len, vring_index);
	if (unlikely(mcast)) {
		d->mac.d[0] |= BIT(MAC_CFG_DESC_TX_0_MCS_EN_POS); /* MCS 0 */
1674
		if (unlikely(len > WIL_BCAST_MCS0_LIMIT)) /* set MCS 1 */
1675 1676
			d->mac.d[0] |= (1 << MAC_CFG_DESC_TX_0_MCS_INDEX_POS);
	}
1677
	/* Process TCP/UDP checksum offloading */
1678
	if (unlikely(wil_tx_desc_offload_setup(d, skb))) {
V
Vladimir Kondratiev 已提交
1679
		wil_err(wil, "Tx[%2d] Failed to set cksum, drop packet\n",
1680 1681 1682 1683
			vring_index);
		goto dma_error;
	}

1684
	vring->ctx[i].nr_frags = nr_frags;
1685
	wil_tx_desc_set_nr_frags(d, nr_frags + 1);
1686

1687
	/* middle segments */
1688
	for (; f < nr_frags; f++) {
1689 1690 1691
		const struct skb_frag_struct *frag =
				&skb_shinfo(skb)->frags[f];
		int len = skb_frag_size(frag);
1692

1693
		*_d = *d;
V
Vladimir Kondratiev 已提交
1694 1695 1696
		wil_dbg_txrx(wil, "Tx[%2d] desc[%4d]\n", vring_index, i);
		wil_hex_dump_txrx("TxD ", DUMP_PREFIX_NONE, 32, 4,
				  (const void *)d, sizeof(*d), false);
1697
		i = (swhead + f + 1) % vring->size;
1698
		_d = &vring->va[i].tx;
1699
		pa = skb_frag_dma_map(dev, frag, 0, skb_frag_size(frag),
1700
				      DMA_TO_DEVICE);
H
Hamad Kadmany 已提交
1701 1702 1703
		if (unlikely(dma_mapping_error(dev, pa))) {
			wil_err(wil, "Tx[%2d] failed to map fragment\n",
				vring_index);
1704
			goto dma_error;
H
Hamad Kadmany 已提交
1705
		}
1706
		vring->ctx[i].mapped_as = wil_mapped_as_page;
1707
		wil_tx_desc_map(d, pa, len, vring_index);
1708 1709 1710 1711
		/* no need to check return code -
		 * if it succeeded for 1-st descriptor,
		 * it will succeed here too
		 */
1712
		wil_tx_desc_offload_setup(d, skb);
1713 1714 1715
	}
	/* for the last seg only */
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_CMD_EOP_POS);
1716
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_CMD_MARK_WB_POS);
1717
	d->dma.d0 |= BIT(DMA_CFG_DESC_TX_0_CMD_DMA_IT_POS);
1718
	*_d = *d;
V
Vladimir Kondratiev 已提交
1719 1720 1721
	wil_dbg_txrx(wil, "Tx[%2d] desc[%4d]\n", vring_index, i);
	wil_hex_dump_txrx("TxD ", DUMP_PREFIX_NONE, 32, 4,
			  (const void *)d, sizeof(*d), false);
1722

1723 1724 1725 1726 1727 1728
	/* hold reference to skb
	 * to prevent skb release before accounting
	 * in case of immediate "tx done"
	 */
	vring->ctx[i].skb = skb_get(skb);

1729 1730 1731 1732
	/* performance monitoring */
	used = wil_vring_used_tx(vring);
	if (wil_val_in_range(vring_idle_trsh,
			     used, used + nr_frags + 1)) {
1733
		txdata->idle += get_cycles() - txdata->last_idle;
1734 1735 1736
		wil_dbg_txrx(wil,  "Ring[%2d] not idle %d -> %d\n",
			     vring_index, used, used + nr_frags + 1);
	}
1737

1738 1739 1740 1741 1742 1743 1744
	/* Make sure to advance the head only after descriptor update is done.
	 * This will prevent a race condition where the completion thread
	 * will see the DU bit set from previous run and will handle the
	 * skb before it was completed.
	 */
	wmb();

1745 1746
	/* advance swhead */
	wil_vring_advance_head(vring, nr_frags + 1);
V
Vladimir Kondratiev 已提交
1747 1748
	wil_dbg_txrx(wil, "Tx[%2d] swhead %d -> %d\n", vring_index, swhead,
		     vring->swhead);
V
Vladimir Kondratiev 已提交
1749
	trace_wil6210_tx(vring_index, swhead, skb->len, nr_frags);
1750 1751 1752 1753 1754 1755

	/* make sure all writes to descriptors (shared memory) are done before
	 * committing them to HW
	 */
	wmb();

1756
	wil_w(wil, vring->hwtail, vring->swhead);
1757 1758 1759 1760

	return 0;
 dma_error:
	/* unmap what we have mapped */
1761 1762 1763
	nr_frags = f + 1; /* frags mapped + one for skb head */
	for (f = 0; f < nr_frags; f++) {
		struct wil_ctx *ctx;
1764

1765
		i = (swhead + f) % vring->size;
1766
		ctx = &vring->ctx[i];
1767
		_d = &vring->va[i].tx;
1768 1769
		*d = *_d;
		_d->dma.status = TX_DMA_STATUS_DU;
1770
		wil_txdesc_unmap(dev, d, ctx);
1771 1772

		memset(ctx, 0, sizeof(*ctx));
1773 1774 1775 1776 1777
	}

	return -EINVAL;
}

1778 1779 1780 1781 1782 1783 1784 1785
static int wil_tx_vring(struct wil6210_priv *wil, struct vring *vring,
			struct sk_buff *skb)
{
	int vring_index = vring - wil->vring_tx;
	struct vring_tx_data *txdata = &wil->vring_tx_data[vring_index];
	int rc;

	spin_lock(&txdata->lock);
1786 1787 1788 1789

	rc = (skb_is_gso(skb) ? __wil_tx_vring_tso : __wil_tx_vring)
	     (wil, vring, skb);

1790
	spin_unlock(&txdata->lock);
1791

1792 1793 1794
	return rc;
}

D
Dedy Lansky 已提交
1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877
/**
 * Check status of tx vrings and stop/wake net queues if needed
 *
 * This function does one of two checks:
 * In case check_stop is true, will check if net queues need to be stopped. If
 * the conditions for stopping are met, netif_tx_stop_all_queues() is called.
 * In case check_stop is false, will check if net queues need to be waked. If
 * the conditions for waking are met, netif_tx_wake_all_queues() is called.
 * vring is the vring which is currently being modified by either adding
 * descriptors (tx) into it or removing descriptors (tx complete) from it. Can
 * be null when irrelevant (e.g. connect/disconnect events).
 *
 * The implementation is to stop net queues if modified vring has low
 * descriptor availability. Wake if all vrings are not in low descriptor
 * availability and modified vring has high descriptor availability.
 */
static inline void __wil_update_net_queues(struct wil6210_priv *wil,
					   struct vring *vring,
					   bool check_stop)
{
	int i;

	if (vring)
		wil_dbg_txrx(wil, "vring %d, check_stop=%d, stopped=%d",
			     (int)(vring - wil->vring_tx), check_stop,
			     wil->net_queue_stopped);
	else
		wil_dbg_txrx(wil, "check_stop=%d, stopped=%d",
			     check_stop, wil->net_queue_stopped);

	if (check_stop == wil->net_queue_stopped)
		/* net queues already in desired state */
		return;

	if (check_stop) {
		if (!vring || unlikely(wil_vring_avail_low(vring))) {
			/* not enough room in the vring */
			netif_tx_stop_all_queues(wil_to_ndev(wil));
			wil->net_queue_stopped = true;
			wil_dbg_txrx(wil, "netif_tx_stop called\n");
		}
		return;
	}

	/* check wake */
	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
		struct vring *cur_vring = &wil->vring_tx[i];
		struct vring_tx_data *txdata = &wil->vring_tx_data[i];

		if (!cur_vring->va || !txdata->enabled || cur_vring == vring)
			continue;

		if (wil_vring_avail_low(cur_vring)) {
			wil_dbg_txrx(wil, "vring %d full, can't wake\n",
				     (int)(cur_vring - wil->vring_tx));
			return;
		}
	}

	if (!vring || wil_vring_avail_high(vring)) {
		/* enough room in the vring */
		wil_dbg_txrx(wil, "calling netif_tx_wake\n");
		netif_tx_wake_all_queues(wil_to_ndev(wil));
		wil->net_queue_stopped = false;
	}
}

void wil_update_net_queues(struct wil6210_priv *wil, struct vring *vring,
			   bool check_stop)
{
	spin_lock(&wil->net_queue_lock);
	__wil_update_net_queues(wil, vring, check_stop);
	spin_unlock(&wil->net_queue_lock);
}

void wil_update_net_queues_bh(struct wil6210_priv *wil, struct vring *vring,
			      bool check_stop)
{
	spin_lock_bh(&wil->net_queue_lock);
	__wil_update_net_queues(wil, vring, check_stop);
	spin_unlock_bh(&wil->net_queue_lock);
}

1878 1879 1880
netdev_tx_t wil_start_xmit(struct sk_buff *skb, struct net_device *ndev)
{
	struct wil6210_priv *wil = ndev_to_wil(ndev);
1881
	struct ethhdr *eth = (void *)skb->data;
1882
	bool bcast = is_multicast_ether_addr(eth->h_dest);
1883
	struct vring *vring;
1884
	static bool pr_once_fw;
1885 1886
	int rc;

1887
	wil_dbg_txrx(wil, "%s()\n", __func__);
1888
	if (unlikely(!test_bit(wil_status_fwready, wil->status))) {
1889 1890 1891 1892
		if (!pr_once_fw) {
			wil_err(wil, "FW not ready\n");
			pr_once_fw = true;
		}
1893 1894
		goto drop;
	}
1895
	if (unlikely(!test_bit(wil_status_fwconnected, wil->status))) {
1896
		wil_dbg_ratelimited(wil, "FW not connected, packet dropped\n");
1897 1898
		goto drop;
	}
1899
	if (unlikely(wil->wdev->iftype == NL80211_IFTYPE_MONITOR)) {
1900 1901 1902
		wil_err(wil, "Xmit in monitor mode not supported\n");
		goto drop;
	}
1903
	pr_once_fw = false;
1904 1905

	/* find vring */
1906 1907 1908 1909
	if (wil->wdev->iftype == NL80211_IFTYPE_STATION) {
		/* in STA mode (ESS), all to same VRING */
		vring = wil_find_tx_vring_sta(wil, skb);
	} else { /* direct communication, find matching VRING */
1910 1911
		vring = bcast ? wil_find_tx_bcast(wil, skb) :
				wil_find_tx_ucast(wil, skb);
1912
	}
1913
	if (unlikely(!vring)) {
1914
		wil_dbg_txrx(wil, "No Tx VRING found for %pM\n", eth->h_dest);
1915
		goto drop;
1916
	}
1917 1918 1919
	/* set up vring entry */
	rc = wil_tx_vring(wil, vring, skb);

1920 1921
	switch (rc) {
	case 0:
D
Dedy Lansky 已提交
1922 1923
		/* shall we stop net queues? */
		wil_update_net_queues_bh(wil, vring, true);
1924
		/* statistics will be updated on the tx_complete */
1925 1926 1927 1928 1929
		dev_kfree_skb_any(skb);
		return NETDEV_TX_OK;
	case -ENOMEM:
		return NETDEV_TX_BUSY;
	default:
1930
		break; /* goto drop; */
1931 1932 1933 1934 1935 1936 1937 1938
	}
 drop:
	ndev->stats.tx_dropped++;
	dev_kfree_skb_any(skb);

	return NET_XMIT_DROP;
}

1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954
static inline bool wil_need_txstat(struct sk_buff *skb)
{
	struct ethhdr *eth = (void *)skb->data;

	return is_unicast_ether_addr(eth->h_dest) && skb->sk &&
	       (skb_shinfo(skb)->tx_flags & SKBTX_WIFI_STATUS);
}

static inline void wil_consume_skb(struct sk_buff *skb, bool acked)
{
	if (unlikely(wil_need_txstat(skb)))
		skb_complete_wifi_ack(skb, acked);
	else
		acked ? dev_consume_skb_any(skb) : dev_kfree_skb_any(skb);
}

1955 1956 1957
/**
 * Clean up transmitted skb's from the Tx VRING
 *
V
Vladimir Kondratiev 已提交
1958 1959
 * Return number of descriptors cleared
 *
1960 1961
 * Safe to call from IRQ
 */
V
Vladimir Kondratiev 已提交
1962
int wil_tx_complete(struct wil6210_priv *wil, int ringid)
1963
{
1964
	struct net_device *ndev = wil_to_ndev(wil);
1965 1966
	struct device *dev = wil_to_dev(wil);
	struct vring *vring = &wil->vring_tx[ringid];
1967
	struct vring_tx_data *txdata = &wil->vring_tx_data[ringid];
V
Vladimir Kondratiev 已提交
1968
	int done = 0;
1969
	int cid = wil->vring2cid_tid[ringid][0];
1970
	struct wil_net_stats *stats = NULL;
1971
	volatile struct vring_tx_desc *_d;
1972 1973
	int used_before_complete;
	int used_new;
1974

1975
	if (unlikely(!vring->va)) {
1976
		wil_err(wil, "Tx irq[%d]: vring not initialized\n", ringid);
V
Vladimir Kondratiev 已提交
1977
		return 0;
1978 1979
	}

1980
	if (unlikely(!txdata->enabled)) {
1981 1982 1983 1984
		wil_info(wil, "Tx irq[%d]: vring disabled\n", ringid);
		return 0;
	}

1985
	wil_dbg_txrx(wil, "%s(%d)\n", __func__, ringid);
1986

1987 1988
	used_before_complete = wil_vring_used_tx(vring);

1989 1990 1991
	if (cid < WIL6210_MAX_CID)
		stats = &wil->sta[cid].stats;

1992
	while (!wil_vring_is_empty(vring)) {
1993
		int new_swtail;
1994
		struct wil_ctx *ctx = &vring->ctx[vring->swtail];
1995 1996
		/**
		 * For the fragmented skb, HW will set DU bit only for the
1997 1998
		 * last fragment. look for it.
		 * In TSO the first DU will include hdr desc
1999 2000 2001
		 */
		int lf = (vring->swtail + ctx->nr_frags) % vring->size;
		/* TODO: check we are not past head */
2002

2003
		_d = &vring->va[lf].tx;
2004
		if (unlikely(!(_d->dma.status & TX_DMA_STATUS_DU)))
2005 2006
			break;

2007 2008 2009 2010
		new_swtail = (lf + 1) % vring->size;
		while (vring->swtail != new_swtail) {
			struct vring_tx_desc dd, *d = &dd;
			u16 dmalen;
2011 2012 2013 2014
			struct sk_buff *skb;

			ctx = &vring->ctx[vring->swtail];
			skb = ctx->skb;
2015
			_d = &vring->va[vring->swtail].tx;
2016

2017
			*d = *_d;
2018

2019 2020 2021 2022
			dmalen = le16_to_cpu(d->dma.length);
			trace_wil6210_tx_done(ringid, vring->swtail, dmalen,
					      d->dma.error);
			wil_dbg_txrx(wil,
V
Vladimir Kondratiev 已提交
2023 2024 2025 2026
				     "TxC[%2d][%3d] : %d bytes, status 0x%02x err 0x%02x\n",
				     ringid, vring->swtail, dmalen,
				     d->dma.status, d->dma.error);
			wil_hex_dump_txrx("TxCD ", DUMP_PREFIX_NONE, 32, 4,
2027
					  (const void *)d, sizeof(*d), false);
2028

2029
			wil_txdesc_unmap(dev, d, ctx);
2030 2031

			if (skb) {
2032
				if (likely(d->dma.error == 0)) {
2033 2034
					ndev->stats.tx_packets++;
					ndev->stats.tx_bytes += skb->len;
2035 2036 2037 2038
					if (stats) {
						stats->tx_packets++;
						stats->tx_bytes += skb->len;
					}
2039 2040
				} else {
					ndev->stats.tx_errors++;
2041 2042
					if (stats)
						stats->tx_errors++;
2043
				}
2044
				wil_consume_skb(skb, d->dma.error == 0);
2045 2046
			}
			memset(ctx, 0, sizeof(*ctx));
2047 2048 2049 2050 2051 2052
			/* Make sure the ctx is zeroed before updating the tail
			 * to prevent a case where wil_tx_vring will see
			 * this descriptor as used and handle it before ctx zero
			 * is completed.
			 */
			wmb();
2053 2054 2055 2056 2057 2058 2059
			/* There is no need to touch HW descriptor:
			 * - ststus bit TX_DMA_STATUS_DU is set by design,
			 *   so hardware will not try to process this desc.,
			 * - rest of descriptor will be initialized on Tx.
			 */
			vring->swtail = wil_vring_next_tail(vring);
			done++;
2060 2061
		}
	}
2062

2063 2064 2065 2066 2067 2068
	/* performance monitoring */
	used_new = wil_vring_used_tx(vring);
	if (wil_val_in_range(vring_idle_trsh,
			     used_new, used_before_complete)) {
		wil_dbg_txrx(wil, "Ring[%2d] idle %d -> %d\n",
			     ringid, used_before_complete, used_new);
2069 2070
		txdata->last_idle = get_cycles();
	}
2071

D
Dedy Lansky 已提交
2072 2073 2074
	/* shall we wake net queues? */
	if (done)
		wil_update_net_queues(wil, vring, false);
V
Vladimir Kondratiev 已提交
2075 2076

	return done;
2077
}