1cdedef59SAnirudh Venkataramanan // SPDX-License-Identifier: GPL-2.0
2cdedef59SAnirudh Venkataramanan /* Copyright (c) 2018, Intel Corporation. */
3cdedef59SAnirudh Venkataramanan 
4cdedef59SAnirudh Venkataramanan /* The driver transmit and receive code */
5cdedef59SAnirudh Venkataramanan 
6cdedef59SAnirudh Venkataramanan #include <linux/prefetch.h>
7cdedef59SAnirudh Venkataramanan #include <linux/mm.h>
8efc2214bSMaciej Fijalkowski #include <linux/bpf_trace.h>
9efc2214bSMaciej Fijalkowski #include <net/xdp.h>
100891d6d4SKrzysztof Kazimierczak #include "ice_txrx_lib.h"
11efc2214bSMaciej Fijalkowski #include "ice_lib.h"
12cdedef59SAnirudh Venkataramanan #include "ice.h"
135f6aa50eSAnirudh Venkataramanan #include "ice_dcb_lib.h"
142d4238f5SKrzysztof Kazimierczak #include "ice_xsk.h"
15cdedef59SAnirudh Venkataramanan 
162b245cb2SAnirudh Venkataramanan #define ICE_RX_HDR_SIZE		256
172b245cb2SAnirudh Venkataramanan 
18148beb61SHenry Tieman #define FDIR_DESC_RXDID 0x40
19cac2a27cSHenry Tieman #define ICE_FDIR_CLEAN_DELAY 10
20cac2a27cSHenry Tieman 
21cac2a27cSHenry Tieman /**
22cac2a27cSHenry Tieman  * ice_prgm_fdir_fltr - Program a Flow Director filter
23cac2a27cSHenry Tieman  * @vsi: VSI to send dummy packet
24cac2a27cSHenry Tieman  * @fdir_desc: flow director descriptor
25cac2a27cSHenry Tieman  * @raw_packet: allocated buffer for flow director
26cac2a27cSHenry Tieman  */
27cac2a27cSHenry Tieman int
28cac2a27cSHenry Tieman ice_prgm_fdir_fltr(struct ice_vsi *vsi, struct ice_fltr_desc *fdir_desc,
29cac2a27cSHenry Tieman 		   u8 *raw_packet)
30cac2a27cSHenry Tieman {
31cac2a27cSHenry Tieman 	struct ice_tx_buf *tx_buf, *first;
32cac2a27cSHenry Tieman 	struct ice_fltr_desc *f_desc;
33cac2a27cSHenry Tieman 	struct ice_tx_desc *tx_desc;
34cac2a27cSHenry Tieman 	struct ice_ring *tx_ring;
35cac2a27cSHenry Tieman 	struct device *dev;
36cac2a27cSHenry Tieman 	dma_addr_t dma;
37cac2a27cSHenry Tieman 	u32 td_cmd;
38cac2a27cSHenry Tieman 	u16 i;
39cac2a27cSHenry Tieman 
40cac2a27cSHenry Tieman 	/* VSI and Tx ring */
41cac2a27cSHenry Tieman 	if (!vsi)
42cac2a27cSHenry Tieman 		return -ENOENT;
43cac2a27cSHenry Tieman 	tx_ring = vsi->tx_rings[0];
44cac2a27cSHenry Tieman 	if (!tx_ring || !tx_ring->desc)
45cac2a27cSHenry Tieman 		return -ENOENT;
46cac2a27cSHenry Tieman 	dev = tx_ring->dev;
47cac2a27cSHenry Tieman 
48cac2a27cSHenry Tieman 	/* we are using two descriptors to add/del a filter and we can wait */
49cac2a27cSHenry Tieman 	for (i = ICE_FDIR_CLEAN_DELAY; ICE_DESC_UNUSED(tx_ring) < 2; i--) {
50cac2a27cSHenry Tieman 		if (!i)
51cac2a27cSHenry Tieman 			return -EAGAIN;
52cac2a27cSHenry Tieman 		msleep_interruptible(1);
53cac2a27cSHenry Tieman 	}
54cac2a27cSHenry Tieman 
55cac2a27cSHenry Tieman 	dma = dma_map_single(dev, raw_packet, ICE_FDIR_MAX_RAW_PKT_SIZE,
56cac2a27cSHenry Tieman 			     DMA_TO_DEVICE);
57cac2a27cSHenry Tieman 
58cac2a27cSHenry Tieman 	if (dma_mapping_error(dev, dma))
59cac2a27cSHenry Tieman 		return -EINVAL;
60cac2a27cSHenry Tieman 
61cac2a27cSHenry Tieman 	/* grab the next descriptor */
62cac2a27cSHenry Tieman 	i = tx_ring->next_to_use;
63cac2a27cSHenry Tieman 	first = &tx_ring->tx_buf[i];
64cac2a27cSHenry Tieman 	f_desc = ICE_TX_FDIRDESC(tx_ring, i);
65cac2a27cSHenry Tieman 	memcpy(f_desc, fdir_desc, sizeof(*f_desc));
66cac2a27cSHenry Tieman 
67cac2a27cSHenry Tieman 	i++;
68cac2a27cSHenry Tieman 	i = (i < tx_ring->count) ? i : 0;
69cac2a27cSHenry Tieman 	tx_desc = ICE_TX_DESC(tx_ring, i);
70cac2a27cSHenry Tieman 	tx_buf = &tx_ring->tx_buf[i];
71cac2a27cSHenry Tieman 
72cac2a27cSHenry Tieman 	i++;
73cac2a27cSHenry Tieman 	tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
74cac2a27cSHenry Tieman 
75cac2a27cSHenry Tieman 	memset(tx_buf, 0, sizeof(*tx_buf));
76cac2a27cSHenry Tieman 	dma_unmap_len_set(tx_buf, len, ICE_FDIR_MAX_RAW_PKT_SIZE);
77cac2a27cSHenry Tieman 	dma_unmap_addr_set(tx_buf, dma, dma);
78cac2a27cSHenry Tieman 
79cac2a27cSHenry Tieman 	tx_desc->buf_addr = cpu_to_le64(dma);
80cac2a27cSHenry Tieman 	td_cmd = ICE_TXD_LAST_DESC_CMD | ICE_TX_DESC_CMD_DUMMY |
81cac2a27cSHenry Tieman 		 ICE_TX_DESC_CMD_RE;
82cac2a27cSHenry Tieman 
83cac2a27cSHenry Tieman 	tx_buf->tx_flags = ICE_TX_FLAGS_DUMMY_PKT;
84cac2a27cSHenry Tieman 	tx_buf->raw_buf = raw_packet;
85cac2a27cSHenry Tieman 
86cac2a27cSHenry Tieman 	tx_desc->cmd_type_offset_bsz =
87cac2a27cSHenry Tieman 		ice_build_ctob(td_cmd, 0, ICE_FDIR_MAX_RAW_PKT_SIZE, 0);
88cac2a27cSHenry Tieman 
89cac2a27cSHenry Tieman 	/* Force memory write to complete before letting h/w know
90cac2a27cSHenry Tieman 	 * there are new descriptors to fetch.
91cac2a27cSHenry Tieman 	 */
92cac2a27cSHenry Tieman 	wmb();
93cac2a27cSHenry Tieman 
94cac2a27cSHenry Tieman 	/* mark the data descriptor to be watched */
95cac2a27cSHenry Tieman 	first->next_to_watch = tx_desc;
96cac2a27cSHenry Tieman 
97cac2a27cSHenry Tieman 	writel(tx_ring->next_to_use, tx_ring->tail);
98cac2a27cSHenry Tieman 
99cac2a27cSHenry Tieman 	return 0;
100cac2a27cSHenry Tieman }
101148beb61SHenry Tieman 
102cdedef59SAnirudh Venkataramanan /**
103cdedef59SAnirudh Venkataramanan  * ice_unmap_and_free_tx_buf - Release a Tx buffer
104cdedef59SAnirudh Venkataramanan  * @ring: the ring that owns the buffer
105cdedef59SAnirudh Venkataramanan  * @tx_buf: the buffer to free
106cdedef59SAnirudh Venkataramanan  */
107cdedef59SAnirudh Venkataramanan static void
108cdedef59SAnirudh Venkataramanan ice_unmap_and_free_tx_buf(struct ice_ring *ring, struct ice_tx_buf *tx_buf)
109cdedef59SAnirudh Venkataramanan {
110cdedef59SAnirudh Venkataramanan 	if (tx_buf->skb) {
111148beb61SHenry Tieman 		if (tx_buf->tx_flags & ICE_TX_FLAGS_DUMMY_PKT)
112148beb61SHenry Tieman 			devm_kfree(ring->dev, tx_buf->raw_buf);
113148beb61SHenry Tieman 		else if (ice_ring_is_xdp(ring))
114efc2214bSMaciej Fijalkowski 			page_frag_free(tx_buf->raw_buf);
115efc2214bSMaciej Fijalkowski 		else
116cdedef59SAnirudh Venkataramanan 			dev_kfree_skb_any(tx_buf->skb);
117cdedef59SAnirudh Venkataramanan 		if (dma_unmap_len(tx_buf, len))
118cdedef59SAnirudh Venkataramanan 			dma_unmap_single(ring->dev,
119cdedef59SAnirudh Venkataramanan 					 dma_unmap_addr(tx_buf, dma),
120cdedef59SAnirudh Venkataramanan 					 dma_unmap_len(tx_buf, len),
121cdedef59SAnirudh Venkataramanan 					 DMA_TO_DEVICE);
122cdedef59SAnirudh Venkataramanan 	} else if (dma_unmap_len(tx_buf, len)) {
123cdedef59SAnirudh Venkataramanan 		dma_unmap_page(ring->dev,
124cdedef59SAnirudh Venkataramanan 			       dma_unmap_addr(tx_buf, dma),
125cdedef59SAnirudh Venkataramanan 			       dma_unmap_len(tx_buf, len),
126cdedef59SAnirudh Venkataramanan 			       DMA_TO_DEVICE);
127cdedef59SAnirudh Venkataramanan 	}
128cdedef59SAnirudh Venkataramanan 
129cdedef59SAnirudh Venkataramanan 	tx_buf->next_to_watch = NULL;
130cdedef59SAnirudh Venkataramanan 	tx_buf->skb = NULL;
131cdedef59SAnirudh Venkataramanan 	dma_unmap_len_set(tx_buf, len, 0);
132cdedef59SAnirudh Venkataramanan 	/* tx_buf must be completely set up in the transmit path */
133cdedef59SAnirudh Venkataramanan }
134cdedef59SAnirudh Venkataramanan 
135cdedef59SAnirudh Venkataramanan static struct netdev_queue *txring_txq(const struct ice_ring *ring)
136cdedef59SAnirudh Venkataramanan {
137cdedef59SAnirudh Venkataramanan 	return netdev_get_tx_queue(ring->netdev, ring->q_index);
138cdedef59SAnirudh Venkataramanan }
139cdedef59SAnirudh Venkataramanan 
140cdedef59SAnirudh Venkataramanan /**
141cdedef59SAnirudh Venkataramanan  * ice_clean_tx_ring - Free any empty Tx buffers
142cdedef59SAnirudh Venkataramanan  * @tx_ring: ring to be cleaned
143cdedef59SAnirudh Venkataramanan  */
144cdedef59SAnirudh Venkataramanan void ice_clean_tx_ring(struct ice_ring *tx_ring)
145cdedef59SAnirudh Venkataramanan {
146cdedef59SAnirudh Venkataramanan 	u16 i;
147cdedef59SAnirudh Venkataramanan 
1481742b3d5SMagnus Karlsson 	if (ice_ring_is_xdp(tx_ring) && tx_ring->xsk_pool) {
1492d4238f5SKrzysztof Kazimierczak 		ice_xsk_clean_xdp_ring(tx_ring);
1502d4238f5SKrzysztof Kazimierczak 		goto tx_skip_free;
1512d4238f5SKrzysztof Kazimierczak 	}
1522d4238f5SKrzysztof Kazimierczak 
153cdedef59SAnirudh Venkataramanan 	/* ring already cleared, nothing to do */
154cdedef59SAnirudh Venkataramanan 	if (!tx_ring->tx_buf)
155cdedef59SAnirudh Venkataramanan 		return;
156cdedef59SAnirudh Venkataramanan 
1572f2da36eSAnirudh Venkataramanan 	/* Free all the Tx ring sk_buffs */
158cdedef59SAnirudh Venkataramanan 	for (i = 0; i < tx_ring->count; i++)
159cdedef59SAnirudh Venkataramanan 		ice_unmap_and_free_tx_buf(tx_ring, &tx_ring->tx_buf[i]);
160cdedef59SAnirudh Venkataramanan 
1612d4238f5SKrzysztof Kazimierczak tx_skip_free:
162c6dfd690SBruce Allan 	memset(tx_ring->tx_buf, 0, sizeof(*tx_ring->tx_buf) * tx_ring->count);
163cdedef59SAnirudh Venkataramanan 
164cdedef59SAnirudh Venkataramanan 	/* Zero out the descriptor ring */
165cdedef59SAnirudh Venkataramanan 	memset(tx_ring->desc, 0, tx_ring->size);
166cdedef59SAnirudh Venkataramanan 
167cdedef59SAnirudh Venkataramanan 	tx_ring->next_to_use = 0;
168cdedef59SAnirudh Venkataramanan 	tx_ring->next_to_clean = 0;
169cdedef59SAnirudh Venkataramanan 
170cdedef59SAnirudh Venkataramanan 	if (!tx_ring->netdev)
171cdedef59SAnirudh Venkataramanan 		return;
172cdedef59SAnirudh Venkataramanan 
173cdedef59SAnirudh Venkataramanan 	/* cleanup Tx queue statistics */
174cdedef59SAnirudh Venkataramanan 	netdev_tx_reset_queue(txring_txq(tx_ring));
175cdedef59SAnirudh Venkataramanan }
176cdedef59SAnirudh Venkataramanan 
177cdedef59SAnirudh Venkataramanan /**
178cdedef59SAnirudh Venkataramanan  * ice_free_tx_ring - Free Tx resources per queue
179cdedef59SAnirudh Venkataramanan  * @tx_ring: Tx descriptor ring for a specific queue
180cdedef59SAnirudh Venkataramanan  *
181cdedef59SAnirudh Venkataramanan  * Free all transmit software resources
182cdedef59SAnirudh Venkataramanan  */
183cdedef59SAnirudh Venkataramanan void ice_free_tx_ring(struct ice_ring *tx_ring)
184cdedef59SAnirudh Venkataramanan {
185cdedef59SAnirudh Venkataramanan 	ice_clean_tx_ring(tx_ring);
186cdedef59SAnirudh Venkataramanan 	devm_kfree(tx_ring->dev, tx_ring->tx_buf);
187cdedef59SAnirudh Venkataramanan 	tx_ring->tx_buf = NULL;
188cdedef59SAnirudh Venkataramanan 
189cdedef59SAnirudh Venkataramanan 	if (tx_ring->desc) {
190cdedef59SAnirudh Venkataramanan 		dmam_free_coherent(tx_ring->dev, tx_ring->size,
191cdedef59SAnirudh Venkataramanan 				   tx_ring->desc, tx_ring->dma);
192cdedef59SAnirudh Venkataramanan 		tx_ring->desc = NULL;
193cdedef59SAnirudh Venkataramanan 	}
194cdedef59SAnirudh Venkataramanan }
195cdedef59SAnirudh Venkataramanan 
196cdedef59SAnirudh Venkataramanan /**
1972b245cb2SAnirudh Venkataramanan  * ice_clean_tx_irq - Reclaim resources after transmit completes
1982b245cb2SAnirudh Venkataramanan  * @tx_ring: Tx ring to clean
1992b245cb2SAnirudh Venkataramanan  * @napi_budget: Used to determine if we are in netpoll
2002b245cb2SAnirudh Venkataramanan  *
2012b245cb2SAnirudh Venkataramanan  * Returns true if there's any budget left (e.g. the clean is finished)
2022b245cb2SAnirudh Venkataramanan  */
2032fb0821fSJesse Brandeburg static bool ice_clean_tx_irq(struct ice_ring *tx_ring, int napi_budget)
2042b245cb2SAnirudh Venkataramanan {
2052b245cb2SAnirudh Venkataramanan 	unsigned int total_bytes = 0, total_pkts = 0;
2062fb0821fSJesse Brandeburg 	unsigned int budget = ICE_DFLT_IRQ_WORK;
2072fb0821fSJesse Brandeburg 	struct ice_vsi *vsi = tx_ring->vsi;
2082b245cb2SAnirudh Venkataramanan 	s16 i = tx_ring->next_to_clean;
2092b245cb2SAnirudh Venkataramanan 	struct ice_tx_desc *tx_desc;
2102b245cb2SAnirudh Venkataramanan 	struct ice_tx_buf *tx_buf;
2112b245cb2SAnirudh Venkataramanan 
2122b245cb2SAnirudh Venkataramanan 	tx_buf = &tx_ring->tx_buf[i];
2132b245cb2SAnirudh Venkataramanan 	tx_desc = ICE_TX_DESC(tx_ring, i);
2142b245cb2SAnirudh Venkataramanan 	i -= tx_ring->count;
2152b245cb2SAnirudh Venkataramanan 
2162fb0821fSJesse Brandeburg 	prefetch(&vsi->state);
2172fb0821fSJesse Brandeburg 
2182b245cb2SAnirudh Venkataramanan 	do {
2192b245cb2SAnirudh Venkataramanan 		struct ice_tx_desc *eop_desc = tx_buf->next_to_watch;
2202b245cb2SAnirudh Venkataramanan 
2212b245cb2SAnirudh Venkataramanan 		/* if next_to_watch is not set then there is no work pending */
2222b245cb2SAnirudh Venkataramanan 		if (!eop_desc)
2232b245cb2SAnirudh Venkataramanan 			break;
2242b245cb2SAnirudh Venkataramanan 
2252b245cb2SAnirudh Venkataramanan 		smp_rmb();	/* prevent any other reads prior to eop_desc */
2262b245cb2SAnirudh Venkataramanan 
2272b245cb2SAnirudh Venkataramanan 		/* if the descriptor isn't done, no work yet to do */
2282b245cb2SAnirudh Venkataramanan 		if (!(eop_desc->cmd_type_offset_bsz &
2292b245cb2SAnirudh Venkataramanan 		      cpu_to_le64(ICE_TX_DESC_DTYPE_DESC_DONE)))
2302b245cb2SAnirudh Venkataramanan 			break;
2312b245cb2SAnirudh Venkataramanan 
2322b245cb2SAnirudh Venkataramanan 		/* clear next_to_watch to prevent false hangs */
2332b245cb2SAnirudh Venkataramanan 		tx_buf->next_to_watch = NULL;
2342b245cb2SAnirudh Venkataramanan 
2352b245cb2SAnirudh Venkataramanan 		/* update the statistics for this packet */
2362b245cb2SAnirudh Venkataramanan 		total_bytes += tx_buf->bytecount;
2372b245cb2SAnirudh Venkataramanan 		total_pkts += tx_buf->gso_segs;
2382b245cb2SAnirudh Venkataramanan 
239efc2214bSMaciej Fijalkowski 		if (ice_ring_is_xdp(tx_ring))
240efc2214bSMaciej Fijalkowski 			page_frag_free(tx_buf->raw_buf);
241efc2214bSMaciej Fijalkowski 		else
2422b245cb2SAnirudh Venkataramanan 			/* free the skb */
2432b245cb2SAnirudh Venkataramanan 			napi_consume_skb(tx_buf->skb, napi_budget);
2442b245cb2SAnirudh Venkataramanan 
2452b245cb2SAnirudh Venkataramanan 		/* unmap skb header data */
2462b245cb2SAnirudh Venkataramanan 		dma_unmap_single(tx_ring->dev,
2472b245cb2SAnirudh Venkataramanan 				 dma_unmap_addr(tx_buf, dma),
2482b245cb2SAnirudh Venkataramanan 				 dma_unmap_len(tx_buf, len),
2492b245cb2SAnirudh Venkataramanan 				 DMA_TO_DEVICE);
2502b245cb2SAnirudh Venkataramanan 
2512b245cb2SAnirudh Venkataramanan 		/* clear tx_buf data */
2522b245cb2SAnirudh Venkataramanan 		tx_buf->skb = NULL;
2532b245cb2SAnirudh Venkataramanan 		dma_unmap_len_set(tx_buf, len, 0);
2542b245cb2SAnirudh Venkataramanan 
2552b245cb2SAnirudh Venkataramanan 		/* unmap remaining buffers */
2562b245cb2SAnirudh Venkataramanan 		while (tx_desc != eop_desc) {
2572b245cb2SAnirudh Venkataramanan 			tx_buf++;
2582b245cb2SAnirudh Venkataramanan 			tx_desc++;
2592b245cb2SAnirudh Venkataramanan 			i++;
2602b245cb2SAnirudh Venkataramanan 			if (unlikely(!i)) {
2612b245cb2SAnirudh Venkataramanan 				i -= tx_ring->count;
2622b245cb2SAnirudh Venkataramanan 				tx_buf = tx_ring->tx_buf;
2632b245cb2SAnirudh Venkataramanan 				tx_desc = ICE_TX_DESC(tx_ring, 0);
2642b245cb2SAnirudh Venkataramanan 			}
2652b245cb2SAnirudh Venkataramanan 
2662b245cb2SAnirudh Venkataramanan 			/* unmap any remaining paged data */
2672b245cb2SAnirudh Venkataramanan 			if (dma_unmap_len(tx_buf, len)) {
2682b245cb2SAnirudh Venkataramanan 				dma_unmap_page(tx_ring->dev,
2692b245cb2SAnirudh Venkataramanan 					       dma_unmap_addr(tx_buf, dma),
2702b245cb2SAnirudh Venkataramanan 					       dma_unmap_len(tx_buf, len),
2712b245cb2SAnirudh Venkataramanan 					       DMA_TO_DEVICE);
2722b245cb2SAnirudh Venkataramanan 				dma_unmap_len_set(tx_buf, len, 0);
2732b245cb2SAnirudh Venkataramanan 			}
2742b245cb2SAnirudh Venkataramanan 		}
2752b245cb2SAnirudh Venkataramanan 
2762b245cb2SAnirudh Venkataramanan 		/* move us one more past the eop_desc for start of next pkt */
2772b245cb2SAnirudh Venkataramanan 		tx_buf++;
2782b245cb2SAnirudh Venkataramanan 		tx_desc++;
2792b245cb2SAnirudh Venkataramanan 		i++;
2802b245cb2SAnirudh Venkataramanan 		if (unlikely(!i)) {
2812b245cb2SAnirudh Venkataramanan 			i -= tx_ring->count;
2822b245cb2SAnirudh Venkataramanan 			tx_buf = tx_ring->tx_buf;
2832b245cb2SAnirudh Venkataramanan 			tx_desc = ICE_TX_DESC(tx_ring, 0);
2842b245cb2SAnirudh Venkataramanan 		}
2852b245cb2SAnirudh Venkataramanan 
2862b245cb2SAnirudh Venkataramanan 		prefetch(tx_desc);
2872b245cb2SAnirudh Venkataramanan 
2882b245cb2SAnirudh Venkataramanan 		/* update budget accounting */
2892b245cb2SAnirudh Venkataramanan 		budget--;
2902b245cb2SAnirudh Venkataramanan 	} while (likely(budget));
2912b245cb2SAnirudh Venkataramanan 
2922b245cb2SAnirudh Venkataramanan 	i += tx_ring->count;
2932b245cb2SAnirudh Venkataramanan 	tx_ring->next_to_clean = i;
2942d4238f5SKrzysztof Kazimierczak 
2952d4238f5SKrzysztof Kazimierczak 	ice_update_tx_ring_stats(tx_ring, total_pkts, total_bytes);
2962b245cb2SAnirudh Venkataramanan 
297efc2214bSMaciej Fijalkowski 	if (ice_ring_is_xdp(tx_ring))
298efc2214bSMaciej Fijalkowski 		return !!budget;
299efc2214bSMaciej Fijalkowski 
3002b245cb2SAnirudh Venkataramanan 	netdev_tx_completed_queue(txring_txq(tx_ring), total_pkts,
3012b245cb2SAnirudh Venkataramanan 				  total_bytes);
3022b245cb2SAnirudh Venkataramanan 
3032b245cb2SAnirudh Venkataramanan #define TX_WAKE_THRESHOLD ((s16)(DESC_NEEDED * 2))
3042b245cb2SAnirudh Venkataramanan 	if (unlikely(total_pkts && netif_carrier_ok(tx_ring->netdev) &&
3052b245cb2SAnirudh Venkataramanan 		     (ICE_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD))) {
3062b245cb2SAnirudh Venkataramanan 		/* Make sure that anybody stopping the queue after this
3072b245cb2SAnirudh Venkataramanan 		 * sees the new next_to_clean.
3082b245cb2SAnirudh Venkataramanan 		 */
3092b245cb2SAnirudh Venkataramanan 		smp_mb();
3102b245cb2SAnirudh Venkataramanan 		if (__netif_subqueue_stopped(tx_ring->netdev,
3112b245cb2SAnirudh Venkataramanan 					     tx_ring->q_index) &&
312e97fb1aeSAnirudh Venkataramanan 		    !test_bit(ICE_VSI_DOWN, vsi->state)) {
3132b245cb2SAnirudh Venkataramanan 			netif_wake_subqueue(tx_ring->netdev,
3142b245cb2SAnirudh Venkataramanan 					    tx_ring->q_index);
3152b245cb2SAnirudh Venkataramanan 			++tx_ring->tx_stats.restart_q;
3162b245cb2SAnirudh Venkataramanan 		}
3172b245cb2SAnirudh Venkataramanan 	}
3182b245cb2SAnirudh Venkataramanan 
3192b245cb2SAnirudh Venkataramanan 	return !!budget;
3202b245cb2SAnirudh Venkataramanan }
3212b245cb2SAnirudh Venkataramanan 
3222b245cb2SAnirudh Venkataramanan /**
323cdedef59SAnirudh Venkataramanan  * ice_setup_tx_ring - Allocate the Tx descriptors
324d337f2afSAnirudh Venkataramanan  * @tx_ring: the Tx ring to set up
325cdedef59SAnirudh Venkataramanan  *
326cdedef59SAnirudh Venkataramanan  * Return 0 on success, negative on error
327cdedef59SAnirudh Venkataramanan  */
328cdedef59SAnirudh Venkataramanan int ice_setup_tx_ring(struct ice_ring *tx_ring)
329cdedef59SAnirudh Venkataramanan {
330cdedef59SAnirudh Venkataramanan 	struct device *dev = tx_ring->dev;
331cdedef59SAnirudh Venkataramanan 
332cdedef59SAnirudh Venkataramanan 	if (!dev)
333cdedef59SAnirudh Venkataramanan 		return -ENOMEM;
334cdedef59SAnirudh Venkataramanan 
335cdedef59SAnirudh Venkataramanan 	/* warn if we are about to overwrite the pointer */
336cdedef59SAnirudh Venkataramanan 	WARN_ON(tx_ring->tx_buf);
337c6dfd690SBruce Allan 	tx_ring->tx_buf =
338c6dfd690SBruce Allan 		devm_kzalloc(dev, sizeof(*tx_ring->tx_buf) * tx_ring->count,
339c6dfd690SBruce Allan 			     GFP_KERNEL);
340cdedef59SAnirudh Venkataramanan 	if (!tx_ring->tx_buf)
341cdedef59SAnirudh Venkataramanan 		return -ENOMEM;
342cdedef59SAnirudh Venkataramanan 
343ad71b256SBrett Creeley 	/* round up to nearest page */
344c6dfd690SBruce Allan 	tx_ring->size = ALIGN(tx_ring->count * sizeof(struct ice_tx_desc),
345ad71b256SBrett Creeley 			      PAGE_SIZE);
346cdedef59SAnirudh Venkataramanan 	tx_ring->desc = dmam_alloc_coherent(dev, tx_ring->size, &tx_ring->dma,
347cdedef59SAnirudh Venkataramanan 					    GFP_KERNEL);
348cdedef59SAnirudh Venkataramanan 	if (!tx_ring->desc) {
349cdedef59SAnirudh Venkataramanan 		dev_err(dev, "Unable to allocate memory for the Tx descriptor ring, size=%d\n",
350cdedef59SAnirudh Venkataramanan 			tx_ring->size);
351cdedef59SAnirudh Venkataramanan 		goto err;
352cdedef59SAnirudh Venkataramanan 	}
353cdedef59SAnirudh Venkataramanan 
354cdedef59SAnirudh Venkataramanan 	tx_ring->next_to_use = 0;
355cdedef59SAnirudh Venkataramanan 	tx_ring->next_to_clean = 0;
356b3969fd7SSudheer Mogilappagari 	tx_ring->tx_stats.prev_pkt = -1;
357cdedef59SAnirudh Venkataramanan 	return 0;
358cdedef59SAnirudh Venkataramanan 
359cdedef59SAnirudh Venkataramanan err:
360cdedef59SAnirudh Venkataramanan 	devm_kfree(dev, tx_ring->tx_buf);
361cdedef59SAnirudh Venkataramanan 	tx_ring->tx_buf = NULL;
362cdedef59SAnirudh Venkataramanan 	return -ENOMEM;
363cdedef59SAnirudh Venkataramanan }
364cdedef59SAnirudh Venkataramanan 
365cdedef59SAnirudh Venkataramanan /**
366cdedef59SAnirudh Venkataramanan  * ice_clean_rx_ring - Free Rx buffers
367cdedef59SAnirudh Venkataramanan  * @rx_ring: ring to be cleaned
368cdedef59SAnirudh Venkataramanan  */
369cdedef59SAnirudh Venkataramanan void ice_clean_rx_ring(struct ice_ring *rx_ring)
370cdedef59SAnirudh Venkataramanan {
371cdedef59SAnirudh Venkataramanan 	struct device *dev = rx_ring->dev;
372cdedef59SAnirudh Venkataramanan 	u16 i;
373cdedef59SAnirudh Venkataramanan 
374cdedef59SAnirudh Venkataramanan 	/* ring already cleared, nothing to do */
375cdedef59SAnirudh Venkataramanan 	if (!rx_ring->rx_buf)
376cdedef59SAnirudh Venkataramanan 		return;
377cdedef59SAnirudh Venkataramanan 
37829b82f2aSMaciej Fijalkowski 	if (rx_ring->skb) {
37929b82f2aSMaciej Fijalkowski 		dev_kfree_skb(rx_ring->skb);
38029b82f2aSMaciej Fijalkowski 		rx_ring->skb = NULL;
38129b82f2aSMaciej Fijalkowski 	}
38229b82f2aSMaciej Fijalkowski 
3831742b3d5SMagnus Karlsson 	if (rx_ring->xsk_pool) {
3842d4238f5SKrzysztof Kazimierczak 		ice_xsk_clean_rx_ring(rx_ring);
3852d4238f5SKrzysztof Kazimierczak 		goto rx_skip_free;
3862d4238f5SKrzysztof Kazimierczak 	}
3872d4238f5SKrzysztof Kazimierczak 
388cdedef59SAnirudh Venkataramanan 	/* Free all the Rx ring sk_buffs */
389cdedef59SAnirudh Venkataramanan 	for (i = 0; i < rx_ring->count; i++) {
390cdedef59SAnirudh Venkataramanan 		struct ice_rx_buf *rx_buf = &rx_ring->rx_buf[i];
391cdedef59SAnirudh Venkataramanan 
392cdedef59SAnirudh Venkataramanan 		if (!rx_buf->page)
393cdedef59SAnirudh Venkataramanan 			continue;
394cdedef59SAnirudh Venkataramanan 
395a65f71feSMaciej Fijalkowski 		/* Invalidate cache lines that may have been written to by
396a65f71feSMaciej Fijalkowski 		 * device so that we avoid corrupting memory.
397a65f71feSMaciej Fijalkowski 		 */
398a65f71feSMaciej Fijalkowski 		dma_sync_single_range_for_cpu(dev, rx_buf->dma,
399a65f71feSMaciej Fijalkowski 					      rx_buf->page_offset,
4007237f5b0SMaciej Fijalkowski 					      rx_ring->rx_buf_len,
4017237f5b0SMaciej Fijalkowski 					      DMA_FROM_DEVICE);
402a65f71feSMaciej Fijalkowski 
403a65f71feSMaciej Fijalkowski 		/* free resources associated with mapping */
4047237f5b0SMaciej Fijalkowski 		dma_unmap_page_attrs(dev, rx_buf->dma, ice_rx_pg_size(rx_ring),
405a65f71feSMaciej Fijalkowski 				     DMA_FROM_DEVICE, ICE_RX_DMA_ATTR);
40603c66a13SMaciej Fijalkowski 		__page_frag_cache_drain(rx_buf->page, rx_buf->pagecnt_bias);
407cdedef59SAnirudh Venkataramanan 
408cdedef59SAnirudh Venkataramanan 		rx_buf->page = NULL;
409cdedef59SAnirudh Venkataramanan 		rx_buf->page_offset = 0;
410cdedef59SAnirudh Venkataramanan 	}
411cdedef59SAnirudh Venkataramanan 
4122d4238f5SKrzysztof Kazimierczak rx_skip_free:
413c6dfd690SBruce Allan 	memset(rx_ring->rx_buf, 0, sizeof(*rx_ring->rx_buf) * rx_ring->count);
414cdedef59SAnirudh Venkataramanan 
415cdedef59SAnirudh Venkataramanan 	/* Zero out the descriptor ring */
416cdedef59SAnirudh Venkataramanan 	memset(rx_ring->desc, 0, rx_ring->size);
417cdedef59SAnirudh Venkataramanan 
418cdedef59SAnirudh Venkataramanan 	rx_ring->next_to_alloc = 0;
419cdedef59SAnirudh Venkataramanan 	rx_ring->next_to_clean = 0;
420cdedef59SAnirudh Venkataramanan 	rx_ring->next_to_use = 0;
421cdedef59SAnirudh Venkataramanan }
422cdedef59SAnirudh Venkataramanan 
423cdedef59SAnirudh Venkataramanan /**
424cdedef59SAnirudh Venkataramanan  * ice_free_rx_ring - Free Rx resources
425cdedef59SAnirudh Venkataramanan  * @rx_ring: ring to clean the resources from
426cdedef59SAnirudh Venkataramanan  *
427cdedef59SAnirudh Venkataramanan  * Free all receive software resources
428cdedef59SAnirudh Venkataramanan  */
429cdedef59SAnirudh Venkataramanan void ice_free_rx_ring(struct ice_ring *rx_ring)
430cdedef59SAnirudh Venkataramanan {
431cdedef59SAnirudh Venkataramanan 	ice_clean_rx_ring(rx_ring);
432efc2214bSMaciej Fijalkowski 	if (rx_ring->vsi->type == ICE_VSI_PF)
433efc2214bSMaciej Fijalkowski 		if (xdp_rxq_info_is_reg(&rx_ring->xdp_rxq))
434efc2214bSMaciej Fijalkowski 			xdp_rxq_info_unreg(&rx_ring->xdp_rxq);
435efc2214bSMaciej Fijalkowski 	rx_ring->xdp_prog = NULL;
436cdedef59SAnirudh Venkataramanan 	devm_kfree(rx_ring->dev, rx_ring->rx_buf);
437cdedef59SAnirudh Venkataramanan 	rx_ring->rx_buf = NULL;
438cdedef59SAnirudh Venkataramanan 
439cdedef59SAnirudh Venkataramanan 	if (rx_ring->desc) {
440cdedef59SAnirudh Venkataramanan 		dmam_free_coherent(rx_ring->dev, rx_ring->size,
441cdedef59SAnirudh Venkataramanan 				   rx_ring->desc, rx_ring->dma);
442cdedef59SAnirudh Venkataramanan 		rx_ring->desc = NULL;
443cdedef59SAnirudh Venkataramanan 	}
444cdedef59SAnirudh Venkataramanan }
445cdedef59SAnirudh Venkataramanan 
446cdedef59SAnirudh Venkataramanan /**
447cdedef59SAnirudh Venkataramanan  * ice_setup_rx_ring - Allocate the Rx descriptors
448d337f2afSAnirudh Venkataramanan  * @rx_ring: the Rx ring to set up
449cdedef59SAnirudh Venkataramanan  *
450cdedef59SAnirudh Venkataramanan  * Return 0 on success, negative on error
451cdedef59SAnirudh Venkataramanan  */
452cdedef59SAnirudh Venkataramanan int ice_setup_rx_ring(struct ice_ring *rx_ring)
453cdedef59SAnirudh Venkataramanan {
454cdedef59SAnirudh Venkataramanan 	struct device *dev = rx_ring->dev;
455cdedef59SAnirudh Venkataramanan 
456cdedef59SAnirudh Venkataramanan 	if (!dev)
457cdedef59SAnirudh Venkataramanan 		return -ENOMEM;
458cdedef59SAnirudh Venkataramanan 
459cdedef59SAnirudh Venkataramanan 	/* warn if we are about to overwrite the pointer */
460cdedef59SAnirudh Venkataramanan 	WARN_ON(rx_ring->rx_buf);
461c6dfd690SBruce Allan 	rx_ring->rx_buf =
462c6dfd690SBruce Allan 		devm_kzalloc(dev, sizeof(*rx_ring->rx_buf) * rx_ring->count,
463c6dfd690SBruce Allan 			     GFP_KERNEL);
464cdedef59SAnirudh Venkataramanan 	if (!rx_ring->rx_buf)
465cdedef59SAnirudh Venkataramanan 		return -ENOMEM;
466cdedef59SAnirudh Venkataramanan 
467ad71b256SBrett Creeley 	/* round up to nearest page */
468ad71b256SBrett Creeley 	rx_ring->size = ALIGN(rx_ring->count * sizeof(union ice_32byte_rx_desc),
469ad71b256SBrett Creeley 			      PAGE_SIZE);
470cdedef59SAnirudh Venkataramanan 	rx_ring->desc = dmam_alloc_coherent(dev, rx_ring->size, &rx_ring->dma,
471cdedef59SAnirudh Venkataramanan 					    GFP_KERNEL);
472cdedef59SAnirudh Venkataramanan 	if (!rx_ring->desc) {
473cdedef59SAnirudh Venkataramanan 		dev_err(dev, "Unable to allocate memory for the Rx descriptor ring, size=%d\n",
474cdedef59SAnirudh Venkataramanan 			rx_ring->size);
475cdedef59SAnirudh Venkataramanan 		goto err;
476cdedef59SAnirudh Venkataramanan 	}
477cdedef59SAnirudh Venkataramanan 
478cdedef59SAnirudh Venkataramanan 	rx_ring->next_to_use = 0;
479cdedef59SAnirudh Venkataramanan 	rx_ring->next_to_clean = 0;
480efc2214bSMaciej Fijalkowski 
481efc2214bSMaciej Fijalkowski 	if (ice_is_xdp_ena_vsi(rx_ring->vsi))
482efc2214bSMaciej Fijalkowski 		WRITE_ONCE(rx_ring->xdp_prog, rx_ring->vsi->xdp_prog);
483efc2214bSMaciej Fijalkowski 
484efc2214bSMaciej Fijalkowski 	if (rx_ring->vsi->type == ICE_VSI_PF &&
485efc2214bSMaciej Fijalkowski 	    !xdp_rxq_info_is_reg(&rx_ring->xdp_rxq))
486efc2214bSMaciej Fijalkowski 		if (xdp_rxq_info_reg(&rx_ring->xdp_rxq, rx_ring->netdev,
487b02e5a0eSBjörn Töpel 				     rx_ring->q_index, rx_ring->q_vector->napi.napi_id))
488efc2214bSMaciej Fijalkowski 			goto err;
489cdedef59SAnirudh Venkataramanan 	return 0;
490cdedef59SAnirudh Venkataramanan 
491cdedef59SAnirudh Venkataramanan err:
492cdedef59SAnirudh Venkataramanan 	devm_kfree(dev, rx_ring->rx_buf);
493cdedef59SAnirudh Venkataramanan 	rx_ring->rx_buf = NULL;
494cdedef59SAnirudh Venkataramanan 	return -ENOMEM;
495cdedef59SAnirudh Venkataramanan }
496cdedef59SAnirudh Venkataramanan 
4976221595fSTony Nguyen static unsigned int
4986221595fSTony Nguyen ice_rx_frame_truesize(struct ice_ring *rx_ring, unsigned int __maybe_unused size)
499d4ecdbf7SJesper Dangaard Brouer {
500d4ecdbf7SJesper Dangaard Brouer 	unsigned int truesize;
501d4ecdbf7SJesper Dangaard Brouer 
502d4ecdbf7SJesper Dangaard Brouer #if (PAGE_SIZE < 8192)
503d4ecdbf7SJesper Dangaard Brouer 	truesize = ice_rx_pg_size(rx_ring) / 2; /* Must be power-of-2 */
504d4ecdbf7SJesper Dangaard Brouer #else
505f1b1f409SMaciej Fijalkowski 	truesize = rx_ring->rx_offset ?
506f1b1f409SMaciej Fijalkowski 		SKB_DATA_ALIGN(rx_ring->rx_offset + size) +
507d4ecdbf7SJesper Dangaard Brouer 		SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) :
508d4ecdbf7SJesper Dangaard Brouer 		SKB_DATA_ALIGN(size);
509d4ecdbf7SJesper Dangaard Brouer #endif
510d4ecdbf7SJesper Dangaard Brouer 	return truesize;
511d4ecdbf7SJesper Dangaard Brouer }
512d4ecdbf7SJesper Dangaard Brouer 
513efc2214bSMaciej Fijalkowski /**
514efc2214bSMaciej Fijalkowski  * ice_run_xdp - Executes an XDP program on initialized xdp_buff
515efc2214bSMaciej Fijalkowski  * @rx_ring: Rx ring
516efc2214bSMaciej Fijalkowski  * @xdp: xdp_buff used as input to the XDP program
517efc2214bSMaciej Fijalkowski  * @xdp_prog: XDP program to run
518efc2214bSMaciej Fijalkowski  *
519efc2214bSMaciej Fijalkowski  * Returns any of ICE_XDP_{PASS, CONSUMED, TX, REDIR}
520efc2214bSMaciej Fijalkowski  */
521efc2214bSMaciej Fijalkowski static int
522efc2214bSMaciej Fijalkowski ice_run_xdp(struct ice_ring *rx_ring, struct xdp_buff *xdp,
523efc2214bSMaciej Fijalkowski 	    struct bpf_prog *xdp_prog)
524efc2214bSMaciej Fijalkowski {
525efc2214bSMaciej Fijalkowski 	struct ice_ring *xdp_ring;
52659c97d1bSMaciej Fijalkowski 	int err;
527efc2214bSMaciej Fijalkowski 	u32 act;
528efc2214bSMaciej Fijalkowski 
529efc2214bSMaciej Fijalkowski 	act = bpf_prog_run_xdp(xdp_prog, xdp);
530efc2214bSMaciej Fijalkowski 	switch (act) {
531efc2214bSMaciej Fijalkowski 	case XDP_PASS:
53259c97d1bSMaciej Fijalkowski 		return ICE_XDP_PASS;
533efc2214bSMaciej Fijalkowski 	case XDP_TX:
534efc2214bSMaciej Fijalkowski 		xdp_ring = rx_ring->vsi->xdp_rings[smp_processor_id()];
53559c97d1bSMaciej Fijalkowski 		return ice_xmit_xdp_buff(xdp, xdp_ring);
536efc2214bSMaciej Fijalkowski 	case XDP_REDIRECT:
537efc2214bSMaciej Fijalkowski 		err = xdp_do_redirect(rx_ring->netdev, xdp, xdp_prog);
53859c97d1bSMaciej Fijalkowski 		return !err ? ICE_XDP_REDIR : ICE_XDP_CONSUMED;
539efc2214bSMaciej Fijalkowski 	default:
540efc2214bSMaciej Fijalkowski 		bpf_warn_invalid_xdp_action(act);
5414e83fc93SBruce Allan 		fallthrough;
542efc2214bSMaciej Fijalkowski 	case XDP_ABORTED:
543efc2214bSMaciej Fijalkowski 		trace_xdp_exception(rx_ring->netdev, xdp_prog, act);
5444e83fc93SBruce Allan 		fallthrough;
545efc2214bSMaciej Fijalkowski 	case XDP_DROP:
54659c97d1bSMaciej Fijalkowski 		return ICE_XDP_CONSUMED;
547efc2214bSMaciej Fijalkowski 	}
548efc2214bSMaciej Fijalkowski }
549efc2214bSMaciej Fijalkowski 
550efc2214bSMaciej Fijalkowski /**
551efc2214bSMaciej Fijalkowski  * ice_xdp_xmit - submit packets to XDP ring for transmission
552efc2214bSMaciej Fijalkowski  * @dev: netdev
553efc2214bSMaciej Fijalkowski  * @n: number of XDP frames to be transmitted
554efc2214bSMaciej Fijalkowski  * @frames: XDP frames to be transmitted
555efc2214bSMaciej Fijalkowski  * @flags: transmit flags
556efc2214bSMaciej Fijalkowski  *
557fdc13979SLorenzo Bianconi  * Returns number of frames successfully sent. Failed frames
558fdc13979SLorenzo Bianconi  * will be free'ed by XDP core.
559efc2214bSMaciej Fijalkowski  * For error cases, a negative errno code is returned and no-frames
560efc2214bSMaciej Fijalkowski  * are transmitted (caller must handle freeing frames).
561efc2214bSMaciej Fijalkowski  */
562efc2214bSMaciej Fijalkowski int
563efc2214bSMaciej Fijalkowski ice_xdp_xmit(struct net_device *dev, int n, struct xdp_frame **frames,
564efc2214bSMaciej Fijalkowski 	     u32 flags)
565efc2214bSMaciej Fijalkowski {
566efc2214bSMaciej Fijalkowski 	struct ice_netdev_priv *np = netdev_priv(dev);
567efc2214bSMaciej Fijalkowski 	unsigned int queue_index = smp_processor_id();
568efc2214bSMaciej Fijalkowski 	struct ice_vsi *vsi = np->vsi;
569efc2214bSMaciej Fijalkowski 	struct ice_ring *xdp_ring;
570fdc13979SLorenzo Bianconi 	int nxmit = 0, i;
571efc2214bSMaciej Fijalkowski 
572e97fb1aeSAnirudh Venkataramanan 	if (test_bit(ICE_VSI_DOWN, vsi->state))
573efc2214bSMaciej Fijalkowski 		return -ENETDOWN;
574efc2214bSMaciej Fijalkowski 
575efc2214bSMaciej Fijalkowski 	if (!ice_is_xdp_ena_vsi(vsi) || queue_index >= vsi->num_xdp_txq)
576efc2214bSMaciej Fijalkowski 		return -ENXIO;
577efc2214bSMaciej Fijalkowski 
578efc2214bSMaciej Fijalkowski 	if (unlikely(flags & ~XDP_XMIT_FLAGS_MASK))
579efc2214bSMaciej Fijalkowski 		return -EINVAL;
580efc2214bSMaciej Fijalkowski 
581efc2214bSMaciej Fijalkowski 	xdp_ring = vsi->xdp_rings[queue_index];
582efc2214bSMaciej Fijalkowski 	for (i = 0; i < n; i++) {
583efc2214bSMaciej Fijalkowski 		struct xdp_frame *xdpf = frames[i];
584efc2214bSMaciej Fijalkowski 		int err;
585efc2214bSMaciej Fijalkowski 
586efc2214bSMaciej Fijalkowski 		err = ice_xmit_xdp_ring(xdpf->data, xdpf->len, xdp_ring);
587fdc13979SLorenzo Bianconi 		if (err != ICE_XDP_TX)
588fdc13979SLorenzo Bianconi 			break;
589fdc13979SLorenzo Bianconi 		nxmit++;
590efc2214bSMaciej Fijalkowski 	}
591efc2214bSMaciej Fijalkowski 
592efc2214bSMaciej Fijalkowski 	if (unlikely(flags & XDP_XMIT_FLUSH))
593efc2214bSMaciej Fijalkowski 		ice_xdp_ring_update_tail(xdp_ring);
594efc2214bSMaciej Fijalkowski 
595fdc13979SLorenzo Bianconi 	return nxmit;
596efc2214bSMaciej Fijalkowski }
597efc2214bSMaciej Fijalkowski 
598efc2214bSMaciej Fijalkowski /**
599cdedef59SAnirudh Venkataramanan  * ice_alloc_mapped_page - recycle or make a new page
600cdedef59SAnirudh Venkataramanan  * @rx_ring: ring to use
601cdedef59SAnirudh Venkataramanan  * @bi: rx_buf struct to modify
602cdedef59SAnirudh Venkataramanan  *
603cdedef59SAnirudh Venkataramanan  * Returns true if the page was successfully allocated or
604cdedef59SAnirudh Venkataramanan  * reused.
605cdedef59SAnirudh Venkataramanan  */
606c8b7abddSBruce Allan static bool
607c8b7abddSBruce Allan ice_alloc_mapped_page(struct ice_ring *rx_ring, struct ice_rx_buf *bi)
608cdedef59SAnirudh Venkataramanan {
609cdedef59SAnirudh Venkataramanan 	struct page *page = bi->page;
610cdedef59SAnirudh Venkataramanan 	dma_addr_t dma;
611cdedef59SAnirudh Venkataramanan 
612cdedef59SAnirudh Venkataramanan 	/* since we are recycling buffers we should seldom need to alloc */
6137dbc63f0STony Nguyen 	if (likely(page))
614cdedef59SAnirudh Venkataramanan 		return true;
615cdedef59SAnirudh Venkataramanan 
616cdedef59SAnirudh Venkataramanan 	/* alloc new page for storage */
6177237f5b0SMaciej Fijalkowski 	page = dev_alloc_pages(ice_rx_pg_order(rx_ring));
6182b245cb2SAnirudh Venkataramanan 	if (unlikely(!page)) {
6192b245cb2SAnirudh Venkataramanan 		rx_ring->rx_stats.alloc_page_failed++;
620cdedef59SAnirudh Venkataramanan 		return false;
6212b245cb2SAnirudh Venkataramanan 	}
622cdedef59SAnirudh Venkataramanan 
623cdedef59SAnirudh Venkataramanan 	/* map page for use */
6247237f5b0SMaciej Fijalkowski 	dma = dma_map_page_attrs(rx_ring->dev, page, 0, ice_rx_pg_size(rx_ring),
625a65f71feSMaciej Fijalkowski 				 DMA_FROM_DEVICE, ICE_RX_DMA_ATTR);
626cdedef59SAnirudh Venkataramanan 
627cdedef59SAnirudh Venkataramanan 	/* if mapping failed free memory back to system since
628cdedef59SAnirudh Venkataramanan 	 * there isn't much point in holding memory we can't use
629cdedef59SAnirudh Venkataramanan 	 */
630cdedef59SAnirudh Venkataramanan 	if (dma_mapping_error(rx_ring->dev, dma)) {
6317237f5b0SMaciej Fijalkowski 		__free_pages(page, ice_rx_pg_order(rx_ring));
6322b245cb2SAnirudh Venkataramanan 		rx_ring->rx_stats.alloc_page_failed++;
633cdedef59SAnirudh Venkataramanan 		return false;
634cdedef59SAnirudh Venkataramanan 	}
635cdedef59SAnirudh Venkataramanan 
636cdedef59SAnirudh Venkataramanan 	bi->dma = dma;
637cdedef59SAnirudh Venkataramanan 	bi->page = page;
638f1b1f409SMaciej Fijalkowski 	bi->page_offset = rx_ring->rx_offset;
63903c66a13SMaciej Fijalkowski 	page_ref_add(page, USHRT_MAX - 1);
64003c66a13SMaciej Fijalkowski 	bi->pagecnt_bias = USHRT_MAX;
641cdedef59SAnirudh Venkataramanan 
642cdedef59SAnirudh Venkataramanan 	return true;
643cdedef59SAnirudh Venkataramanan }
644cdedef59SAnirudh Venkataramanan 
645cdedef59SAnirudh Venkataramanan /**
646cdedef59SAnirudh Venkataramanan  * ice_alloc_rx_bufs - Replace used receive buffers
647cdedef59SAnirudh Venkataramanan  * @rx_ring: ring to place buffers on
648cdedef59SAnirudh Venkataramanan  * @cleaned_count: number of buffers to replace
649cdedef59SAnirudh Venkataramanan  *
650cb7db356SBrett Creeley  * Returns false if all allocations were successful, true if any fail. Returning
651cb7db356SBrett Creeley  * true signals to the caller that we didn't replace cleaned_count buffers and
652cb7db356SBrett Creeley  * there is more work to do.
653cb7db356SBrett Creeley  *
654cb7db356SBrett Creeley  * First, try to clean "cleaned_count" Rx buffers. Then refill the cleaned Rx
655cb7db356SBrett Creeley  * buffers. Then bump tail at most one time. Grouping like this lets us avoid
656cb7db356SBrett Creeley  * multiple tail writes per call.
657cdedef59SAnirudh Venkataramanan  */
658cdedef59SAnirudh Venkataramanan bool ice_alloc_rx_bufs(struct ice_ring *rx_ring, u16 cleaned_count)
659cdedef59SAnirudh Venkataramanan {
660cdedef59SAnirudh Venkataramanan 	union ice_32b_rx_flex_desc *rx_desc;
661cdedef59SAnirudh Venkataramanan 	u16 ntu = rx_ring->next_to_use;
662cdedef59SAnirudh Venkataramanan 	struct ice_rx_buf *bi;
663cdedef59SAnirudh Venkataramanan 
664cdedef59SAnirudh Venkataramanan 	/* do nothing if no valid netdev defined */
665148beb61SHenry Tieman 	if ((!rx_ring->netdev && rx_ring->vsi->type != ICE_VSI_CTRL) ||
666148beb61SHenry Tieman 	    !cleaned_count)
667cdedef59SAnirudh Venkataramanan 		return false;
668cdedef59SAnirudh Venkataramanan 
669f9867df6SAnirudh Venkataramanan 	/* get the Rx descriptor and buffer based on next_to_use */
670cdedef59SAnirudh Venkataramanan 	rx_desc = ICE_RX_DESC(rx_ring, ntu);
671cdedef59SAnirudh Venkataramanan 	bi = &rx_ring->rx_buf[ntu];
672cdedef59SAnirudh Venkataramanan 
673cdedef59SAnirudh Venkataramanan 	do {
674a1e99685SBrett Creeley 		/* if we fail here, we have work remaining */
675cdedef59SAnirudh Venkataramanan 		if (!ice_alloc_mapped_page(rx_ring, bi))
676a1e99685SBrett Creeley 			break;
677cdedef59SAnirudh Venkataramanan 
678a65f71feSMaciej Fijalkowski 		/* sync the buffer for use by the device */
679a65f71feSMaciej Fijalkowski 		dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
680a65f71feSMaciej Fijalkowski 						 bi->page_offset,
6817237f5b0SMaciej Fijalkowski 						 rx_ring->rx_buf_len,
682a65f71feSMaciej Fijalkowski 						 DMA_FROM_DEVICE);
683a65f71feSMaciej Fijalkowski 
684cdedef59SAnirudh Venkataramanan 		/* Refresh the desc even if buffer_addrs didn't change
685cdedef59SAnirudh Venkataramanan 		 * because each write-back erases this info.
686cdedef59SAnirudh Venkataramanan 		 */
687cdedef59SAnirudh Venkataramanan 		rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
688cdedef59SAnirudh Venkataramanan 
689cdedef59SAnirudh Venkataramanan 		rx_desc++;
690cdedef59SAnirudh Venkataramanan 		bi++;
691cdedef59SAnirudh Venkataramanan 		ntu++;
692cdedef59SAnirudh Venkataramanan 		if (unlikely(ntu == rx_ring->count)) {
693cdedef59SAnirudh Venkataramanan 			rx_desc = ICE_RX_DESC(rx_ring, 0);
694cdedef59SAnirudh Venkataramanan 			bi = rx_ring->rx_buf;
695cdedef59SAnirudh Venkataramanan 			ntu = 0;
696cdedef59SAnirudh Venkataramanan 		}
697cdedef59SAnirudh Venkataramanan 
698cdedef59SAnirudh Venkataramanan 		/* clear the status bits for the next_to_use descriptor */
699cdedef59SAnirudh Venkataramanan 		rx_desc->wb.status_error0 = 0;
700cdedef59SAnirudh Venkataramanan 
701cdedef59SAnirudh Venkataramanan 		cleaned_count--;
702cdedef59SAnirudh Venkataramanan 	} while (cleaned_count);
703cdedef59SAnirudh Venkataramanan 
704cdedef59SAnirudh Venkataramanan 	if (rx_ring->next_to_use != ntu)
705cdedef59SAnirudh Venkataramanan 		ice_release_rx_desc(rx_ring, ntu);
706cdedef59SAnirudh Venkataramanan 
707a1e99685SBrett Creeley 	return !!cleaned_count;
708cdedef59SAnirudh Venkataramanan }
7092b245cb2SAnirudh Venkataramanan 
7102b245cb2SAnirudh Venkataramanan /**
7111d032bc7SMaciej Fijalkowski  * ice_rx_buf_adjust_pg_offset - Prepare Rx buffer for reuse
7121d032bc7SMaciej Fijalkowski  * @rx_buf: Rx buffer to adjust
7131d032bc7SMaciej Fijalkowski  * @size: Size of adjustment
7142b245cb2SAnirudh Venkataramanan  *
7151d032bc7SMaciej Fijalkowski  * Update the offset within page so that Rx buf will be ready to be reused.
7161d032bc7SMaciej Fijalkowski  * For systems with PAGE_SIZE < 8192 this function will flip the page offset
7171d032bc7SMaciej Fijalkowski  * so the second half of page assigned to Rx buffer will be used, otherwise
7184ee656bbSTony Nguyen  * the offset is moved by "size" bytes
7192b245cb2SAnirudh Venkataramanan  */
7201d032bc7SMaciej Fijalkowski static void
7211d032bc7SMaciej Fijalkowski ice_rx_buf_adjust_pg_offset(struct ice_rx_buf *rx_buf, unsigned int size)
7222b245cb2SAnirudh Venkataramanan {
7232b245cb2SAnirudh Venkataramanan #if (PAGE_SIZE < 8192)
7241d032bc7SMaciej Fijalkowski 	/* flip page offset to other buffer */
7251d032bc7SMaciej Fijalkowski 	rx_buf->page_offset ^= size;
7262b245cb2SAnirudh Venkataramanan #else
7271d032bc7SMaciej Fijalkowski 	/* move offset up to the next cache line */
7281d032bc7SMaciej Fijalkowski 	rx_buf->page_offset += size;
7291d032bc7SMaciej Fijalkowski #endif
7302b245cb2SAnirudh Venkataramanan }
7312b245cb2SAnirudh Venkataramanan 
7321d032bc7SMaciej Fijalkowski /**
733bbb97808SMaciej Fijalkowski  * ice_can_reuse_rx_page - Determine if page can be reused for another Rx
734bbb97808SMaciej Fijalkowski  * @rx_buf: buffer containing the page
7351beb7830SBjörn Töpel  * @rx_buf_pgcnt: rx_buf page refcount pre xdp_do_redirect() call
736bbb97808SMaciej Fijalkowski  *
737bbb97808SMaciej Fijalkowski  * If page is reusable, we have a green light for calling ice_reuse_rx_page,
738bbb97808SMaciej Fijalkowski  * which will assign the current buffer to the buffer that next_to_alloc is
739bbb97808SMaciej Fijalkowski  * pointing to; otherwise, the DMA mapping needs to be destroyed and
740bbb97808SMaciej Fijalkowski  * page freed
741bbb97808SMaciej Fijalkowski  */
7421beb7830SBjörn Töpel static bool
7431beb7830SBjörn Töpel ice_can_reuse_rx_page(struct ice_rx_buf *rx_buf, int rx_buf_pgcnt)
744bbb97808SMaciej Fijalkowski {
74503c66a13SMaciej Fijalkowski 	unsigned int pagecnt_bias = rx_buf->pagecnt_bias;
746bbb97808SMaciej Fijalkowski 	struct page *page = rx_buf->page;
7472b245cb2SAnirudh Venkataramanan 
748a79afa78SAlexander Lobakin 	/* avoid re-using remote and pfmemalloc pages */
749a79afa78SAlexander Lobakin 	if (!dev_page_is_reusable(page))
7502b245cb2SAnirudh Venkataramanan 		return false;
7512b245cb2SAnirudh Venkataramanan 
7522b245cb2SAnirudh Venkataramanan #if (PAGE_SIZE < 8192)
7532b245cb2SAnirudh Venkataramanan 	/* if we are only owner of page we can reuse it */
7541beb7830SBjörn Töpel 	if (unlikely((rx_buf_pgcnt - pagecnt_bias) > 1))
7552b245cb2SAnirudh Venkataramanan 		return false;
7562b245cb2SAnirudh Venkataramanan #else
7577237f5b0SMaciej Fijalkowski #define ICE_LAST_OFFSET \
7587237f5b0SMaciej Fijalkowski 	(SKB_WITH_OVERHEAD(PAGE_SIZE) - ICE_RXBUF_2048)
7597237f5b0SMaciej Fijalkowski 	if (rx_buf->page_offset > ICE_LAST_OFFSET)
7602b245cb2SAnirudh Venkataramanan 		return false;
7612b245cb2SAnirudh Venkataramanan #endif /* PAGE_SIZE < 8192) */
7622b245cb2SAnirudh Venkataramanan 
76303c66a13SMaciej Fijalkowski 	/* If we have drained the page fragment pool we need to update
76403c66a13SMaciej Fijalkowski 	 * the pagecnt_bias and page count so that we fully restock the
76503c66a13SMaciej Fijalkowski 	 * number of references the driver holds.
7662b245cb2SAnirudh Venkataramanan 	 */
76703c66a13SMaciej Fijalkowski 	if (unlikely(pagecnt_bias == 1)) {
76803c66a13SMaciej Fijalkowski 		page_ref_add(page, USHRT_MAX - 1);
76903c66a13SMaciej Fijalkowski 		rx_buf->pagecnt_bias = USHRT_MAX;
77003c66a13SMaciej Fijalkowski 	}
7712b245cb2SAnirudh Venkataramanan 
7722b245cb2SAnirudh Venkataramanan 	return true;
7732b245cb2SAnirudh Venkataramanan }
7742b245cb2SAnirudh Venkataramanan 
7752b245cb2SAnirudh Venkataramanan /**
776712edbbbSMaciej Fijalkowski  * ice_add_rx_frag - Add contents of Rx buffer to sk_buff as a frag
7777237f5b0SMaciej Fijalkowski  * @rx_ring: Rx descriptor ring to transact packets on
7782b245cb2SAnirudh Venkataramanan  * @rx_buf: buffer containing page to add
779712edbbbSMaciej Fijalkowski  * @skb: sk_buff to place the data into
780712edbbbSMaciej Fijalkowski  * @size: packet length from rx_desc
7812b245cb2SAnirudh Venkataramanan  *
7822b245cb2SAnirudh Venkataramanan  * This function will add the data contained in rx_buf->page to the skb.
783712edbbbSMaciej Fijalkowski  * It will just attach the page as a frag to the skb.
784712edbbbSMaciej Fijalkowski  * The function will then update the page offset.
7852b245cb2SAnirudh Venkataramanan  */
7861d032bc7SMaciej Fijalkowski static void
7877237f5b0SMaciej Fijalkowski ice_add_rx_frag(struct ice_ring *rx_ring, struct ice_rx_buf *rx_buf,
7887237f5b0SMaciej Fijalkowski 		struct sk_buff *skb, unsigned int size)
7892b245cb2SAnirudh Venkataramanan {
790712edbbbSMaciej Fijalkowski #if (PAGE_SIZE >= 8192)
791f1b1f409SMaciej Fijalkowski 	unsigned int truesize = SKB_DATA_ALIGN(size + rx_ring->rx_offset);
7922b245cb2SAnirudh Venkataramanan #else
7937237f5b0SMaciej Fijalkowski 	unsigned int truesize = ice_rx_pg_size(rx_ring) / 2;
794712edbbbSMaciej Fijalkowski #endif
7951857ca42SMaciej Fijalkowski 
796ac6f733aSMitch Williams 	if (!size)
797ac6f733aSMitch Williams 		return;
798712edbbbSMaciej Fijalkowski 	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buf->page,
799712edbbbSMaciej Fijalkowski 			rx_buf->page_offset, size, truesize);
8002b245cb2SAnirudh Venkataramanan 
801712edbbbSMaciej Fijalkowski 	/* page is being used so we must update the page offset */
8021d032bc7SMaciej Fijalkowski 	ice_rx_buf_adjust_pg_offset(rx_buf, truesize);
8032b245cb2SAnirudh Venkataramanan }
8042b245cb2SAnirudh Venkataramanan 
8052b245cb2SAnirudh Venkataramanan /**
8062b245cb2SAnirudh Venkataramanan  * ice_reuse_rx_page - page flip buffer and store it back on the ring
807d337f2afSAnirudh Venkataramanan  * @rx_ring: Rx descriptor ring to store buffers on
8082b245cb2SAnirudh Venkataramanan  * @old_buf: donor buffer to have page reused
8092b245cb2SAnirudh Venkataramanan  *
8102b245cb2SAnirudh Venkataramanan  * Synchronizes page for reuse by the adapter
8112b245cb2SAnirudh Venkataramanan  */
812c8b7abddSBruce Allan static void
813c8b7abddSBruce Allan ice_reuse_rx_page(struct ice_ring *rx_ring, struct ice_rx_buf *old_buf)
8142b245cb2SAnirudh Venkataramanan {
8152b245cb2SAnirudh Venkataramanan 	u16 nta = rx_ring->next_to_alloc;
8162b245cb2SAnirudh Venkataramanan 	struct ice_rx_buf *new_buf;
8172b245cb2SAnirudh Venkataramanan 
8182b245cb2SAnirudh Venkataramanan 	new_buf = &rx_ring->rx_buf[nta];
8192b245cb2SAnirudh Venkataramanan 
8202b245cb2SAnirudh Venkataramanan 	/* update, and store next to alloc */
8212b245cb2SAnirudh Venkataramanan 	nta++;
8222b245cb2SAnirudh Venkataramanan 	rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
8232b245cb2SAnirudh Venkataramanan 
824712edbbbSMaciej Fijalkowski 	/* Transfer page from old buffer to new buffer.
825712edbbbSMaciej Fijalkowski 	 * Move each member individually to avoid possible store
826712edbbbSMaciej Fijalkowski 	 * forwarding stalls and unnecessary copy of skb.
827712edbbbSMaciej Fijalkowski 	 */
828712edbbbSMaciej Fijalkowski 	new_buf->dma = old_buf->dma;
829712edbbbSMaciej Fijalkowski 	new_buf->page = old_buf->page;
830712edbbbSMaciej Fijalkowski 	new_buf->page_offset = old_buf->page_offset;
831712edbbbSMaciej Fijalkowski 	new_buf->pagecnt_bias = old_buf->pagecnt_bias;
8322b245cb2SAnirudh Venkataramanan }
8332b245cb2SAnirudh Venkataramanan 
8342b245cb2SAnirudh Venkataramanan /**
8356c869cb7SMaciej Fijalkowski  * ice_get_rx_buf - Fetch Rx buffer and synchronize data for use
836d337f2afSAnirudh Venkataramanan  * @rx_ring: Rx descriptor ring to transact packets on
8376c869cb7SMaciej Fijalkowski  * @size: size of buffer to add to skb
8381beb7830SBjörn Töpel  * @rx_buf_pgcnt: rx_buf page refcount
8392b245cb2SAnirudh Venkataramanan  *
8406c869cb7SMaciej Fijalkowski  * This function will pull an Rx buffer from the ring and synchronize it
8416c869cb7SMaciej Fijalkowski  * for use by the CPU.
8422b245cb2SAnirudh Venkataramanan  */
8436c869cb7SMaciej Fijalkowski static struct ice_rx_buf *
84429b82f2aSMaciej Fijalkowski ice_get_rx_buf(struct ice_ring *rx_ring, const unsigned int size,
84529b82f2aSMaciej Fijalkowski 	       int *rx_buf_pgcnt)
8462b245cb2SAnirudh Venkataramanan {
8472b245cb2SAnirudh Venkataramanan 	struct ice_rx_buf *rx_buf;
8482b245cb2SAnirudh Venkataramanan 
8492b245cb2SAnirudh Venkataramanan 	rx_buf = &rx_ring->rx_buf[rx_ring->next_to_clean];
8501beb7830SBjörn Töpel 	*rx_buf_pgcnt =
8511beb7830SBjörn Töpel #if (PAGE_SIZE < 8192)
8521beb7830SBjörn Töpel 		page_count(rx_buf->page);
8531beb7830SBjörn Töpel #else
8541beb7830SBjörn Töpel 		0;
8551beb7830SBjörn Töpel #endif
8566c869cb7SMaciej Fijalkowski 	prefetchw(rx_buf->page);
8572b245cb2SAnirudh Venkataramanan 
858ac6f733aSMitch Williams 	if (!size)
859ac6f733aSMitch Williams 		return rx_buf;
8606c869cb7SMaciej Fijalkowski 	/* we are reusing so sync this buffer for CPU use */
8616c869cb7SMaciej Fijalkowski 	dma_sync_single_range_for_cpu(rx_ring->dev, rx_buf->dma,
8626c869cb7SMaciej Fijalkowski 				      rx_buf->page_offset, size,
8636c869cb7SMaciej Fijalkowski 				      DMA_FROM_DEVICE);
8642b245cb2SAnirudh Venkataramanan 
86503c66a13SMaciej Fijalkowski 	/* We have pulled a buffer for use, so decrement pagecnt_bias */
86603c66a13SMaciej Fijalkowski 	rx_buf->pagecnt_bias--;
86703c66a13SMaciej Fijalkowski 
8686c869cb7SMaciej Fijalkowski 	return rx_buf;
8696c869cb7SMaciej Fijalkowski }
8706c869cb7SMaciej Fijalkowski 
8716c869cb7SMaciej Fijalkowski /**
872aaf27254SMaciej Fijalkowski  * ice_build_skb - Build skb around an existing buffer
873aaf27254SMaciej Fijalkowski  * @rx_ring: Rx descriptor ring to transact packets on
874aaf27254SMaciej Fijalkowski  * @rx_buf: Rx buffer to pull data from
875aaf27254SMaciej Fijalkowski  * @xdp: xdp_buff pointing to the data
876aaf27254SMaciej Fijalkowski  *
877aaf27254SMaciej Fijalkowski  * This function builds an skb around an existing Rx buffer, taking care
878aaf27254SMaciej Fijalkowski  * to set up the skb correctly and avoid any memcpy overhead.
879aaf27254SMaciej Fijalkowski  */
880aaf27254SMaciej Fijalkowski static struct sk_buff *
881aaf27254SMaciej Fijalkowski ice_build_skb(struct ice_ring *rx_ring, struct ice_rx_buf *rx_buf,
882aaf27254SMaciej Fijalkowski 	      struct xdp_buff *xdp)
883aaf27254SMaciej Fijalkowski {
88488865fc4SKarol Kolacinski 	u8 metasize = xdp->data - xdp->data_meta;
885aaf27254SMaciej Fijalkowski #if (PAGE_SIZE < 8192)
886aaf27254SMaciej Fijalkowski 	unsigned int truesize = ice_rx_pg_size(rx_ring) / 2;
887aaf27254SMaciej Fijalkowski #else
888aaf27254SMaciej Fijalkowski 	unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
889aaf27254SMaciej Fijalkowski 				SKB_DATA_ALIGN(xdp->data_end -
890aaf27254SMaciej Fijalkowski 					       xdp->data_hard_start);
891aaf27254SMaciej Fijalkowski #endif
892aaf27254SMaciej Fijalkowski 	struct sk_buff *skb;
893aaf27254SMaciej Fijalkowski 
894aaf27254SMaciej Fijalkowski 	/* Prefetch first cache line of first page. If xdp->data_meta
895aaf27254SMaciej Fijalkowski 	 * is unused, this points exactly as xdp->data, otherwise we
896aaf27254SMaciej Fijalkowski 	 * likely have a consumer accessing first few bytes of meta
897aaf27254SMaciej Fijalkowski 	 * data, and then actual data.
898aaf27254SMaciej Fijalkowski 	 */
899f468f21bSTariq Toukan 	net_prefetch(xdp->data_meta);
900aaf27254SMaciej Fijalkowski 	/* build an skb around the page buffer */
901aaf27254SMaciej Fijalkowski 	skb = build_skb(xdp->data_hard_start, truesize);
902aaf27254SMaciej Fijalkowski 	if (unlikely(!skb))
903aaf27254SMaciej Fijalkowski 		return NULL;
904aaf27254SMaciej Fijalkowski 
905aaf27254SMaciej Fijalkowski 	/* must to record Rx queue, otherwise OS features such as
906aaf27254SMaciej Fijalkowski 	 * symmetric queue won't work
907aaf27254SMaciej Fijalkowski 	 */
908aaf27254SMaciej Fijalkowski 	skb_record_rx_queue(skb, rx_ring->q_index);
909aaf27254SMaciej Fijalkowski 
910aaf27254SMaciej Fijalkowski 	/* update pointers within the skb to store the data */
911aaf27254SMaciej Fijalkowski 	skb_reserve(skb, xdp->data - xdp->data_hard_start);
912aaf27254SMaciej Fijalkowski 	__skb_put(skb, xdp->data_end - xdp->data);
913aaf27254SMaciej Fijalkowski 	if (metasize)
914aaf27254SMaciej Fijalkowski 		skb_metadata_set(skb, metasize);
915aaf27254SMaciej Fijalkowski 
916aaf27254SMaciej Fijalkowski 	/* buffer is used by skb, update page_offset */
917aaf27254SMaciej Fijalkowski 	ice_rx_buf_adjust_pg_offset(rx_buf, truesize);
918aaf27254SMaciej Fijalkowski 
919aaf27254SMaciej Fijalkowski 	return skb;
920aaf27254SMaciej Fijalkowski }
921aaf27254SMaciej Fijalkowski 
922aaf27254SMaciej Fijalkowski /**
923712edbbbSMaciej Fijalkowski  * ice_construct_skb - Allocate skb and populate it
9242b245cb2SAnirudh Venkataramanan  * @rx_ring: Rx descriptor ring to transact packets on
9256c869cb7SMaciej Fijalkowski  * @rx_buf: Rx buffer to pull data from
926efc2214bSMaciej Fijalkowski  * @xdp: xdp_buff pointing to the data
9272b245cb2SAnirudh Venkataramanan  *
928712edbbbSMaciej Fijalkowski  * This function allocates an skb. It then populates it with the page
929712edbbbSMaciej Fijalkowski  * data from the current receive descriptor, taking care to set up the
930712edbbbSMaciej Fijalkowski  * skb correctly.
9312b245cb2SAnirudh Venkataramanan  */
932c8b7abddSBruce Allan static struct sk_buff *
933712edbbbSMaciej Fijalkowski ice_construct_skb(struct ice_ring *rx_ring, struct ice_rx_buf *rx_buf,
934efc2214bSMaciej Fijalkowski 		  struct xdp_buff *xdp)
9352b245cb2SAnirudh Venkataramanan {
936efc2214bSMaciej Fijalkowski 	unsigned int size = xdp->data_end - xdp->data;
937712edbbbSMaciej Fijalkowski 	unsigned int headlen;
938712edbbbSMaciej Fijalkowski 	struct sk_buff *skb;
9392b245cb2SAnirudh Venkataramanan 
9402b245cb2SAnirudh Venkataramanan 	/* prefetch first cache line of first page */
941f468f21bSTariq Toukan 	net_prefetch(xdp->data);
9422b245cb2SAnirudh Venkataramanan 
9432b245cb2SAnirudh Venkataramanan 	/* allocate a skb to store the frags */
944712edbbbSMaciej Fijalkowski 	skb = __napi_alloc_skb(&rx_ring->q_vector->napi, ICE_RX_HDR_SIZE,
9452b245cb2SAnirudh Venkataramanan 			       GFP_ATOMIC | __GFP_NOWARN);
946712edbbbSMaciej Fijalkowski 	if (unlikely(!skb))
9472b245cb2SAnirudh Venkataramanan 		return NULL;
9482b245cb2SAnirudh Venkataramanan 
9492b245cb2SAnirudh Venkataramanan 	skb_record_rx_queue(skb, rx_ring->q_index);
950712edbbbSMaciej Fijalkowski 	/* Determine available headroom for copy */
951712edbbbSMaciej Fijalkowski 	headlen = size;
952712edbbbSMaciej Fijalkowski 	if (headlen > ICE_RX_HDR_SIZE)
953efc2214bSMaciej Fijalkowski 		headlen = eth_get_headlen(skb->dev, xdp->data, ICE_RX_HDR_SIZE);
9542b245cb2SAnirudh Venkataramanan 
955712edbbbSMaciej Fijalkowski 	/* align pull length to size of long to optimize memcpy performance */
956efc2214bSMaciej Fijalkowski 	memcpy(__skb_put(skb, headlen), xdp->data, ALIGN(headlen,
957efc2214bSMaciej Fijalkowski 							 sizeof(long)));
958712edbbbSMaciej Fijalkowski 
959712edbbbSMaciej Fijalkowski 	/* if we exhaust the linear part then add what is left as a frag */
960712edbbbSMaciej Fijalkowski 	size -= headlen;
961712edbbbSMaciej Fijalkowski 	if (size) {
962712edbbbSMaciej Fijalkowski #if (PAGE_SIZE >= 8192)
963712edbbbSMaciej Fijalkowski 		unsigned int truesize = SKB_DATA_ALIGN(size);
964712edbbbSMaciej Fijalkowski #else
9657237f5b0SMaciej Fijalkowski 		unsigned int truesize = ice_rx_pg_size(rx_ring) / 2;
966712edbbbSMaciej Fijalkowski #endif
967712edbbbSMaciej Fijalkowski 		skb_add_rx_frag(skb, 0, rx_buf->page,
968712edbbbSMaciej Fijalkowski 				rx_buf->page_offset + headlen, size, truesize);
969712edbbbSMaciej Fijalkowski 		/* buffer is used by skb, update page_offset */
970712edbbbSMaciej Fijalkowski 		ice_rx_buf_adjust_pg_offset(rx_buf, truesize);
9712b245cb2SAnirudh Venkataramanan 	} else {
972712edbbbSMaciej Fijalkowski 		/* buffer is unused, reset bias back to rx_buf; data was copied
973712edbbbSMaciej Fijalkowski 		 * onto skb's linear part so there's no need for adjusting
974712edbbbSMaciej Fijalkowski 		 * page offset and we can reuse this buffer as-is
975712edbbbSMaciej Fijalkowski 		 */
976712edbbbSMaciej Fijalkowski 		rx_buf->pagecnt_bias++;
9772b245cb2SAnirudh Venkataramanan 	}
9782b245cb2SAnirudh Venkataramanan 
9792b245cb2SAnirudh Venkataramanan 	return skb;
9802b245cb2SAnirudh Venkataramanan }
9812b245cb2SAnirudh Venkataramanan 
9822b245cb2SAnirudh Venkataramanan /**
9831d032bc7SMaciej Fijalkowski  * ice_put_rx_buf - Clean up used buffer and either recycle or free
9841d032bc7SMaciej Fijalkowski  * @rx_ring: Rx descriptor ring to transact packets on
9851d032bc7SMaciej Fijalkowski  * @rx_buf: Rx buffer to pull data from
9861beb7830SBjörn Töpel  * @rx_buf_pgcnt: Rx buffer page count pre xdp_do_redirect()
9872b245cb2SAnirudh Venkataramanan  *
988efc2214bSMaciej Fijalkowski  * This function will update next_to_clean and then clean up the contents
989efc2214bSMaciej Fijalkowski  * of the rx_buf. It will either recycle the buffer or unmap it and free
990efc2214bSMaciej Fijalkowski  * the associated resources.
9912b245cb2SAnirudh Venkataramanan  */
9921beb7830SBjörn Töpel static void
9931beb7830SBjörn Töpel ice_put_rx_buf(struct ice_ring *rx_ring, struct ice_rx_buf *rx_buf,
9941beb7830SBjörn Töpel 	       int rx_buf_pgcnt)
9952b245cb2SAnirudh Venkataramanan {
99688865fc4SKarol Kolacinski 	u16 ntc = rx_ring->next_to_clean + 1;
997efc2214bSMaciej Fijalkowski 
998efc2214bSMaciej Fijalkowski 	/* fetch, update, and store next to clean */
999efc2214bSMaciej Fijalkowski 	ntc = (ntc < rx_ring->count) ? ntc : 0;
1000efc2214bSMaciej Fijalkowski 	rx_ring->next_to_clean = ntc;
1001efc2214bSMaciej Fijalkowski 
1002ac6f733aSMitch Williams 	if (!rx_buf)
1003ac6f733aSMitch Williams 		return;
1004ac6f733aSMitch Williams 
10051beb7830SBjörn Töpel 	if (ice_can_reuse_rx_page(rx_buf, rx_buf_pgcnt)) {
1006ac6f733aSMitch Williams 		/* hand second half of page back to the ring */
10072b245cb2SAnirudh Venkataramanan 		ice_reuse_rx_page(rx_ring, rx_buf);
10082b245cb2SAnirudh Venkataramanan 	} else {
10092b245cb2SAnirudh Venkataramanan 		/* we are not reusing the buffer so unmap it */
10107237f5b0SMaciej Fijalkowski 		dma_unmap_page_attrs(rx_ring->dev, rx_buf->dma,
10117237f5b0SMaciej Fijalkowski 				     ice_rx_pg_size(rx_ring), DMA_FROM_DEVICE,
10127237f5b0SMaciej Fijalkowski 				     ICE_RX_DMA_ATTR);
101303c66a13SMaciej Fijalkowski 		__page_frag_cache_drain(rx_buf->page, rx_buf->pagecnt_bias);
10142b245cb2SAnirudh Venkataramanan 	}
10152b245cb2SAnirudh Venkataramanan 
10162b245cb2SAnirudh Venkataramanan 	/* clear contents of buffer_info */
10172b245cb2SAnirudh Venkataramanan 	rx_buf->page = NULL;
10182b245cb2SAnirudh Venkataramanan }
10192b245cb2SAnirudh Venkataramanan 
10202b245cb2SAnirudh Venkataramanan /**
10212b245cb2SAnirudh Venkataramanan  * ice_is_non_eop - process handling of non-EOP buffers
10222b245cb2SAnirudh Venkataramanan  * @rx_ring: Rx ring being processed
10232b245cb2SAnirudh Venkataramanan  * @rx_desc: Rx descriptor for current buffer
10242b245cb2SAnirudh Venkataramanan  *
1025efc2214bSMaciej Fijalkowski  * If the buffer is an EOP buffer, this function exits returning false,
1026efc2214bSMaciej Fijalkowski  * otherwise return true indicating that this is in fact a non-EOP buffer.
10272b245cb2SAnirudh Venkataramanan  */
1028c8b7abddSBruce Allan static bool
102929b82f2aSMaciej Fijalkowski ice_is_non_eop(struct ice_ring *rx_ring, union ice_32b_rx_flex_desc *rx_desc)
10302b245cb2SAnirudh Venkataramanan {
10312b245cb2SAnirudh Venkataramanan 	/* if we are the last buffer then there is nothing else to do */
10322b245cb2SAnirudh Venkataramanan #define ICE_RXD_EOF BIT(ICE_RX_FLEX_DESC_STATUS0_EOF_S)
10332b245cb2SAnirudh Venkataramanan 	if (likely(ice_test_staterr(rx_desc, ICE_RXD_EOF)))
10342b245cb2SAnirudh Venkataramanan 		return false;
10352b245cb2SAnirudh Venkataramanan 
10362b245cb2SAnirudh Venkataramanan 	rx_ring->rx_stats.non_eop_descs++;
10372b245cb2SAnirudh Venkataramanan 
10382b245cb2SAnirudh Venkataramanan 	return true;
10392b245cb2SAnirudh Venkataramanan }
10402b245cb2SAnirudh Venkataramanan 
10412b245cb2SAnirudh Venkataramanan /**
10422b245cb2SAnirudh Venkataramanan  * ice_clean_rx_irq - Clean completed descriptors from Rx ring - bounce buf
1043d337f2afSAnirudh Venkataramanan  * @rx_ring: Rx descriptor ring to transact packets on
10442b245cb2SAnirudh Venkataramanan  * @budget: Total limit on number of packets to process
10452b245cb2SAnirudh Venkataramanan  *
10462b245cb2SAnirudh Venkataramanan  * This function provides a "bounce buffer" approach to Rx interrupt
10472b245cb2SAnirudh Venkataramanan  * processing. The advantage to this is that on systems that have
10482b245cb2SAnirudh Venkataramanan  * expensive overhead for IOMMU access this provides a means of avoiding
10492b245cb2SAnirudh Venkataramanan  * it by maintaining the mapping of the page to the system.
10502b245cb2SAnirudh Venkataramanan  *
10512b245cb2SAnirudh Venkataramanan  * Returns amount of work completed
10522b245cb2SAnirudh Venkataramanan  */
1053148beb61SHenry Tieman int ice_clean_rx_irq(struct ice_ring *rx_ring, int budget)
10542b245cb2SAnirudh Venkataramanan {
105543b5169dSLorenzo Bianconi 	unsigned int total_rx_bytes = 0, total_rx_pkts = 0, frame_sz = 0;
10562b245cb2SAnirudh Venkataramanan 	u16 cleaned_count = ICE_DESC_UNUSED(rx_ring);
1057f1b1f409SMaciej Fijalkowski 	unsigned int offset = rx_ring->rx_offset;
1058efc2214bSMaciej Fijalkowski 	unsigned int xdp_res, xdp_xmit = 0;
105929b82f2aSMaciej Fijalkowski 	struct sk_buff *skb = rx_ring->skb;
1060efc2214bSMaciej Fijalkowski 	struct bpf_prog *xdp_prog = NULL;
1061efc2214bSMaciej Fijalkowski 	struct xdp_buff xdp;
1062cb7db356SBrett Creeley 	bool failure;
10632b245cb2SAnirudh Venkataramanan 
1064d4ecdbf7SJesper Dangaard Brouer 	/* Frame size depend on rx_ring setup when PAGE_SIZE=4K */
1065d4ecdbf7SJesper Dangaard Brouer #if (PAGE_SIZE < 8192)
106643b5169dSLorenzo Bianconi 	frame_sz = ice_rx_frame_truesize(rx_ring, 0);
1067d4ecdbf7SJesper Dangaard Brouer #endif
106843b5169dSLorenzo Bianconi 	xdp_init_buff(&xdp, frame_sz, &rx_ring->xdp_rxq);
1069efc2214bSMaciej Fijalkowski 
1070f9867df6SAnirudh Venkataramanan 	/* start the loop to process Rx packets bounded by 'budget' */
10712b245cb2SAnirudh Venkataramanan 	while (likely(total_rx_pkts < (unsigned int)budget)) {
10722b245cb2SAnirudh Venkataramanan 		union ice_32b_rx_flex_desc *rx_desc;
10736c869cb7SMaciej Fijalkowski 		struct ice_rx_buf *rx_buf;
1074be9df4afSLorenzo Bianconi 		unsigned char *hard_start;
10756c869cb7SMaciej Fijalkowski 		unsigned int size;
10762b245cb2SAnirudh Venkataramanan 		u16 stat_err_bits;
10771beb7830SBjörn Töpel 		int rx_buf_pgcnt;
10782b245cb2SAnirudh Venkataramanan 		u16 vlan_tag = 0;
1079d76a60baSAnirudh Venkataramanan 		u8 rx_ptype;
10802b245cb2SAnirudh Venkataramanan 
1081f9867df6SAnirudh Venkataramanan 		/* get the Rx desc from Rx ring based on 'next_to_clean' */
10822b245cb2SAnirudh Venkataramanan 		rx_desc = ICE_RX_DESC(rx_ring, rx_ring->next_to_clean);
10832b245cb2SAnirudh Venkataramanan 
10842b245cb2SAnirudh Venkataramanan 		/* status_error_len will always be zero for unused descriptors
10852b245cb2SAnirudh Venkataramanan 		 * because it's cleared in cleanup, and overlaps with hdr_addr
10862b245cb2SAnirudh Venkataramanan 		 * which is always zero because packet split isn't used, if the
10872b245cb2SAnirudh Venkataramanan 		 * hardware wrote DD then it will be non-zero
10882b245cb2SAnirudh Venkataramanan 		 */
10892b245cb2SAnirudh Venkataramanan 		stat_err_bits = BIT(ICE_RX_FLEX_DESC_STATUS0_DD_S);
10902b245cb2SAnirudh Venkataramanan 		if (!ice_test_staterr(rx_desc, stat_err_bits))
10912b245cb2SAnirudh Venkataramanan 			break;
10922b245cb2SAnirudh Venkataramanan 
10932b245cb2SAnirudh Venkataramanan 		/* This memory barrier is needed to keep us from reading
10942b245cb2SAnirudh Venkataramanan 		 * any other fields out of the rx_desc until we know the
10952b245cb2SAnirudh Venkataramanan 		 * DD bit is set.
10962b245cb2SAnirudh Venkataramanan 		 */
10972b245cb2SAnirudh Venkataramanan 		dma_rmb();
10982b245cb2SAnirudh Venkataramanan 
1099148beb61SHenry Tieman 		if (rx_desc->wb.rxdid == FDIR_DESC_RXDID || !rx_ring->netdev) {
1100d6218317SQi Zhang 			struct ice_vsi *ctrl_vsi = rx_ring->vsi;
1101d6218317SQi Zhang 
1102d6218317SQi Zhang 			if (rx_desc->wb.rxdid == FDIR_DESC_RXDID &&
1103d6218317SQi Zhang 			    ctrl_vsi->vf_id != ICE_INVAL_VFID)
1104d6218317SQi Zhang 				ice_vc_fdir_irq_handler(ctrl_vsi, rx_desc);
11051beb7830SBjörn Töpel 			ice_put_rx_buf(rx_ring, NULL, 0);
1106148beb61SHenry Tieman 			cleaned_count++;
1107148beb61SHenry Tieman 			continue;
1108148beb61SHenry Tieman 		}
1109148beb61SHenry Tieman 
11106c869cb7SMaciej Fijalkowski 		size = le16_to_cpu(rx_desc->wb.pkt_len) &
11116c869cb7SMaciej Fijalkowski 			ICE_RX_FLX_DESC_PKT_LEN_M;
11122b245cb2SAnirudh Venkataramanan 
1113ac6f733aSMitch Williams 		/* retrieve a buffer from the ring */
111429b82f2aSMaciej Fijalkowski 		rx_buf = ice_get_rx_buf(rx_ring, size, &rx_buf_pgcnt);
1115ac6f733aSMitch Williams 
1116efc2214bSMaciej Fijalkowski 		if (!size) {
1117efc2214bSMaciej Fijalkowski 			xdp.data = NULL;
1118efc2214bSMaciej Fijalkowski 			xdp.data_end = NULL;
1119aaf27254SMaciej Fijalkowski 			xdp.data_hard_start = NULL;
1120aaf27254SMaciej Fijalkowski 			xdp.data_meta = NULL;
1121efc2214bSMaciej Fijalkowski 			goto construct_skb;
1122efc2214bSMaciej Fijalkowski 		}
1123efc2214bSMaciej Fijalkowski 
1124be9df4afSLorenzo Bianconi 		hard_start = page_address(rx_buf->page) + rx_buf->page_offset -
1125be9df4afSLorenzo Bianconi 			     offset;
1126be9df4afSLorenzo Bianconi 		xdp_prepare_buff(&xdp, hard_start, offset, size, true);
1127d4ecdbf7SJesper Dangaard Brouer #if (PAGE_SIZE > 4096)
1128d4ecdbf7SJesper Dangaard Brouer 		/* At larger PAGE_SIZE, frame_sz depend on len size */
1129d4ecdbf7SJesper Dangaard Brouer 		xdp.frame_sz = ice_rx_frame_truesize(rx_ring, size);
1130d4ecdbf7SJesper Dangaard Brouer #endif
1131efc2214bSMaciej Fijalkowski 
1132efc2214bSMaciej Fijalkowski 		rcu_read_lock();
1133efc2214bSMaciej Fijalkowski 		xdp_prog = READ_ONCE(rx_ring->xdp_prog);
1134efc2214bSMaciej Fijalkowski 		if (!xdp_prog) {
1135efc2214bSMaciej Fijalkowski 			rcu_read_unlock();
1136efc2214bSMaciej Fijalkowski 			goto construct_skb;
1137efc2214bSMaciej Fijalkowski 		}
1138efc2214bSMaciej Fijalkowski 
1139efc2214bSMaciej Fijalkowski 		xdp_res = ice_run_xdp(rx_ring, &xdp, xdp_prog);
1140efc2214bSMaciej Fijalkowski 		rcu_read_unlock();
114159bb0808SMaciej Fijalkowski 		if (!xdp_res)
114259bb0808SMaciej Fijalkowski 			goto construct_skb;
1143efc2214bSMaciej Fijalkowski 		if (xdp_res & (ICE_XDP_TX | ICE_XDP_REDIR)) {
1144efc2214bSMaciej Fijalkowski 			xdp_xmit |= xdp_res;
1145d4ecdbf7SJesper Dangaard Brouer 			ice_rx_buf_adjust_pg_offset(rx_buf, xdp.frame_sz);
1146efc2214bSMaciej Fijalkowski 		} else {
1147efc2214bSMaciej Fijalkowski 			rx_buf->pagecnt_bias++;
1148efc2214bSMaciej Fijalkowski 		}
1149efc2214bSMaciej Fijalkowski 		total_rx_bytes += size;
1150efc2214bSMaciej Fijalkowski 		total_rx_pkts++;
1151efc2214bSMaciej Fijalkowski 
1152efc2214bSMaciej Fijalkowski 		cleaned_count++;
11531beb7830SBjörn Töpel 		ice_put_rx_buf(rx_ring, rx_buf, rx_buf_pgcnt);
1154efc2214bSMaciej Fijalkowski 		continue;
1155efc2214bSMaciej Fijalkowski construct_skb:
11561f45ebe0SMitch Williams 		if (skb) {
11577237f5b0SMaciej Fijalkowski 			ice_add_rx_frag(rx_ring, rx_buf, skb, size);
11581f45ebe0SMitch Williams 		} else if (likely(xdp.data)) {
11591f45ebe0SMitch Williams 			if (ice_ring_uses_build_skb(rx_ring))
1160aaf27254SMaciej Fijalkowski 				skb = ice_build_skb(rx_ring, rx_buf, &xdp);
1161712edbbbSMaciej Fijalkowski 			else
1162efc2214bSMaciej Fijalkowski 				skb = ice_construct_skb(rx_ring, rx_buf, &xdp);
11631f45ebe0SMitch Williams 		}
1164712edbbbSMaciej Fijalkowski 		/* exit if we failed to retrieve a buffer */
1165712edbbbSMaciej Fijalkowski 		if (!skb) {
1166712edbbbSMaciej Fijalkowski 			rx_ring->rx_stats.alloc_buf_failed++;
1167ac6f733aSMitch Williams 			if (rx_buf)
1168712edbbbSMaciej Fijalkowski 				rx_buf->pagecnt_bias++;
11692b245cb2SAnirudh Venkataramanan 			break;
1170712edbbbSMaciej Fijalkowski 		}
11712b245cb2SAnirudh Venkataramanan 
11721beb7830SBjörn Töpel 		ice_put_rx_buf(rx_ring, rx_buf, rx_buf_pgcnt);
11732b245cb2SAnirudh Venkataramanan 		cleaned_count++;
11742b245cb2SAnirudh Venkataramanan 
11752b245cb2SAnirudh Venkataramanan 		/* skip if it is NOP desc */
117629b82f2aSMaciej Fijalkowski 		if (ice_is_non_eop(rx_ring, rx_desc))
11772b245cb2SAnirudh Venkataramanan 			continue;
11782b245cb2SAnirudh Venkataramanan 
11792b245cb2SAnirudh Venkataramanan 		stat_err_bits = BIT(ICE_RX_FLEX_DESC_STATUS0_RXE_S);
11802b245cb2SAnirudh Venkataramanan 		if (unlikely(ice_test_staterr(rx_desc, stat_err_bits))) {
11812b245cb2SAnirudh Venkataramanan 			dev_kfree_skb_any(skb);
11822b245cb2SAnirudh Venkataramanan 			continue;
11832b245cb2SAnirudh Venkataramanan 		}
11842b245cb2SAnirudh Venkataramanan 
11852b245cb2SAnirudh Venkataramanan 		stat_err_bits = BIT(ICE_RX_FLEX_DESC_STATUS0_L2TAG1P_S);
11862b245cb2SAnirudh Venkataramanan 		if (ice_test_staterr(rx_desc, stat_err_bits))
11872b245cb2SAnirudh Venkataramanan 			vlan_tag = le16_to_cpu(rx_desc->wb.l2tag1);
11882b245cb2SAnirudh Venkataramanan 
1189133f4883SKrzysztof Kazimierczak 		/* pad the skb if needed, to make a valid ethernet frame */
1190133f4883SKrzysztof Kazimierczak 		if (eth_skb_pad(skb)) {
11912b245cb2SAnirudh Venkataramanan 			skb = NULL;
11922b245cb2SAnirudh Venkataramanan 			continue;
11932b245cb2SAnirudh Venkataramanan 		}
11942b245cb2SAnirudh Venkataramanan 
11952b245cb2SAnirudh Venkataramanan 		/* probably a little skewed due to removing CRC */
11962b245cb2SAnirudh Venkataramanan 		total_rx_bytes += skb->len;
11972b245cb2SAnirudh Venkataramanan 
1198d76a60baSAnirudh Venkataramanan 		/* populate checksum, VLAN, and protocol */
11996503b659SJesse Brandeburg 		rx_ptype = le16_to_cpu(rx_desc->wb.ptype_flex_flags0) &
12006503b659SJesse Brandeburg 			ICE_RX_FLEX_DESC_PTYPE_M;
12016503b659SJesse Brandeburg 
1202d76a60baSAnirudh Venkataramanan 		ice_process_skb_fields(rx_ring, rx_desc, skb, rx_ptype);
1203d76a60baSAnirudh Venkataramanan 
12042b245cb2SAnirudh Venkataramanan 		/* send completed skb up the stack */
12052b245cb2SAnirudh Venkataramanan 		ice_receive_skb(rx_ring, skb, vlan_tag);
120629b82f2aSMaciej Fijalkowski 		skb = NULL;
12072b245cb2SAnirudh Venkataramanan 
12082b245cb2SAnirudh Venkataramanan 		/* update budget accounting */
12092b245cb2SAnirudh Venkataramanan 		total_rx_pkts++;
12102b245cb2SAnirudh Venkataramanan 	}
12112b245cb2SAnirudh Venkataramanan 
1212cb7db356SBrett Creeley 	/* return up to cleaned_count buffers to hardware */
1213cb7db356SBrett Creeley 	failure = ice_alloc_rx_bufs(rx_ring, cleaned_count);
1214cb7db356SBrett Creeley 
1215efc2214bSMaciej Fijalkowski 	if (xdp_prog)
1216efc2214bSMaciej Fijalkowski 		ice_finalize_xdp_rx(rx_ring, xdp_xmit);
121729b82f2aSMaciej Fijalkowski 	rx_ring->skb = skb;
1218efc2214bSMaciej Fijalkowski 
12192d4238f5SKrzysztof Kazimierczak 	ice_update_rx_ring_stats(rx_ring, total_rx_pkts, total_rx_bytes);
12202b245cb2SAnirudh Venkataramanan 
12212b245cb2SAnirudh Venkataramanan 	/* guarantee a trip back through this routine if there was a failure */
12222b245cb2SAnirudh Venkataramanan 	return failure ? budget : (int)total_rx_pkts;
12232b245cb2SAnirudh Venkataramanan }
12242b245cb2SAnirudh Venkataramanan 
12252b245cb2SAnirudh Venkataramanan /**
1226cdf1f1f1SJacob Keller  * ice_net_dim - Update net DIM algorithm
1227cdf1f1f1SJacob Keller  * @q_vector: the vector associated with the interrupt
1228711987bbSBrett Creeley  *
1229cdf1f1f1SJacob Keller  * Create a DIM sample and notify net_dim() so that it can possibly decide
1230cdf1f1f1SJacob Keller  * a new ITR value based on incoming packets, bytes, and interrupts.
1231711987bbSBrett Creeley  *
1232cdf1f1f1SJacob Keller  * This function is a no-op if the ring is not configured to dynamic ITR.
1233711987bbSBrett Creeley  */
1234cdf1f1f1SJacob Keller static void ice_net_dim(struct ice_q_vector *q_vector)
123564a59d05SAnirudh Venkataramanan {
1236cdf1f1f1SJacob Keller 	struct ice_ring_container *tx = &q_vector->tx;
1237cdf1f1f1SJacob Keller 	struct ice_ring_container *rx = &q_vector->rx;
1238cdf1f1f1SJacob Keller 
1239cdf1f1f1SJacob Keller 	if (ITR_IS_DYNAMIC(tx->itr_setting)) {
1240cdf1f1f1SJacob Keller 		struct dim_sample dim_sample = {};
1241cdf1f1f1SJacob Keller 		u64 packets = 0, bytes = 0;
1242cdf1f1f1SJacob Keller 		struct ice_ring *ring;
1243cdf1f1f1SJacob Keller 
1244cdf1f1f1SJacob Keller 		ice_for_each_ring(ring, q_vector->tx) {
1245cdf1f1f1SJacob Keller 			packets += ring->stats.pkts;
1246cdf1f1f1SJacob Keller 			bytes += ring->stats.bytes;
124764a59d05SAnirudh Venkataramanan 		}
1248711987bbSBrett Creeley 
1249cdf1f1f1SJacob Keller 		dim_update_sample(q_vector->total_events, packets, bytes,
1250cdf1f1f1SJacob Keller 				  &dim_sample);
1251cdf1f1f1SJacob Keller 
1252cdf1f1f1SJacob Keller 		net_dim(&tx->dim, dim_sample);
1253711987bbSBrett Creeley 	}
1254711987bbSBrett Creeley 
1255cdf1f1f1SJacob Keller 	if (ITR_IS_DYNAMIC(rx->itr_setting)) {
1256cdf1f1f1SJacob Keller 		struct dim_sample dim_sample = {};
1257cdf1f1f1SJacob Keller 		u64 packets = 0, bytes = 0;
1258cdf1f1f1SJacob Keller 		struct ice_ring *ring;
1259cdf1f1f1SJacob Keller 
1260cdf1f1f1SJacob Keller 		ice_for_each_ring(ring, q_vector->rx) {
1261cdf1f1f1SJacob Keller 			packets += ring->stats.pkts;
1262cdf1f1f1SJacob Keller 			bytes += ring->stats.bytes;
126364a59d05SAnirudh Venkataramanan 		}
126464a59d05SAnirudh Venkataramanan 
1265cdf1f1f1SJacob Keller 		dim_update_sample(q_vector->total_events, packets, bytes,
1266cdf1f1f1SJacob Keller 				  &dim_sample);
126764a59d05SAnirudh Venkataramanan 
1268cdf1f1f1SJacob Keller 		net_dim(&rx->dim, dim_sample);
126964a59d05SAnirudh Venkataramanan 	}
127064a59d05SAnirudh Venkataramanan }
127164a59d05SAnirudh Venkataramanan 
12722b245cb2SAnirudh Venkataramanan /**
127363f545edSBrett Creeley  * ice_buildreg_itr - build value for writing to the GLINT_DYN_CTL register
127463f545edSBrett Creeley  * @itr_idx: interrupt throttling index
127564a59d05SAnirudh Venkataramanan  * @itr: interrupt throttling value in usecs
127663f545edSBrett Creeley  */
12778244dd2dSBrett Creeley static u32 ice_buildreg_itr(u16 itr_idx, u16 itr)
127863f545edSBrett Creeley {
12792f2da36eSAnirudh Venkataramanan 	/* The ITR value is reported in microseconds, and the register value is
128064a59d05SAnirudh Venkataramanan 	 * recorded in 2 microsecond units. For this reason we only need to
128164a59d05SAnirudh Venkataramanan 	 * shift by the GLINT_DYN_CTL_INTERVAL_S - ICE_ITR_GRAN_S to apply this
128264a59d05SAnirudh Venkataramanan 	 * granularity as a shift instead of division. The mask makes sure the
128364a59d05SAnirudh Venkataramanan 	 * ITR value is never odd so we don't accidentally write into the field
128464a59d05SAnirudh Venkataramanan 	 * prior to the ITR field.
128564a59d05SAnirudh Venkataramanan 	 */
128664a59d05SAnirudh Venkataramanan 	itr &= ICE_ITR_MASK;
128764a59d05SAnirudh Venkataramanan 
128863f545edSBrett Creeley 	return GLINT_DYN_CTL_INTENA_M | GLINT_DYN_CTL_CLEARPBA_M |
128963f545edSBrett Creeley 		(itr_idx << GLINT_DYN_CTL_ITR_INDX_S) |
129064a59d05SAnirudh Venkataramanan 		(itr << (GLINT_DYN_CTL_INTERVAL_S - ICE_ITR_GRAN_S));
129163f545edSBrett Creeley }
129263f545edSBrett Creeley 
129363f545edSBrett Creeley /**
1294cdf1f1f1SJacob Keller  * ice_update_ena_itr - Update ITR moderation and re-enable MSI-X interrupt
1295cdf1f1f1SJacob Keller  * @q_vector: the vector associated with the interrupt to enable
1296cdf1f1f1SJacob Keller  *
1297cdf1f1f1SJacob Keller  * Update the net_dim() algorithm and re-enable the interrupt associated with
1298cdf1f1f1SJacob Keller  * this vector.
1299cdf1f1f1SJacob Keller  *
1300cdf1f1f1SJacob Keller  * If the VSI is down, the interrupt will not be re-enabled.
130163f545edSBrett Creeley  */
13022fb0821fSJesse Brandeburg static void ice_update_ena_itr(struct ice_q_vector *q_vector)
130363f545edSBrett Creeley {
13042fb0821fSJesse Brandeburg 	struct ice_vsi *vsi = q_vector->vsi;
1305*b7306b42SJesse Brandeburg 	bool wb_en = q_vector->wb_on_itr;
130663f545edSBrett Creeley 	u32 itr_val;
130763f545edSBrett Creeley 
1308cdf1f1f1SJacob Keller 	if (test_bit(ICE_DOWN, vsi->state))
1309cdf1f1f1SJacob Keller 		return;
13102ab28bb0SBrett Creeley 
1311cdf1f1f1SJacob Keller 	/* When exiting WB_ON_ITR, let ITR resume its normal
1312cdf1f1f1SJacob Keller 	 * interrupts-enabled path.
1313cdf1f1f1SJacob Keller 	 */
1314*b7306b42SJesse Brandeburg 	if (wb_en)
1315cdf1f1f1SJacob Keller 		q_vector->wb_on_itr = false;
131664a59d05SAnirudh Venkataramanan 
1317cdf1f1f1SJacob Keller 	/* This will do nothing if dynamic updates are not enabled. */
1318cdf1f1f1SJacob Keller 	ice_net_dim(q_vector);
1319cdf1f1f1SJacob Keller 
1320cdf1f1f1SJacob Keller 	/* net_dim() updates ITR out-of-band using a work item */
132163f545edSBrett Creeley 	itr_val = ice_buildreg_itr(ICE_ITR_NONE, 0);
1322*b7306b42SJesse Brandeburg 	/* trigger an immediate software interrupt when exiting
1323*b7306b42SJesse Brandeburg 	 * busy poll, to make sure to catch any pending cleanups
1324*b7306b42SJesse Brandeburg 	 * that might have been missed due to interrupt state
1325*b7306b42SJesse Brandeburg 	 * transition.
1326*b7306b42SJesse Brandeburg 	 */
1327*b7306b42SJesse Brandeburg 	if (wb_en) {
1328*b7306b42SJesse Brandeburg 		itr_val |= GLINT_DYN_CTL_SWINT_TRIG_M |
1329*b7306b42SJesse Brandeburg 			   GLINT_DYN_CTL_SW_ITR_INDX_M |
1330*b7306b42SJesse Brandeburg 			   GLINT_DYN_CTL_SW_ITR_INDX_ENA_M;
1331*b7306b42SJesse Brandeburg 	}
13321d9f7ca3SJesse Brandeburg 	wr32(&vsi->back->hw, GLINT_DYN_CTL(q_vector->reg_idx), itr_val);
133363f545edSBrett Creeley }
133463f545edSBrett Creeley 
133563f545edSBrett Creeley /**
13362ab28bb0SBrett Creeley  * ice_set_wb_on_itr - set WB_ON_ITR for this q_vector
13372ab28bb0SBrett Creeley  * @q_vector: q_vector to set WB_ON_ITR on
13382ab28bb0SBrett Creeley  *
13392ab28bb0SBrett Creeley  * We need to tell hardware to write-back completed descriptors even when
13402ab28bb0SBrett Creeley  * interrupts are disabled. Descriptors will be written back on cache line
13412ab28bb0SBrett Creeley  * boundaries without WB_ON_ITR enabled, but if we don't enable WB_ON_ITR
13421d9f7ca3SJesse Brandeburg  * descriptors may not be written back if they don't fill a cache line until
13431d9f7ca3SJesse Brandeburg  * the next interrupt.
13442ab28bb0SBrett Creeley  *
13451d9f7ca3SJesse Brandeburg  * This sets the write-back frequency to whatever was set previously for the
13461d9f7ca3SJesse Brandeburg  * ITR indices. Also, set the INTENA_MSK bit to make sure hardware knows we
13471d9f7ca3SJesse Brandeburg  * aren't meddling with the INTENA_M bit.
13482ab28bb0SBrett Creeley  */
13492fb0821fSJesse Brandeburg static void ice_set_wb_on_itr(struct ice_q_vector *q_vector)
13502ab28bb0SBrett Creeley {
13512fb0821fSJesse Brandeburg 	struct ice_vsi *vsi = q_vector->vsi;
13522fb0821fSJesse Brandeburg 
13531d9f7ca3SJesse Brandeburg 	/* already in wb_on_itr mode no need to change it */
1354cdf1f1f1SJacob Keller 	if (q_vector->wb_on_itr)
13552ab28bb0SBrett Creeley 		return;
13562ab28bb0SBrett Creeley 
13571d9f7ca3SJesse Brandeburg 	/* use previously set ITR values for all of the ITR indices by
13581d9f7ca3SJesse Brandeburg 	 * specifying ICE_ITR_NONE, which will vary in adaptive (AIM) mode and
13591d9f7ca3SJesse Brandeburg 	 * be static in non-adaptive mode (user configured)
13601d9f7ca3SJesse Brandeburg 	 */
13612ab28bb0SBrett Creeley 	wr32(&vsi->back->hw, GLINT_DYN_CTL(q_vector->reg_idx),
13621d9f7ca3SJesse Brandeburg 	     ((ICE_ITR_NONE << GLINT_DYN_CTL_ITR_INDX_S) &
13631d9f7ca3SJesse Brandeburg 	      GLINT_DYN_CTL_ITR_INDX_M) | GLINT_DYN_CTL_INTENA_MSK_M |
13641d9f7ca3SJesse Brandeburg 	     GLINT_DYN_CTL_WB_ON_ITR_M);
13652ab28bb0SBrett Creeley 
1366cdf1f1f1SJacob Keller 	q_vector->wb_on_itr = true;
13672ab28bb0SBrett Creeley }
13682ab28bb0SBrett Creeley 
13692ab28bb0SBrett Creeley /**
13702b245cb2SAnirudh Venkataramanan  * ice_napi_poll - NAPI polling Rx/Tx cleanup routine
13712b245cb2SAnirudh Venkataramanan  * @napi: napi struct with our devices info in it
13722b245cb2SAnirudh Venkataramanan  * @budget: amount of work driver is allowed to do this pass, in packets
13732b245cb2SAnirudh Venkataramanan  *
13742b245cb2SAnirudh Venkataramanan  * This function will clean all queues associated with a q_vector.
13752b245cb2SAnirudh Venkataramanan  *
13762b245cb2SAnirudh Venkataramanan  * Returns the amount of work done
13772b245cb2SAnirudh Venkataramanan  */
13782b245cb2SAnirudh Venkataramanan int ice_napi_poll(struct napi_struct *napi, int budget)
13792b245cb2SAnirudh Venkataramanan {
13802b245cb2SAnirudh Venkataramanan 	struct ice_q_vector *q_vector =
13812b245cb2SAnirudh Venkataramanan 				container_of(napi, struct ice_q_vector, napi);
13822b245cb2SAnirudh Venkataramanan 	bool clean_complete = true;
13832b245cb2SAnirudh Venkataramanan 	struct ice_ring *ring;
13849118fcd5SBrett Creeley 	int budget_per_ring;
13852b245cb2SAnirudh Venkataramanan 	int work_done = 0;
13862b245cb2SAnirudh Venkataramanan 
13872b245cb2SAnirudh Venkataramanan 	/* Since the actual Tx work is minimal, we can give the Tx a larger
13882b245cb2SAnirudh Venkataramanan 	 * budget and be more aggressive about cleaning up the Tx descriptors.
13892b245cb2SAnirudh Venkataramanan 	 */
13902d4238f5SKrzysztof Kazimierczak 	ice_for_each_ring(ring, q_vector->tx) {
13911742b3d5SMagnus Karlsson 		bool wd = ring->xsk_pool ?
13922d4238f5SKrzysztof Kazimierczak 			  ice_clean_tx_irq_zc(ring, budget) :
13932d4238f5SKrzysztof Kazimierczak 			  ice_clean_tx_irq(ring, budget);
13942d4238f5SKrzysztof Kazimierczak 
13952d4238f5SKrzysztof Kazimierczak 		if (!wd)
13962b245cb2SAnirudh Venkataramanan 			clean_complete = false;
13972d4238f5SKrzysztof Kazimierczak 	}
13982b245cb2SAnirudh Venkataramanan 
13992b245cb2SAnirudh Venkataramanan 	/* Handle case where we are called by netpoll with a budget of 0 */
1400d27525ecSJesse Brandeburg 	if (unlikely(budget <= 0))
14012b245cb2SAnirudh Venkataramanan 		return budget;
14022b245cb2SAnirudh Venkataramanan 
14039118fcd5SBrett Creeley 	/* normally we have 1 Rx ring per q_vector */
14049118fcd5SBrett Creeley 	if (unlikely(q_vector->num_ring_rx > 1))
14059118fcd5SBrett Creeley 		/* We attempt to distribute budget to each Rx queue fairly, but
14069118fcd5SBrett Creeley 		 * don't allow the budget to go below 1 because that would exit
14079118fcd5SBrett Creeley 		 * polling early.
14082b245cb2SAnirudh Venkataramanan 		 */
140988865fc4SKarol Kolacinski 		budget_per_ring = max_t(int, budget / q_vector->num_ring_rx, 1);
14109118fcd5SBrett Creeley 	else
14119118fcd5SBrett Creeley 		/* Max of 1 Rx ring in this q_vector so give it the budget */
14129118fcd5SBrett Creeley 		budget_per_ring = budget;
14132b245cb2SAnirudh Venkataramanan 
14142b245cb2SAnirudh Venkataramanan 	ice_for_each_ring(ring, q_vector->rx) {
14152b245cb2SAnirudh Venkataramanan 		int cleaned;
14162b245cb2SAnirudh Venkataramanan 
14172d4238f5SKrzysztof Kazimierczak 		/* A dedicated path for zero-copy allows making a single
14182d4238f5SKrzysztof Kazimierczak 		 * comparison in the irq context instead of many inside the
14192d4238f5SKrzysztof Kazimierczak 		 * ice_clean_rx_irq function and makes the codebase cleaner.
14202d4238f5SKrzysztof Kazimierczak 		 */
14211742b3d5SMagnus Karlsson 		cleaned = ring->xsk_pool ?
14222d4238f5SKrzysztof Kazimierczak 			  ice_clean_rx_irq_zc(ring, budget_per_ring) :
14232d4238f5SKrzysztof Kazimierczak 			  ice_clean_rx_irq(ring, budget_per_ring);
14242b245cb2SAnirudh Venkataramanan 		work_done += cleaned;
14252b245cb2SAnirudh Venkataramanan 		/* if we clean as many as budgeted, we must not be done */
14262b245cb2SAnirudh Venkataramanan 		if (cleaned >= budget_per_ring)
14272b245cb2SAnirudh Venkataramanan 			clean_complete = false;
14282b245cb2SAnirudh Venkataramanan 	}
14292b245cb2SAnirudh Venkataramanan 
14302b245cb2SAnirudh Venkataramanan 	/* If work not completed, return budget and polling will return */
14311d9f7ca3SJesse Brandeburg 	if (!clean_complete) {
14321d9f7ca3SJesse Brandeburg 		/* Set the writeback on ITR so partial completions of
14331d9f7ca3SJesse Brandeburg 		 * cache-lines will still continue even if we're polling.
14341d9f7ca3SJesse Brandeburg 		 */
14351d9f7ca3SJesse Brandeburg 		ice_set_wb_on_itr(q_vector);
14362b245cb2SAnirudh Venkataramanan 		return budget;
14371d9f7ca3SJesse Brandeburg 	}
14382b245cb2SAnirudh Venkataramanan 
14390bcd952fSJesse Brandeburg 	/* Exit the polling mode, but don't re-enable interrupts if stack might
14400bcd952fSJesse Brandeburg 	 * poll us due to busy-polling
14410bcd952fSJesse Brandeburg 	 */
14420bcd952fSJesse Brandeburg 	if (likely(napi_complete_done(napi, work_done)))
14432fb0821fSJesse Brandeburg 		ice_update_ena_itr(q_vector);
14442ab28bb0SBrett Creeley 	else
14452fb0821fSJesse Brandeburg 		ice_set_wb_on_itr(q_vector);
1446e0c9fd9bSDave Ertman 
144732a64994SBruce Allan 	return min_t(int, work_done, budget - 1);
14482b245cb2SAnirudh Venkataramanan }
14492b245cb2SAnirudh Venkataramanan 
14502b245cb2SAnirudh Venkataramanan /**
1451d337f2afSAnirudh Venkataramanan  * __ice_maybe_stop_tx - 2nd level check for Tx stop conditions
14522b245cb2SAnirudh Venkataramanan  * @tx_ring: the ring to be checked
14532b245cb2SAnirudh Venkataramanan  * @size: the size buffer we want to assure is available
14542b245cb2SAnirudh Venkataramanan  *
14552b245cb2SAnirudh Venkataramanan  * Returns -EBUSY if a stop is needed, else 0
14562b245cb2SAnirudh Venkataramanan  */
14572b245cb2SAnirudh Venkataramanan static int __ice_maybe_stop_tx(struct ice_ring *tx_ring, unsigned int size)
14582b245cb2SAnirudh Venkataramanan {
14592b245cb2SAnirudh Venkataramanan 	netif_stop_subqueue(tx_ring->netdev, tx_ring->q_index);
14602b245cb2SAnirudh Venkataramanan 	/* Memory barrier before checking head and tail */
14612b245cb2SAnirudh Venkataramanan 	smp_mb();
14622b245cb2SAnirudh Venkataramanan 
14632b245cb2SAnirudh Venkataramanan 	/* Check again in a case another CPU has just made room available. */
14642b245cb2SAnirudh Venkataramanan 	if (likely(ICE_DESC_UNUSED(tx_ring) < size))
14652b245cb2SAnirudh Venkataramanan 		return -EBUSY;
14662b245cb2SAnirudh Venkataramanan 
14672b245cb2SAnirudh Venkataramanan 	/* A reprieve! - use start_subqueue because it doesn't call schedule */
14682b245cb2SAnirudh Venkataramanan 	netif_start_subqueue(tx_ring->netdev, tx_ring->q_index);
14692b245cb2SAnirudh Venkataramanan 	++tx_ring->tx_stats.restart_q;
14702b245cb2SAnirudh Venkataramanan 	return 0;
14712b245cb2SAnirudh Venkataramanan }
14722b245cb2SAnirudh Venkataramanan 
14732b245cb2SAnirudh Venkataramanan /**
1474d337f2afSAnirudh Venkataramanan  * ice_maybe_stop_tx - 1st level check for Tx stop conditions
14752b245cb2SAnirudh Venkataramanan  * @tx_ring: the ring to be checked
14762b245cb2SAnirudh Venkataramanan  * @size:    the size buffer we want to assure is available
14772b245cb2SAnirudh Venkataramanan  *
14782b245cb2SAnirudh Venkataramanan  * Returns 0 if stop is not needed
14792b245cb2SAnirudh Venkataramanan  */
14802b245cb2SAnirudh Venkataramanan static int ice_maybe_stop_tx(struct ice_ring *tx_ring, unsigned int size)
14812b245cb2SAnirudh Venkataramanan {
14822b245cb2SAnirudh Venkataramanan 	if (likely(ICE_DESC_UNUSED(tx_ring) >= size))
14832b245cb2SAnirudh Venkataramanan 		return 0;
1484d337f2afSAnirudh Venkataramanan 
14852b245cb2SAnirudh Venkataramanan 	return __ice_maybe_stop_tx(tx_ring, size);
14862b245cb2SAnirudh Venkataramanan }
14872b245cb2SAnirudh Venkataramanan 
14882b245cb2SAnirudh Venkataramanan /**
14892b245cb2SAnirudh Venkataramanan  * ice_tx_map - Build the Tx descriptor
14902b245cb2SAnirudh Venkataramanan  * @tx_ring: ring to send buffer on
14912b245cb2SAnirudh Venkataramanan  * @first: first buffer info buffer to use
1492d76a60baSAnirudh Venkataramanan  * @off: pointer to struct that holds offload parameters
14932b245cb2SAnirudh Venkataramanan  *
14942b245cb2SAnirudh Venkataramanan  * This function loops over the skb data pointed to by *first
14952b245cb2SAnirudh Venkataramanan  * and gets a physical address for each memory location and programs
14962b245cb2SAnirudh Venkataramanan  * it and the length into the transmit descriptor.
14972b245cb2SAnirudh Venkataramanan  */
1498d76a60baSAnirudh Venkataramanan static void
1499d76a60baSAnirudh Venkataramanan ice_tx_map(struct ice_ring *tx_ring, struct ice_tx_buf *first,
1500d76a60baSAnirudh Venkataramanan 	   struct ice_tx_offload_params *off)
15012b245cb2SAnirudh Venkataramanan {
1502d76a60baSAnirudh Venkataramanan 	u64 td_offset, td_tag, td_cmd;
15032b245cb2SAnirudh Venkataramanan 	u16 i = tx_ring->next_to_use;
15042b245cb2SAnirudh Venkataramanan 	unsigned int data_len, size;
15052b245cb2SAnirudh Venkataramanan 	struct ice_tx_desc *tx_desc;
15062b245cb2SAnirudh Venkataramanan 	struct ice_tx_buf *tx_buf;
15072b245cb2SAnirudh Venkataramanan 	struct sk_buff *skb;
15084ee656bbSTony Nguyen 	skb_frag_t *frag;
15092b245cb2SAnirudh Venkataramanan 	dma_addr_t dma;
15102b245cb2SAnirudh Venkataramanan 
1511d76a60baSAnirudh Venkataramanan 	td_tag = off->td_l2tag1;
1512d76a60baSAnirudh Venkataramanan 	td_cmd = off->td_cmd;
1513d76a60baSAnirudh Venkataramanan 	td_offset = off->td_offset;
15142b245cb2SAnirudh Venkataramanan 	skb = first->skb;
15152b245cb2SAnirudh Venkataramanan 
15162b245cb2SAnirudh Venkataramanan 	data_len = skb->data_len;
15172b245cb2SAnirudh Venkataramanan 	size = skb_headlen(skb);
15182b245cb2SAnirudh Venkataramanan 
15192b245cb2SAnirudh Venkataramanan 	tx_desc = ICE_TX_DESC(tx_ring, i);
15202b245cb2SAnirudh Venkataramanan 
1521d76a60baSAnirudh Venkataramanan 	if (first->tx_flags & ICE_TX_FLAGS_HW_VLAN) {
1522d76a60baSAnirudh Venkataramanan 		td_cmd |= (u64)ICE_TX_DESC_CMD_IL2TAG1;
1523d76a60baSAnirudh Venkataramanan 		td_tag = (first->tx_flags & ICE_TX_FLAGS_VLAN_M) >>
1524d76a60baSAnirudh Venkataramanan 			  ICE_TX_FLAGS_VLAN_S;
1525d76a60baSAnirudh Venkataramanan 	}
1526d76a60baSAnirudh Venkataramanan 
15272b245cb2SAnirudh Venkataramanan 	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
15282b245cb2SAnirudh Venkataramanan 
15292b245cb2SAnirudh Venkataramanan 	tx_buf = first;
15302b245cb2SAnirudh Venkataramanan 
15312b245cb2SAnirudh Venkataramanan 	for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
15322b245cb2SAnirudh Venkataramanan 		unsigned int max_data = ICE_MAX_DATA_PER_TXD_ALIGNED;
15332b245cb2SAnirudh Venkataramanan 
15342b245cb2SAnirudh Venkataramanan 		if (dma_mapping_error(tx_ring->dev, dma))
15352b245cb2SAnirudh Venkataramanan 			goto dma_error;
15362b245cb2SAnirudh Venkataramanan 
15372b245cb2SAnirudh Venkataramanan 		/* record length, and DMA address */
15382b245cb2SAnirudh Venkataramanan 		dma_unmap_len_set(tx_buf, len, size);
15392b245cb2SAnirudh Venkataramanan 		dma_unmap_addr_set(tx_buf, dma, dma);
15402b245cb2SAnirudh Venkataramanan 
15412b245cb2SAnirudh Venkataramanan 		/* align size to end of page */
15422b245cb2SAnirudh Venkataramanan 		max_data += -dma & (ICE_MAX_READ_REQ_SIZE - 1);
15432b245cb2SAnirudh Venkataramanan 		tx_desc->buf_addr = cpu_to_le64(dma);
15442b245cb2SAnirudh Venkataramanan 
15452b245cb2SAnirudh Venkataramanan 		/* account for data chunks larger than the hardware
15462b245cb2SAnirudh Venkataramanan 		 * can handle
15472b245cb2SAnirudh Venkataramanan 		 */
15482b245cb2SAnirudh Venkataramanan 		while (unlikely(size > ICE_MAX_DATA_PER_TXD)) {
15492b245cb2SAnirudh Venkataramanan 			tx_desc->cmd_type_offset_bsz =
15505757cc7cSTony Nguyen 				ice_build_ctob(td_cmd, td_offset, max_data,
15515757cc7cSTony Nguyen 					       td_tag);
15522b245cb2SAnirudh Venkataramanan 
15532b245cb2SAnirudh Venkataramanan 			tx_desc++;
15542b245cb2SAnirudh Venkataramanan 			i++;
15552b245cb2SAnirudh Venkataramanan 
15562b245cb2SAnirudh Venkataramanan 			if (i == tx_ring->count) {
15572b245cb2SAnirudh Venkataramanan 				tx_desc = ICE_TX_DESC(tx_ring, 0);
15582b245cb2SAnirudh Venkataramanan 				i = 0;
15592b245cb2SAnirudh Venkataramanan 			}
15602b245cb2SAnirudh Venkataramanan 
15612b245cb2SAnirudh Venkataramanan 			dma += max_data;
15622b245cb2SAnirudh Venkataramanan 			size -= max_data;
15632b245cb2SAnirudh Venkataramanan 
15642b245cb2SAnirudh Venkataramanan 			max_data = ICE_MAX_DATA_PER_TXD_ALIGNED;
15652b245cb2SAnirudh Venkataramanan 			tx_desc->buf_addr = cpu_to_le64(dma);
15662b245cb2SAnirudh Venkataramanan 		}
15672b245cb2SAnirudh Venkataramanan 
15682b245cb2SAnirudh Venkataramanan 		if (likely(!data_len))
15692b245cb2SAnirudh Venkataramanan 			break;
15702b245cb2SAnirudh Venkataramanan 
15715757cc7cSTony Nguyen 		tx_desc->cmd_type_offset_bsz = ice_build_ctob(td_cmd, td_offset,
15722b245cb2SAnirudh Venkataramanan 							      size, td_tag);
15732b245cb2SAnirudh Venkataramanan 
15742b245cb2SAnirudh Venkataramanan 		tx_desc++;
15752b245cb2SAnirudh Venkataramanan 		i++;
15762b245cb2SAnirudh Venkataramanan 
15772b245cb2SAnirudh Venkataramanan 		if (i == tx_ring->count) {
15782b245cb2SAnirudh Venkataramanan 			tx_desc = ICE_TX_DESC(tx_ring, 0);
15792b245cb2SAnirudh Venkataramanan 			i = 0;
15802b245cb2SAnirudh Venkataramanan 		}
15812b245cb2SAnirudh Venkataramanan 
15822b245cb2SAnirudh Venkataramanan 		size = skb_frag_size(frag);
15832b245cb2SAnirudh Venkataramanan 		data_len -= size;
15842b245cb2SAnirudh Venkataramanan 
15852b245cb2SAnirudh Venkataramanan 		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
15862b245cb2SAnirudh Venkataramanan 				       DMA_TO_DEVICE);
15872b245cb2SAnirudh Venkataramanan 
15882b245cb2SAnirudh Venkataramanan 		tx_buf = &tx_ring->tx_buf[i];
15892b245cb2SAnirudh Venkataramanan 	}
15902b245cb2SAnirudh Venkataramanan 
15912b245cb2SAnirudh Venkataramanan 	/* record bytecount for BQL */
15922b245cb2SAnirudh Venkataramanan 	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
15932b245cb2SAnirudh Venkataramanan 
15942b245cb2SAnirudh Venkataramanan 	/* record SW timestamp if HW timestamp is not available */
15952b245cb2SAnirudh Venkataramanan 	skb_tx_timestamp(first->skb);
15962b245cb2SAnirudh Venkataramanan 
15972b245cb2SAnirudh Venkataramanan 	i++;
15982b245cb2SAnirudh Venkataramanan 	if (i == tx_ring->count)
15992b245cb2SAnirudh Venkataramanan 		i = 0;
16002b245cb2SAnirudh Venkataramanan 
16012b245cb2SAnirudh Venkataramanan 	/* write last descriptor with RS and EOP bits */
1602efc2214bSMaciej Fijalkowski 	td_cmd |= (u64)ICE_TXD_LAST_DESC_CMD;
16035757cc7cSTony Nguyen 	tx_desc->cmd_type_offset_bsz =
16045757cc7cSTony Nguyen 			ice_build_ctob(td_cmd, td_offset, size, td_tag);
16052b245cb2SAnirudh Venkataramanan 
16062b245cb2SAnirudh Venkataramanan 	/* Force memory writes to complete before letting h/w know there
16072b245cb2SAnirudh Venkataramanan 	 * are new descriptors to fetch.
16082b245cb2SAnirudh Venkataramanan 	 *
16092b245cb2SAnirudh Venkataramanan 	 * We also use this memory barrier to make certain all of the
16102b245cb2SAnirudh Venkataramanan 	 * status bits have been updated before next_to_watch is written.
16112b245cb2SAnirudh Venkataramanan 	 */
16122b245cb2SAnirudh Venkataramanan 	wmb();
16132b245cb2SAnirudh Venkataramanan 
16142b245cb2SAnirudh Venkataramanan 	/* set next_to_watch value indicating a packet is present */
16152b245cb2SAnirudh Venkataramanan 	first->next_to_watch = tx_desc;
16162b245cb2SAnirudh Venkataramanan 
16172b245cb2SAnirudh Venkataramanan 	tx_ring->next_to_use = i;
16182b245cb2SAnirudh Venkataramanan 
16192b245cb2SAnirudh Venkataramanan 	ice_maybe_stop_tx(tx_ring, DESC_NEEDED);
16202b245cb2SAnirudh Venkataramanan 
16212b245cb2SAnirudh Venkataramanan 	/* notify HW of packet */
16224ee656bbSTony Nguyen 	if (netif_xmit_stopped(txring_txq(tx_ring)) || !netdev_xmit_more())
16232b245cb2SAnirudh Venkataramanan 		writel(i, tx_ring->tail);
16242b245cb2SAnirudh Venkataramanan 
16252b245cb2SAnirudh Venkataramanan 	return;
16262b245cb2SAnirudh Venkataramanan 
16272b245cb2SAnirudh Venkataramanan dma_error:
16282f2da36eSAnirudh Venkataramanan 	/* clear DMA mappings for failed tx_buf map */
16292b245cb2SAnirudh Venkataramanan 	for (;;) {
16302b245cb2SAnirudh Venkataramanan 		tx_buf = &tx_ring->tx_buf[i];
16312b245cb2SAnirudh Venkataramanan 		ice_unmap_and_free_tx_buf(tx_ring, tx_buf);
16322b245cb2SAnirudh Venkataramanan 		if (tx_buf == first)
16332b245cb2SAnirudh Venkataramanan 			break;
16342b245cb2SAnirudh Venkataramanan 		if (i == 0)
16352b245cb2SAnirudh Venkataramanan 			i = tx_ring->count;
16362b245cb2SAnirudh Venkataramanan 		i--;
16372b245cb2SAnirudh Venkataramanan 	}
16382b245cb2SAnirudh Venkataramanan 
16392b245cb2SAnirudh Venkataramanan 	tx_ring->next_to_use = i;
16402b245cb2SAnirudh Venkataramanan }
16412b245cb2SAnirudh Venkataramanan 
16422b245cb2SAnirudh Venkataramanan /**
1643d76a60baSAnirudh Venkataramanan  * ice_tx_csum - Enable Tx checksum offloads
1644d76a60baSAnirudh Venkataramanan  * @first: pointer to the first descriptor
1645d76a60baSAnirudh Venkataramanan  * @off: pointer to struct that holds offload parameters
1646d76a60baSAnirudh Venkataramanan  *
1647d76a60baSAnirudh Venkataramanan  * Returns 0 or error (negative) if checksum offload can't happen, 1 otherwise.
1648d76a60baSAnirudh Venkataramanan  */
1649d76a60baSAnirudh Venkataramanan static
1650d76a60baSAnirudh Venkataramanan int ice_tx_csum(struct ice_tx_buf *first, struct ice_tx_offload_params *off)
1651d76a60baSAnirudh Venkataramanan {
1652d76a60baSAnirudh Venkataramanan 	u32 l4_len = 0, l3_len = 0, l2_len = 0;
1653d76a60baSAnirudh Venkataramanan 	struct sk_buff *skb = first->skb;
1654d76a60baSAnirudh Venkataramanan 	union {
1655d76a60baSAnirudh Venkataramanan 		struct iphdr *v4;
1656d76a60baSAnirudh Venkataramanan 		struct ipv6hdr *v6;
1657d76a60baSAnirudh Venkataramanan 		unsigned char *hdr;
1658d76a60baSAnirudh Venkataramanan 	} ip;
1659d76a60baSAnirudh Venkataramanan 	union {
1660d76a60baSAnirudh Venkataramanan 		struct tcphdr *tcp;
1661d76a60baSAnirudh Venkataramanan 		unsigned char *hdr;
1662d76a60baSAnirudh Venkataramanan 	} l4;
1663d76a60baSAnirudh Venkataramanan 	__be16 frag_off, protocol;
1664d76a60baSAnirudh Venkataramanan 	unsigned char *exthdr;
1665d76a60baSAnirudh Venkataramanan 	u32 offset, cmd = 0;
1666d76a60baSAnirudh Venkataramanan 	u8 l4_proto = 0;
1667d76a60baSAnirudh Venkataramanan 
1668d76a60baSAnirudh Venkataramanan 	if (skb->ip_summed != CHECKSUM_PARTIAL)
1669d76a60baSAnirudh Venkataramanan 		return 0;
1670d76a60baSAnirudh Venkataramanan 
1671d76a60baSAnirudh Venkataramanan 	ip.hdr = skb_network_header(skb);
1672d76a60baSAnirudh Venkataramanan 	l4.hdr = skb_transport_header(skb);
1673d76a60baSAnirudh Venkataramanan 
1674d76a60baSAnirudh Venkataramanan 	/* compute outer L2 header size */
1675d76a60baSAnirudh Venkataramanan 	l2_len = ip.hdr - skb->data;
1676d76a60baSAnirudh Venkataramanan 	offset = (l2_len / 2) << ICE_TX_DESC_LEN_MACLEN_S;
1677d76a60baSAnirudh Venkataramanan 
1678a4e82a81STony Nguyen 	protocol = vlan_get_protocol(skb);
1679a4e82a81STony Nguyen 
1680a4e82a81STony Nguyen 	if (protocol == htons(ETH_P_IP))
1681a4e82a81STony Nguyen 		first->tx_flags |= ICE_TX_FLAGS_IPV4;
1682a4e82a81STony Nguyen 	else if (protocol == htons(ETH_P_IPV6))
1683a4e82a81STony Nguyen 		first->tx_flags |= ICE_TX_FLAGS_IPV6;
1684a4e82a81STony Nguyen 
1685a4e82a81STony Nguyen 	if (skb->encapsulation) {
1686a4e82a81STony Nguyen 		bool gso_ena = false;
1687a4e82a81STony Nguyen 		u32 tunnel = 0;
1688a4e82a81STony Nguyen 
1689a4e82a81STony Nguyen 		/* define outer network header type */
1690a4e82a81STony Nguyen 		if (first->tx_flags & ICE_TX_FLAGS_IPV4) {
1691a4e82a81STony Nguyen 			tunnel |= (first->tx_flags & ICE_TX_FLAGS_TSO) ?
1692a4e82a81STony Nguyen 				  ICE_TX_CTX_EIPT_IPV4 :
1693a4e82a81STony Nguyen 				  ICE_TX_CTX_EIPT_IPV4_NO_CSUM;
1694a4e82a81STony Nguyen 			l4_proto = ip.v4->protocol;
1695a4e82a81STony Nguyen 		} else if (first->tx_flags & ICE_TX_FLAGS_IPV6) {
16961b0b0b58SNick Nunley 			int ret;
16971b0b0b58SNick Nunley 
1698a4e82a81STony Nguyen 			tunnel |= ICE_TX_CTX_EIPT_IPV6;
1699a4e82a81STony Nguyen 			exthdr = ip.hdr + sizeof(*ip.v6);
1700a4e82a81STony Nguyen 			l4_proto = ip.v6->nexthdr;
17011b0b0b58SNick Nunley 			ret = ipv6_skip_exthdr(skb, exthdr - skb->data,
1702a4e82a81STony Nguyen 					       &l4_proto, &frag_off);
17031b0b0b58SNick Nunley 			if (ret < 0)
17041b0b0b58SNick Nunley 				return -1;
1705a4e82a81STony Nguyen 		}
1706a4e82a81STony Nguyen 
1707a4e82a81STony Nguyen 		/* define outer transport */
1708a4e82a81STony Nguyen 		switch (l4_proto) {
1709a4e82a81STony Nguyen 		case IPPROTO_UDP:
1710a4e82a81STony Nguyen 			tunnel |= ICE_TXD_CTX_UDP_TUNNELING;
1711a4e82a81STony Nguyen 			first->tx_flags |= ICE_TX_FLAGS_TUNNEL;
1712a4e82a81STony Nguyen 			break;
1713a4e82a81STony Nguyen 		case IPPROTO_GRE:
1714a4e82a81STony Nguyen 			tunnel |= ICE_TXD_CTX_GRE_TUNNELING;
1715a4e82a81STony Nguyen 			first->tx_flags |= ICE_TX_FLAGS_TUNNEL;
1716a4e82a81STony Nguyen 			break;
1717a4e82a81STony Nguyen 		case IPPROTO_IPIP:
1718a4e82a81STony Nguyen 		case IPPROTO_IPV6:
1719a4e82a81STony Nguyen 			first->tx_flags |= ICE_TX_FLAGS_TUNNEL;
1720a4e82a81STony Nguyen 			l4.hdr = skb_inner_network_header(skb);
1721a4e82a81STony Nguyen 			break;
1722a4e82a81STony Nguyen 		default:
1723a4e82a81STony Nguyen 			if (first->tx_flags & ICE_TX_FLAGS_TSO)
1724d76a60baSAnirudh Venkataramanan 				return -1;
1725d76a60baSAnirudh Venkataramanan 
1726a4e82a81STony Nguyen 			skb_checksum_help(skb);
1727a4e82a81STony Nguyen 			return 0;
1728a4e82a81STony Nguyen 		}
1729a4e82a81STony Nguyen 
1730a4e82a81STony Nguyen 		/* compute outer L3 header size */
1731a4e82a81STony Nguyen 		tunnel |= ((l4.hdr - ip.hdr) / 4) <<
1732a4e82a81STony Nguyen 			  ICE_TXD_CTX_QW0_EIPLEN_S;
1733a4e82a81STony Nguyen 
1734a4e82a81STony Nguyen 		/* switch IP header pointer from outer to inner header */
1735a4e82a81STony Nguyen 		ip.hdr = skb_inner_network_header(skb);
1736a4e82a81STony Nguyen 
1737a4e82a81STony Nguyen 		/* compute tunnel header size */
1738a4e82a81STony Nguyen 		tunnel |= ((ip.hdr - l4.hdr) / 2) <<
1739a4e82a81STony Nguyen 			   ICE_TXD_CTX_QW0_NATLEN_S;
1740a4e82a81STony Nguyen 
1741a4e82a81STony Nguyen 		gso_ena = skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL;
1742a4e82a81STony Nguyen 		/* indicate if we need to offload outer UDP header */
1743a4e82a81STony Nguyen 		if ((first->tx_flags & ICE_TX_FLAGS_TSO) && !gso_ena &&
1744a4e82a81STony Nguyen 		    (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM))
1745a4e82a81STony Nguyen 			tunnel |= ICE_TXD_CTX_QW0_L4T_CS_M;
1746a4e82a81STony Nguyen 
1747a4e82a81STony Nguyen 		/* record tunnel offload values */
1748a4e82a81STony Nguyen 		off->cd_tunnel_params |= tunnel;
1749a4e82a81STony Nguyen 
1750a4e82a81STony Nguyen 		/* set DTYP=1 to indicate that it's an Tx context descriptor
1751a4e82a81STony Nguyen 		 * in IPsec tunnel mode with Tx offloads in Quad word 1
1752a4e82a81STony Nguyen 		 */
1753a4e82a81STony Nguyen 		off->cd_qw1 |= (u64)ICE_TX_DESC_DTYPE_CTX;
1754a4e82a81STony Nguyen 
1755a4e82a81STony Nguyen 		/* switch L4 header pointer from outer to inner */
1756a4e82a81STony Nguyen 		l4.hdr = skb_inner_transport_header(skb);
1757a4e82a81STony Nguyen 		l4_proto = 0;
1758a4e82a81STony Nguyen 
1759a4e82a81STony Nguyen 		/* reset type as we transition from outer to inner headers */
1760a4e82a81STony Nguyen 		first->tx_flags &= ~(ICE_TX_FLAGS_IPV4 | ICE_TX_FLAGS_IPV6);
1761a4e82a81STony Nguyen 		if (ip.v4->version == 4)
1762a4e82a81STony Nguyen 			first->tx_flags |= ICE_TX_FLAGS_IPV4;
1763a4e82a81STony Nguyen 		if (ip.v6->version == 6)
1764a4e82a81STony Nguyen 			first->tx_flags |= ICE_TX_FLAGS_IPV6;
1765a4e82a81STony Nguyen 	}
1766a4e82a81STony Nguyen 
1767d76a60baSAnirudh Venkataramanan 	/* Enable IP checksum offloads */
1768a4e82a81STony Nguyen 	if (first->tx_flags & ICE_TX_FLAGS_IPV4) {
1769d76a60baSAnirudh Venkataramanan 		l4_proto = ip.v4->protocol;
1770d76a60baSAnirudh Venkataramanan 		/* the stack computes the IP header already, the only time we
1771d76a60baSAnirudh Venkataramanan 		 * need the hardware to recompute it is in the case of TSO.
1772d76a60baSAnirudh Venkataramanan 		 */
1773d76a60baSAnirudh Venkataramanan 		if (first->tx_flags & ICE_TX_FLAGS_TSO)
1774d76a60baSAnirudh Venkataramanan 			cmd |= ICE_TX_DESC_CMD_IIPT_IPV4_CSUM;
1775d76a60baSAnirudh Venkataramanan 		else
1776d76a60baSAnirudh Venkataramanan 			cmd |= ICE_TX_DESC_CMD_IIPT_IPV4;
1777d76a60baSAnirudh Venkataramanan 
1778a4e82a81STony Nguyen 	} else if (first->tx_flags & ICE_TX_FLAGS_IPV6) {
1779d76a60baSAnirudh Venkataramanan 		cmd |= ICE_TX_DESC_CMD_IIPT_IPV6;
1780d76a60baSAnirudh Venkataramanan 		exthdr = ip.hdr + sizeof(*ip.v6);
1781d76a60baSAnirudh Venkataramanan 		l4_proto = ip.v6->nexthdr;
1782d76a60baSAnirudh Venkataramanan 		if (l4.hdr != exthdr)
1783d76a60baSAnirudh Venkataramanan 			ipv6_skip_exthdr(skb, exthdr - skb->data, &l4_proto,
1784d76a60baSAnirudh Venkataramanan 					 &frag_off);
1785d76a60baSAnirudh Venkataramanan 	} else {
1786d76a60baSAnirudh Venkataramanan 		return -1;
1787d76a60baSAnirudh Venkataramanan 	}
1788d76a60baSAnirudh Venkataramanan 
1789d76a60baSAnirudh Venkataramanan 	/* compute inner L3 header size */
1790d76a60baSAnirudh Venkataramanan 	l3_len = l4.hdr - ip.hdr;
1791d76a60baSAnirudh Venkataramanan 	offset |= (l3_len / 4) << ICE_TX_DESC_LEN_IPLEN_S;
1792d76a60baSAnirudh Venkataramanan 
1793d76a60baSAnirudh Venkataramanan 	/* Enable L4 checksum offloads */
1794d76a60baSAnirudh Venkataramanan 	switch (l4_proto) {
1795d76a60baSAnirudh Venkataramanan 	case IPPROTO_TCP:
1796d76a60baSAnirudh Venkataramanan 		/* enable checksum offloads */
1797d76a60baSAnirudh Venkataramanan 		cmd |= ICE_TX_DESC_CMD_L4T_EOFT_TCP;
1798d76a60baSAnirudh Venkataramanan 		l4_len = l4.tcp->doff;
1799d76a60baSAnirudh Venkataramanan 		offset |= l4_len << ICE_TX_DESC_LEN_L4_LEN_S;
1800d76a60baSAnirudh Venkataramanan 		break;
1801d76a60baSAnirudh Venkataramanan 	case IPPROTO_UDP:
1802d76a60baSAnirudh Venkataramanan 		/* enable UDP checksum offload */
1803d76a60baSAnirudh Venkataramanan 		cmd |= ICE_TX_DESC_CMD_L4T_EOFT_UDP;
1804d76a60baSAnirudh Venkataramanan 		l4_len = (sizeof(struct udphdr) >> 2);
1805d76a60baSAnirudh Venkataramanan 		offset |= l4_len << ICE_TX_DESC_LEN_L4_LEN_S;
1806d76a60baSAnirudh Venkataramanan 		break;
1807d76a60baSAnirudh Venkataramanan 	case IPPROTO_SCTP:
1808cf909e19SAnirudh Venkataramanan 		/* enable SCTP checksum offload */
1809cf909e19SAnirudh Venkataramanan 		cmd |= ICE_TX_DESC_CMD_L4T_EOFT_SCTP;
1810cf909e19SAnirudh Venkataramanan 		l4_len = sizeof(struct sctphdr) >> 2;
1811cf909e19SAnirudh Venkataramanan 		offset |= l4_len << ICE_TX_DESC_LEN_L4_LEN_S;
1812cf909e19SAnirudh Venkataramanan 		break;
1813cf909e19SAnirudh Venkataramanan 
1814d76a60baSAnirudh Venkataramanan 	default:
1815d76a60baSAnirudh Venkataramanan 		if (first->tx_flags & ICE_TX_FLAGS_TSO)
1816d76a60baSAnirudh Venkataramanan 			return -1;
1817d76a60baSAnirudh Venkataramanan 		skb_checksum_help(skb);
1818d76a60baSAnirudh Venkataramanan 		return 0;
1819d76a60baSAnirudh Venkataramanan 	}
1820d76a60baSAnirudh Venkataramanan 
1821d76a60baSAnirudh Venkataramanan 	off->td_cmd |= cmd;
1822d76a60baSAnirudh Venkataramanan 	off->td_offset |= offset;
1823d76a60baSAnirudh Venkataramanan 	return 1;
1824d76a60baSAnirudh Venkataramanan }
1825d76a60baSAnirudh Venkataramanan 
1826d76a60baSAnirudh Venkataramanan /**
1827f9867df6SAnirudh Venkataramanan  * ice_tx_prepare_vlan_flags - prepare generic Tx VLAN tagging flags for HW
1828d76a60baSAnirudh Venkataramanan  * @tx_ring: ring to send buffer on
1829d76a60baSAnirudh Venkataramanan  * @first: pointer to struct ice_tx_buf
1830d76a60baSAnirudh Venkataramanan  *
1831d76a60baSAnirudh Venkataramanan  * Checks the skb and set up correspondingly several generic transmit flags
1832d76a60baSAnirudh Venkataramanan  * related to VLAN tagging for the HW, such as VLAN, DCB, etc.
1833d76a60baSAnirudh Venkataramanan  */
18342bb19d6eSBrett Creeley static void
1835d76a60baSAnirudh Venkataramanan ice_tx_prepare_vlan_flags(struct ice_ring *tx_ring, struct ice_tx_buf *first)
1836d76a60baSAnirudh Venkataramanan {
1837d76a60baSAnirudh Venkataramanan 	struct sk_buff *skb = first->skb;
1838d76a60baSAnirudh Venkataramanan 
18392bb19d6eSBrett Creeley 	/* nothing left to do, software offloaded VLAN */
18402bb19d6eSBrett Creeley 	if (!skb_vlan_tag_present(skb) && eth_type_vlan(skb->protocol))
18412bb19d6eSBrett Creeley 		return;
18422bb19d6eSBrett Creeley 
18432bb19d6eSBrett Creeley 	/* currently, we always assume 802.1Q for VLAN insertion as VLAN
18442bb19d6eSBrett Creeley 	 * insertion for 802.1AD is not supported
1845d76a60baSAnirudh Venkataramanan 	 */
1846d76a60baSAnirudh Venkataramanan 	if (skb_vlan_tag_present(skb)) {
1847d76a60baSAnirudh Venkataramanan 		first->tx_flags |= skb_vlan_tag_get(skb) << ICE_TX_FLAGS_VLAN_S;
1848d76a60baSAnirudh Venkataramanan 		first->tx_flags |= ICE_TX_FLAGS_HW_VLAN;
1849d76a60baSAnirudh Venkataramanan 	}
1850d76a60baSAnirudh Venkataramanan 
18512bb19d6eSBrett Creeley 	ice_tx_prepare_vlan_flags_dcb(tx_ring, first);
1852d76a60baSAnirudh Venkataramanan }
1853d76a60baSAnirudh Venkataramanan 
1854d76a60baSAnirudh Venkataramanan /**
1855d76a60baSAnirudh Venkataramanan  * ice_tso - computes mss and TSO length to prepare for TSO
1856d76a60baSAnirudh Venkataramanan  * @first: pointer to struct ice_tx_buf
1857d76a60baSAnirudh Venkataramanan  * @off: pointer to struct that holds offload parameters
1858d76a60baSAnirudh Venkataramanan  *
1859d76a60baSAnirudh Venkataramanan  * Returns 0 or error (negative) if TSO can't happen, 1 otherwise.
1860d76a60baSAnirudh Venkataramanan  */
1861d76a60baSAnirudh Venkataramanan static
1862d76a60baSAnirudh Venkataramanan int ice_tso(struct ice_tx_buf *first, struct ice_tx_offload_params *off)
1863d76a60baSAnirudh Venkataramanan {
1864d76a60baSAnirudh Venkataramanan 	struct sk_buff *skb = first->skb;
1865d76a60baSAnirudh Venkataramanan 	union {
1866d76a60baSAnirudh Venkataramanan 		struct iphdr *v4;
1867d76a60baSAnirudh Venkataramanan 		struct ipv6hdr *v6;
1868d76a60baSAnirudh Venkataramanan 		unsigned char *hdr;
1869d76a60baSAnirudh Venkataramanan 	} ip;
1870d76a60baSAnirudh Venkataramanan 	union {
1871d76a60baSAnirudh Venkataramanan 		struct tcphdr *tcp;
1872a54e3b8cSBrett Creeley 		struct udphdr *udp;
1873d76a60baSAnirudh Venkataramanan 		unsigned char *hdr;
1874d76a60baSAnirudh Venkataramanan 	} l4;
1875d76a60baSAnirudh Venkataramanan 	u64 cd_mss, cd_tso_len;
187688865fc4SKarol Kolacinski 	u32 paylen;
187788865fc4SKarol Kolacinski 	u8 l4_start;
1878d76a60baSAnirudh Venkataramanan 	int err;
1879d76a60baSAnirudh Venkataramanan 
1880d76a60baSAnirudh Venkataramanan 	if (skb->ip_summed != CHECKSUM_PARTIAL)
1881d76a60baSAnirudh Venkataramanan 		return 0;
1882d76a60baSAnirudh Venkataramanan 
1883d76a60baSAnirudh Venkataramanan 	if (!skb_is_gso(skb))
1884d76a60baSAnirudh Venkataramanan 		return 0;
1885d76a60baSAnirudh Venkataramanan 
1886d76a60baSAnirudh Venkataramanan 	err = skb_cow_head(skb, 0);
1887d76a60baSAnirudh Venkataramanan 	if (err < 0)
1888d76a60baSAnirudh Venkataramanan 		return err;
1889d76a60baSAnirudh Venkataramanan 
1890c3a6825eSBruce Allan 	/* cppcheck-suppress unreadVariable */
1891d76a60baSAnirudh Venkataramanan 	ip.hdr = skb_network_header(skb);
1892d76a60baSAnirudh Venkataramanan 	l4.hdr = skb_transport_header(skb);
1893d76a60baSAnirudh Venkataramanan 
1894d76a60baSAnirudh Venkataramanan 	/* initialize outer IP header fields */
1895d76a60baSAnirudh Venkataramanan 	if (ip.v4->version == 4) {
1896d76a60baSAnirudh Venkataramanan 		ip.v4->tot_len = 0;
1897d76a60baSAnirudh Venkataramanan 		ip.v4->check = 0;
1898d76a60baSAnirudh Venkataramanan 	} else {
1899d76a60baSAnirudh Venkataramanan 		ip.v6->payload_len = 0;
1900d76a60baSAnirudh Venkataramanan 	}
1901d76a60baSAnirudh Venkataramanan 
1902a4e82a81STony Nguyen 	if (skb_shinfo(skb)->gso_type & (SKB_GSO_GRE |
1903a4e82a81STony Nguyen 					 SKB_GSO_GRE_CSUM |
1904a4e82a81STony Nguyen 					 SKB_GSO_IPXIP4 |
1905a4e82a81STony Nguyen 					 SKB_GSO_IPXIP6 |
1906a4e82a81STony Nguyen 					 SKB_GSO_UDP_TUNNEL |
1907a4e82a81STony Nguyen 					 SKB_GSO_UDP_TUNNEL_CSUM)) {
1908a4e82a81STony Nguyen 		if (!(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) &&
1909a4e82a81STony Nguyen 		    (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM)) {
1910a4e82a81STony Nguyen 			l4.udp->len = 0;
1911a4e82a81STony Nguyen 
1912a4e82a81STony Nguyen 			/* determine offset of outer transport header */
191388865fc4SKarol Kolacinski 			l4_start = (u8)(l4.hdr - skb->data);
1914a4e82a81STony Nguyen 
1915a4e82a81STony Nguyen 			/* remove payload length from outer checksum */
1916a4e82a81STony Nguyen 			paylen = skb->len - l4_start;
1917a4e82a81STony Nguyen 			csum_replace_by_diff(&l4.udp->check,
1918a4e82a81STony Nguyen 					     (__force __wsum)htonl(paylen));
1919a4e82a81STony Nguyen 		}
1920a4e82a81STony Nguyen 
1921a4e82a81STony Nguyen 		/* reset pointers to inner headers */
1922a4e82a81STony Nguyen 
1923a4e82a81STony Nguyen 		/* cppcheck-suppress unreadVariable */
1924a4e82a81STony Nguyen 		ip.hdr = skb_inner_network_header(skb);
1925a4e82a81STony Nguyen 		l4.hdr = skb_inner_transport_header(skb);
1926a4e82a81STony Nguyen 
1927a4e82a81STony Nguyen 		/* initialize inner IP header fields */
1928a4e82a81STony Nguyen 		if (ip.v4->version == 4) {
1929a4e82a81STony Nguyen 			ip.v4->tot_len = 0;
1930a4e82a81STony Nguyen 			ip.v4->check = 0;
1931a4e82a81STony Nguyen 		} else {
1932a4e82a81STony Nguyen 			ip.v6->payload_len = 0;
1933a4e82a81STony Nguyen 		}
1934a4e82a81STony Nguyen 	}
1935a4e82a81STony Nguyen 
1936d76a60baSAnirudh Venkataramanan 	/* determine offset of transport header */
193788865fc4SKarol Kolacinski 	l4_start = (u8)(l4.hdr - skb->data);
1938d76a60baSAnirudh Venkataramanan 
1939d76a60baSAnirudh Venkataramanan 	/* remove payload length from checksum */
1940d76a60baSAnirudh Venkataramanan 	paylen = skb->len - l4_start;
1941d76a60baSAnirudh Venkataramanan 
1942a54e3b8cSBrett Creeley 	if (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_L4) {
1943a54e3b8cSBrett Creeley 		csum_replace_by_diff(&l4.udp->check,
1944a54e3b8cSBrett Creeley 				     (__force __wsum)htonl(paylen));
1945a54e3b8cSBrett Creeley 		/* compute length of UDP segmentation header */
194688865fc4SKarol Kolacinski 		off->header_len = (u8)sizeof(l4.udp) + l4_start;
1947a54e3b8cSBrett Creeley 	} else {
1948a54e3b8cSBrett Creeley 		csum_replace_by_diff(&l4.tcp->check,
1949a54e3b8cSBrett Creeley 				     (__force __wsum)htonl(paylen));
1950a54e3b8cSBrett Creeley 		/* compute length of TCP segmentation header */
195188865fc4SKarol Kolacinski 		off->header_len = (u8)((l4.tcp->doff * 4) + l4_start);
1952a54e3b8cSBrett Creeley 	}
1953d76a60baSAnirudh Venkataramanan 
1954d76a60baSAnirudh Venkataramanan 	/* update gso_segs and bytecount */
1955d76a60baSAnirudh Venkataramanan 	first->gso_segs = skb_shinfo(skb)->gso_segs;
1956d944b469SBrett Creeley 	first->bytecount += (first->gso_segs - 1) * off->header_len;
1957d76a60baSAnirudh Venkataramanan 
1958d76a60baSAnirudh Venkataramanan 	cd_tso_len = skb->len - off->header_len;
1959d76a60baSAnirudh Venkataramanan 	cd_mss = skb_shinfo(skb)->gso_size;
1960d76a60baSAnirudh Venkataramanan 
1961d76a60baSAnirudh Venkataramanan 	/* record cdesc_qw1 with TSO parameters */
1962e65e9e15SBruce Allan 	off->cd_qw1 |= (u64)(ICE_TX_DESC_DTYPE_CTX |
1963d76a60baSAnirudh Venkataramanan 			     (ICE_TX_CTX_DESC_TSO << ICE_TXD_CTX_QW1_CMD_S) |
1964d76a60baSAnirudh Venkataramanan 			     (cd_tso_len << ICE_TXD_CTX_QW1_TSO_LEN_S) |
1965e65e9e15SBruce Allan 			     (cd_mss << ICE_TXD_CTX_QW1_MSS_S));
1966d76a60baSAnirudh Venkataramanan 	first->tx_flags |= ICE_TX_FLAGS_TSO;
1967d76a60baSAnirudh Venkataramanan 	return 1;
1968d76a60baSAnirudh Venkataramanan }
1969d76a60baSAnirudh Venkataramanan 
1970d76a60baSAnirudh Venkataramanan /**
19712b245cb2SAnirudh Venkataramanan  * ice_txd_use_count  - estimate the number of descriptors needed for Tx
19722b245cb2SAnirudh Venkataramanan  * @size: transmit request size in bytes
19732b245cb2SAnirudh Venkataramanan  *
19742b245cb2SAnirudh Venkataramanan  * Due to hardware alignment restrictions (4K alignment), we need to
19752b245cb2SAnirudh Venkataramanan  * assume that we can have no more than 12K of data per descriptor, even
19762b245cb2SAnirudh Venkataramanan  * though each descriptor can take up to 16K - 1 bytes of aligned memory.
19772b245cb2SAnirudh Venkataramanan  * Thus, we need to divide by 12K. But division is slow! Instead,
19782b245cb2SAnirudh Venkataramanan  * we decompose the operation into shifts and one relatively cheap
19792b245cb2SAnirudh Venkataramanan  * multiply operation.
19802b245cb2SAnirudh Venkataramanan  *
19812b245cb2SAnirudh Venkataramanan  * To divide by 12K, we first divide by 4K, then divide by 3:
19822b245cb2SAnirudh Venkataramanan  *     To divide by 4K, shift right by 12 bits
19832b245cb2SAnirudh Venkataramanan  *     To divide by 3, multiply by 85, then divide by 256
19842b245cb2SAnirudh Venkataramanan  *     (Divide by 256 is done by shifting right by 8 bits)
19852b245cb2SAnirudh Venkataramanan  * Finally, we add one to round up. Because 256 isn't an exact multiple of
19862b245cb2SAnirudh Venkataramanan  * 3, we'll underestimate near each multiple of 12K. This is actually more
19872b245cb2SAnirudh Venkataramanan  * accurate as we have 4K - 1 of wiggle room that we can fit into the last
19882b245cb2SAnirudh Venkataramanan  * segment. For our purposes this is accurate out to 1M which is orders of
19892b245cb2SAnirudh Venkataramanan  * magnitude greater than our largest possible GSO size.
19902b245cb2SAnirudh Venkataramanan  *
19912b245cb2SAnirudh Venkataramanan  * This would then be implemented as:
1992c585ea42SBrett Creeley  *     return (((size >> 12) * 85) >> 8) + ICE_DESCS_FOR_SKB_DATA_PTR;
19932b245cb2SAnirudh Venkataramanan  *
19942b245cb2SAnirudh Venkataramanan  * Since multiplication and division are commutative, we can reorder
19952b245cb2SAnirudh Venkataramanan  * operations into:
1996c585ea42SBrett Creeley  *     return ((size * 85) >> 20) + ICE_DESCS_FOR_SKB_DATA_PTR;
19972b245cb2SAnirudh Venkataramanan  */
19982b245cb2SAnirudh Venkataramanan static unsigned int ice_txd_use_count(unsigned int size)
19992b245cb2SAnirudh Venkataramanan {
2000c585ea42SBrett Creeley 	return ((size * 85) >> 20) + ICE_DESCS_FOR_SKB_DATA_PTR;
20012b245cb2SAnirudh Venkataramanan }
20022b245cb2SAnirudh Venkataramanan 
20032b245cb2SAnirudh Venkataramanan /**
2004d337f2afSAnirudh Venkataramanan  * ice_xmit_desc_count - calculate number of Tx descriptors needed
20052b245cb2SAnirudh Venkataramanan  * @skb: send buffer
20062b245cb2SAnirudh Venkataramanan  *
20072b245cb2SAnirudh Venkataramanan  * Returns number of data descriptors needed for this skb.
20082b245cb2SAnirudh Venkataramanan  */
20092b245cb2SAnirudh Venkataramanan static unsigned int ice_xmit_desc_count(struct sk_buff *skb)
20102b245cb2SAnirudh Venkataramanan {
2011d7840976SMatthew Wilcox (Oracle) 	const skb_frag_t *frag = &skb_shinfo(skb)->frags[0];
20122b245cb2SAnirudh Venkataramanan 	unsigned int nr_frags = skb_shinfo(skb)->nr_frags;
20132b245cb2SAnirudh Venkataramanan 	unsigned int count = 0, size = skb_headlen(skb);
20142b245cb2SAnirudh Venkataramanan 
20152b245cb2SAnirudh Venkataramanan 	for (;;) {
20162b245cb2SAnirudh Venkataramanan 		count += ice_txd_use_count(size);
20172b245cb2SAnirudh Venkataramanan 
20182b245cb2SAnirudh Venkataramanan 		if (!nr_frags--)
20192b245cb2SAnirudh Venkataramanan 			break;
20202b245cb2SAnirudh Venkataramanan 
20212b245cb2SAnirudh Venkataramanan 		size = skb_frag_size(frag++);
20222b245cb2SAnirudh Venkataramanan 	}
20232b245cb2SAnirudh Venkataramanan 
20242b245cb2SAnirudh Venkataramanan 	return count;
20252b245cb2SAnirudh Venkataramanan }
20262b245cb2SAnirudh Venkataramanan 
20272b245cb2SAnirudh Venkataramanan /**
20282b245cb2SAnirudh Venkataramanan  * __ice_chk_linearize - Check if there are more than 8 buffers per packet
20292b245cb2SAnirudh Venkataramanan  * @skb: send buffer
20302b245cb2SAnirudh Venkataramanan  *
20312b245cb2SAnirudh Venkataramanan  * Note: This HW can't DMA more than 8 buffers to build a packet on the wire
20322b245cb2SAnirudh Venkataramanan  * and so we need to figure out the cases where we need to linearize the skb.
20332b245cb2SAnirudh Venkataramanan  *
20342b245cb2SAnirudh Venkataramanan  * For TSO we need to count the TSO header and segment payload separately.
20352b245cb2SAnirudh Venkataramanan  * As such we need to check cases where we have 7 fragments or more as we
20362b245cb2SAnirudh Venkataramanan  * can potentially require 9 DMA transactions, 1 for the TSO header, 1 for
20372b245cb2SAnirudh Venkataramanan  * the segment payload in the first descriptor, and another 7 for the
20382b245cb2SAnirudh Venkataramanan  * fragments.
20392b245cb2SAnirudh Venkataramanan  */
20402b245cb2SAnirudh Venkataramanan static bool __ice_chk_linearize(struct sk_buff *skb)
20412b245cb2SAnirudh Venkataramanan {
2042d7840976SMatthew Wilcox (Oracle) 	const skb_frag_t *frag, *stale;
20432b245cb2SAnirudh Venkataramanan 	int nr_frags, sum;
20442b245cb2SAnirudh Venkataramanan 
20452b245cb2SAnirudh Venkataramanan 	/* no need to check if number of frags is less than 7 */
20462b245cb2SAnirudh Venkataramanan 	nr_frags = skb_shinfo(skb)->nr_frags;
20472b245cb2SAnirudh Venkataramanan 	if (nr_frags < (ICE_MAX_BUF_TXD - 1))
20482b245cb2SAnirudh Venkataramanan 		return false;
20492b245cb2SAnirudh Venkataramanan 
20502b245cb2SAnirudh Venkataramanan 	/* We need to walk through the list and validate that each group
20512b245cb2SAnirudh Venkataramanan 	 * of 6 fragments totals at least gso_size.
20522b245cb2SAnirudh Venkataramanan 	 */
20532b245cb2SAnirudh Venkataramanan 	nr_frags -= ICE_MAX_BUF_TXD - 2;
20542b245cb2SAnirudh Venkataramanan 	frag = &skb_shinfo(skb)->frags[0];
20552b245cb2SAnirudh Venkataramanan 
20562b245cb2SAnirudh Venkataramanan 	/* Initialize size to the negative value of gso_size minus 1. We
20574ee656bbSTony Nguyen 	 * use this as the worst case scenario in which the frag ahead
20582b245cb2SAnirudh Venkataramanan 	 * of us only provides one byte which is why we are limited to 6
20592b245cb2SAnirudh Venkataramanan 	 * descriptors for a single transmit as the header and previous
20602b245cb2SAnirudh Venkataramanan 	 * fragment are already consuming 2 descriptors.
20612b245cb2SAnirudh Venkataramanan 	 */
20622b245cb2SAnirudh Venkataramanan 	sum = 1 - skb_shinfo(skb)->gso_size;
20632b245cb2SAnirudh Venkataramanan 
20642b245cb2SAnirudh Venkataramanan 	/* Add size of frags 0 through 4 to create our initial sum */
20652b245cb2SAnirudh Venkataramanan 	sum += skb_frag_size(frag++);
20662b245cb2SAnirudh Venkataramanan 	sum += skb_frag_size(frag++);
20672b245cb2SAnirudh Venkataramanan 	sum += skb_frag_size(frag++);
20682b245cb2SAnirudh Venkataramanan 	sum += skb_frag_size(frag++);
20692b245cb2SAnirudh Venkataramanan 	sum += skb_frag_size(frag++);
20702b245cb2SAnirudh Venkataramanan 
20712b245cb2SAnirudh Venkataramanan 	/* Walk through fragments adding latest fragment, testing it, and
20722b245cb2SAnirudh Venkataramanan 	 * then removing stale fragments from the sum.
20732b245cb2SAnirudh Venkataramanan 	 */
20740a37abfaSKiran Patil 	for (stale = &skb_shinfo(skb)->frags[0];; stale++) {
20750a37abfaSKiran Patil 		int stale_size = skb_frag_size(stale);
20760a37abfaSKiran Patil 
20772b245cb2SAnirudh Venkataramanan 		sum += skb_frag_size(frag++);
20782b245cb2SAnirudh Venkataramanan 
20790a37abfaSKiran Patil 		/* The stale fragment may present us with a smaller
20800a37abfaSKiran Patil 		 * descriptor than the actual fragment size. To account
20810a37abfaSKiran Patil 		 * for that we need to remove all the data on the front and
20820a37abfaSKiran Patil 		 * figure out what the remainder would be in the last
20830a37abfaSKiran Patil 		 * descriptor associated with the fragment.
20840a37abfaSKiran Patil 		 */
20850a37abfaSKiran Patil 		if (stale_size > ICE_MAX_DATA_PER_TXD) {
20860a37abfaSKiran Patil 			int align_pad = -(skb_frag_off(stale)) &
20870a37abfaSKiran Patil 					(ICE_MAX_READ_REQ_SIZE - 1);
20880a37abfaSKiran Patil 
20890a37abfaSKiran Patil 			sum -= align_pad;
20900a37abfaSKiran Patil 			stale_size -= align_pad;
20910a37abfaSKiran Patil 
20920a37abfaSKiran Patil 			do {
20930a37abfaSKiran Patil 				sum -= ICE_MAX_DATA_PER_TXD_ALIGNED;
20940a37abfaSKiran Patil 				stale_size -= ICE_MAX_DATA_PER_TXD_ALIGNED;
20950a37abfaSKiran Patil 			} while (stale_size > ICE_MAX_DATA_PER_TXD);
20960a37abfaSKiran Patil 		}
20970a37abfaSKiran Patil 
20982b245cb2SAnirudh Venkataramanan 		/* if sum is negative we failed to make sufficient progress */
20992b245cb2SAnirudh Venkataramanan 		if (sum < 0)
21002b245cb2SAnirudh Venkataramanan 			return true;
21012b245cb2SAnirudh Venkataramanan 
21022b245cb2SAnirudh Venkataramanan 		if (!nr_frags--)
21032b245cb2SAnirudh Venkataramanan 			break;
21042b245cb2SAnirudh Venkataramanan 
21050a37abfaSKiran Patil 		sum -= stale_size;
21062b245cb2SAnirudh Venkataramanan 	}
21072b245cb2SAnirudh Venkataramanan 
21082b245cb2SAnirudh Venkataramanan 	return false;
21092b245cb2SAnirudh Venkataramanan }
21102b245cb2SAnirudh Venkataramanan 
21112b245cb2SAnirudh Venkataramanan /**
21122b245cb2SAnirudh Venkataramanan  * ice_chk_linearize - Check if there are more than 8 fragments per packet
21132b245cb2SAnirudh Venkataramanan  * @skb:      send buffer
21142b245cb2SAnirudh Venkataramanan  * @count:    number of buffers used
21152b245cb2SAnirudh Venkataramanan  *
21162b245cb2SAnirudh Venkataramanan  * Note: Our HW can't scatter-gather more than 8 fragments to build
21172b245cb2SAnirudh Venkataramanan  * a packet on the wire and so we need to figure out the cases where we
21182b245cb2SAnirudh Venkataramanan  * need to linearize the skb.
21192b245cb2SAnirudh Venkataramanan  */
21202b245cb2SAnirudh Venkataramanan static bool ice_chk_linearize(struct sk_buff *skb, unsigned int count)
21212b245cb2SAnirudh Venkataramanan {
21222b245cb2SAnirudh Venkataramanan 	/* Both TSO and single send will work if count is less than 8 */
21232b245cb2SAnirudh Venkataramanan 	if (likely(count < ICE_MAX_BUF_TXD))
21242b245cb2SAnirudh Venkataramanan 		return false;
21252b245cb2SAnirudh Venkataramanan 
21262b245cb2SAnirudh Venkataramanan 	if (skb_is_gso(skb))
21272b245cb2SAnirudh Venkataramanan 		return __ice_chk_linearize(skb);
21282b245cb2SAnirudh Venkataramanan 
21292b245cb2SAnirudh Venkataramanan 	/* we can support up to 8 data buffers for a single send */
21302b245cb2SAnirudh Venkataramanan 	return count != ICE_MAX_BUF_TXD;
21312b245cb2SAnirudh Venkataramanan }
21322b245cb2SAnirudh Venkataramanan 
21332b245cb2SAnirudh Venkataramanan /**
21342b245cb2SAnirudh Venkataramanan  * ice_xmit_frame_ring - Sends buffer on Tx ring
21352b245cb2SAnirudh Venkataramanan  * @skb: send buffer
21362b245cb2SAnirudh Venkataramanan  * @tx_ring: ring to send buffer on
21372b245cb2SAnirudh Venkataramanan  *
21382b245cb2SAnirudh Venkataramanan  * Returns NETDEV_TX_OK if sent, else an error code
21392b245cb2SAnirudh Venkataramanan  */
21402b245cb2SAnirudh Venkataramanan static netdev_tx_t
21412b245cb2SAnirudh Venkataramanan ice_xmit_frame_ring(struct sk_buff *skb, struct ice_ring *tx_ring)
21422b245cb2SAnirudh Venkataramanan {
2143d76a60baSAnirudh Venkataramanan 	struct ice_tx_offload_params offload = { 0 };
21440c3a6101SDave Ertman 	struct ice_vsi *vsi = tx_ring->vsi;
21452b245cb2SAnirudh Venkataramanan 	struct ice_tx_buf *first;
21462b245cb2SAnirudh Venkataramanan 	unsigned int count;
2147d76a60baSAnirudh Venkataramanan 	int tso, csum;
21482b245cb2SAnirudh Venkataramanan 
21492b245cb2SAnirudh Venkataramanan 	count = ice_xmit_desc_count(skb);
21502b245cb2SAnirudh Venkataramanan 	if (ice_chk_linearize(skb, count)) {
21512b245cb2SAnirudh Venkataramanan 		if (__skb_linearize(skb))
21522b245cb2SAnirudh Venkataramanan 			goto out_drop;
21532b245cb2SAnirudh Venkataramanan 		count = ice_txd_use_count(skb->len);
21542b245cb2SAnirudh Venkataramanan 		tx_ring->tx_stats.tx_linearize++;
21552b245cb2SAnirudh Venkataramanan 	}
21562b245cb2SAnirudh Venkataramanan 
21572b245cb2SAnirudh Venkataramanan 	/* need: 1 descriptor per page * PAGE_SIZE/ICE_MAX_DATA_PER_TXD,
21582b245cb2SAnirudh Venkataramanan 	 *       + 1 desc for skb_head_len/ICE_MAX_DATA_PER_TXD,
21592b245cb2SAnirudh Venkataramanan 	 *       + 4 desc gap to avoid the cache line where head is,
21602b245cb2SAnirudh Venkataramanan 	 *       + 1 desc for context descriptor,
21612b245cb2SAnirudh Venkataramanan 	 * otherwise try next time
21622b245cb2SAnirudh Venkataramanan 	 */
2163c585ea42SBrett Creeley 	if (ice_maybe_stop_tx(tx_ring, count + ICE_DESCS_PER_CACHE_LINE +
2164c585ea42SBrett Creeley 			      ICE_DESCS_FOR_CTX_DESC)) {
21652b245cb2SAnirudh Venkataramanan 		tx_ring->tx_stats.tx_busy++;
21662b245cb2SAnirudh Venkataramanan 		return NETDEV_TX_BUSY;
21672b245cb2SAnirudh Venkataramanan 	}
21682b245cb2SAnirudh Venkataramanan 
2169d76a60baSAnirudh Venkataramanan 	offload.tx_ring = tx_ring;
2170d76a60baSAnirudh Venkataramanan 
21712b245cb2SAnirudh Venkataramanan 	/* record the location of the first descriptor for this packet */
21722b245cb2SAnirudh Venkataramanan 	first = &tx_ring->tx_buf[tx_ring->next_to_use];
21732b245cb2SAnirudh Venkataramanan 	first->skb = skb;
21742b245cb2SAnirudh Venkataramanan 	first->bytecount = max_t(unsigned int, skb->len, ETH_ZLEN);
21752b245cb2SAnirudh Venkataramanan 	first->gso_segs = 1;
2176d76a60baSAnirudh Venkataramanan 	first->tx_flags = 0;
21772b245cb2SAnirudh Venkataramanan 
2178d76a60baSAnirudh Venkataramanan 	/* prepare the VLAN tagging flags for Tx */
21792bb19d6eSBrett Creeley 	ice_tx_prepare_vlan_flags(tx_ring, first);
2180d76a60baSAnirudh Venkataramanan 
2181d76a60baSAnirudh Venkataramanan 	/* set up TSO offload */
2182d76a60baSAnirudh Venkataramanan 	tso = ice_tso(first, &offload);
2183d76a60baSAnirudh Venkataramanan 	if (tso < 0)
2184d76a60baSAnirudh Venkataramanan 		goto out_drop;
2185d76a60baSAnirudh Venkataramanan 
2186d76a60baSAnirudh Venkataramanan 	/* always set up Tx checksum offload */
2187d76a60baSAnirudh Venkataramanan 	csum = ice_tx_csum(first, &offload);
2188d76a60baSAnirudh Venkataramanan 	if (csum < 0)
2189d76a60baSAnirudh Venkataramanan 		goto out_drop;
2190d76a60baSAnirudh Venkataramanan 
21910c3a6101SDave Ertman 	/* allow CONTROL frames egress from main VSI if FW LLDP disabled */
21920c3a6101SDave Ertman 	if (unlikely(skb->priority == TC_PRIO_CONTROL &&
21930c3a6101SDave Ertman 		     vsi->type == ICE_VSI_PF &&
2194fc2d1165SChinh T Cao 		     vsi->port_info->qos_cfg.is_sw_lldp))
21950c3a6101SDave Ertman 		offload.cd_qw1 |= (u64)(ICE_TX_DESC_DTYPE_CTX |
21960c3a6101SDave Ertman 					ICE_TX_CTX_DESC_SWTCH_UPLINK <<
21970c3a6101SDave Ertman 					ICE_TXD_CTX_QW1_CMD_S);
21980c3a6101SDave Ertman 
21990c3a6101SDave Ertman 	if (offload.cd_qw1 & ICE_TX_DESC_DTYPE_CTX) {
2200d76a60baSAnirudh Venkataramanan 		struct ice_tx_ctx_desc *cdesc;
220188865fc4SKarol Kolacinski 		u16 i = tx_ring->next_to_use;
2202d76a60baSAnirudh Venkataramanan 
2203d76a60baSAnirudh Venkataramanan 		/* grab the next descriptor */
2204d76a60baSAnirudh Venkataramanan 		cdesc = ICE_TX_CTX_DESC(tx_ring, i);
2205d76a60baSAnirudh Venkataramanan 		i++;
2206d76a60baSAnirudh Venkataramanan 		tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
2207d76a60baSAnirudh Venkataramanan 
2208d76a60baSAnirudh Venkataramanan 		/* setup context descriptor */
2209d76a60baSAnirudh Venkataramanan 		cdesc->tunneling_params = cpu_to_le32(offload.cd_tunnel_params);
2210d76a60baSAnirudh Venkataramanan 		cdesc->l2tag2 = cpu_to_le16(offload.cd_l2tag2);
2211d76a60baSAnirudh Venkataramanan 		cdesc->rsvd = cpu_to_le16(0);
2212d76a60baSAnirudh Venkataramanan 		cdesc->qw1 = cpu_to_le64(offload.cd_qw1);
2213d76a60baSAnirudh Venkataramanan 	}
2214d76a60baSAnirudh Venkataramanan 
2215d76a60baSAnirudh Venkataramanan 	ice_tx_map(tx_ring, first, &offload);
22162b245cb2SAnirudh Venkataramanan 	return NETDEV_TX_OK;
22172b245cb2SAnirudh Venkataramanan 
22182b245cb2SAnirudh Venkataramanan out_drop:
22192b245cb2SAnirudh Venkataramanan 	dev_kfree_skb_any(skb);
22202b245cb2SAnirudh Venkataramanan 	return NETDEV_TX_OK;
22212b245cb2SAnirudh Venkataramanan }
22222b245cb2SAnirudh Venkataramanan 
22232b245cb2SAnirudh Venkataramanan /**
22242b245cb2SAnirudh Venkataramanan  * ice_start_xmit - Selects the correct VSI and Tx queue to send buffer
22252b245cb2SAnirudh Venkataramanan  * @skb: send buffer
22262b245cb2SAnirudh Venkataramanan  * @netdev: network interface device structure
22272b245cb2SAnirudh Venkataramanan  *
22282b245cb2SAnirudh Venkataramanan  * Returns NETDEV_TX_OK if sent, else an error code
22292b245cb2SAnirudh Venkataramanan  */
22302b245cb2SAnirudh Venkataramanan netdev_tx_t ice_start_xmit(struct sk_buff *skb, struct net_device *netdev)
22312b245cb2SAnirudh Venkataramanan {
22322b245cb2SAnirudh Venkataramanan 	struct ice_netdev_priv *np = netdev_priv(netdev);
22332b245cb2SAnirudh Venkataramanan 	struct ice_vsi *vsi = np->vsi;
22342b245cb2SAnirudh Venkataramanan 	struct ice_ring *tx_ring;
22352b245cb2SAnirudh Venkataramanan 
22362b245cb2SAnirudh Venkataramanan 	tx_ring = vsi->tx_rings[skb->queue_mapping];
22372b245cb2SAnirudh Venkataramanan 
22382b245cb2SAnirudh Venkataramanan 	/* hardware can't handle really short frames, hardware padding works
22392b245cb2SAnirudh Venkataramanan 	 * beyond this point
22402b245cb2SAnirudh Venkataramanan 	 */
22412b245cb2SAnirudh Venkataramanan 	if (skb_put_padto(skb, ICE_MIN_TX_LEN))
22422b245cb2SAnirudh Venkataramanan 		return NETDEV_TX_OK;
22432b245cb2SAnirudh Venkataramanan 
22442b245cb2SAnirudh Venkataramanan 	return ice_xmit_frame_ring(skb, tx_ring);
22452b245cb2SAnirudh Venkataramanan }
2246148beb61SHenry Tieman 
2247148beb61SHenry Tieman /**
2248148beb61SHenry Tieman  * ice_clean_ctrl_tx_irq - interrupt handler for flow director Tx queue
2249148beb61SHenry Tieman  * @tx_ring: tx_ring to clean
2250148beb61SHenry Tieman  */
2251148beb61SHenry Tieman void ice_clean_ctrl_tx_irq(struct ice_ring *tx_ring)
2252148beb61SHenry Tieman {
2253148beb61SHenry Tieman 	struct ice_vsi *vsi = tx_ring->vsi;
2254148beb61SHenry Tieman 	s16 i = tx_ring->next_to_clean;
2255148beb61SHenry Tieman 	int budget = ICE_DFLT_IRQ_WORK;
2256148beb61SHenry Tieman 	struct ice_tx_desc *tx_desc;
2257148beb61SHenry Tieman 	struct ice_tx_buf *tx_buf;
2258148beb61SHenry Tieman 
2259148beb61SHenry Tieman 	tx_buf = &tx_ring->tx_buf[i];
2260148beb61SHenry Tieman 	tx_desc = ICE_TX_DESC(tx_ring, i);
2261148beb61SHenry Tieman 	i -= tx_ring->count;
2262148beb61SHenry Tieman 
2263148beb61SHenry Tieman 	do {
2264148beb61SHenry Tieman 		struct ice_tx_desc *eop_desc = tx_buf->next_to_watch;
2265148beb61SHenry Tieman 
2266148beb61SHenry Tieman 		/* if next_to_watch is not set then there is no pending work */
2267148beb61SHenry Tieman 		if (!eop_desc)
2268148beb61SHenry Tieman 			break;
2269148beb61SHenry Tieman 
2270148beb61SHenry Tieman 		/* prevent any other reads prior to eop_desc */
2271148beb61SHenry Tieman 		smp_rmb();
2272148beb61SHenry Tieman 
2273148beb61SHenry Tieman 		/* if the descriptor isn't done, no work to do */
2274148beb61SHenry Tieman 		if (!(eop_desc->cmd_type_offset_bsz &
2275148beb61SHenry Tieman 		      cpu_to_le64(ICE_TX_DESC_DTYPE_DESC_DONE)))
2276148beb61SHenry Tieman 			break;
2277148beb61SHenry Tieman 
2278148beb61SHenry Tieman 		/* clear next_to_watch to prevent false hangs */
2279148beb61SHenry Tieman 		tx_buf->next_to_watch = NULL;
2280148beb61SHenry Tieman 		tx_desc->buf_addr = 0;
2281148beb61SHenry Tieman 		tx_desc->cmd_type_offset_bsz = 0;
2282148beb61SHenry Tieman 
2283148beb61SHenry Tieman 		/* move past filter desc */
2284148beb61SHenry Tieman 		tx_buf++;
2285148beb61SHenry Tieman 		tx_desc++;
2286148beb61SHenry Tieman 		i++;
2287148beb61SHenry Tieman 		if (unlikely(!i)) {
2288148beb61SHenry Tieman 			i -= tx_ring->count;
2289148beb61SHenry Tieman 			tx_buf = tx_ring->tx_buf;
2290148beb61SHenry Tieman 			tx_desc = ICE_TX_DESC(tx_ring, 0);
2291148beb61SHenry Tieman 		}
2292148beb61SHenry Tieman 
2293148beb61SHenry Tieman 		/* unmap the data header */
2294148beb61SHenry Tieman 		if (dma_unmap_len(tx_buf, len))
2295148beb61SHenry Tieman 			dma_unmap_single(tx_ring->dev,
2296148beb61SHenry Tieman 					 dma_unmap_addr(tx_buf, dma),
2297148beb61SHenry Tieman 					 dma_unmap_len(tx_buf, len),
2298148beb61SHenry Tieman 					 DMA_TO_DEVICE);
2299148beb61SHenry Tieman 		if (tx_buf->tx_flags & ICE_TX_FLAGS_DUMMY_PKT)
2300148beb61SHenry Tieman 			devm_kfree(tx_ring->dev, tx_buf->raw_buf);
2301148beb61SHenry Tieman 
2302148beb61SHenry Tieman 		/* clear next_to_watch to prevent false hangs */
2303148beb61SHenry Tieman 		tx_buf->raw_buf = NULL;
2304148beb61SHenry Tieman 		tx_buf->tx_flags = 0;
2305148beb61SHenry Tieman 		tx_buf->next_to_watch = NULL;
2306148beb61SHenry Tieman 		dma_unmap_len_set(tx_buf, len, 0);
2307148beb61SHenry Tieman 		tx_desc->buf_addr = 0;
2308148beb61SHenry Tieman 		tx_desc->cmd_type_offset_bsz = 0;
2309148beb61SHenry Tieman 
2310148beb61SHenry Tieman 		/* move past eop_desc for start of next FD desc */
2311148beb61SHenry Tieman 		tx_buf++;
2312148beb61SHenry Tieman 		tx_desc++;
2313148beb61SHenry Tieman 		i++;
2314148beb61SHenry Tieman 		if (unlikely(!i)) {
2315148beb61SHenry Tieman 			i -= tx_ring->count;
2316148beb61SHenry Tieman 			tx_buf = tx_ring->tx_buf;
2317148beb61SHenry Tieman 			tx_desc = ICE_TX_DESC(tx_ring, 0);
2318148beb61SHenry Tieman 		}
2319148beb61SHenry Tieman 
2320148beb61SHenry Tieman 		budget--;
2321148beb61SHenry Tieman 	} while (likely(budget));
2322148beb61SHenry Tieman 
2323148beb61SHenry Tieman 	i += tx_ring->count;
2324148beb61SHenry Tieman 	tx_ring->next_to_clean = i;
2325148beb61SHenry Tieman 
2326148beb61SHenry Tieman 	/* re-enable interrupt if needed */
2327148beb61SHenry Tieman 	ice_irq_dynamic_ena(&vsi->back->hw, vsi, vsi->q_vectors[0]);
2328148beb61SHenry Tieman }
2329