185630469SLior David // SPDX-License-Identifier: ISC
296c93589SGidon Studinski /*
3bf0353a6SAhmad Masri  * Copyright (c) 2012-2019 The Linux Foundation. All rights reserved.
496c93589SGidon Studinski  */
596c93589SGidon Studinski 
696c93589SGidon Studinski #include <linux/etherdevice.h>
796c93589SGidon Studinski #include <linux/moduleparam.h>
896c93589SGidon Studinski #include <linux/prefetch.h>
996c93589SGidon Studinski #include <linux/types.h>
1096c93589SGidon Studinski #include <linux/list.h>
1196c93589SGidon Studinski #include <linux/ip.h>
1296c93589SGidon Studinski #include <linux/ipv6.h>
1396c93589SGidon Studinski #include "wil6210.h"
1496c93589SGidon Studinski #include "txrx_edma.h"
1596c93589SGidon Studinski #include "txrx.h"
169202d7b6SMaya Erez #include "trace.h"
1796c93589SGidon Studinski 
1896b77bb0SAhmad Masri /* Max number of entries (packets to complete) to update the hwtail of tx
1996b77bb0SAhmad Masri  * status ring. Should be power of 2
2096b77bb0SAhmad Masri  */
2196b77bb0SAhmad Masri #define WIL_EDMA_TX_SRING_UPDATE_HW_TAIL 128
2296c93589SGidon Studinski #define WIL_EDMA_MAX_DATA_OFFSET (2)
231bb38e8bSMaya Erez /* RX buffer size must be aligned to 4 bytes */
241bb38e8bSMaya Erez #define WIL_EDMA_RX_BUF_LEN_DEFAULT (2048)
25b4a967b7SMaya Erez #define MAX_INVALID_BUFF_ID_RETRY (3)
2696c93589SGidon Studinski 
wil_tx_desc_unmap_edma(struct device * dev,union wil_tx_desc * desc,struct wil_ctx * ctx)2796c93589SGidon Studinski static void wil_tx_desc_unmap_edma(struct device *dev,
289202d7b6SMaya Erez 				   union wil_tx_desc *desc,
2996c93589SGidon Studinski 				   struct wil_ctx *ctx)
3096c93589SGidon Studinski {
319202d7b6SMaya Erez 	struct wil_tx_enhanced_desc *d = (struct wil_tx_enhanced_desc *)desc;
3296c93589SGidon Studinski 	dma_addr_t pa = wil_tx_desc_get_addr_edma(&d->dma);
3396c93589SGidon Studinski 	u16 dmalen = le16_to_cpu(d->dma.length);
3496c93589SGidon Studinski 
3596c93589SGidon Studinski 	switch (ctx->mapped_as) {
3696c93589SGidon Studinski 	case wil_mapped_as_single:
3796c93589SGidon Studinski 		dma_unmap_single(dev, pa, dmalen, DMA_TO_DEVICE);
3896c93589SGidon Studinski 		break;
3996c93589SGidon Studinski 	case wil_mapped_as_page:
4096c93589SGidon Studinski 		dma_unmap_page(dev, pa, dmalen, DMA_TO_DEVICE);
4196c93589SGidon Studinski 		break;
4296c93589SGidon Studinski 	default:
4396c93589SGidon Studinski 		break;
4496c93589SGidon Studinski 	}
4596c93589SGidon Studinski }
4696c93589SGidon Studinski 
wil_find_free_sring(struct wil6210_priv * wil)4796c93589SGidon Studinski static int wil_find_free_sring(struct wil6210_priv *wil)
4896c93589SGidon Studinski {
4996c93589SGidon Studinski 	int i;
5096c93589SGidon Studinski 
5196c93589SGidon Studinski 	for (i = 0; i < WIL6210_MAX_STATUS_RINGS; i++) {
5296c93589SGidon Studinski 		if (!wil->srings[i].va)
5396c93589SGidon Studinski 			return i;
5496c93589SGidon Studinski 	}
5596c93589SGidon Studinski 
5696c93589SGidon Studinski 	return -EINVAL;
5796c93589SGidon Studinski }
5896c93589SGidon Studinski 
wil_sring_free(struct wil6210_priv * wil,struct wil_status_ring * sring)5996c93589SGidon Studinski static void wil_sring_free(struct wil6210_priv *wil,
6096c93589SGidon Studinski 			   struct wil_status_ring *sring)
6196c93589SGidon Studinski {
6296c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
6396c93589SGidon Studinski 	size_t sz;
6496c93589SGidon Studinski 
6596c93589SGidon Studinski 	if (!sring || !sring->va)
6696c93589SGidon Studinski 		return;
6796c93589SGidon Studinski 
6896c93589SGidon Studinski 	sz = sring->elem_size * sring->size;
6996c93589SGidon Studinski 
7096c93589SGidon Studinski 	wil_dbg_misc(wil, "status_ring_free, size(bytes)=%zu, 0x%p:%pad\n",
7196c93589SGidon Studinski 		     sz, sring->va, &sring->pa);
7296c93589SGidon Studinski 
7396c93589SGidon Studinski 	dma_free_coherent(dev, sz, (void *)sring->va, sring->pa);
7496c93589SGidon Studinski 	sring->pa = 0;
7596c93589SGidon Studinski 	sring->va = NULL;
7696c93589SGidon Studinski }
7796c93589SGidon Studinski 
wil_sring_alloc(struct wil6210_priv * wil,struct wil_status_ring * sring)7896c93589SGidon Studinski static int wil_sring_alloc(struct wil6210_priv *wil,
7996c93589SGidon Studinski 			   struct wil_status_ring *sring)
8096c93589SGidon Studinski {
8196c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
8296c93589SGidon Studinski 	size_t sz = sring->elem_size * sring->size;
8396c93589SGidon Studinski 
8496c93589SGidon Studinski 	wil_dbg_misc(wil, "status_ring_alloc: size=%zu\n", sz);
8596c93589SGidon Studinski 
8696c93589SGidon Studinski 	if (sz == 0) {
8796c93589SGidon Studinski 		wil_err(wil, "Cannot allocate a zero size status ring\n");
8896c93589SGidon Studinski 		return -EINVAL;
8996c93589SGidon Studinski 	}
9096c93589SGidon Studinski 
9196c93589SGidon Studinski 	sring->swhead = 0;
9296c93589SGidon Studinski 
9396c93589SGidon Studinski 	/* Status messages are allocated and initialized to 0. This is necessary
9496c93589SGidon Studinski 	 * since DR bit should be initialized to 0.
9596c93589SGidon Studinski 	 */
96750afb08SLuis Chamberlain 	sring->va = dma_alloc_coherent(dev, sz, &sring->pa, GFP_KERNEL);
9796c93589SGidon Studinski 	if (!sring->va)
9896c93589SGidon Studinski 		return -ENOMEM;
9996c93589SGidon Studinski 
10096c93589SGidon Studinski 	wil_dbg_misc(wil, "status_ring[%d] 0x%p:%pad\n", sring->size, sring->va,
10196c93589SGidon Studinski 		     &sring->pa);
10296c93589SGidon Studinski 
10396c93589SGidon Studinski 	return 0;
10496c93589SGidon Studinski }
10596c93589SGidon Studinski 
wil_tx_init_edma(struct wil6210_priv * wil)10696c93589SGidon Studinski static int wil_tx_init_edma(struct wil6210_priv *wil)
10796c93589SGidon Studinski {
10896c93589SGidon Studinski 	int ring_id = wil_find_free_sring(wil);
10996c93589SGidon Studinski 	struct wil_status_ring *sring;
11096c93589SGidon Studinski 	int rc;
11196c93589SGidon Studinski 	u16 status_ring_size;
11296c93589SGidon Studinski 
11396c93589SGidon Studinski 	if (wil->tx_status_ring_order < WIL_SRING_SIZE_ORDER_MIN ||
11496c93589SGidon Studinski 	    wil->tx_status_ring_order > WIL_SRING_SIZE_ORDER_MAX)
11596c93589SGidon Studinski 		wil->tx_status_ring_order = WIL_TX_SRING_SIZE_ORDER_DEFAULT;
11696c93589SGidon Studinski 
11796c93589SGidon Studinski 	status_ring_size = 1 << wil->tx_status_ring_order;
11896c93589SGidon Studinski 
11996c93589SGidon Studinski 	wil_dbg_misc(wil, "init TX sring: size=%u, ring_id=%u\n",
12096c93589SGidon Studinski 		     status_ring_size, ring_id);
12196c93589SGidon Studinski 
12296c93589SGidon Studinski 	if (ring_id < 0)
12396c93589SGidon Studinski 		return ring_id;
12496c93589SGidon Studinski 
12596c93589SGidon Studinski 	/* Allocate Tx status ring. Tx descriptor rings will be
12696c93589SGidon Studinski 	 * allocated on WMI connect event
12796c93589SGidon Studinski 	 */
12896c93589SGidon Studinski 	sring = &wil->srings[ring_id];
12996c93589SGidon Studinski 
13096c93589SGidon Studinski 	sring->is_rx = false;
13196c93589SGidon Studinski 	sring->size = status_ring_size;
13296c93589SGidon Studinski 	sring->elem_size = sizeof(struct wil_ring_tx_status);
13396c93589SGidon Studinski 	rc = wil_sring_alloc(wil, sring);
13496c93589SGidon Studinski 	if (rc)
13596c93589SGidon Studinski 		return rc;
13696c93589SGidon Studinski 
13796c93589SGidon Studinski 	rc = wil_wmi_tx_sring_cfg(wil, ring_id);
13896c93589SGidon Studinski 	if (rc)
13996c93589SGidon Studinski 		goto out_free;
14096c93589SGidon Studinski 
14196c93589SGidon Studinski 	sring->desc_rdy_pol = 1;
14296c93589SGidon Studinski 	wil->tx_sring_idx = ring_id;
14396c93589SGidon Studinski 
14496c93589SGidon Studinski 	return 0;
14596c93589SGidon Studinski out_free:
14696c93589SGidon Studinski 	wil_sring_free(wil, sring);
14796c93589SGidon Studinski 	return rc;
14896c93589SGidon Studinski }
14996c93589SGidon Studinski 
150e2d651b9SLee Jones /* Allocate one skb for Rx descriptor RING */
wil_ring_alloc_skb_edma(struct wil6210_priv * wil,struct wil_ring * ring,u32 i)15196c93589SGidon Studinski static int wil_ring_alloc_skb_edma(struct wil6210_priv *wil,
15296c93589SGidon Studinski 				   struct wil_ring *ring, u32 i)
15396c93589SGidon Studinski {
15496c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
155a834df74SAhmad Masri 	unsigned int sz = wil->rx_buf_len;
15696c93589SGidon Studinski 	dma_addr_t pa;
15796c93589SGidon Studinski 	u16 buff_id;
15896c93589SGidon Studinski 	struct list_head *active = &wil->rx_buff_mgmt.active;
15996c93589SGidon Studinski 	struct list_head *free = &wil->rx_buff_mgmt.free;
16096c93589SGidon Studinski 	struct wil_rx_buff *rx_buff;
16196c93589SGidon Studinski 	struct wil_rx_buff *buff_arr = wil->rx_buff_mgmt.buff_arr;
16296c93589SGidon Studinski 	struct sk_buff *skb;
16396c93589SGidon Studinski 	struct wil_rx_enhanced_desc dd, *d = &dd;
16496c93589SGidon Studinski 	struct wil_rx_enhanced_desc *_d = (struct wil_rx_enhanced_desc *)
16596c93589SGidon Studinski 		&ring->va[i].rx.enhanced;
16696c93589SGidon Studinski 
16796c93589SGidon Studinski 	if (unlikely(list_empty(free))) {
16896c93589SGidon Studinski 		wil->rx_buff_mgmt.free_list_empty_cnt++;
16996c93589SGidon Studinski 		return -EAGAIN;
17096c93589SGidon Studinski 	}
17196c93589SGidon Studinski 
17296c93589SGidon Studinski 	skb = dev_alloc_skb(sz);
17396c93589SGidon Studinski 	if (unlikely(!skb))
17496c93589SGidon Studinski 		return -ENOMEM;
17596c93589SGidon Studinski 
17696c93589SGidon Studinski 	skb_put(skb, sz);
17796c93589SGidon Studinski 
1780b853210SMaya Erez 	/**
1790b853210SMaya Erez 	 * Make sure that the network stack calculates checksum for packets
1800b853210SMaya Erez 	 * which failed the HW checksum calculation
1810b853210SMaya Erez 	 */
1820b853210SMaya Erez 	skb->ip_summed = CHECKSUM_NONE;
1830b853210SMaya Erez 
18496c93589SGidon Studinski 	pa = dma_map_single(dev, skb->data, skb->len, DMA_FROM_DEVICE);
18596c93589SGidon Studinski 	if (unlikely(dma_mapping_error(dev, pa))) {
18696c93589SGidon Studinski 		kfree_skb(skb);
18796c93589SGidon Studinski 		return -ENOMEM;
18896c93589SGidon Studinski 	}
18996c93589SGidon Studinski 
19096c93589SGidon Studinski 	/* Get the buffer ID - the index of the rx buffer in the buff_arr */
19196c93589SGidon Studinski 	rx_buff = list_first_entry(free, struct wil_rx_buff, list);
19296c93589SGidon Studinski 	buff_id = rx_buff->id;
19396c93589SGidon Studinski 
19496c93589SGidon Studinski 	/* Move a buffer from the free list to the active list */
19596c93589SGidon Studinski 	list_move(&rx_buff->list, active);
19696c93589SGidon Studinski 
19796c93589SGidon Studinski 	buff_arr[buff_id].skb = skb;
19896c93589SGidon Studinski 
19996c93589SGidon Studinski 	wil_desc_set_addr_edma(&d->dma.addr, &d->dma.addr_high_high, pa);
20096c93589SGidon Studinski 	d->dma.length = cpu_to_le16(sz);
20196c93589SGidon Studinski 	d->mac.buff_id = cpu_to_le16(buff_id);
20296c93589SGidon Studinski 	*_d = *d;
20396c93589SGidon Studinski 
20496c93589SGidon Studinski 	/* Save the physical address in skb->cb for later use in dma_unmap */
20596c93589SGidon Studinski 	memcpy(skb->cb, &pa, sizeof(pa));
20696c93589SGidon Studinski 
20796c93589SGidon Studinski 	return 0;
20896c93589SGidon Studinski }
20996c93589SGidon Studinski 
2107be13fc3SGidon Studinski static inline
wil_get_next_rx_status_msg(struct wil_status_ring * sring,u8 * dr_bit,void * msg)211f4519fd9SDedy Lansky void wil_get_next_rx_status_msg(struct wil_status_ring *sring, u8 *dr_bit,
212f4519fd9SDedy Lansky 				void *msg)
2137be13fc3SGidon Studinski {
214f4519fd9SDedy Lansky 	struct wil_rx_status_compressed *_msg;
215f4519fd9SDedy Lansky 
216f4519fd9SDedy Lansky 	_msg = (struct wil_rx_status_compressed *)
217f4519fd9SDedy Lansky 		(sring->va + (sring->elem_size * sring->swhead));
218f4519fd9SDedy Lansky 	*dr_bit = WIL_GET_BITS(_msg->d0, 31, 31);
219f4519fd9SDedy Lansky 	/* make sure dr_bit is read before the rest of status msg */
220f4519fd9SDedy Lansky 	rmb();
221f4519fd9SDedy Lansky 	memcpy(msg, (void *)_msg, sring->elem_size);
2227be13fc3SGidon Studinski }
2237be13fc3SGidon Studinski 
wil_sring_advance_swhead(struct wil_status_ring * sring)2249202d7b6SMaya Erez static inline void wil_sring_advance_swhead(struct wil_status_ring *sring)
2259202d7b6SMaya Erez {
2269202d7b6SMaya Erez 	sring->swhead = (sring->swhead + 1) % sring->size;
2279202d7b6SMaya Erez 	if (sring->swhead == 0)
2289202d7b6SMaya Erez 		sring->desc_rdy_pol = 1 - sring->desc_rdy_pol;
2299202d7b6SMaya Erez }
2309202d7b6SMaya Erez 
wil_rx_refill_edma(struct wil6210_priv * wil)23196c93589SGidon Studinski static int wil_rx_refill_edma(struct wil6210_priv *wil)
23296c93589SGidon Studinski {
23396c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
23496c93589SGidon Studinski 	u32 next_head;
23596c93589SGidon Studinski 	int rc = 0;
2366470f319SAhmad Masri 	ring->swtail = *ring->edma_rx_swtail.va;
23796c93589SGidon Studinski 
2386470f319SAhmad Masri 	for (; next_head = wil_ring_next_head(ring),
2396470f319SAhmad Masri 	     (next_head != ring->swtail);
24096c93589SGidon Studinski 	     ring->swhead = next_head) {
24196c93589SGidon Studinski 		rc = wil_ring_alloc_skb_edma(wil, ring, ring->swhead);
24296c93589SGidon Studinski 		if (unlikely(rc)) {
24396c93589SGidon Studinski 			if (rc == -EAGAIN)
24496c93589SGidon Studinski 				wil_dbg_txrx(wil, "No free buffer ID found\n");
24596c93589SGidon Studinski 			else
24696c93589SGidon Studinski 				wil_err_ratelimited(wil,
24796c93589SGidon Studinski 						    "Error %d in refill desc[%d]\n",
24896c93589SGidon Studinski 						    rc, ring->swhead);
24996c93589SGidon Studinski 			break;
25096c93589SGidon Studinski 		}
25196c93589SGidon Studinski 	}
25296c93589SGidon Studinski 
25396c93589SGidon Studinski 	/* make sure all writes to descriptors (shared memory) are done before
25496c93589SGidon Studinski 	 * committing them to HW
25596c93589SGidon Studinski 	 */
25696c93589SGidon Studinski 	wmb();
25796c93589SGidon Studinski 
25896c93589SGidon Studinski 	wil_w(wil, ring->hwtail, ring->swhead);
25996c93589SGidon Studinski 
26096c93589SGidon Studinski 	return rc;
26196c93589SGidon Studinski }
26296c93589SGidon Studinski 
wil_move_all_rx_buff_to_free_list(struct wil6210_priv * wil,struct wil_ring * ring)26396c93589SGidon Studinski static void wil_move_all_rx_buff_to_free_list(struct wil6210_priv *wil,
26496c93589SGidon Studinski 					      struct wil_ring *ring)
26596c93589SGidon Studinski {
26696c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
2676470f319SAhmad Masri 	struct list_head *active = &wil->rx_buff_mgmt.active;
26896c93589SGidon Studinski 	dma_addr_t pa;
26996c93589SGidon Studinski 
270d6a553c0SDedy Lansky 	if (!wil->rx_buff_mgmt.buff_arr)
271d6a553c0SDedy Lansky 		return;
272d6a553c0SDedy Lansky 
2736470f319SAhmad Masri 	while (!list_empty(active)) {
2746470f319SAhmad Masri 		struct wil_rx_buff *rx_buff =
2756470f319SAhmad Masri 			list_first_entry(active, struct wil_rx_buff, list);
2766470f319SAhmad Masri 		struct sk_buff *skb = rx_buff->skb;
27796c93589SGidon Studinski 
27884f16fbbSMaya Erez 		if (unlikely(!skb)) {
2796470f319SAhmad Masri 			wil_err(wil, "No Rx skb at buff_id %d\n", rx_buff->id);
28084f16fbbSMaya Erez 		} else {
2816470f319SAhmad Masri 			rx_buff->skb = NULL;
2826470f319SAhmad Masri 			memcpy(&pa, skb->cb, sizeof(pa));
2836470f319SAhmad Masri 			dma_unmap_single(dev, pa, wil->rx_buf_len,
2846470f319SAhmad Masri 					 DMA_FROM_DEVICE);
28596c93589SGidon Studinski 			kfree_skb(skb);
28684f16fbbSMaya Erez 		}
28796c93589SGidon Studinski 
28896c93589SGidon Studinski 		/* Move the buffer from the active to the free list */
2896470f319SAhmad Masri 		list_move(&rx_buff->list, &wil->rx_buff_mgmt.free);
29096c93589SGidon Studinski 	}
29196c93589SGidon Studinski }
29296c93589SGidon Studinski 
wil_free_rx_buff_arr(struct wil6210_priv * wil)29396c93589SGidon Studinski static void wil_free_rx_buff_arr(struct wil6210_priv *wil)
29496c93589SGidon Studinski {
29596c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
29696c93589SGidon Studinski 
29796c93589SGidon Studinski 	if (!wil->rx_buff_mgmt.buff_arr)
29896c93589SGidon Studinski 		return;
29996c93589SGidon Studinski 
30096c93589SGidon Studinski 	/* Move all the buffers to the free list in case active list is
30196c93589SGidon Studinski 	 * not empty in order to release all SKBs before deleting the array
30296c93589SGidon Studinski 	 */
30396c93589SGidon Studinski 	wil_move_all_rx_buff_to_free_list(wil, ring);
30496c93589SGidon Studinski 
30596c93589SGidon Studinski 	kfree(wil->rx_buff_mgmt.buff_arr);
30696c93589SGidon Studinski 	wil->rx_buff_mgmt.buff_arr = NULL;
30796c93589SGidon Studinski }
30896c93589SGidon Studinski 
wil_init_rx_buff_arr(struct wil6210_priv * wil,size_t size)30996c93589SGidon Studinski static int wil_init_rx_buff_arr(struct wil6210_priv *wil,
31096c93589SGidon Studinski 				size_t size)
31196c93589SGidon Studinski {
31296c93589SGidon Studinski 	struct wil_rx_buff *buff_arr;
31396c93589SGidon Studinski 	struct list_head *active = &wil->rx_buff_mgmt.active;
31496c93589SGidon Studinski 	struct list_head *free = &wil->rx_buff_mgmt.free;
31596c93589SGidon Studinski 	int i;
31696c93589SGidon Studinski 
317b4a967b7SMaya Erez 	wil->rx_buff_mgmt.buff_arr = kcalloc(size + 1,
318b4a967b7SMaya Erez 					     sizeof(struct wil_rx_buff),
31996c93589SGidon Studinski 					     GFP_KERNEL);
32096c93589SGidon Studinski 	if (!wil->rx_buff_mgmt.buff_arr)
32196c93589SGidon Studinski 		return -ENOMEM;
32296c93589SGidon Studinski 
32396c93589SGidon Studinski 	/* Set list heads */
32496c93589SGidon Studinski 	INIT_LIST_HEAD(active);
32596c93589SGidon Studinski 	INIT_LIST_HEAD(free);
32696c93589SGidon Studinski 
327b4a967b7SMaya Erez 	/* Linkify the list.
328b4a967b7SMaya Erez 	 * buffer id 0 should not be used (marks invalid id).
329b4a967b7SMaya Erez 	 */
33096c93589SGidon Studinski 	buff_arr = wil->rx_buff_mgmt.buff_arr;
331b4a967b7SMaya Erez 	for (i = 1; i <= size; i++) {
33296c93589SGidon Studinski 		list_add(&buff_arr[i].list, free);
33396c93589SGidon Studinski 		buff_arr[i].id = i;
33496c93589SGidon Studinski 	}
33596c93589SGidon Studinski 
336b4a967b7SMaya Erez 	wil->rx_buff_mgmt.size = size + 1;
33796c93589SGidon Studinski 
33896c93589SGidon Studinski 	return 0;
33996c93589SGidon Studinski }
34096c93589SGidon Studinski 
wil_init_rx_sring(struct wil6210_priv * wil,u16 status_ring_size,size_t elem_size,u16 ring_id)34196c93589SGidon Studinski static int wil_init_rx_sring(struct wil6210_priv *wil,
34296c93589SGidon Studinski 			     u16 status_ring_size,
34396c93589SGidon Studinski 			     size_t elem_size,
34496c93589SGidon Studinski 			     u16 ring_id)
34596c93589SGidon Studinski {
34696c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[ring_id];
34796c93589SGidon Studinski 	int rc;
34896c93589SGidon Studinski 
349cbebe277SMaya Erez 	wil_dbg_misc(wil, "init RX sring: size=%u, ring_id=%u\n",
350cbebe277SMaya Erez 		     status_ring_size, ring_id);
35196c93589SGidon Studinski 
35296c93589SGidon Studinski 	memset(&sring->rx_data, 0, sizeof(sring->rx_data));
35396c93589SGidon Studinski 
35496c93589SGidon Studinski 	sring->is_rx = true;
35596c93589SGidon Studinski 	sring->size = status_ring_size;
35696c93589SGidon Studinski 	sring->elem_size = elem_size;
35796c93589SGidon Studinski 	rc = wil_sring_alloc(wil, sring);
35896c93589SGidon Studinski 	if (rc)
35996c93589SGidon Studinski 		return rc;
36096c93589SGidon Studinski 
36196c93589SGidon Studinski 	rc = wil_wmi_rx_sring_add(wil, ring_id);
36296c93589SGidon Studinski 	if (rc)
36396c93589SGidon Studinski 		goto out_free;
36496c93589SGidon Studinski 
36596c93589SGidon Studinski 	sring->desc_rdy_pol = 1;
36696c93589SGidon Studinski 
36796c93589SGidon Studinski 	return 0;
36896c93589SGidon Studinski out_free:
36996c93589SGidon Studinski 	wil_sring_free(wil, sring);
37096c93589SGidon Studinski 	return rc;
37196c93589SGidon Studinski }
37296c93589SGidon Studinski 
wil_ring_alloc_desc_ring(struct wil6210_priv * wil,struct wil_ring * ring)37396c93589SGidon Studinski static int wil_ring_alloc_desc_ring(struct wil6210_priv *wil,
37496c93589SGidon Studinski 				    struct wil_ring *ring)
37596c93589SGidon Studinski {
37696c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
37796c93589SGidon Studinski 	size_t sz = ring->size * sizeof(ring->va[0]);
37896c93589SGidon Studinski 
37996c93589SGidon Studinski 	wil_dbg_misc(wil, "alloc_desc_ring:\n");
38096c93589SGidon Studinski 
38196c93589SGidon Studinski 	BUILD_BUG_ON(sizeof(ring->va[0]) != 32);
38296c93589SGidon Studinski 
38396c93589SGidon Studinski 	ring->swhead = 0;
38496c93589SGidon Studinski 	ring->swtail = 0;
38596c93589SGidon Studinski 	ring->ctx = kcalloc(ring->size, sizeof(ring->ctx[0]), GFP_KERNEL);
38696c93589SGidon Studinski 	if (!ring->ctx)
38796c93589SGidon Studinski 		goto err;
38896c93589SGidon Studinski 
389750afb08SLuis Chamberlain 	ring->va = dma_alloc_coherent(dev, sz, &ring->pa, GFP_KERNEL);
39096c93589SGidon Studinski 	if (!ring->va)
39196c93589SGidon Studinski 		goto err_free_ctx;
39296c93589SGidon Studinski 
39396c93589SGidon Studinski 	if (ring->is_rx) {
39496c93589SGidon Studinski 		sz = sizeof(*ring->edma_rx_swtail.va);
39596c93589SGidon Studinski 		ring->edma_rx_swtail.va =
396750afb08SLuis Chamberlain 			dma_alloc_coherent(dev, sz, &ring->edma_rx_swtail.pa,
39796c93589SGidon Studinski 					   GFP_KERNEL);
39896c93589SGidon Studinski 		if (!ring->edma_rx_swtail.va)
39996c93589SGidon Studinski 			goto err_free_va;
40096c93589SGidon Studinski 	}
40196c93589SGidon Studinski 
40296c93589SGidon Studinski 	wil_dbg_misc(wil, "%s ring[%d] 0x%p:%pad 0x%p\n",
40396c93589SGidon Studinski 		     ring->is_rx ? "RX" : "TX",
40496c93589SGidon Studinski 		     ring->size, ring->va, &ring->pa, ring->ctx);
40596c93589SGidon Studinski 
40696c93589SGidon Studinski 	return 0;
40796c93589SGidon Studinski err_free_va:
40896c93589SGidon Studinski 	dma_free_coherent(dev, ring->size * sizeof(ring->va[0]),
40996c93589SGidon Studinski 			  (void *)ring->va, ring->pa);
41096c93589SGidon Studinski 	ring->va = NULL;
41196c93589SGidon Studinski err_free_ctx:
41296c93589SGidon Studinski 	kfree(ring->ctx);
41396c93589SGidon Studinski 	ring->ctx = NULL;
41496c93589SGidon Studinski err:
41596c93589SGidon Studinski 	return -ENOMEM;
41696c93589SGidon Studinski }
41796c93589SGidon Studinski 
wil_ring_free_edma(struct wil6210_priv * wil,struct wil_ring * ring)41896c93589SGidon Studinski static void wil_ring_free_edma(struct wil6210_priv *wil, struct wil_ring *ring)
41996c93589SGidon Studinski {
42096c93589SGidon Studinski 	struct device *dev = wil_to_dev(wil);
42196c93589SGidon Studinski 	size_t sz;
42296c93589SGidon Studinski 	int ring_index = 0;
42396c93589SGidon Studinski 
42496c93589SGidon Studinski 	if (!ring->va)
42596c93589SGidon Studinski 		return;
42696c93589SGidon Studinski 
42796c93589SGidon Studinski 	sz = ring->size * sizeof(ring->va[0]);
42896c93589SGidon Studinski 
42996c93589SGidon Studinski 	lockdep_assert_held(&wil->mutex);
43096c93589SGidon Studinski 	if (ring->is_rx) {
43196c93589SGidon Studinski 		wil_dbg_misc(wil, "free Rx ring [%d] 0x%p:%pad 0x%p\n",
43296c93589SGidon Studinski 			     ring->size, ring->va,
43396c93589SGidon Studinski 			     &ring->pa, ring->ctx);
43496c93589SGidon Studinski 
43596c93589SGidon Studinski 		wil_move_all_rx_buff_to_free_list(wil, ring);
43629ca3760SDedy Lansky 		dma_free_coherent(dev, sizeof(*ring->edma_rx_swtail.va),
43729ca3760SDedy Lansky 				  ring->edma_rx_swtail.va,
43829ca3760SDedy Lansky 				  ring->edma_rx_swtail.pa);
43996c93589SGidon Studinski 		goto out;
44096c93589SGidon Studinski 	}
44196c93589SGidon Studinski 
44296c93589SGidon Studinski 	/* TX ring */
44396c93589SGidon Studinski 	ring_index = ring - wil->ring_tx;
44496c93589SGidon Studinski 
44596c93589SGidon Studinski 	wil_dbg_misc(wil, "free Tx ring %d [%d] 0x%p:%pad 0x%p\n",
44696c93589SGidon Studinski 		     ring_index, ring->size, ring->va,
44796c93589SGidon Studinski 		     &ring->pa, ring->ctx);
44896c93589SGidon Studinski 
44996c93589SGidon Studinski 	while (!wil_ring_is_empty(ring)) {
45096c93589SGidon Studinski 		struct wil_ctx *ctx;
45196c93589SGidon Studinski 
45296c93589SGidon Studinski 		struct wil_tx_enhanced_desc dd, *d = &dd;
45396c93589SGidon Studinski 		struct wil_tx_enhanced_desc *_d =
45496c93589SGidon Studinski 			(struct wil_tx_enhanced_desc *)
45596c93589SGidon Studinski 			&ring->va[ring->swtail].tx.enhanced;
45696c93589SGidon Studinski 
45796c93589SGidon Studinski 		ctx = &ring->ctx[ring->swtail];
45896c93589SGidon Studinski 		if (!ctx) {
45996c93589SGidon Studinski 			wil_dbg_txrx(wil,
46096c93589SGidon Studinski 				     "ctx(%d) was already completed\n",
46196c93589SGidon Studinski 				     ring->swtail);
46296c93589SGidon Studinski 			ring->swtail = wil_ring_next_tail(ring);
46396c93589SGidon Studinski 			continue;
46496c93589SGidon Studinski 		}
46596c93589SGidon Studinski 		*d = *_d;
4669202d7b6SMaya Erez 		wil_tx_desc_unmap_edma(dev, (union wil_tx_desc *)d, ctx);
46796c93589SGidon Studinski 		if (ctx->skb)
46896c93589SGidon Studinski 			dev_kfree_skb_any(ctx->skb);
46996c93589SGidon Studinski 		ring->swtail = wil_ring_next_tail(ring);
47096c93589SGidon Studinski 	}
47196c93589SGidon Studinski 
47296c93589SGidon Studinski out:
47396c93589SGidon Studinski 	dma_free_coherent(dev, sz, (void *)ring->va, ring->pa);
47496c93589SGidon Studinski 	kfree(ring->ctx);
47596c93589SGidon Studinski 	ring->pa = 0;
47696c93589SGidon Studinski 	ring->va = NULL;
47796c93589SGidon Studinski 	ring->ctx = NULL;
47896c93589SGidon Studinski }
47996c93589SGidon Studinski 
wil_init_rx_desc_ring(struct wil6210_priv * wil,u16 desc_ring_size,int status_ring_id)48096c93589SGidon Studinski static int wil_init_rx_desc_ring(struct wil6210_priv *wil, u16 desc_ring_size,
48196c93589SGidon Studinski 				 int status_ring_id)
48296c93589SGidon Studinski {
48396c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
48496c93589SGidon Studinski 	int rc;
48596c93589SGidon Studinski 
48696c93589SGidon Studinski 	wil_dbg_misc(wil, "init RX desc ring\n");
48796c93589SGidon Studinski 
48896c93589SGidon Studinski 	ring->size = desc_ring_size;
48996c93589SGidon Studinski 	ring->is_rx = true;
49096c93589SGidon Studinski 	rc = wil_ring_alloc_desc_ring(wil, ring);
49196c93589SGidon Studinski 	if (rc)
49296c93589SGidon Studinski 		return rc;
49396c93589SGidon Studinski 
49496c93589SGidon Studinski 	rc = wil_wmi_rx_desc_ring_add(wil, status_ring_id);
49596c93589SGidon Studinski 	if (rc)
49696c93589SGidon Studinski 		goto out_free;
49796c93589SGidon Studinski 
49896c93589SGidon Studinski 	return 0;
49996c93589SGidon Studinski out_free:
50096c93589SGidon Studinski 	wil_ring_free_edma(wil, ring);
50196c93589SGidon Studinski 	return rc;
50296c93589SGidon Studinski }
50396c93589SGidon Studinski 
wil_get_reorder_params_edma(struct wil6210_priv * wil,struct sk_buff * skb,int * tid,int * cid,int * mid,u16 * seq,int * mcast,int * retry)5047be13fc3SGidon Studinski static void wil_get_reorder_params_edma(struct wil6210_priv *wil,
5057be13fc3SGidon Studinski 					struct sk_buff *skb, int *tid,
5067be13fc3SGidon Studinski 					int *cid, int *mid, u16 *seq,
5071bd82ee0SDedy Lansky 					int *mcast, int *retry)
5087be13fc3SGidon Studinski {
5097be13fc3SGidon Studinski 	struct wil_rx_status_extended *s = wil_skb_rxstatus(skb);
5107be13fc3SGidon Studinski 
5117be13fc3SGidon Studinski 	*tid = wil_rx_status_get_tid(s);
5127be13fc3SGidon Studinski 	*cid = wil_rx_status_get_cid(s);
5137be13fc3SGidon Studinski 	*mid = wil_rx_status_get_mid(s);
5147be13fc3SGidon Studinski 	*seq = le16_to_cpu(wil_rx_status_get_seq(wil, s));
5157be13fc3SGidon Studinski 	*mcast = wil_rx_status_get_mcast(s);
5161bd82ee0SDedy Lansky 	*retry = wil_rx_status_get_retry(s);
5177be13fc3SGidon Studinski }
5187be13fc3SGidon Studinski 
wil_get_netif_rx_params_edma(struct sk_buff * skb,int * cid,int * security)5197be13fc3SGidon Studinski static void wil_get_netif_rx_params_edma(struct sk_buff *skb, int *cid,
5207be13fc3SGidon Studinski 					 int *security)
5217be13fc3SGidon Studinski {
5227be13fc3SGidon Studinski 	struct wil_rx_status_extended *s = wil_skb_rxstatus(skb);
5237be13fc3SGidon Studinski 
5247be13fc3SGidon Studinski 	*cid = wil_rx_status_get_cid(s);
5257be13fc3SGidon Studinski 	*security = wil_rx_status_get_security(s);
5267be13fc3SGidon Studinski }
5277be13fc3SGidon Studinski 
wil_rx_crypto_check_edma(struct wil6210_priv * wil,struct sk_buff * skb)5287be13fc3SGidon Studinski static int wil_rx_crypto_check_edma(struct wil6210_priv *wil,
5297be13fc3SGidon Studinski 				    struct sk_buff *skb)
5307be13fc3SGidon Studinski {
5317be13fc3SGidon Studinski 	struct wil_rx_status_extended *st;
5327be13fc3SGidon Studinski 	int cid, tid, key_id, mc;
5337be13fc3SGidon Studinski 	struct wil_sta_info *s;
5347be13fc3SGidon Studinski 	struct wil_tid_crypto_rx *c;
5357be13fc3SGidon Studinski 	struct wil_tid_crypto_rx_single *cc;
5367be13fc3SGidon Studinski 	const u8 *pn;
5377be13fc3SGidon Studinski 
5387be13fc3SGidon Studinski 	/* In HW reorder, HW is responsible for crypto check */
5397be13fc3SGidon Studinski 	if (wil->use_rx_hw_reordering)
5407be13fc3SGidon Studinski 		return 0;
5417be13fc3SGidon Studinski 
5427be13fc3SGidon Studinski 	st = wil_skb_rxstatus(skb);
5437be13fc3SGidon Studinski 
5447be13fc3SGidon Studinski 	cid = wil_rx_status_get_cid(st);
5457be13fc3SGidon Studinski 	tid = wil_rx_status_get_tid(st);
5467be13fc3SGidon Studinski 	key_id = wil_rx_status_get_key_id(st);
5477be13fc3SGidon Studinski 	mc = wil_rx_status_get_mcast(st);
5487be13fc3SGidon Studinski 	s = &wil->sta[cid];
5497be13fc3SGidon Studinski 	c = mc ? &s->group_crypto_rx : &s->tid_crypto_rx[tid];
5507be13fc3SGidon Studinski 	cc = &c->key_id[key_id];
551*1ad8237eSDmitry Antipov 	pn = (u8 *)&st->ext.pn;
5527be13fc3SGidon Studinski 
5537be13fc3SGidon Studinski 	if (!cc->key_set) {
5547be13fc3SGidon Studinski 		wil_err_ratelimited(wil,
5557be13fc3SGidon Studinski 				    "Key missing. CID %d TID %d MCast %d KEY_ID %d\n",
5567be13fc3SGidon Studinski 				    cid, tid, mc, key_id);
5577be13fc3SGidon Studinski 		return -EINVAL;
5587be13fc3SGidon Studinski 	}
5597be13fc3SGidon Studinski 
5607be13fc3SGidon Studinski 	if (reverse_memcmp(pn, cc->pn, IEEE80211_GCMP_PN_LEN) <= 0) {
5617be13fc3SGidon Studinski 		wil_err_ratelimited(wil,
5627be13fc3SGidon Studinski 				    "Replay attack. CID %d TID %d MCast %d KEY_ID %d PN %6phN last %6phN\n",
5637be13fc3SGidon Studinski 				    cid, tid, mc, key_id, pn, cc->pn);
5647be13fc3SGidon Studinski 		return -EINVAL;
5657be13fc3SGidon Studinski 	}
5667be13fc3SGidon Studinski 	memcpy(cc->pn, pn, IEEE80211_GCMP_PN_LEN);
5677be13fc3SGidon Studinski 
5687be13fc3SGidon Studinski 	return 0;
5697be13fc3SGidon Studinski }
5707be13fc3SGidon Studinski 
wil_is_rx_idle_edma(struct wil6210_priv * wil)5717be13fc3SGidon Studinski static bool wil_is_rx_idle_edma(struct wil6210_priv *wil)
5727be13fc3SGidon Studinski {
5737be13fc3SGidon Studinski 	struct wil_status_ring *sring;
5747be13fc3SGidon Studinski 	struct wil_rx_status_extended msg1;
5757be13fc3SGidon Studinski 	void *msg = &msg1;
5767be13fc3SGidon Studinski 	u8 dr_bit;
5777be13fc3SGidon Studinski 	int i;
5787be13fc3SGidon Studinski 
5797be13fc3SGidon Studinski 	for (i = 0; i < wil->num_rx_status_rings; i++) {
5807be13fc3SGidon Studinski 		sring = &wil->srings[i];
5817be13fc3SGidon Studinski 		if (!sring->va)
5827be13fc3SGidon Studinski 			continue;
5837be13fc3SGidon Studinski 
584f4519fd9SDedy Lansky 		wil_get_next_rx_status_msg(sring, &dr_bit, msg);
5857be13fc3SGidon Studinski 
5867be13fc3SGidon Studinski 		/* Check if there are unhandled RX status messages */
5877be13fc3SGidon Studinski 		if (dr_bit == sring->desc_rdy_pol)
5887be13fc3SGidon Studinski 			return false;
5897be13fc3SGidon Studinski 	}
5907be13fc3SGidon Studinski 
5917be13fc3SGidon Studinski 	return true;
5927be13fc3SGidon Studinski }
5937be13fc3SGidon Studinski 
wil_rx_buf_len_init_edma(struct wil6210_priv * wil)59496c93589SGidon Studinski static void wil_rx_buf_len_init_edma(struct wil6210_priv *wil)
59596c93589SGidon Studinski {
596a834df74SAhmad Masri 	/* RX buffer size must be aligned to 4 bytes */
59796c93589SGidon Studinski 	wil->rx_buf_len = rx_large_buf ?
5981bb38e8bSMaya Erez 		WIL_MAX_ETH_MTU : WIL_EDMA_RX_BUF_LEN_DEFAULT;
59996c93589SGidon Studinski }
60096c93589SGidon Studinski 
wil_rx_init_edma(struct wil6210_priv * wil,uint desc_ring_order)60161e5ec04SDedy Lansky static int wil_rx_init_edma(struct wil6210_priv *wil, uint desc_ring_order)
60296c93589SGidon Studinski {
60361e5ec04SDedy Lansky 	u16 status_ring_size, desc_ring_size = 1 << desc_ring_order;
60496c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
60596c93589SGidon Studinski 	int rc;
60696c93589SGidon Studinski 	size_t elem_size = wil->use_compressed_rx_status ?
60796c93589SGidon Studinski 		sizeof(struct wil_rx_status_compressed) :
60896c93589SGidon Studinski 		sizeof(struct wil_rx_status_extended);
60996c93589SGidon Studinski 	int i;
61096c93589SGidon Studinski 
6117be13fc3SGidon Studinski 	/* In SW reorder one must use extended status messages */
6127be13fc3SGidon Studinski 	if (wil->use_compressed_rx_status && !wil->use_rx_hw_reordering) {
6137be13fc3SGidon Studinski 		wil_err(wil,
6147be13fc3SGidon Studinski 			"compressed RX status cannot be used with SW reorder\n");
6157be13fc3SGidon Studinski 		return -EINVAL;
6167be13fc3SGidon Studinski 	}
61761e5ec04SDedy Lansky 	if (wil->rx_status_ring_order <= desc_ring_order)
61861e5ec04SDedy Lansky 		/* make sure sring is larger than desc ring */
61961e5ec04SDedy Lansky 		wil->rx_status_ring_order = desc_ring_order + 1;
62061e5ec04SDedy Lansky 	if (wil->rx_buff_id_count <= desc_ring_size)
62161e5ec04SDedy Lansky 		/* make sure we will not run out of buff_ids */
62261e5ec04SDedy Lansky 		wil->rx_buff_id_count = desc_ring_size + 512;
62396c93589SGidon Studinski 	if (wil->rx_status_ring_order < WIL_SRING_SIZE_ORDER_MIN ||
62496c93589SGidon Studinski 	    wil->rx_status_ring_order > WIL_SRING_SIZE_ORDER_MAX)
62596c93589SGidon Studinski 		wil->rx_status_ring_order = WIL_RX_SRING_SIZE_ORDER_DEFAULT;
62696c93589SGidon Studinski 
62796c93589SGidon Studinski 	status_ring_size = 1 << wil->rx_status_ring_order;
62896c93589SGidon Studinski 
62996c93589SGidon Studinski 	wil_dbg_misc(wil,
63096c93589SGidon Studinski 		     "rx_init, desc_ring_size=%u, status_ring_size=%u, elem_size=%zu\n",
63196c93589SGidon Studinski 		     desc_ring_size, status_ring_size, elem_size);
63296c93589SGidon Studinski 
63396c93589SGidon Studinski 	wil_rx_buf_len_init_edma(wil);
63496c93589SGidon Studinski 
63596c93589SGidon Studinski 	/* Use debugfs dbg_num_rx_srings if set, reserve one sring for TX */
63696c93589SGidon Studinski 	if (wil->num_rx_status_rings > WIL6210_MAX_STATUS_RINGS - 1)
63796c93589SGidon Studinski 		wil->num_rx_status_rings = WIL6210_MAX_STATUS_RINGS - 1;
63896c93589SGidon Studinski 
63996c93589SGidon Studinski 	wil_dbg_misc(wil, "rx_init: allocate %d status rings\n",
64096c93589SGidon Studinski 		     wil->num_rx_status_rings);
64196c93589SGidon Studinski 
642a834df74SAhmad Masri 	rc = wil_wmi_cfg_def_rx_offload(wil, wil->rx_buf_len);
64396c93589SGidon Studinski 	if (rc)
64496c93589SGidon Studinski 		return rc;
64596c93589SGidon Studinski 
64696c93589SGidon Studinski 	/* Allocate status ring */
64796c93589SGidon Studinski 	for (i = 0; i < wil->num_rx_status_rings; i++) {
64896c93589SGidon Studinski 		int sring_id = wil_find_free_sring(wil);
64996c93589SGidon Studinski 
65096c93589SGidon Studinski 		if (sring_id < 0) {
65196c93589SGidon Studinski 			rc = -EFAULT;
65296c93589SGidon Studinski 			goto err_free_status;
65396c93589SGidon Studinski 		}
65496c93589SGidon Studinski 		rc = wil_init_rx_sring(wil, status_ring_size, elem_size,
65596c93589SGidon Studinski 				       sring_id);
65696c93589SGidon Studinski 		if (rc)
65796c93589SGidon Studinski 			goto err_free_status;
65896c93589SGidon Studinski 	}
65996c93589SGidon Studinski 
66096c93589SGidon Studinski 	/* Allocate descriptor ring */
66196c93589SGidon Studinski 	rc = wil_init_rx_desc_ring(wil, desc_ring_size,
66296c93589SGidon Studinski 				   WIL_DEFAULT_RX_STATUS_RING_ID);
66396c93589SGidon Studinski 	if (rc)
66496c93589SGidon Studinski 		goto err_free_status;
66596c93589SGidon Studinski 
66696c93589SGidon Studinski 	if (wil->rx_buff_id_count >= status_ring_size) {
66796c93589SGidon Studinski 		wil_info(wil,
66896c93589SGidon Studinski 			 "rx_buff_id_count %d exceeds sring_size %d. set it to %d\n",
66996c93589SGidon Studinski 			 wil->rx_buff_id_count, status_ring_size,
67096c93589SGidon Studinski 			 status_ring_size - 1);
67196c93589SGidon Studinski 		wil->rx_buff_id_count = status_ring_size - 1;
67296c93589SGidon Studinski 	}
67396c93589SGidon Studinski 
67496c93589SGidon Studinski 	/* Allocate Rx buffer array */
67596c93589SGidon Studinski 	rc = wil_init_rx_buff_arr(wil, wil->rx_buff_id_count);
67696c93589SGidon Studinski 	if (rc)
67796c93589SGidon Studinski 		goto err_free_desc;
67896c93589SGidon Studinski 
67996c93589SGidon Studinski 	/* Fill descriptor ring with credits */
68096c93589SGidon Studinski 	rc = wil_rx_refill_edma(wil);
68196c93589SGidon Studinski 	if (rc)
68296c93589SGidon Studinski 		goto err_free_rx_buff_arr;
68396c93589SGidon Studinski 
68496c93589SGidon Studinski 	return 0;
68596c93589SGidon Studinski err_free_rx_buff_arr:
68696c93589SGidon Studinski 	wil_free_rx_buff_arr(wil);
68796c93589SGidon Studinski err_free_desc:
68896c93589SGidon Studinski 	wil_ring_free_edma(wil, ring);
68996c93589SGidon Studinski err_free_status:
69096c93589SGidon Studinski 	for (i = 0; i < wil->num_rx_status_rings; i++)
69196c93589SGidon Studinski 		wil_sring_free(wil, &wil->srings[i]);
69296c93589SGidon Studinski 
69396c93589SGidon Studinski 	return rc;
69496c93589SGidon Studinski }
69596c93589SGidon Studinski 
wil_ring_init_tx_edma(struct wil6210_vif * vif,int ring_id,int size,int cid,int tid)69696c93589SGidon Studinski static int wil_ring_init_tx_edma(struct wil6210_vif *vif, int ring_id,
69796c93589SGidon Studinski 				 int size, int cid, int tid)
69896c93589SGidon Studinski {
69996c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
70096c93589SGidon Studinski 	int rc;
70196c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
70296c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
70396c93589SGidon Studinski 
70496c93589SGidon Studinski 	lockdep_assert_held(&wil->mutex);
70596c93589SGidon Studinski 
70696c93589SGidon Studinski 	wil_dbg_misc(wil,
70796c93589SGidon Studinski 		     "init TX ring: ring_id=%u, cid=%u, tid=%u, sring_id=%u\n",
70896c93589SGidon Studinski 		     ring_id, cid, tid, wil->tx_sring_idx);
70996c93589SGidon Studinski 
71096c93589SGidon Studinski 	wil_tx_data_init(txdata);
71196c93589SGidon Studinski 	ring->size = size;
71296c93589SGidon Studinski 	rc = wil_ring_alloc_desc_ring(wil, ring);
71396c93589SGidon Studinski 	if (rc)
71496c93589SGidon Studinski 		goto out;
71596c93589SGidon Studinski 
71696c93589SGidon Studinski 	wil->ring2cid_tid[ring_id][0] = cid;
71796c93589SGidon Studinski 	wil->ring2cid_tid[ring_id][1] = tid;
71896c93589SGidon Studinski 	if (!vif->privacy)
71996c93589SGidon Studinski 		txdata->dot1x_open = true;
72096c93589SGidon Studinski 
72196c93589SGidon Studinski 	rc = wil_wmi_tx_desc_ring_add(vif, ring_id, cid, tid);
72296c93589SGidon Studinski 	if (rc) {
72396c93589SGidon Studinski 		wil_err(wil, "WMI_TX_DESC_RING_ADD_CMD failed\n");
72496c93589SGidon Studinski 		goto out_free;
72596c93589SGidon Studinski 	}
72696c93589SGidon Studinski 
72796c93589SGidon Studinski 	if (txdata->dot1x_open && agg_wsize >= 0)
72896c93589SGidon Studinski 		wil_addba_tx_request(wil, ring_id, agg_wsize);
72996c93589SGidon Studinski 
73096c93589SGidon Studinski 	return 0;
73196c93589SGidon Studinski  out_free:
73296c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
73396c93589SGidon Studinski 	txdata->dot1x_open = false;
73496c93589SGidon Studinski 	txdata->enabled = 0;
73596c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
73696c93589SGidon Studinski 	wil_ring_free_edma(wil, ring);
737ddf7afddSAhmad Masri 	wil->ring2cid_tid[ring_id][0] = wil->max_assoc_sta;
73896c93589SGidon Studinski 	wil->ring2cid_tid[ring_id][1] = 0;
73996c93589SGidon Studinski 
74096c93589SGidon Studinski  out:
74196c93589SGidon Studinski 	return rc;
74296c93589SGidon Studinski }
74396c93589SGidon Studinski 
wil_tx_ring_modify_edma(struct wil6210_vif * vif,int ring_id,int cid,int tid)744b9010f10SAhmad Masri static int wil_tx_ring_modify_edma(struct wil6210_vif *vif, int ring_id,
745b9010f10SAhmad Masri 				   int cid, int tid)
746b9010f10SAhmad Masri {
747b9010f10SAhmad Masri 	struct wil6210_priv *wil = vif_to_wil(vif);
748b9010f10SAhmad Masri 
749b9010f10SAhmad Masri 	wil_err(wil, "ring modify is not supported for EDMA\n");
750b9010f10SAhmad Masri 
751b9010f10SAhmad Masri 	return -EOPNOTSUPP;
752b9010f10SAhmad Masri }
753b9010f10SAhmad Masri 
7547be13fc3SGidon Studinski /* This function is used only for RX SW reorder */
wil_check_bar(struct wil6210_priv * wil,void * msg,int cid,struct sk_buff * skb,struct wil_net_stats * stats)7557be13fc3SGidon Studinski static int wil_check_bar(struct wil6210_priv *wil, void *msg, int cid,
7567be13fc3SGidon Studinski 			 struct sk_buff *skb, struct wil_net_stats *stats)
7577be13fc3SGidon Studinski {
7587be13fc3SGidon Studinski 	u8 ftype;
7597be13fc3SGidon Studinski 	u8 fc1;
7607be13fc3SGidon Studinski 	int mid;
7617be13fc3SGidon Studinski 	int tid;
7627be13fc3SGidon Studinski 	u16 seq;
7637be13fc3SGidon Studinski 	struct wil6210_vif *vif;
7647be13fc3SGidon Studinski 
7657be13fc3SGidon Studinski 	ftype = wil_rx_status_get_frame_type(wil, msg);
7667be13fc3SGidon Studinski 	if (ftype == IEEE80211_FTYPE_DATA)
7677be13fc3SGidon Studinski 		return 0;
7687be13fc3SGidon Studinski 
7697be13fc3SGidon Studinski 	fc1 = wil_rx_status_get_fc1(wil, msg);
7707be13fc3SGidon Studinski 	mid = wil_rx_status_get_mid(msg);
7717be13fc3SGidon Studinski 	tid = wil_rx_status_get_tid(msg);
7727be13fc3SGidon Studinski 	seq = le16_to_cpu(wil_rx_status_get_seq(wil, msg));
7737be13fc3SGidon Studinski 	vif = wil->vifs[mid];
7747be13fc3SGidon Studinski 
7757be13fc3SGidon Studinski 	if (unlikely(!vif)) {
7767be13fc3SGidon Studinski 		wil_dbg_txrx(wil, "RX descriptor with invalid mid %d", mid);
7777be13fc3SGidon Studinski 		return -EAGAIN;
7787be13fc3SGidon Studinski 	}
7797be13fc3SGidon Studinski 
7807be13fc3SGidon Studinski 	wil_dbg_txrx(wil,
7817be13fc3SGidon Studinski 		     "Non-data frame FC[7:0] 0x%02x MID %d CID %d TID %d Seq 0x%03x\n",
7827be13fc3SGidon Studinski 		     fc1, mid, cid, tid, seq);
7837be13fc3SGidon Studinski 	if (stats)
7847be13fc3SGidon Studinski 		stats->rx_non_data_frame++;
7857be13fc3SGidon Studinski 	if (wil_is_back_req(fc1)) {
7867be13fc3SGidon Studinski 		wil_dbg_txrx(wil,
7877be13fc3SGidon Studinski 			     "BAR: MID %d CID %d TID %d Seq 0x%03x\n",
7887be13fc3SGidon Studinski 			     mid, cid, tid, seq);
7897be13fc3SGidon Studinski 		wil_rx_bar(wil, vif, cid, tid, seq);
7907be13fc3SGidon Studinski 	} else {
7917be13fc3SGidon Studinski 		u32 sz = wil->use_compressed_rx_status ?
7927be13fc3SGidon Studinski 			sizeof(struct wil_rx_status_compressed) :
7937be13fc3SGidon Studinski 			sizeof(struct wil_rx_status_extended);
7947be13fc3SGidon Studinski 
7957be13fc3SGidon Studinski 		/* print again all info. One can enable only this
7967be13fc3SGidon Studinski 		 * without overhead for printing every Rx frame
7977be13fc3SGidon Studinski 		 */
7987be13fc3SGidon Studinski 		wil_dbg_txrx(wil,
7997be13fc3SGidon Studinski 			     "Unhandled non-data frame FC[7:0] 0x%02x MID %d CID %d TID %d Seq 0x%03x\n",
8007be13fc3SGidon Studinski 			     fc1, mid, cid, tid, seq);
8017be13fc3SGidon Studinski 		wil_hex_dump_txrx("RxS ", DUMP_PREFIX_NONE, 32, 4,
8027be13fc3SGidon Studinski 				  (const void *)msg, sz, false);
8037be13fc3SGidon Studinski 		wil_hex_dump_txrx("Rx ", DUMP_PREFIX_OFFSET, 16, 1,
8047be13fc3SGidon Studinski 				  skb->data, skb_headlen(skb), false);
8057be13fc3SGidon Studinski 	}
8067be13fc3SGidon Studinski 
8077be13fc3SGidon Studinski 	return -EAGAIN;
8087be13fc3SGidon Studinski }
8097be13fc3SGidon Studinski 
wil_rx_error_check_edma(struct wil6210_priv * wil,struct sk_buff * skb,struct wil_net_stats * stats)810e15af41cSDedy Lansky static int wil_rx_error_check_edma(struct wil6210_priv *wil,
811e15af41cSDedy Lansky 				   struct sk_buff *skb,
812e15af41cSDedy Lansky 				   struct wil_net_stats *stats)
8137be13fc3SGidon Studinski {
8147be13fc3SGidon Studinski 	int l2_rx_status;
815e15af41cSDedy Lansky 	void *msg = wil_skb_rxstatus(skb);
8167be13fc3SGidon Studinski 
8177be13fc3SGidon Studinski 	l2_rx_status = wil_rx_status_get_l2_rx_status(msg);
8187be13fc3SGidon Studinski 	if (l2_rx_status != 0) {
8197be13fc3SGidon Studinski 		wil_dbg_txrx(wil, "L2 RX error, l2_rx_status=0x%x\n",
8207be13fc3SGidon Studinski 			     l2_rx_status);
8217be13fc3SGidon Studinski 		/* Due to HW issue, KEY error will trigger a MIC error */
82204de1501SMaya Erez 		if (l2_rx_status == WIL_RX_EDMA_ERROR_MIC) {
82304de1501SMaya Erez 			wil_err_ratelimited(wil,
8247be13fc3SGidon Studinski 					    "L2 MIC/KEY error, dropping packet\n");
8257be13fc3SGidon Studinski 			stats->rx_mic_error++;
8267be13fc3SGidon Studinski 		}
82704de1501SMaya Erez 		if (l2_rx_status == WIL_RX_EDMA_ERROR_KEY) {
82804de1501SMaya Erez 			wil_err_ratelimited(wil,
82904de1501SMaya Erez 					    "L2 KEY error, dropping packet\n");
8307be13fc3SGidon Studinski 			stats->rx_key_error++;
8317be13fc3SGidon Studinski 		}
83204de1501SMaya Erez 		if (l2_rx_status == WIL_RX_EDMA_ERROR_REPLAY) {
83304de1501SMaya Erez 			wil_err_ratelimited(wil,
8347be13fc3SGidon Studinski 					    "L2 REPLAY error, dropping packet\n");
8357be13fc3SGidon Studinski 			stats->rx_replay++;
8367be13fc3SGidon Studinski 		}
83704de1501SMaya Erez 		if (l2_rx_status == WIL_RX_EDMA_ERROR_AMSDU) {
83804de1501SMaya Erez 			wil_err_ratelimited(wil,
8397be13fc3SGidon Studinski 					    "L2 AMSDU error, dropping packet\n");
8407be13fc3SGidon Studinski 			stats->rx_amsdu_error++;
8417be13fc3SGidon Studinski 		}
8427be13fc3SGidon Studinski 		return -EFAULT;
8437be13fc3SGidon Studinski 	}
8447be13fc3SGidon Studinski 
8454bf01986SAhmad Masri 	skb->ip_summed = wil_rx_status_get_checksum(msg, stats);
8467be13fc3SGidon Studinski 
8477be13fc3SGidon Studinski 	return 0;
8487be13fc3SGidon Studinski }
8497be13fc3SGidon Studinski 
wil_sring_reap_rx_edma(struct wil6210_priv * wil,struct wil_status_ring * sring)8507be13fc3SGidon Studinski static struct sk_buff *wil_sring_reap_rx_edma(struct wil6210_priv *wil,
8517be13fc3SGidon Studinski 					      struct wil_status_ring *sring)
8527be13fc3SGidon Studinski {
8537be13fc3SGidon Studinski 	struct device *dev = wil_to_dev(wil);
8547be13fc3SGidon Studinski 	struct wil_rx_status_extended msg1;
8557be13fc3SGidon Studinski 	void *msg = &msg1;
8567be13fc3SGidon Studinski 	u16 buff_id;
8577be13fc3SGidon Studinski 	struct sk_buff *skb;
8587be13fc3SGidon Studinski 	dma_addr_t pa;
8597be13fc3SGidon Studinski 	struct wil_ring_rx_data *rxdata = &sring->rx_data;
860a834df74SAhmad Masri 	unsigned int sz = wil->rx_buf_len;
8617be13fc3SGidon Studinski 	struct wil_net_stats *stats = NULL;
8627be13fc3SGidon Studinski 	u16 dmalen;
8637be13fc3SGidon Studinski 	int cid;
8647be13fc3SGidon Studinski 	bool eop, headstolen;
8657be13fc3SGidon Studinski 	int delta;
8667be13fc3SGidon Studinski 	u8 dr_bit;
8677be13fc3SGidon Studinski 	u8 data_offset;
8687be13fc3SGidon Studinski 	struct wil_rx_status_extended *s;
8697be13fc3SGidon Studinski 	u16 sring_idx = sring - wil->srings;
8705b1413f0SColin Ian King 	int invalid_buff_id_retry;
8717be13fc3SGidon Studinski 
8727be13fc3SGidon Studinski 	BUILD_BUG_ON(sizeof(struct wil_rx_status_extended) > sizeof(skb->cb));
8737be13fc3SGidon Studinski 
8747be13fc3SGidon Studinski again:
875f4519fd9SDedy Lansky 	wil_get_next_rx_status_msg(sring, &dr_bit, msg);
8767be13fc3SGidon Studinski 
8777be13fc3SGidon Studinski 	/* Completed handling all the ready status messages */
8787be13fc3SGidon Studinski 	if (dr_bit != sring->desc_rdy_pol)
8797be13fc3SGidon Studinski 		return NULL;
8807be13fc3SGidon Studinski 
8817be13fc3SGidon Studinski 	/* Extract the buffer ID from the status message */
8827be13fc3SGidon Studinski 	buff_id = le16_to_cpu(wil_rx_status_get_buff_id(msg));
883b4a967b7SMaya Erez 
8845b1413f0SColin Ian King 	invalid_buff_id_retry = 0;
885b4a967b7SMaya Erez 	while (!buff_id) {
886b4a967b7SMaya Erez 		struct wil_rx_status_extended *s;
887b4a967b7SMaya Erez 
888b4a967b7SMaya Erez 		wil_dbg_txrx(wil,
889b4a967b7SMaya Erez 			     "buff_id is not updated yet by HW, (swhead 0x%x)\n",
890b4a967b7SMaya Erez 			     sring->swhead);
891b4a967b7SMaya Erez 		if (++invalid_buff_id_retry > MAX_INVALID_BUFF_ID_RETRY)
892b4a967b7SMaya Erez 			break;
893b4a967b7SMaya Erez 
894b4a967b7SMaya Erez 		/* Read the status message again */
895b4a967b7SMaya Erez 		s = (struct wil_rx_status_extended *)
896b4a967b7SMaya Erez 			(sring->va + (sring->elem_size * sring->swhead));
897b4a967b7SMaya Erez 		*(struct wil_rx_status_extended *)msg = *s;
898b4a967b7SMaya Erez 		buff_id = le16_to_cpu(wil_rx_status_get_buff_id(msg));
8997be13fc3SGidon Studinski 	}
9007be13fc3SGidon Studinski 
901b4a967b7SMaya Erez 	if (unlikely(!wil_val_in_range(buff_id, 1, wil->rx_buff_mgmt.size))) {
902b4a967b7SMaya Erez 		wil_err(wil, "Corrupt buff_id=%d, sring->swhead=%d\n",
903b4a967b7SMaya Erez 			buff_id, sring->swhead);
9047be3c233SAhmad Masri 		print_hex_dump(KERN_ERR, "RxS ", DUMP_PREFIX_OFFSET, 16, 1,
9057be3c233SAhmad Masri 			       msg, wil->use_compressed_rx_status ?
9067be3c233SAhmad Masri 			       sizeof(struct wil_rx_status_compressed) :
9077be3c233SAhmad Masri 			       sizeof(struct wil_rx_status_extended), false);
9087be3c233SAhmad Masri 
909b4a967b7SMaya Erez 		wil_rx_status_reset_buff_id(sring);
9107be13fc3SGidon Studinski 		wil_sring_advance_swhead(sring);
911b4a967b7SMaya Erez 		sring->invalid_buff_id_cnt++;
912b4a967b7SMaya Erez 		goto again;
913b4a967b7SMaya Erez 	}
9147be13fc3SGidon Studinski 
9157be13fc3SGidon Studinski 	/* Extract the SKB from the rx_buff management array */
9167be13fc3SGidon Studinski 	skb = wil->rx_buff_mgmt.buff_arr[buff_id].skb;
9177be13fc3SGidon Studinski 	wil->rx_buff_mgmt.buff_arr[buff_id].skb = NULL;
9187be13fc3SGidon Studinski 	if (!skb) {
9197be13fc3SGidon Studinski 		wil_err(wil, "No Rx skb at buff_id %d\n", buff_id);
920b4a967b7SMaya Erez 		wil_rx_status_reset_buff_id(sring);
92184f16fbbSMaya Erez 		/* Move the buffer from the active list to the free list */
922b4a967b7SMaya Erez 		list_move_tail(&wil->rx_buff_mgmt.buff_arr[buff_id].list,
92384f16fbbSMaya Erez 			       &wil->rx_buff_mgmt.free);
924b4a967b7SMaya Erez 		wil_sring_advance_swhead(sring);
925b4a967b7SMaya Erez 		sring->invalid_buff_id_cnt++;
9267be13fc3SGidon Studinski 		goto again;
9277be13fc3SGidon Studinski 	}
9287be13fc3SGidon Studinski 
929b4a967b7SMaya Erez 	wil_rx_status_reset_buff_id(sring);
930b4a967b7SMaya Erez 	wil_sring_advance_swhead(sring);
931b4a967b7SMaya Erez 
9327be13fc3SGidon Studinski 	memcpy(&pa, skb->cb, sizeof(pa));
9337be13fc3SGidon Studinski 	dma_unmap_single(dev, pa, sz, DMA_FROM_DEVICE);
9347be13fc3SGidon Studinski 	dmalen = le16_to_cpu(wil_rx_status_get_length(msg));
9357be13fc3SGidon Studinski 
9367be13fc3SGidon Studinski 	trace_wil6210_rx_status(wil, wil->use_compressed_rx_status, buff_id,
9377be13fc3SGidon Studinski 				msg);
9387be13fc3SGidon Studinski 	wil_dbg_txrx(wil, "Rx, buff_id=%u, sring_idx=%u, dmalen=%u bytes\n",
9397be13fc3SGidon Studinski 		     buff_id, sring_idx, dmalen);
9407be13fc3SGidon Studinski 	wil_hex_dump_txrx("RxS ", DUMP_PREFIX_NONE, 32, 4,
9417be13fc3SGidon Studinski 			  (const void *)msg, wil->use_compressed_rx_status ?
9427be13fc3SGidon Studinski 			  sizeof(struct wil_rx_status_compressed) :
9437be13fc3SGidon Studinski 			  sizeof(struct wil_rx_status_extended), false);
9447be13fc3SGidon Studinski 
9457be13fc3SGidon Studinski 	/* Move the buffer from the active list to the free list */
946b4a967b7SMaya Erez 	list_move_tail(&wil->rx_buff_mgmt.buff_arr[buff_id].list,
9477be13fc3SGidon Studinski 		       &wil->rx_buff_mgmt.free);
9487be13fc3SGidon Studinski 
9497be13fc3SGidon Studinski 	eop = wil_rx_status_get_eop(msg);
9507be13fc3SGidon Studinski 
9517be13fc3SGidon Studinski 	cid = wil_rx_status_get_cid(msg);
952ddf7afddSAhmad Masri 	if (unlikely(!wil_val_in_range(cid, 0, wil->max_assoc_sta))) {
9537be13fc3SGidon Studinski 		wil_err(wil, "Corrupt cid=%d, sring->swhead=%d\n",
9547be13fc3SGidon Studinski 			cid, sring->swhead);
9557be13fc3SGidon Studinski 		rxdata->skipping = true;
9567be13fc3SGidon Studinski 		goto skipping;
9577be13fc3SGidon Studinski 	}
9587be13fc3SGidon Studinski 	stats = &wil->sta[cid].stats;
9597be13fc3SGidon Studinski 
960055c8a71SLior David 	if (unlikely(dmalen < ETH_HLEN)) {
961055c8a71SLior David 		wil_dbg_txrx(wil, "Short frame, len = %d\n", dmalen);
9627be13fc3SGidon Studinski 		stats->rx_short_frame++;
9637be13fc3SGidon Studinski 		rxdata->skipping = true;
9647be13fc3SGidon Studinski 		goto skipping;
9657be13fc3SGidon Studinski 	}
9667be13fc3SGidon Studinski 
9677be13fc3SGidon Studinski 	if (unlikely(dmalen > sz)) {
9687be13fc3SGidon Studinski 		wil_err(wil, "Rx size too large: %d bytes!\n", dmalen);
9697be3c233SAhmad Masri 		print_hex_dump(KERN_ERR, "RxS ", DUMP_PREFIX_OFFSET, 16, 1,
9707be3c233SAhmad Masri 			       msg, wil->use_compressed_rx_status ?
9717be3c233SAhmad Masri 			       sizeof(struct wil_rx_status_compressed) :
9727be3c233SAhmad Masri 			       sizeof(struct wil_rx_status_extended), false);
9737be3c233SAhmad Masri 
9747be13fc3SGidon Studinski 		stats->rx_large_frame++;
9757be13fc3SGidon Studinski 		rxdata->skipping = true;
9767be13fc3SGidon Studinski 	}
9777be13fc3SGidon Studinski 
9787be13fc3SGidon Studinski skipping:
9797be13fc3SGidon Studinski 	/* skipping indicates if a certain SKB should be dropped.
9807be13fc3SGidon Studinski 	 * It is set in case there is an error on the current SKB or in case
9817be13fc3SGidon Studinski 	 * of RX chaining: as long as we manage to merge the SKBs it will
9827be13fc3SGidon Studinski 	 * be false. once we have a bad SKB or we don't manage to merge SKBs
9837be13fc3SGidon Studinski 	 * it will be set to the !EOP value of the current SKB.
9847be13fc3SGidon Studinski 	 * This guarantees that all the following SKBs until EOP will also
9857be13fc3SGidon Studinski 	 * get dropped.
9867be13fc3SGidon Studinski 	 */
9877be13fc3SGidon Studinski 	if (unlikely(rxdata->skipping)) {
9887be13fc3SGidon Studinski 		kfree_skb(skb);
9897be13fc3SGidon Studinski 		if (rxdata->skb) {
9907be13fc3SGidon Studinski 			kfree_skb(rxdata->skb);
9917be13fc3SGidon Studinski 			rxdata->skb = NULL;
9927be13fc3SGidon Studinski 		}
9937be13fc3SGidon Studinski 		rxdata->skipping = !eop;
9947be13fc3SGidon Studinski 		goto again;
9957be13fc3SGidon Studinski 	}
9967be13fc3SGidon Studinski 
9977be13fc3SGidon Studinski 	skb_trim(skb, dmalen);
9987be13fc3SGidon Studinski 
9997be13fc3SGidon Studinski 	prefetch(skb->data);
10007be13fc3SGidon Studinski 
10017be13fc3SGidon Studinski 	if (!rxdata->skb) {
10027be13fc3SGidon Studinski 		rxdata->skb = skb;
10037be13fc3SGidon Studinski 	} else {
10047be13fc3SGidon Studinski 		if (likely(skb_try_coalesce(rxdata->skb, skb, &headstolen,
10057be13fc3SGidon Studinski 					    &delta))) {
10067be13fc3SGidon Studinski 			kfree_skb_partial(skb, headstolen);
10077be13fc3SGidon Studinski 		} else {
10087be13fc3SGidon Studinski 			wil_err(wil, "failed to merge skbs!\n");
10097be13fc3SGidon Studinski 			kfree_skb(skb);
10107be13fc3SGidon Studinski 			kfree_skb(rxdata->skb);
10117be13fc3SGidon Studinski 			rxdata->skb = NULL;
10127be13fc3SGidon Studinski 			rxdata->skipping = !eop;
10137be13fc3SGidon Studinski 			goto again;
10147be13fc3SGidon Studinski 		}
10157be13fc3SGidon Studinski 	}
10167be13fc3SGidon Studinski 
10177be13fc3SGidon Studinski 	if (!eop)
10187be13fc3SGidon Studinski 		goto again;
10197be13fc3SGidon Studinski 
10207be13fc3SGidon Studinski 	/* reaching here rxdata->skb always contains a full packet */
10217be13fc3SGidon Studinski 	skb = rxdata->skb;
10227be13fc3SGidon Studinski 	rxdata->skb = NULL;
10237be13fc3SGidon Studinski 	rxdata->skipping = false;
10247be13fc3SGidon Studinski 
10257be13fc3SGidon Studinski 	if (stats) {
10267be13fc3SGidon Studinski 		stats->last_mcs_rx = wil_rx_status_get_mcs(msg);
10277be13fc3SGidon Studinski 		if (stats->last_mcs_rx < ARRAY_SIZE(stats->rx_per_mcs))
10287be13fc3SGidon Studinski 			stats->rx_per_mcs[stats->last_mcs_rx]++;
10297064e219SMax Chen 		else if (stats->last_mcs_rx == WIL_EXTENDED_MCS_26)
10307064e219SMax Chen 			stats->rx_per_mcs[WIL_BASE_MCS_FOR_EXTENDED_26]++;
10319abe3e30SAlexei Avshalom Lazar 
10329abe3e30SAlexei Avshalom Lazar 		stats->last_cb_mode_rx  = wil_rx_status_get_cb_mode(msg);
10337be13fc3SGidon Studinski 	}
10347be13fc3SGidon Studinski 
10357be13fc3SGidon Studinski 	if (!wil->use_rx_hw_reordering && !wil->use_compressed_rx_status &&
10367be13fc3SGidon Studinski 	    wil_check_bar(wil, msg, cid, skb, stats) == -EAGAIN) {
10377be13fc3SGidon Studinski 		kfree_skb(skb);
10387be13fc3SGidon Studinski 		goto again;
10397be13fc3SGidon Studinski 	}
10407be13fc3SGidon Studinski 
10417be13fc3SGidon Studinski 	/* Compensate for the HW data alignment according to the status
10427be13fc3SGidon Studinski 	 * message
10437be13fc3SGidon Studinski 	 */
10447be13fc3SGidon Studinski 	data_offset = wil_rx_status_get_data_offset(msg);
10457be13fc3SGidon Studinski 	if (data_offset == 0xFF ||
10467be13fc3SGidon Studinski 	    data_offset > WIL_EDMA_MAX_DATA_OFFSET) {
10477be13fc3SGidon Studinski 		wil_err(wil, "Unexpected data offset %d\n", data_offset);
10487be13fc3SGidon Studinski 		kfree_skb(skb);
10497be13fc3SGidon Studinski 		goto again;
10507be13fc3SGidon Studinski 	}
10517be13fc3SGidon Studinski 
10527be13fc3SGidon Studinski 	skb_pull(skb, data_offset);
10537be13fc3SGidon Studinski 
10547be13fc3SGidon Studinski 	wil_hex_dump_txrx("Rx ", DUMP_PREFIX_OFFSET, 16, 1,
10557be13fc3SGidon Studinski 			  skb->data, skb_headlen(skb), false);
10567be13fc3SGidon Studinski 
10577be13fc3SGidon Studinski 	/* Has to be done after dma_unmap_single as skb->cb is also
10587be13fc3SGidon Studinski 	 * used for holding the pa
10597be13fc3SGidon Studinski 	 */
10607be13fc3SGidon Studinski 	s = wil_skb_rxstatus(skb);
10617be13fc3SGidon Studinski 	memcpy(s, msg, sring->elem_size);
10627be13fc3SGidon Studinski 
10637be13fc3SGidon Studinski 	return skb;
10647be13fc3SGidon Studinski }
10657be13fc3SGidon Studinski 
wil_rx_handle_edma(struct wil6210_priv * wil,int * quota)10667be13fc3SGidon Studinski void wil_rx_handle_edma(struct wil6210_priv *wil, int *quota)
10677be13fc3SGidon Studinski {
10687be13fc3SGidon Studinski 	struct net_device *ndev;
10697be13fc3SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
10707be13fc3SGidon Studinski 	struct wil_status_ring *sring;
10717be13fc3SGidon Studinski 	struct sk_buff *skb;
10727be13fc3SGidon Studinski 	int i;
10737be13fc3SGidon Studinski 
10747be13fc3SGidon Studinski 	if (unlikely(!ring->va)) {
10757be13fc3SGidon Studinski 		wil_err(wil, "Rx IRQ while Rx not yet initialized\n");
10767be13fc3SGidon Studinski 		return;
10777be13fc3SGidon Studinski 	}
10787be13fc3SGidon Studinski 	wil_dbg_txrx(wil, "rx_handle\n");
10797be13fc3SGidon Studinski 
10807be13fc3SGidon Studinski 	for (i = 0; i < wil->num_rx_status_rings; i++) {
10817be13fc3SGidon Studinski 		sring = &wil->srings[i];
10827be13fc3SGidon Studinski 		if (unlikely(!sring->va)) {
10837be13fc3SGidon Studinski 			wil_err(wil,
10847be13fc3SGidon Studinski 				"Rx IRQ while Rx status ring %d not yet initialized\n",
10857be13fc3SGidon Studinski 				i);
10867be13fc3SGidon Studinski 			continue;
10877be13fc3SGidon Studinski 		}
10887be13fc3SGidon Studinski 
10897be13fc3SGidon Studinski 		while ((*quota > 0) &&
10907be13fc3SGidon Studinski 		       (NULL != (skb =
10917be13fc3SGidon Studinski 			wil_sring_reap_rx_edma(wil, sring)))) {
10927be13fc3SGidon Studinski 			(*quota)--;
10937be13fc3SGidon Studinski 			if (wil->use_rx_hw_reordering) {
10947be13fc3SGidon Studinski 				void *msg = wil_skb_rxstatus(skb);
10957be13fc3SGidon Studinski 				int mid = wil_rx_status_get_mid(msg);
10967be13fc3SGidon Studinski 				struct wil6210_vif *vif = wil->vifs[mid];
10977be13fc3SGidon Studinski 
10987be13fc3SGidon Studinski 				if (unlikely(!vif)) {
10997be13fc3SGidon Studinski 					wil_dbg_txrx(wil,
11007be13fc3SGidon Studinski 						     "RX desc invalid mid %d",
11017be13fc3SGidon Studinski 						     mid);
11027be13fc3SGidon Studinski 					kfree_skb(skb);
11037be13fc3SGidon Studinski 					continue;
11047be13fc3SGidon Studinski 				}
11057be13fc3SGidon Studinski 				ndev = vif_to_ndev(vif);
11067be13fc3SGidon Studinski 				wil_netif_rx_any(skb, ndev);
11077be13fc3SGidon Studinski 			} else {
11087be13fc3SGidon Studinski 				wil_rx_reorder(wil, skb);
11097be13fc3SGidon Studinski 			}
11107be13fc3SGidon Studinski 		}
11117be13fc3SGidon Studinski 
11127be13fc3SGidon Studinski 		wil_w(wil, sring->hwtail, (sring->swhead - 1) % sring->size);
11137be13fc3SGidon Studinski 	}
11147be13fc3SGidon Studinski 
11157be13fc3SGidon Studinski 	wil_rx_refill_edma(wil);
11167be13fc3SGidon Studinski }
11177be13fc3SGidon Studinski 
wil_tx_desc_map_edma(union wil_tx_desc * desc,dma_addr_t pa,u32 len,int ring_index)11189202d7b6SMaya Erez static int wil_tx_desc_map_edma(union wil_tx_desc *desc,
11199202d7b6SMaya Erez 				dma_addr_t pa,
11209202d7b6SMaya Erez 				u32 len,
11219202d7b6SMaya Erez 				int ring_index)
11229202d7b6SMaya Erez {
11239202d7b6SMaya Erez 	struct wil_tx_enhanced_desc *d =
11249202d7b6SMaya Erez 		(struct wil_tx_enhanced_desc *)&desc->enhanced;
11259202d7b6SMaya Erez 
11269202d7b6SMaya Erez 	memset(d, 0, sizeof(struct wil_tx_enhanced_desc));
11279202d7b6SMaya Erez 
11289202d7b6SMaya Erez 	wil_desc_set_addr_edma(&d->dma.addr, &d->dma.addr_high_high, pa);
11299202d7b6SMaya Erez 
11309202d7b6SMaya Erez 	/* 0..6: mac_length; 7:ip_version 0-IP6 1-IP4*/
11319202d7b6SMaya Erez 	d->dma.length = cpu_to_le16((u16)len);
11329202d7b6SMaya Erez 	d->mac.d[0] = (ring_index << WIL_EDMA_DESC_TX_MAC_CFG_0_QID_POS);
11339202d7b6SMaya Erez 	/* translation type:  0 - bypass; 1 - 802.3; 2 - native wifi;
11349202d7b6SMaya Erez 	 * 3 - eth mode
11359202d7b6SMaya Erez 	 */
11369202d7b6SMaya Erez 	d->mac.d[2] = BIT(MAC_CFG_DESC_TX_2_SNAP_HDR_INSERTION_EN_POS) |
11379202d7b6SMaya Erez 		      (0x3 << MAC_CFG_DESC_TX_2_L2_TRANSLATION_TYPE_POS);
11389202d7b6SMaya Erez 
11399202d7b6SMaya Erez 	return 0;
11409202d7b6SMaya Erez }
11419202d7b6SMaya Erez 
11429202d7b6SMaya Erez static inline void
wil_get_next_tx_status_msg(struct wil_status_ring * sring,u8 * dr_bit,struct wil_ring_tx_status * msg)1143f4519fd9SDedy Lansky wil_get_next_tx_status_msg(struct wil_status_ring *sring, u8 *dr_bit,
11449202d7b6SMaya Erez 			   struct wil_ring_tx_status *msg)
11459202d7b6SMaya Erez {
11469202d7b6SMaya Erez 	struct wil_ring_tx_status *_msg = (struct wil_ring_tx_status *)
11479202d7b6SMaya Erez 		(sring->va + (sring->elem_size * sring->swhead));
11489202d7b6SMaya Erez 
1149f4519fd9SDedy Lansky 	*dr_bit = _msg->desc_ready >> TX_STATUS_DESC_READY_POS;
1150f4519fd9SDedy Lansky 	/* make sure dr_bit is read before the rest of status msg */
1151f4519fd9SDedy Lansky 	rmb();
11529202d7b6SMaya Erez 	*msg = *_msg;
11539202d7b6SMaya Erez }
11549202d7b6SMaya Erez 
1155e2d651b9SLee Jones /* Clean up transmitted skb's from the Tx descriptor RING.
11569202d7b6SMaya Erez  * Return number of descriptors cleared.
11579202d7b6SMaya Erez  */
wil_tx_sring_handler(struct wil6210_priv * wil,struct wil_status_ring * sring)11589202d7b6SMaya Erez int wil_tx_sring_handler(struct wil6210_priv *wil,
11599202d7b6SMaya Erez 			 struct wil_status_ring *sring)
11609202d7b6SMaya Erez {
11619202d7b6SMaya Erez 	struct net_device *ndev;
11629202d7b6SMaya Erez 	struct device *dev = wil_to_dev(wil);
11639202d7b6SMaya Erez 	struct wil_ring *ring = NULL;
11649202d7b6SMaya Erez 	struct wil_ring_tx_data *txdata;
11659202d7b6SMaya Erez 	/* Total number of completed descriptors in all descriptor rings */
11669202d7b6SMaya Erez 	int desc_cnt = 0;
11679202d7b6SMaya Erez 	int cid;
1168a380eb57SDedy Lansky 	struct wil_net_stats *stats;
11699202d7b6SMaya Erez 	struct wil_tx_enhanced_desc *_d;
11709202d7b6SMaya Erez 	unsigned int ring_id;
117196b77bb0SAhmad Masri 	unsigned int num_descs, num_statuses = 0;
11729202d7b6SMaya Erez 	int i;
11739202d7b6SMaya Erez 	u8 dr_bit; /* Descriptor Ready bit */
11749202d7b6SMaya Erez 	struct wil_ring_tx_status msg;
11759202d7b6SMaya Erez 	struct wil6210_vif *vif;
11769202d7b6SMaya Erez 	int used_before_complete;
11779202d7b6SMaya Erez 	int used_new;
11789202d7b6SMaya Erez 
1179f4519fd9SDedy Lansky 	wil_get_next_tx_status_msg(sring, &dr_bit, &msg);
11809202d7b6SMaya Erez 
11819202d7b6SMaya Erez 	/* Process completion messages while DR bit has the expected polarity */
11829202d7b6SMaya Erez 	while (dr_bit == sring->desc_rdy_pol) {
11839202d7b6SMaya Erez 		num_descs = msg.num_descriptors;
11849202d7b6SMaya Erez 		if (!num_descs) {
11859202d7b6SMaya Erez 			wil_err(wil, "invalid num_descs 0\n");
11869202d7b6SMaya Erez 			goto again;
11879202d7b6SMaya Erez 		}
11889202d7b6SMaya Erez 
11899202d7b6SMaya Erez 		/* Find the corresponding descriptor ring */
11909202d7b6SMaya Erez 		ring_id = msg.ring_id;
11919202d7b6SMaya Erez 
11929202d7b6SMaya Erez 		if (unlikely(ring_id >= WIL6210_MAX_TX_RINGS)) {
11939202d7b6SMaya Erez 			wil_err(wil, "invalid ring id %d\n", ring_id);
11949202d7b6SMaya Erez 			goto again;
11959202d7b6SMaya Erez 		}
11969202d7b6SMaya Erez 		ring = &wil->ring_tx[ring_id];
11979202d7b6SMaya Erez 		if (unlikely(!ring->va)) {
11989202d7b6SMaya Erez 			wil_err(wil, "Tx irq[%d]: ring not initialized\n",
11999202d7b6SMaya Erez 				ring_id);
12009202d7b6SMaya Erez 			goto again;
12019202d7b6SMaya Erez 		}
12029202d7b6SMaya Erez 		txdata = &wil->ring_tx_data[ring_id];
12039202d7b6SMaya Erez 		if (unlikely(!txdata->enabled)) {
12049202d7b6SMaya Erez 			wil_info(wil, "Tx irq[%d]: ring disabled\n", ring_id);
12059202d7b6SMaya Erez 			goto again;
12069202d7b6SMaya Erez 		}
12079202d7b6SMaya Erez 		vif = wil->vifs[txdata->mid];
12089202d7b6SMaya Erez 		if (unlikely(!vif)) {
12099202d7b6SMaya Erez 			wil_dbg_txrx(wil, "invalid MID %d for ring %d\n",
12109202d7b6SMaya Erez 				     txdata->mid, ring_id);
12119202d7b6SMaya Erez 			goto again;
12129202d7b6SMaya Erez 		}
12139202d7b6SMaya Erez 
12149202d7b6SMaya Erez 		ndev = vif_to_ndev(vif);
12159202d7b6SMaya Erez 
12169202d7b6SMaya Erez 		cid = wil->ring2cid_tid[ring_id][0];
1217ddf7afddSAhmad Masri 		stats = (cid < wil->max_assoc_sta) ? &wil->sta[cid].stats :
1218ddf7afddSAhmad Masri 						     NULL;
12199202d7b6SMaya Erez 
12209202d7b6SMaya Erez 		wil_dbg_txrx(wil,
12219202d7b6SMaya Erez 			     "tx_status: completed desc_ring (%d), num_descs (%d)\n",
12229202d7b6SMaya Erez 			     ring_id, num_descs);
12239202d7b6SMaya Erez 
12249202d7b6SMaya Erez 		used_before_complete = wil_ring_used_tx(ring);
12259202d7b6SMaya Erez 
12269202d7b6SMaya Erez 		for (i = 0 ; i < num_descs; ++i) {
12279202d7b6SMaya Erez 			struct wil_ctx *ctx = &ring->ctx[ring->swtail];
12289202d7b6SMaya Erez 			struct wil_tx_enhanced_desc dd, *d = &dd;
12299202d7b6SMaya Erez 			u16 dmalen;
12309202d7b6SMaya Erez 			struct sk_buff *skb = ctx->skb;
12319202d7b6SMaya Erez 
12329202d7b6SMaya Erez 			_d = (struct wil_tx_enhanced_desc *)
12339202d7b6SMaya Erez 				&ring->va[ring->swtail].tx.enhanced;
12349202d7b6SMaya Erez 			*d = *_d;
12359202d7b6SMaya Erez 
12369202d7b6SMaya Erez 			dmalen = le16_to_cpu(d->dma.length);
12379202d7b6SMaya Erez 			trace_wil6210_tx_status(&msg, ring->swtail, dmalen);
12389202d7b6SMaya Erez 			wil_dbg_txrx(wil,
12399202d7b6SMaya Erez 				     "TxC[%2d][%3d] : %d bytes, status 0x%02x\n",
12409202d7b6SMaya Erez 				     ring_id, ring->swtail, dmalen,
12419202d7b6SMaya Erez 				     msg.status);
12429202d7b6SMaya Erez 			wil_hex_dump_txrx("TxS ", DUMP_PREFIX_NONE, 32, 4,
12439202d7b6SMaya Erez 					  (const void *)&msg, sizeof(msg),
12449202d7b6SMaya Erez 					  false);
12459202d7b6SMaya Erez 
12469202d7b6SMaya Erez 			wil_tx_desc_unmap_edma(dev,
12479202d7b6SMaya Erez 					       (union wil_tx_desc *)d,
12489202d7b6SMaya Erez 					       ctx);
12499202d7b6SMaya Erez 
12509202d7b6SMaya Erez 			if (skb) {
12519202d7b6SMaya Erez 				if (likely(msg.status == 0)) {
12529202d7b6SMaya Erez 					ndev->stats.tx_packets++;
12539202d7b6SMaya Erez 					ndev->stats.tx_bytes += skb->len;
12549202d7b6SMaya Erez 					if (stats) {
12559202d7b6SMaya Erez 						stats->tx_packets++;
12569202d7b6SMaya Erez 						stats->tx_bytes += skb->len;
1257a24a3d6aSDedy Lansky 
1258a24a3d6aSDedy Lansky 						wil_tx_latency_calc(wil, skb,
1259a24a3d6aSDedy Lansky 							&wil->sta[cid]);
12609202d7b6SMaya Erez 					}
12619202d7b6SMaya Erez 				} else {
12629202d7b6SMaya Erez 					ndev->stats.tx_errors++;
12639202d7b6SMaya Erez 					if (stats)
12649202d7b6SMaya Erez 						stats->tx_errors++;
12659202d7b6SMaya Erez 				}
126642fe1e51SAhmad Masri 
126742fe1e51SAhmad Masri 				if (skb->protocol == cpu_to_be16(ETH_P_PAE))
126842fe1e51SAhmad Masri 					wil_tx_complete_handle_eapol(vif, skb);
126942fe1e51SAhmad Masri 
12709202d7b6SMaya Erez 				wil_consume_skb(skb, msg.status == 0);
12719202d7b6SMaya Erez 			}
12729202d7b6SMaya Erez 			memset(ctx, 0, sizeof(*ctx));
12739202d7b6SMaya Erez 			/* Make sure the ctx is zeroed before updating the tail
12749202d7b6SMaya Erez 			 * to prevent a case where wil_tx_ring will see
12759202d7b6SMaya Erez 			 * this descriptor as used and handle it before ctx zero
12769202d7b6SMaya Erez 			 * is completed.
12779202d7b6SMaya Erez 			 */
12789202d7b6SMaya Erez 			wmb();
12799202d7b6SMaya Erez 
12809202d7b6SMaya Erez 			ring->swtail = wil_ring_next_tail(ring);
12819202d7b6SMaya Erez 
12829202d7b6SMaya Erez 			desc_cnt++;
12839202d7b6SMaya Erez 		}
12849202d7b6SMaya Erez 
12859202d7b6SMaya Erez 		/* performance monitoring */
12869202d7b6SMaya Erez 		used_new = wil_ring_used_tx(ring);
12879202d7b6SMaya Erez 		if (wil_val_in_range(wil->ring_idle_trsh,
12889202d7b6SMaya Erez 				     used_new, used_before_complete)) {
12899202d7b6SMaya Erez 			wil_dbg_txrx(wil, "Ring[%2d] idle %d -> %d\n",
12909202d7b6SMaya Erez 				     ring_id, used_before_complete, used_new);
12919202d7b6SMaya Erez 			txdata->last_idle = get_cycles();
12929202d7b6SMaya Erez 		}
12939202d7b6SMaya Erez 
12949202d7b6SMaya Erez again:
129596b77bb0SAhmad Masri 		num_statuses++;
129696b77bb0SAhmad Masri 		if (num_statuses % WIL_EDMA_TX_SRING_UPDATE_HW_TAIL == 0)
129796b77bb0SAhmad Masri 			/* update HW tail to allow HW to push new statuses */
129896b77bb0SAhmad Masri 			wil_w(wil, sring->hwtail, sring->swhead);
129996b77bb0SAhmad Masri 
13009202d7b6SMaya Erez 		wil_sring_advance_swhead(sring);
13019202d7b6SMaya Erez 
1302f4519fd9SDedy Lansky 		wil_get_next_tx_status_msg(sring, &dr_bit, &msg);
13039202d7b6SMaya Erez 	}
13049202d7b6SMaya Erez 
13059202d7b6SMaya Erez 	/* shall we wake net queues? */
13069202d7b6SMaya Erez 	if (desc_cnt)
13079202d7b6SMaya Erez 		wil_update_net_queues(wil, vif, NULL, false);
13089202d7b6SMaya Erez 
130996b77bb0SAhmad Masri 	if (num_statuses % WIL_EDMA_TX_SRING_UPDATE_HW_TAIL != 0)
13109202d7b6SMaya Erez 		/* Update the HW tail ptr (RD ptr) */
13119202d7b6SMaya Erez 		wil_w(wil, sring->hwtail, (sring->swhead - 1) % sring->size);
13129202d7b6SMaya Erez 
13139202d7b6SMaya Erez 	return desc_cnt;
13149202d7b6SMaya Erez }
13159202d7b6SMaya Erez 
1316e2d651b9SLee Jones /* Sets the descriptor @d up for csum and/or TSO offloading. The corresponding
13179202d7b6SMaya Erez  * @skb is used to obtain the protocol and headers length.
13189202d7b6SMaya Erez  * @tso_desc_type is a descriptor type for TSO: 0 - a header, 1 - first data,
13199202d7b6SMaya Erez  * 2 - middle, 3 - last descriptor.
13209202d7b6SMaya Erez  */
wil_tx_desc_offload_setup_tso_edma(struct wil_tx_enhanced_desc * d,int tso_desc_type,bool is_ipv4,int tcp_hdr_len,int skb_net_hdr_len,int mss)13219202d7b6SMaya Erez static void wil_tx_desc_offload_setup_tso_edma(struct wil_tx_enhanced_desc *d,
13229202d7b6SMaya Erez 					       int tso_desc_type, bool is_ipv4,
13239202d7b6SMaya Erez 					       int tcp_hdr_len,
13249202d7b6SMaya Erez 					       int skb_net_hdr_len,
13259202d7b6SMaya Erez 					       int mss)
13269202d7b6SMaya Erez {
13279202d7b6SMaya Erez 	/* Number of descriptors */
13289202d7b6SMaya Erez 	d->mac.d[2] |= 1;
13299202d7b6SMaya Erez 	/* Maximum Segment Size */
13309202d7b6SMaya Erez 	d->mac.tso_mss |= cpu_to_le16(mss >> 2);
13319202d7b6SMaya Erez 	/* L4 header len: TCP header length */
13329202d7b6SMaya Erez 	d->dma.l4_hdr_len |= tcp_hdr_len & DMA_CFG_DESC_TX_0_L4_LENGTH_MSK;
13339202d7b6SMaya Erez 	/* EOP, TSO desc type, Segmentation enable,
13349202d7b6SMaya Erez 	 * Insert IPv4 and TCP / UDP Checksum
13359202d7b6SMaya Erez 	 */
13369202d7b6SMaya Erez 	d->dma.cmd |= BIT(WIL_EDMA_DESC_TX_CFG_EOP_POS) |
13379202d7b6SMaya Erez 		      tso_desc_type << WIL_EDMA_DESC_TX_CFG_TSO_DESC_TYPE_POS |
13389202d7b6SMaya Erez 		      BIT(WIL_EDMA_DESC_TX_CFG_SEG_EN_POS) |
13399202d7b6SMaya Erez 		      BIT(WIL_EDMA_DESC_TX_CFG_INSERT_IP_CHKSUM_POS) |
13409202d7b6SMaya Erez 		      BIT(WIL_EDMA_DESC_TX_CFG_INSERT_TCP_CHKSUM_POS);
13419202d7b6SMaya Erez 	/* Calculate pseudo-header */
13429202d7b6SMaya Erez 	d->dma.w1 |= BIT(WIL_EDMA_DESC_TX_CFG_PSEUDO_HEADER_CALC_EN_POS) |
13439202d7b6SMaya Erez 		     BIT(WIL_EDMA_DESC_TX_CFG_L4_TYPE_POS);
13449202d7b6SMaya Erez 	/* IP Header Length */
13459202d7b6SMaya Erez 	d->dma.ip_length |= skb_net_hdr_len;
13469202d7b6SMaya Erez 	/* MAC header length and IP address family*/
13479202d7b6SMaya Erez 	d->dma.b11 |= ETH_HLEN |
13489202d7b6SMaya Erez 		      is_ipv4 << DMA_CFG_DESC_TX_OFFLOAD_CFG_L3T_IPV4_POS;
13499202d7b6SMaya Erez }
13509202d7b6SMaya Erez 
wil_tx_tso_gen_desc(struct wil6210_priv * wil,void * buff_addr,int len,uint i,int tso_desc_type,skb_frag_t * frag,struct wil_ring * ring,struct sk_buff * skb,bool is_ipv4,int tcp_hdr_len,int skb_net_hdr_len,int mss,int * descs_used)13519202d7b6SMaya Erez static int wil_tx_tso_gen_desc(struct wil6210_priv *wil, void *buff_addr,
13529202d7b6SMaya Erez 			       int len, uint i, int tso_desc_type,
13539202d7b6SMaya Erez 			       skb_frag_t *frag, struct wil_ring *ring,
13549202d7b6SMaya Erez 			       struct sk_buff *skb, bool is_ipv4,
13559202d7b6SMaya Erez 			       int tcp_hdr_len, int skb_net_hdr_len,
13569202d7b6SMaya Erez 			       int mss, int *descs_used)
13579202d7b6SMaya Erez {
13589202d7b6SMaya Erez 	struct device *dev = wil_to_dev(wil);
13599202d7b6SMaya Erez 	struct wil_tx_enhanced_desc *_desc = (struct wil_tx_enhanced_desc *)
13609202d7b6SMaya Erez 		&ring->va[i].tx.enhanced;
13619202d7b6SMaya Erez 	struct wil_tx_enhanced_desc desc_mem, *d = &desc_mem;
13629202d7b6SMaya Erez 	int ring_index = ring - wil->ring_tx;
13639202d7b6SMaya Erez 	dma_addr_t pa;
13649202d7b6SMaya Erez 
13659202d7b6SMaya Erez 	if (len == 0)
13669202d7b6SMaya Erez 		return 0;
13679202d7b6SMaya Erez 
13689202d7b6SMaya Erez 	if (!frag) {
13699202d7b6SMaya Erez 		pa = dma_map_single(dev, buff_addr, len, DMA_TO_DEVICE);
13709202d7b6SMaya Erez 		ring->ctx[i].mapped_as = wil_mapped_as_single;
13719202d7b6SMaya Erez 	} else {
13729202d7b6SMaya Erez 		pa = skb_frag_dma_map(dev, frag, 0, len, DMA_TO_DEVICE);
13739202d7b6SMaya Erez 		ring->ctx[i].mapped_as = wil_mapped_as_page;
13749202d7b6SMaya Erez 	}
13759202d7b6SMaya Erez 	if (unlikely(dma_mapping_error(dev, pa))) {
13769202d7b6SMaya Erez 		wil_err(wil, "TSO: Skb DMA map error\n");
13779202d7b6SMaya Erez 		return -EINVAL;
13789202d7b6SMaya Erez 	}
13799202d7b6SMaya Erez 
13809202d7b6SMaya Erez 	wil->txrx_ops.tx_desc_map((union wil_tx_desc *)d, pa,
13819202d7b6SMaya Erez 				   len, ring_index);
13829202d7b6SMaya Erez 	wil_tx_desc_offload_setup_tso_edma(d, tso_desc_type, is_ipv4,
13839202d7b6SMaya Erez 					   tcp_hdr_len,
13849202d7b6SMaya Erez 					   skb_net_hdr_len, mss);
13859202d7b6SMaya Erez 
13869202d7b6SMaya Erez 	/* hold reference to skb
13879202d7b6SMaya Erez 	 * to prevent skb release before accounting
13889202d7b6SMaya Erez 	 * in case of immediate "tx done"
13899202d7b6SMaya Erez 	 */
13909202d7b6SMaya Erez 	if (tso_desc_type == wil_tso_type_lst)
13919202d7b6SMaya Erez 		ring->ctx[i].skb = skb_get(skb);
13929202d7b6SMaya Erez 
13939202d7b6SMaya Erez 	wil_hex_dump_txrx("TxD ", DUMP_PREFIX_NONE, 32, 4,
13949202d7b6SMaya Erez 			  (const void *)d, sizeof(*d), false);
13959202d7b6SMaya Erez 
13969202d7b6SMaya Erez 	*_desc = *d;
13979202d7b6SMaya Erez 	(*descs_used)++;
13989202d7b6SMaya Erez 
13999202d7b6SMaya Erez 	return 0;
14009202d7b6SMaya Erez }
14019202d7b6SMaya Erez 
__wil_tx_ring_tso_edma(struct wil6210_priv * wil,struct wil6210_vif * vif,struct wil_ring * ring,struct sk_buff * skb)14029202d7b6SMaya Erez static int __wil_tx_ring_tso_edma(struct wil6210_priv *wil,
14039202d7b6SMaya Erez 				  struct wil6210_vif *vif,
14049202d7b6SMaya Erez 				  struct wil_ring *ring,
14059202d7b6SMaya Erez 				  struct sk_buff *skb)
14069202d7b6SMaya Erez {
14079202d7b6SMaya Erez 	int ring_index = ring - wil->ring_tx;
14089202d7b6SMaya Erez 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_index];
14099202d7b6SMaya Erez 	int nr_frags = skb_shinfo(skb)->nr_frags;
14109202d7b6SMaya Erez 	int min_desc_required = nr_frags + 2; /* Headers, Head, Fragments */
14119202d7b6SMaya Erez 	int used, avail = wil_ring_avail_tx(ring);
14129202d7b6SMaya Erez 	int f, hdrlen, headlen;
14139202d7b6SMaya Erez 	int gso_type;
14149202d7b6SMaya Erez 	bool is_ipv4;
14159202d7b6SMaya Erez 	u32 swhead = ring->swhead;
14169202d7b6SMaya Erez 	int descs_used = 0; /* total number of used descriptors */
14179202d7b6SMaya Erez 	int rc = -EINVAL;
14189202d7b6SMaya Erez 	int tcp_hdr_len;
14199202d7b6SMaya Erez 	int skb_net_hdr_len;
14209202d7b6SMaya Erez 	int mss = skb_shinfo(skb)->gso_size;
14219202d7b6SMaya Erez 
14229202d7b6SMaya Erez 	wil_dbg_txrx(wil, "tx_ring_tso: %d bytes to ring %d\n", skb->len,
14239202d7b6SMaya Erez 		     ring_index);
14249202d7b6SMaya Erez 
14259202d7b6SMaya Erez 	if (unlikely(!txdata->enabled))
14269202d7b6SMaya Erez 		return -EINVAL;
14279202d7b6SMaya Erez 
14289202d7b6SMaya Erez 	if (unlikely(avail < min_desc_required)) {
14299202d7b6SMaya Erez 		wil_err_ratelimited(wil,
14309202d7b6SMaya Erez 				    "TSO: Tx ring[%2d] full. No space for %d fragments\n",
14319202d7b6SMaya Erez 				    ring_index, min_desc_required);
14329202d7b6SMaya Erez 		return -ENOMEM;
14339202d7b6SMaya Erez 	}
14349202d7b6SMaya Erez 
14359202d7b6SMaya Erez 	gso_type = skb_shinfo(skb)->gso_type & (SKB_GSO_TCPV6 | SKB_GSO_TCPV4);
14369202d7b6SMaya Erez 	switch (gso_type) {
14379202d7b6SMaya Erez 	case SKB_GSO_TCPV4:
14389202d7b6SMaya Erez 		is_ipv4 = true;
14399202d7b6SMaya Erez 		break;
14409202d7b6SMaya Erez 	case SKB_GSO_TCPV6:
14419202d7b6SMaya Erez 		is_ipv4 = false;
14429202d7b6SMaya Erez 		break;
14439202d7b6SMaya Erez 	default:
14449202d7b6SMaya Erez 		return -EINVAL;
14459202d7b6SMaya Erez 	}
14469202d7b6SMaya Erez 
14479202d7b6SMaya Erez 	if (skb->ip_summed != CHECKSUM_PARTIAL)
14489202d7b6SMaya Erez 		return -EINVAL;
14499202d7b6SMaya Erez 
14509202d7b6SMaya Erez 	/* tcp header length and skb network header length are fixed for all
14519202d7b6SMaya Erez 	 * packet's descriptors - read them once here
14529202d7b6SMaya Erez 	 */
14539202d7b6SMaya Erez 	tcp_hdr_len = tcp_hdrlen(skb);
14549202d7b6SMaya Erez 	skb_net_hdr_len = skb_network_header_len(skb);
14559202d7b6SMaya Erez 
14569202d7b6SMaya Erez 	/* First descriptor must contain the header only
14579202d7b6SMaya Erez 	 * Header Length = MAC header len + IP header len + TCP header len
14589202d7b6SMaya Erez 	 */
14599202d7b6SMaya Erez 	hdrlen = ETH_HLEN + tcp_hdr_len + skb_net_hdr_len;
14609202d7b6SMaya Erez 	wil_dbg_txrx(wil, "TSO: process header descriptor, hdrlen %u\n",
14619202d7b6SMaya Erez 		     hdrlen);
14629202d7b6SMaya Erez 	rc = wil_tx_tso_gen_desc(wil, skb->data, hdrlen, swhead,
14639202d7b6SMaya Erez 				 wil_tso_type_hdr, NULL, ring, skb,
14649202d7b6SMaya Erez 				 is_ipv4, tcp_hdr_len, skb_net_hdr_len,
14659202d7b6SMaya Erez 				 mss, &descs_used);
14669202d7b6SMaya Erez 	if (rc)
14679202d7b6SMaya Erez 		return -EINVAL;
14689202d7b6SMaya Erez 
14699202d7b6SMaya Erez 	/* Second descriptor contains the head */
14709202d7b6SMaya Erez 	headlen = skb_headlen(skb) - hdrlen;
14719202d7b6SMaya Erez 	wil_dbg_txrx(wil, "TSO: process skb head, headlen %u\n", headlen);
14729202d7b6SMaya Erez 	rc = wil_tx_tso_gen_desc(wil, skb->data + hdrlen, headlen,
14739202d7b6SMaya Erez 				 (swhead + descs_used) % ring->size,
14749202d7b6SMaya Erez 				 (nr_frags != 0) ? wil_tso_type_first :
14759202d7b6SMaya Erez 				 wil_tso_type_lst, NULL, ring, skb,
14769202d7b6SMaya Erez 				 is_ipv4, tcp_hdr_len, skb_net_hdr_len,
14779202d7b6SMaya Erez 				 mss, &descs_used);
14789202d7b6SMaya Erez 	if (rc)
14799202d7b6SMaya Erez 		goto mem_error;
14809202d7b6SMaya Erez 
14819202d7b6SMaya Erez 	/* Rest of the descriptors are from the SKB fragments */
14829202d7b6SMaya Erez 	for (f = 0; f < nr_frags; f++) {
14839202d7b6SMaya Erez 		skb_frag_t *frag = &skb_shinfo(skb)->frags[f];
1484d7840976SMatthew Wilcox (Oracle) 		int len = skb_frag_size(frag);
14859202d7b6SMaya Erez 
14869202d7b6SMaya Erez 		wil_dbg_txrx(wil, "TSO: frag[%d]: len %u, descs_used %d\n", f,
14879202d7b6SMaya Erez 			     len, descs_used);
14889202d7b6SMaya Erez 
14899202d7b6SMaya Erez 		rc = wil_tx_tso_gen_desc(wil, NULL, len,
14909202d7b6SMaya Erez 					 (swhead + descs_used) % ring->size,
14919202d7b6SMaya Erez 					 (f != nr_frags - 1) ?
14929202d7b6SMaya Erez 					 wil_tso_type_mid : wil_tso_type_lst,
14939202d7b6SMaya Erez 					 frag, ring, skb, is_ipv4,
14949202d7b6SMaya Erez 					 tcp_hdr_len, skb_net_hdr_len,
14959202d7b6SMaya Erez 					 mss, &descs_used);
14969202d7b6SMaya Erez 		if (rc)
14979202d7b6SMaya Erez 			goto mem_error;
14989202d7b6SMaya Erez 	}
14999202d7b6SMaya Erez 
15009202d7b6SMaya Erez 	/* performance monitoring */
15019202d7b6SMaya Erez 	used = wil_ring_used_tx(ring);
15029202d7b6SMaya Erez 	if (wil_val_in_range(wil->ring_idle_trsh,
15039202d7b6SMaya Erez 			     used, used + descs_used)) {
15049202d7b6SMaya Erez 		txdata->idle += get_cycles() - txdata->last_idle;
15059202d7b6SMaya Erez 		wil_dbg_txrx(wil,  "Ring[%2d] not idle %d -> %d\n",
15069202d7b6SMaya Erez 			     ring_index, used, used + descs_used);
15079202d7b6SMaya Erez 	}
15089202d7b6SMaya Erez 
15099202d7b6SMaya Erez 	/* advance swhead */
15109202d7b6SMaya Erez 	wil_ring_advance_head(ring, descs_used);
15119202d7b6SMaya Erez 	wil_dbg_txrx(wil, "TSO: Tx swhead %d -> %d\n", swhead, ring->swhead);
15129202d7b6SMaya Erez 
15139202d7b6SMaya Erez 	/* make sure all writes to descriptors (shared memory) are done before
15149202d7b6SMaya Erez 	 * committing them to HW
15159202d7b6SMaya Erez 	 */
15169202d7b6SMaya Erez 	wmb();
15179202d7b6SMaya Erez 
1518a24a3d6aSDedy Lansky 	if (wil->tx_latency)
1519a24a3d6aSDedy Lansky 		*(ktime_t *)&skb->cb = ktime_get();
1520a24a3d6aSDedy Lansky 	else
1521a24a3d6aSDedy Lansky 		memset(skb->cb, 0, sizeof(ktime_t));
1522a24a3d6aSDedy Lansky 
15239202d7b6SMaya Erez 	wil_w(wil, ring->hwtail, ring->swhead);
15249202d7b6SMaya Erez 
15259202d7b6SMaya Erez 	return 0;
15269202d7b6SMaya Erez 
15279202d7b6SMaya Erez mem_error:
15289202d7b6SMaya Erez 	while (descs_used > 0) {
15299202d7b6SMaya Erez 		struct device *dev = wil_to_dev(wil);
15309202d7b6SMaya Erez 		struct wil_ctx *ctx;
15319202d7b6SMaya Erez 		int i = (swhead + descs_used - 1) % ring->size;
15329202d7b6SMaya Erez 		struct wil_tx_enhanced_desc dd, *d = &dd;
15339202d7b6SMaya Erez 		struct wil_tx_enhanced_desc *_desc =
15349202d7b6SMaya Erez 			(struct wil_tx_enhanced_desc *)
15359202d7b6SMaya Erez 			&ring->va[i].tx.enhanced;
15369202d7b6SMaya Erez 
15379202d7b6SMaya Erez 		*d = *_desc;
15389202d7b6SMaya Erez 		ctx = &ring->ctx[i];
15399202d7b6SMaya Erez 		wil_tx_desc_unmap_edma(dev, (union wil_tx_desc *)d, ctx);
15409202d7b6SMaya Erez 		memset(ctx, 0, sizeof(*ctx));
15419202d7b6SMaya Erez 		descs_used--;
15429202d7b6SMaya Erez 	}
15439202d7b6SMaya Erez 	return rc;
15449202d7b6SMaya Erez }
15459202d7b6SMaya Erez 
wil_ring_init_bcast_edma(struct wil6210_vif * vif,int ring_id,int size)154696c93589SGidon Studinski static int wil_ring_init_bcast_edma(struct wil6210_vif *vif, int ring_id,
154796c93589SGidon Studinski 				    int size)
154896c93589SGidon Studinski {
154996c93589SGidon Studinski 	struct wil6210_priv *wil = vif_to_wil(vif);
155096c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_tx[ring_id];
155196c93589SGidon Studinski 	int rc;
155296c93589SGidon Studinski 	struct wil_ring_tx_data *txdata = &wil->ring_tx_data[ring_id];
155396c93589SGidon Studinski 
155496c93589SGidon Studinski 	wil_dbg_misc(wil, "init bcast: ring_id=%d, sring_id=%d\n",
155596c93589SGidon Studinski 		     ring_id, wil->tx_sring_idx);
155696c93589SGidon Studinski 
155796c93589SGidon Studinski 	lockdep_assert_held(&wil->mutex);
155896c93589SGidon Studinski 
155996c93589SGidon Studinski 	wil_tx_data_init(txdata);
156096c93589SGidon Studinski 	ring->size = size;
156196c93589SGidon Studinski 	ring->is_rx = false;
156296c93589SGidon Studinski 	rc = wil_ring_alloc_desc_ring(wil, ring);
156396c93589SGidon Studinski 	if (rc)
156496c93589SGidon Studinski 		goto out;
156596c93589SGidon Studinski 
156696c93589SGidon Studinski 	wil->ring2cid_tid[ring_id][0] = WIL6210_MAX_CID; /* CID */
156796c93589SGidon Studinski 	wil->ring2cid_tid[ring_id][1] = 0; /* TID */
156896c93589SGidon Studinski 	if (!vif->privacy)
156996c93589SGidon Studinski 		txdata->dot1x_open = true;
157096c93589SGidon Studinski 
157196c93589SGidon Studinski 	rc = wil_wmi_bcast_desc_ring_add(vif, ring_id);
157296c93589SGidon Studinski 	if (rc)
157396c93589SGidon Studinski 		goto out_free;
157496c93589SGidon Studinski 
157596c93589SGidon Studinski 	return 0;
157696c93589SGidon Studinski 
157796c93589SGidon Studinski  out_free:
157896c93589SGidon Studinski 	spin_lock_bh(&txdata->lock);
157996c93589SGidon Studinski 	txdata->enabled = 0;
158096c93589SGidon Studinski 	txdata->dot1x_open = false;
158196c93589SGidon Studinski 	spin_unlock_bh(&txdata->lock);
158296c93589SGidon Studinski 	wil_ring_free_edma(wil, ring);
158396c93589SGidon Studinski 
158496c93589SGidon Studinski out:
158596c93589SGidon Studinski 	return rc;
158696c93589SGidon Studinski }
158796c93589SGidon Studinski 
wil_tx_fini_edma(struct wil6210_priv * wil)158896c93589SGidon Studinski static void wil_tx_fini_edma(struct wil6210_priv *wil)
158996c93589SGidon Studinski {
159096c93589SGidon Studinski 	struct wil_status_ring *sring = &wil->srings[wil->tx_sring_idx];
159196c93589SGidon Studinski 
159296c93589SGidon Studinski 	wil_dbg_misc(wil, "free TX sring\n");
159396c93589SGidon Studinski 
159496c93589SGidon Studinski 	wil_sring_free(wil, sring);
159596c93589SGidon Studinski }
159696c93589SGidon Studinski 
wil_rx_data_free(struct wil_status_ring * sring)159796c93589SGidon Studinski static void wil_rx_data_free(struct wil_status_ring *sring)
159896c93589SGidon Studinski {
159996c93589SGidon Studinski 	if (!sring)
160096c93589SGidon Studinski 		return;
160196c93589SGidon Studinski 
160296c93589SGidon Studinski 	kfree_skb(sring->rx_data.skb);
160396c93589SGidon Studinski 	sring->rx_data.skb = NULL;
160496c93589SGidon Studinski }
160596c93589SGidon Studinski 
wil_rx_fini_edma(struct wil6210_priv * wil)160696c93589SGidon Studinski static void wil_rx_fini_edma(struct wil6210_priv *wil)
160796c93589SGidon Studinski {
160896c93589SGidon Studinski 	struct wil_ring *ring = &wil->ring_rx;
160996c93589SGidon Studinski 	int i;
161096c93589SGidon Studinski 
161196c93589SGidon Studinski 	wil_dbg_misc(wil, "rx_fini_edma\n");
161296c93589SGidon Studinski 
161396c93589SGidon Studinski 	wil_ring_free_edma(wil, ring);
161496c93589SGidon Studinski 
161596c93589SGidon Studinski 	for (i = 0; i < wil->num_rx_status_rings; i++) {
161696c93589SGidon Studinski 		wil_rx_data_free(&wil->srings[i]);
161796c93589SGidon Studinski 		wil_sring_free(wil, &wil->srings[i]);
161896c93589SGidon Studinski 	}
161996c93589SGidon Studinski 
162096c93589SGidon Studinski 	wil_free_rx_buff_arr(wil);
162196c93589SGidon Studinski }
162296c93589SGidon Studinski 
wil_init_txrx_ops_edma(struct wil6210_priv * wil)162396c93589SGidon Studinski void wil_init_txrx_ops_edma(struct wil6210_priv *wil)
162496c93589SGidon Studinski {
162596c93589SGidon Studinski 	wil->txrx_ops.configure_interrupt_moderation =
162696c93589SGidon Studinski 		wil_configure_interrupt_moderation_edma;
162796c93589SGidon Studinski 	/* TX ops */
162896c93589SGidon Studinski 	wil->txrx_ops.ring_init_tx = wil_ring_init_tx_edma;
162996c93589SGidon Studinski 	wil->txrx_ops.ring_fini_tx = wil_ring_free_edma;
163096c93589SGidon Studinski 	wil->txrx_ops.ring_init_bcast = wil_ring_init_bcast_edma;
163196c93589SGidon Studinski 	wil->txrx_ops.tx_init = wil_tx_init_edma;
163296c93589SGidon Studinski 	wil->txrx_ops.tx_fini = wil_tx_fini_edma;
16339202d7b6SMaya Erez 	wil->txrx_ops.tx_desc_map = wil_tx_desc_map_edma;
16349202d7b6SMaya Erez 	wil->txrx_ops.tx_desc_unmap = wil_tx_desc_unmap_edma;
16359202d7b6SMaya Erez 	wil->txrx_ops.tx_ring_tso = __wil_tx_ring_tso_edma;
1636b9010f10SAhmad Masri 	wil->txrx_ops.tx_ring_modify = wil_tx_ring_modify_edma;
163796c93589SGidon Studinski 	/* RX ops */
163896c93589SGidon Studinski 	wil->txrx_ops.rx_init = wil_rx_init_edma;
16397be13fc3SGidon Studinski 	wil->txrx_ops.wmi_addba_rx_resp = wmi_addba_rx_resp_edma;
16407be13fc3SGidon Studinski 	wil->txrx_ops.get_reorder_params = wil_get_reorder_params_edma;
16417be13fc3SGidon Studinski 	wil->txrx_ops.get_netif_rx_params = wil_get_netif_rx_params_edma;
16427be13fc3SGidon Studinski 	wil->txrx_ops.rx_crypto_check = wil_rx_crypto_check_edma;
1643e15af41cSDedy Lansky 	wil->txrx_ops.rx_error_check = wil_rx_error_check_edma;
16447be13fc3SGidon Studinski 	wil->txrx_ops.is_rx_idle = wil_is_rx_idle_edma;
164596c93589SGidon Studinski 	wil->txrx_ops.rx_fini = wil_rx_fini_edma;
164696c93589SGidon Studinski }
164796c93589SGidon Studinski 
1648