blob: d464fceb300f8667e8a0d26f75c682286a3357da [file] [log] [blame]
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001/*******************************************************************************
2 *
3 * Intel Ethernet Controller XL710 Family Linux Driver
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -08004 * Copyright(c) 2013 - 2016 Intel Corporation.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00005 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
13 * more details.
14 *
Greg Rosedc641b72013-12-18 13:45:51 +000015 * You should have received a copy of the GNU General Public License along
16 * with this program. If not, see <http://www.gnu.org/licenses/>.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000017 *
18 * The full GNU General Public License is included in this distribution in
19 * the file called "COPYING".
20 *
21 * Contact Information:
22 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24 *
25 ******************************************************************************/
26
Mitch Williams1c112a62014-04-04 04:43:06 +000027#include <linux/prefetch.h>
Mitch Williamsa132af22015-01-24 09:58:35 +000028#include <net/busy_poll.h>
Björn Töpel0c8493d2017-05-24 07:55:34 +020029#include <linux/bpf_trace.h>
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000030#include "i40e.h"
Scott Petersoned0980c2017-04-13 04:45:44 -040031#include "i40e_trace.h"
Jesse Brandeburg206812b2014-02-12 01:45:33 +000032#include "i40e_prototype.h"
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000033
34static inline __le64 build_ctob(u32 td_cmd, u32 td_offset, unsigned int size,
35 u32 td_tag)
36{
37 return cpu_to_le64(I40E_TX_DESC_DTYPE_DATA |
38 ((u64)td_cmd << I40E_TXD_QW1_CMD_SHIFT) |
39 ((u64)td_offset << I40E_TXD_QW1_OFFSET_SHIFT) |
40 ((u64)size << I40E_TXD_QW1_TX_BUF_SZ_SHIFT) |
41 ((u64)td_tag << I40E_TXD_QW1_L2TAG1_SHIFT));
42}
43
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +000044#define I40E_TXD_CMD (I40E_TX_DESC_CMD_EOP | I40E_TX_DESC_CMD_RS)
Alexander Duyck5e02f282016-09-12 14:18:41 -070045/**
46 * i40e_fdir - Generate a Flow Director descriptor based on fdata
47 * @tx_ring: Tx ring to send buffer on
48 * @fdata: Flow director filter data
49 * @add: Indicate if we are adding a rule or deleting one
50 *
51 **/
52static void i40e_fdir(struct i40e_ring *tx_ring,
53 struct i40e_fdir_filter *fdata, bool add)
54{
55 struct i40e_filter_program_desc *fdir_desc;
56 struct i40e_pf *pf = tx_ring->vsi->back;
57 u32 flex_ptype, dtype_cmd;
58 u16 i;
59
60 /* grab the next descriptor */
61 i = tx_ring->next_to_use;
62 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
63
64 i++;
65 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
66
67 flex_ptype = I40E_TXD_FLTR_QW0_QINDEX_MASK &
68 (fdata->q_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT);
69
70 flex_ptype |= I40E_TXD_FLTR_QW0_FLEXOFF_MASK &
71 (fdata->flex_off << I40E_TXD_FLTR_QW0_FLEXOFF_SHIFT);
72
73 flex_ptype |= I40E_TXD_FLTR_QW0_PCTYPE_MASK &
74 (fdata->pctype << I40E_TXD_FLTR_QW0_PCTYPE_SHIFT);
75
Jacob Keller0e588de2017-02-06 14:38:50 -080076 flex_ptype |= I40E_TXD_FLTR_QW0_PCTYPE_MASK &
77 (fdata->flex_offset << I40E_TXD_FLTR_QW0_FLEXOFF_SHIFT);
78
Alexander Duyck5e02f282016-09-12 14:18:41 -070079 /* Use LAN VSI Id if not programmed by user */
80 flex_ptype |= I40E_TXD_FLTR_QW0_DEST_VSI_MASK &
81 ((u32)(fdata->dest_vsi ? : pf->vsi[pf->lan_vsi]->id) <<
82 I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT);
83
84 dtype_cmd = I40E_TX_DESC_DTYPE_FILTER_PROG;
85
86 dtype_cmd |= add ?
87 I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
88 I40E_TXD_FLTR_QW1_PCMD_SHIFT :
89 I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
90 I40E_TXD_FLTR_QW1_PCMD_SHIFT;
91
92 dtype_cmd |= I40E_TXD_FLTR_QW1_DEST_MASK &
93 (fdata->dest_ctl << I40E_TXD_FLTR_QW1_DEST_SHIFT);
94
95 dtype_cmd |= I40E_TXD_FLTR_QW1_FD_STATUS_MASK &
96 (fdata->fd_status << I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT);
97
98 if (fdata->cnt_index) {
99 dtype_cmd |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
100 dtype_cmd |= I40E_TXD_FLTR_QW1_CNTINDEX_MASK &
101 ((u32)fdata->cnt_index <<
102 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT);
103 }
104
105 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(flex_ptype);
106 fdir_desc->rsvd = cpu_to_le32(0);
107 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dtype_cmd);
108 fdir_desc->fd_id = cpu_to_le32(fdata->fd_id);
109}
110
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000111#define I40E_FD_CLEAN_DELAY 10
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000112/**
113 * i40e_program_fdir_filter - Program a Flow Director filter
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000114 * @fdir_data: Packet data that will be filter parameters
115 * @raw_packet: the pre-allocated packet buffer for FDir
Jeff Kirsherb40c82e62015-02-27 09:18:34 +0000116 * @pf: The PF pointer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000117 * @add: True for add/update, False for remove
118 **/
Alexander Duyck1eb846a2016-09-12 14:18:42 -0700119static int i40e_program_fdir_filter(struct i40e_fdir_filter *fdir_data,
120 u8 *raw_packet, struct i40e_pf *pf,
121 bool add)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000122{
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000123 struct i40e_tx_buffer *tx_buf, *first;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000124 struct i40e_tx_desc *tx_desc;
125 struct i40e_ring *tx_ring;
126 struct i40e_vsi *vsi;
127 struct device *dev;
128 dma_addr_t dma;
129 u32 td_cmd = 0;
130 u16 i;
131
132 /* find existing FDIR VSI */
Alexander Duyck4b816442016-10-11 15:26:53 -0700133 vsi = i40e_find_vsi_by_type(pf, I40E_VSI_FDIR);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000134 if (!vsi)
135 return -ENOENT;
136
Alexander Duyck9f65e152013-09-28 06:00:58 +0000137 tx_ring = vsi->tx_rings[0];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000138 dev = tx_ring->dev;
139
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000140 /* we need two descriptors to add/del a filter and we can wait */
Alexander Duycked245402016-09-14 16:24:32 -0700141 for (i = I40E_FD_CLEAN_DELAY; I40E_DESC_UNUSED(tx_ring) < 2; i--) {
142 if (!i)
143 return -EAGAIN;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000144 msleep_interruptible(1);
Alexander Duycked245402016-09-14 16:24:32 -0700145 }
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000146
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000147 dma = dma_map_single(dev, raw_packet,
148 I40E_FDIR_MAX_RAW_PACKET_SIZE, DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000149 if (dma_mapping_error(dev, dma))
150 goto dma_fail;
151
152 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000153 i = tx_ring->next_to_use;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000154 first = &tx_ring->tx_bi[i];
Alexander Duyck5e02f282016-09-12 14:18:41 -0700155 i40e_fdir(tx_ring, fdir_data, add);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000156
157 /* Now program a dummy descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000158 i = tx_ring->next_to_use;
159 tx_desc = I40E_TX_DESC(tx_ring, i);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000160 tx_buf = &tx_ring->tx_bi[i];
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000161
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000162 tx_ring->next_to_use = ((i + 1) < tx_ring->count) ? i + 1 : 0;
163
164 memset(tx_buf, 0, sizeof(struct i40e_tx_buffer));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000165
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000166 /* record length, and DMA address */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000167 dma_unmap_len_set(tx_buf, len, I40E_FDIR_MAX_RAW_PACKET_SIZE);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000168 dma_unmap_addr_set(tx_buf, dma, dma);
169
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000170 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000171 td_cmd = I40E_TXD_CMD | I40E_TX_DESC_CMD_DUMMY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000172
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000173 tx_buf->tx_flags = I40E_TX_FLAGS_FD_SB;
174 tx_buf->raw_buf = (void *)raw_packet;
175
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000176 tx_desc->cmd_type_offset_bsz =
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000177 build_ctob(td_cmd, 0, I40E_FDIR_MAX_RAW_PACKET_SIZE, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000178
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000179 /* Force memory writes to complete before letting h/w
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000180 * know there are new descriptors to fetch.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000181 */
182 wmb();
183
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000184 /* Mark the data descriptor to be watched */
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000185 first->next_to_watch = tx_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000186
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000187 writel(tx_ring->next_to_use, tx_ring->tail);
188 return 0;
189
190dma_fail:
191 return -1;
192}
193
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000194#define IP_HEADER_OFFSET 14
195#define I40E_UDPIP_DUMMY_PACKET_LEN 42
196/**
197 * i40e_add_del_fdir_udpv4 - Add/Remove UDPv4 filters
198 * @vsi: pointer to the targeted VSI
199 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000200 * @add: true adds a filter, false removes it
201 *
202 * Returns 0 if the filters were successfully added or removed
203 **/
204static int i40e_add_del_fdir_udpv4(struct i40e_vsi *vsi,
205 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000206 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000207{
208 struct i40e_pf *pf = vsi->back;
209 struct udphdr *udp;
210 struct iphdr *ip;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000211 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000212 int ret;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000213 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
214 0x45, 0, 0, 0x1c, 0, 0, 0x40, 0, 0x40, 0x11, 0, 0, 0, 0, 0, 0,
215 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
216
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000217 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
218 if (!raw_packet)
219 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000220 memcpy(raw_packet, packet, I40E_UDPIP_DUMMY_PACKET_LEN);
221
222 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
223 udp = (struct udphdr *)(raw_packet + IP_HEADER_OFFSET
224 + sizeof(struct iphdr));
225
Jacob Keller8ce43dc2017-02-06 14:38:39 -0800226 ip->daddr = fd_data->dst_ip;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000227 udp->dest = fd_data->dst_port;
Jacob Keller8ce43dc2017-02-06 14:38:39 -0800228 ip->saddr = fd_data->src_ip;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000229 udp->source = fd_data->src_port;
230
Jacob Keller0e588de2017-02-06 14:38:50 -0800231 if (fd_data->flex_filter) {
232 u8 *payload = raw_packet + I40E_UDPIP_DUMMY_PACKET_LEN;
233 __be16 pattern = fd_data->flex_word;
234 u16 off = fd_data->flex_offset;
235
236 *((__force __be16 *)(payload + off)) = pattern;
237 }
238
Kevin Scottb2d36c02014-04-09 05:58:59 +0000239 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
240 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
241 if (ret) {
242 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000243 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
244 fd_data->pctype, fd_data->fd_id, ret);
Jacob Kellere5187ee2017-02-06 14:38:41 -0800245 /* Free the packet buffer since it wasn't added to the ring */
246 kfree(raw_packet);
247 return -EOPNOTSUPP;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000248 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000249 if (add)
250 dev_info(&pf->pdev->dev,
251 "Filter OK for PCTYPE %d loc = %d\n",
252 fd_data->pctype, fd_data->fd_id);
253 else
254 dev_info(&pf->pdev->dev,
255 "Filter deleted for PCTYPE %d loc = %d\n",
256 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000257 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800258
Jacob Keller097dbf52017-02-06 14:38:46 -0800259 if (add)
260 pf->fd_udp4_filter_cnt++;
261 else
262 pf->fd_udp4_filter_cnt--;
263
Jacob Kellere5187ee2017-02-06 14:38:41 -0800264 return 0;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000265}
266
267#define I40E_TCPIP_DUMMY_PACKET_LEN 54
268/**
269 * i40e_add_del_fdir_tcpv4 - Add/Remove TCPv4 filters
270 * @vsi: pointer to the targeted VSI
271 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000272 * @add: true adds a filter, false removes it
273 *
274 * Returns 0 if the filters were successfully added or removed
275 **/
276static int i40e_add_del_fdir_tcpv4(struct i40e_vsi *vsi,
277 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000278 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000279{
280 struct i40e_pf *pf = vsi->back;
281 struct tcphdr *tcp;
282 struct iphdr *ip;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000283 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000284 int ret;
285 /* Dummy packet */
286 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
287 0x45, 0, 0, 0x28, 0, 0, 0x40, 0, 0x40, 0x6, 0, 0, 0, 0, 0, 0,
288 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x80, 0x11,
289 0x0, 0x72, 0, 0, 0, 0};
290
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000291 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
292 if (!raw_packet)
293 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000294 memcpy(raw_packet, packet, I40E_TCPIP_DUMMY_PACKET_LEN);
295
296 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
297 tcp = (struct tcphdr *)(raw_packet + IP_HEADER_OFFSET
298 + sizeof(struct iphdr));
299
Jacob Keller8ce43dc2017-02-06 14:38:39 -0800300 ip->daddr = fd_data->dst_ip;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000301 tcp->dest = fd_data->dst_port;
Jacob Keller8ce43dc2017-02-06 14:38:39 -0800302 ip->saddr = fd_data->src_ip;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000303 tcp->source = fd_data->src_port;
304
Jacob Keller0e588de2017-02-06 14:38:50 -0800305 if (fd_data->flex_filter) {
306 u8 *payload = raw_packet + I40E_TCPIP_DUMMY_PACKET_LEN;
307 __be16 pattern = fd_data->flex_word;
308 u16 off = fd_data->flex_offset;
309
310 *((__force __be16 *)(payload + off)) = pattern;
311 }
312
Kevin Scottb2d36c02014-04-09 05:58:59 +0000313 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000314 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000315 if (ret) {
316 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000317 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
318 fd_data->pctype, fd_data->fd_id, ret);
Jacob Kellere5187ee2017-02-06 14:38:41 -0800319 /* Free the packet buffer since it wasn't added to the ring */
320 kfree(raw_packet);
321 return -EOPNOTSUPP;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000322 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000323 if (add)
324 dev_info(&pf->pdev->dev, "Filter OK for PCTYPE %d loc = %d)\n",
325 fd_data->pctype, fd_data->fd_id);
326 else
327 dev_info(&pf->pdev->dev,
328 "Filter deleted for PCTYPE %d loc = %d\n",
329 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000330 }
331
Jacob Keller377cc242017-02-06 14:38:42 -0800332 if (add) {
Jacob Keller097dbf52017-02-06 14:38:46 -0800333 pf->fd_tcp4_filter_cnt++;
Jacob Keller377cc242017-02-06 14:38:42 -0800334 if ((pf->flags & I40E_FLAG_FD_ATR_ENABLED) &&
335 I40E_DEBUG_FD & pf->hw.debug_mask)
336 dev_info(&pf->pdev->dev, "Forcing ATR off, sideband rules for TCP/IPv4 flow being applied\n");
Jacob Keller47994c12017-04-19 09:25:57 -0400337 pf->flags |= I40E_FLAG_FD_ATR_AUTO_DISABLED;
Jacob Keller377cc242017-02-06 14:38:42 -0800338 } else {
Jacob Keller097dbf52017-02-06 14:38:46 -0800339 pf->fd_tcp4_filter_cnt--;
Jacob Keller377cc242017-02-06 14:38:42 -0800340 }
341
Jacob Kellere5187ee2017-02-06 14:38:41 -0800342 return 0;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000343}
344
Jacob Kellerf223c872017-02-06 14:38:51 -0800345#define I40E_SCTPIP_DUMMY_PACKET_LEN 46
346/**
347 * i40e_add_del_fdir_sctpv4 - Add/Remove SCTPv4 Flow Director filters for
348 * a specific flow spec
349 * @vsi: pointer to the targeted VSI
350 * @fd_data: the flow director data required for the FDir descriptor
351 * @add: true adds a filter, false removes it
352 *
353 * Returns 0 if the filters were successfully added or removed
354 **/
355static int i40e_add_del_fdir_sctpv4(struct i40e_vsi *vsi,
356 struct i40e_fdir_filter *fd_data,
357 bool add)
358{
359 struct i40e_pf *pf = vsi->back;
360 struct sctphdr *sctp;
361 struct iphdr *ip;
362 u8 *raw_packet;
363 int ret;
364 /* Dummy packet */
365 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
366 0x45, 0, 0, 0x20, 0, 0, 0x40, 0, 0x40, 0x84, 0, 0, 0, 0, 0, 0,
367 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
368
369 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
370 if (!raw_packet)
371 return -ENOMEM;
372 memcpy(raw_packet, packet, I40E_SCTPIP_DUMMY_PACKET_LEN);
373
374 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
375 sctp = (struct sctphdr *)(raw_packet + IP_HEADER_OFFSET
376 + sizeof(struct iphdr));
377
378 ip->daddr = fd_data->dst_ip;
379 sctp->dest = fd_data->dst_port;
380 ip->saddr = fd_data->src_ip;
381 sctp->source = fd_data->src_port;
382
383 if (fd_data->flex_filter) {
384 u8 *payload = raw_packet + I40E_SCTPIP_DUMMY_PACKET_LEN;
385 __be16 pattern = fd_data->flex_word;
386 u16 off = fd_data->flex_offset;
387
388 *((__force __be16 *)(payload + off)) = pattern;
389 }
390
391 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_SCTP;
392 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
393 if (ret) {
394 dev_info(&pf->pdev->dev,
395 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
396 fd_data->pctype, fd_data->fd_id, ret);
397 /* Free the packet buffer since it wasn't added to the ring */
398 kfree(raw_packet);
399 return -EOPNOTSUPP;
400 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
401 if (add)
402 dev_info(&pf->pdev->dev,
403 "Filter OK for PCTYPE %d loc = %d\n",
404 fd_data->pctype, fd_data->fd_id);
405 else
406 dev_info(&pf->pdev->dev,
407 "Filter deleted for PCTYPE %d loc = %d\n",
408 fd_data->pctype, fd_data->fd_id);
409 }
410
411 if (add)
412 pf->fd_sctp4_filter_cnt++;
413 else
414 pf->fd_sctp4_filter_cnt--;
415
416 return 0;
417}
418
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000419#define I40E_IP_DUMMY_PACKET_LEN 34
420/**
421 * i40e_add_del_fdir_ipv4 - Add/Remove IPv4 Flow Director filters for
422 * a specific flow spec
423 * @vsi: pointer to the targeted VSI
424 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000425 * @add: true adds a filter, false removes it
426 *
427 * Returns 0 if the filters were successfully added or removed
428 **/
429static int i40e_add_del_fdir_ipv4(struct i40e_vsi *vsi,
430 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000431 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000432{
433 struct i40e_pf *pf = vsi->back;
434 struct iphdr *ip;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000435 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000436 int ret;
437 int i;
438 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
439 0x45, 0, 0, 0x14, 0, 0, 0x40, 0, 0x40, 0x10, 0, 0, 0, 0, 0, 0,
440 0, 0, 0, 0};
441
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000442 for (i = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER;
443 i <= I40E_FILTER_PCTYPE_FRAG_IPV4; i++) {
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000444 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
445 if (!raw_packet)
446 return -ENOMEM;
447 memcpy(raw_packet, packet, I40E_IP_DUMMY_PACKET_LEN);
448 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
449
Jacob Keller8ce43dc2017-02-06 14:38:39 -0800450 ip->saddr = fd_data->src_ip;
451 ip->daddr = fd_data->dst_ip;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000452 ip->protocol = 0;
453
Jacob Keller0e588de2017-02-06 14:38:50 -0800454 if (fd_data->flex_filter) {
455 u8 *payload = raw_packet + I40E_IP_DUMMY_PACKET_LEN;
456 __be16 pattern = fd_data->flex_word;
457 u16 off = fd_data->flex_offset;
458
459 *((__force __be16 *)(payload + off)) = pattern;
460 }
461
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000462 fd_data->pctype = i;
463 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000464 if (ret) {
465 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000466 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
467 fd_data->pctype, fd_data->fd_id, ret);
Jacob Kellere5187ee2017-02-06 14:38:41 -0800468 /* The packet buffer wasn't added to the ring so we
469 * need to free it now.
470 */
471 kfree(raw_packet);
472 return -EOPNOTSUPP;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000473 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000474 if (add)
475 dev_info(&pf->pdev->dev,
476 "Filter OK for PCTYPE %d loc = %d\n",
477 fd_data->pctype, fd_data->fd_id);
478 else
479 dev_info(&pf->pdev->dev,
480 "Filter deleted for PCTYPE %d loc = %d\n",
481 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000482 }
483 }
484
Jacob Keller097dbf52017-02-06 14:38:46 -0800485 if (add)
486 pf->fd_ip4_filter_cnt++;
487 else
488 pf->fd_ip4_filter_cnt--;
489
Jacob Kellere5187ee2017-02-06 14:38:41 -0800490 return 0;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000491}
492
493/**
494 * i40e_add_del_fdir - Build raw packets to add/del fdir filter
495 * @vsi: pointer to the targeted VSI
496 * @cmd: command to get or set RX flow classification rules
497 * @add: true adds a filter, false removes it
498 *
499 **/
500int i40e_add_del_fdir(struct i40e_vsi *vsi,
501 struct i40e_fdir_filter *input, bool add)
502{
503 struct i40e_pf *pf = vsi->back;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000504 int ret;
505
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000506 switch (input->flow_type & ~FLOW_EXT) {
507 case TCP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000508 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000509 break;
510 case UDP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000511 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000512 break;
Jacob Kellerf223c872017-02-06 14:38:51 -0800513 case SCTP_V4_FLOW:
514 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
515 break;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000516 case IP_USER_FLOW:
517 switch (input->ip4_proto) {
518 case IPPROTO_TCP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000519 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000520 break;
521 case IPPROTO_UDP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000522 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000523 break;
Jacob Kellerf223c872017-02-06 14:38:51 -0800524 case IPPROTO_SCTP:
525 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
526 break;
Alexander Duycke1da71c2016-09-14 16:24:35 -0700527 case IPPROTO_IP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000528 ret = i40e_add_del_fdir_ipv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000529 break;
Alexander Duycke1da71c2016-09-14 16:24:35 -0700530 default:
531 /* We cannot support masking based on protocol */
Jacob Kellera346fb82017-04-05 07:50:53 -0400532 dev_info(&pf->pdev->dev, "Unsupported IPv4 protocol 0x%02x\n",
533 input->ip4_proto);
534 return -EINVAL;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000535 }
536 break;
537 default:
Jacob Kellera346fb82017-04-05 07:50:53 -0400538 dev_info(&pf->pdev->dev, "Unsupported flow type 0x%02x\n",
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000539 input->flow_type);
Jacob Kellera346fb82017-04-05 07:50:53 -0400540 return -EINVAL;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000541 }
542
Jacob Kellera158aea2017-02-09 23:44:27 -0800543 /* The buffer allocated here will be normally be freed by
544 * i40e_clean_fdir_tx_irq() as it reclaims resources after transmit
545 * completion. In the event of an error adding the buffer to the FDIR
546 * ring, it will immediately be freed. It may also be freed by
547 * i40e_clean_tx_ring() when closing the VSI.
548 */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000549 return ret;
550}
551
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000552/**
553 * i40e_fd_handle_status - check the Programming Status for FD
554 * @rx_ring: the Rx ring for this descriptor
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000555 * @rx_desc: the Rx descriptor for programming Status, not a packet descriptor.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000556 * @prog_id: the id originally used for programming
557 *
558 * This is used to verify if the FD programming or invalidation
559 * requested by SW to the HW is successful or not and take actions accordingly.
560 **/
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000561static void i40e_fd_handle_status(struct i40e_ring *rx_ring,
562 union i40e_rx_desc *rx_desc, u8 prog_id)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000563{
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000564 struct i40e_pf *pf = rx_ring->vsi->back;
565 struct pci_dev *pdev = pf->pdev;
566 u32 fcnt_prog, fcnt_avail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000567 u32 error;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000568 u64 qw;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000569
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000570 qw = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000571 error = (qw & I40E_RX_PROG_STATUS_DESC_QW1_ERROR_MASK) >>
572 I40E_RX_PROG_STATUS_DESC_QW1_ERROR_SHIFT;
573
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400574 if (error == BIT(I40E_RX_PROG_STATUS_DESC_FD_TBL_FULL_SHIFT)) {
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400575 pf->fd_inv = le32_to_cpu(rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000576 if ((rx_desc->wb.qword0.hi_dword.fd_id != 0) ||
577 (I40E_DEBUG_FD & pf->hw.debug_mask))
578 dev_warn(&pdev->dev, "ntuple filter loc = %d, could not be added\n",
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400579 pf->fd_inv);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000580
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000581 /* Check if the programming error is for ATR.
582 * If so, auto disable ATR and set a state for
583 * flush in progress. Next time we come here if flush is in
584 * progress do nothing, once flush is complete the state will
585 * be cleared.
586 */
Jacob Keller0da36b92017-04-19 09:25:55 -0400587 if (test_bit(__I40E_FD_FLUSH_REQUESTED, pf->state))
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000588 return;
589
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000590 pf->fd_add_err++;
591 /* store the current atr filter count */
592 pf->fd_atr_cnt = i40e_get_current_atr_cnt(pf);
593
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000594 if ((rx_desc->wb.qword0.hi_dword.fd_id == 0) &&
Jacob Keller47994c12017-04-19 09:25:57 -0400595 pf->flags & I40E_FLAG_FD_SB_AUTO_DISABLED) {
596 pf->flags |= I40E_FLAG_FD_ATR_AUTO_DISABLED;
Jacob Keller0da36b92017-04-19 09:25:55 -0400597 set_bit(__I40E_FD_FLUSH_REQUESTED, pf->state);
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000598 }
599
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000600 /* filter programming failed most likely due to table full */
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000601 fcnt_prog = i40e_get_global_fd_count(pf);
Anjali Singhai Jain12957382014-06-04 04:22:47 +0000602 fcnt_avail = pf->fdir_pf_filter_count;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000603 /* If ATR is running fcnt_prog can quickly change,
604 * if we are very close to full, it makes sense to disable
605 * FD ATR/SB and then re-enable it when there is room.
606 */
607 if (fcnt_prog >= (fcnt_avail - I40E_FDIR_BUFFER_FULL_MARGIN)) {
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000608 if ((pf->flags & I40E_FLAG_FD_SB_ENABLED) &&
Jacob Keller47994c12017-04-19 09:25:57 -0400609 !(pf->flags & I40E_FLAG_FD_SB_AUTO_DISABLED)) {
610 pf->flags |= I40E_FLAG_FD_SB_AUTO_DISABLED;
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400611 if (I40E_DEBUG_FD & pf->hw.debug_mask)
612 dev_warn(&pdev->dev, "FD filter space full, new ntuple rules will not be added\n");
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000613 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000614 }
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400615 } else if (error == BIT(I40E_RX_PROG_STATUS_DESC_NO_FD_ENTRY_SHIFT)) {
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000616 if (I40E_DEBUG_FD & pf->hw.debug_mask)
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000617 dev_info(&pdev->dev, "ntuple filter fd_id = %d, could not be removed\n",
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000618 rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000619 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000620}
621
622/**
Alexander Duycka5e9c572013-09-28 06:00:27 +0000623 * i40e_unmap_and_free_tx_resource - Release a Tx buffer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000624 * @ring: the ring that owns the buffer
625 * @tx_buffer: the buffer to free
626 **/
Alexander Duycka5e9c572013-09-28 06:00:27 +0000627static void i40e_unmap_and_free_tx_resource(struct i40e_ring *ring,
628 struct i40e_tx_buffer *tx_buffer)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000629{
Alexander Duycka5e9c572013-09-28 06:00:27 +0000630 if (tx_buffer->skb) {
Alexander Duyck64bfd682016-09-12 14:18:39 -0700631 if (tx_buffer->tx_flags & I40E_TX_FLAGS_FD_SB)
632 kfree(tx_buffer->raw_buf);
Björn Töpel74608d12017-05-24 07:55:35 +0200633 else if (ring_is_xdp(ring))
634 page_frag_free(tx_buffer->raw_buf);
Alexander Duyck64bfd682016-09-12 14:18:39 -0700635 else
636 dev_kfree_skb_any(tx_buffer->skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000637 if (dma_unmap_len(tx_buffer, len))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000638 dma_unmap_single(ring->dev,
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000639 dma_unmap_addr(tx_buffer, dma),
640 dma_unmap_len(tx_buffer, len),
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000641 DMA_TO_DEVICE);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000642 } else if (dma_unmap_len(tx_buffer, len)) {
643 dma_unmap_page(ring->dev,
644 dma_unmap_addr(tx_buffer, dma),
645 dma_unmap_len(tx_buffer, len),
646 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000647 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800648
Alexander Duycka5e9c572013-09-28 06:00:27 +0000649 tx_buffer->next_to_watch = NULL;
650 tx_buffer->skb = NULL;
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000651 dma_unmap_len_set(tx_buffer, len, 0);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000652 /* tx_buffer must be completely set up in the transmit path */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000653}
654
655/**
656 * i40e_clean_tx_ring - Free any empty Tx buffers
657 * @tx_ring: ring to be cleaned
658 **/
659void i40e_clean_tx_ring(struct i40e_ring *tx_ring)
660{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000661 unsigned long bi_size;
662 u16 i;
663
664 /* ring already cleared, nothing to do */
665 if (!tx_ring->tx_bi)
666 return;
667
668 /* Free all the Tx ring sk_buffs */
Alexander Duycka5e9c572013-09-28 06:00:27 +0000669 for (i = 0; i < tx_ring->count; i++)
670 i40e_unmap_and_free_tx_resource(tx_ring, &tx_ring->tx_bi[i]);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000671
672 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
673 memset(tx_ring->tx_bi, 0, bi_size);
674
675 /* Zero out the descriptor ring */
676 memset(tx_ring->desc, 0, tx_ring->size);
677
678 tx_ring->next_to_use = 0;
679 tx_ring->next_to_clean = 0;
Alexander Duyck7070ce02013-09-28 06:00:37 +0000680
681 if (!tx_ring->netdev)
682 return;
683
684 /* cleanup Tx queue statistics */
Alexander Duycke486bdf2016-09-12 14:18:40 -0700685 netdev_tx_reset_queue(txring_txq(tx_ring));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000686}
687
688/**
689 * i40e_free_tx_resources - Free Tx resources per queue
690 * @tx_ring: Tx descriptor ring for a specific queue
691 *
692 * Free all transmit software resources
693 **/
694void i40e_free_tx_resources(struct i40e_ring *tx_ring)
695{
696 i40e_clean_tx_ring(tx_ring);
697 kfree(tx_ring->tx_bi);
698 tx_ring->tx_bi = NULL;
699
700 if (tx_ring->desc) {
701 dma_free_coherent(tx_ring->dev, tx_ring->size,
702 tx_ring->desc, tx_ring->dma);
703 tx_ring->desc = NULL;
704 }
705}
706
Jesse Brandeburga68de582015-02-24 05:26:03 +0000707/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000708 * i40e_get_tx_pending - how many tx descriptors not processed
709 * @tx_ring: the ring of descriptors
710 *
711 * Since there is no access to the ring head register
712 * in XL710, we need to use our local copies
713 **/
Alan Brady17daabb2017-04-05 07:50:56 -0400714u32 i40e_get_tx_pending(struct i40e_ring *ring)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000715{
Jesse Brandeburga68de582015-02-24 05:26:03 +0000716 u32 head, tail;
717
Alan Brady17daabb2017-04-05 07:50:56 -0400718 head = i40e_get_head(ring);
Jesse Brandeburga68de582015-02-24 05:26:03 +0000719 tail = readl(ring->tail);
720
721 if (head != tail)
722 return (head < tail) ?
723 tail - head : (tail + ring->count - head);
724
725 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000726}
727
Alexander Duyck1dc8b532016-10-11 15:26:54 -0700728#define WB_STRIDE 4
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000729
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000730/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000731 * i40e_clean_tx_irq - Reclaim resources after transmit completes
Alexander Duycka619afe2016-03-07 09:30:03 -0800732 * @vsi: the VSI we care about
733 * @tx_ring: Tx ring to clean
734 * @napi_budget: Used to determine if we are in netpoll
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000735 *
736 * Returns true if there's any budget left (e.g. the clean is finished)
737 **/
Alexander Duycka619afe2016-03-07 09:30:03 -0800738static bool i40e_clean_tx_irq(struct i40e_vsi *vsi,
739 struct i40e_ring *tx_ring, int napi_budget)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000740{
741 u16 i = tx_ring->next_to_clean;
742 struct i40e_tx_buffer *tx_buf;
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000743 struct i40e_tx_desc *tx_head;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000744 struct i40e_tx_desc *tx_desc;
Alexander Duycka619afe2016-03-07 09:30:03 -0800745 unsigned int total_bytes = 0, total_packets = 0;
746 unsigned int budget = vsi->work_limit;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000747
748 tx_buf = &tx_ring->tx_bi[i];
749 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000750 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000751
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000752 tx_head = I40E_TX_DESC(tx_ring, i40e_get_head(tx_ring));
753
Alexander Duycka5e9c572013-09-28 06:00:27 +0000754 do {
755 struct i40e_tx_desc *eop_desc = tx_buf->next_to_watch;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000756
757 /* if next_to_watch is not set then there is no work pending */
758 if (!eop_desc)
759 break;
760
Alexander Duycka5e9c572013-09-28 06:00:27 +0000761 /* prevent any other reads prior to eop_desc */
762 read_barrier_depends();
763
Scott Petersoned0980c2017-04-13 04:45:44 -0400764 i40e_trace(clean_tx_irq, tx_ring, tx_desc, tx_buf);
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000765 /* we have caught up to head, no work left to do */
766 if (tx_head == tx_desc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000767 break;
768
Alexander Duyckc304fda2013-09-28 06:00:12 +0000769 /* clear next_to_watch to prevent false hangs */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000770 tx_buf->next_to_watch = NULL;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000771
Alexander Duycka5e9c572013-09-28 06:00:27 +0000772 /* update the statistics for this packet */
773 total_bytes += tx_buf->bytecount;
774 total_packets += tx_buf->gso_segs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000775
Björn Töpel74608d12017-05-24 07:55:35 +0200776 /* free the skb/XDP data */
777 if (ring_is_xdp(tx_ring))
778 page_frag_free(tx_buf->raw_buf);
779 else
780 napi_consume_skb(tx_buf->skb, napi_budget);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000781
Alexander Duycka5e9c572013-09-28 06:00:27 +0000782 /* unmap skb header data */
783 dma_unmap_single(tx_ring->dev,
784 dma_unmap_addr(tx_buf, dma),
785 dma_unmap_len(tx_buf, len),
786 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000787
Alexander Duycka5e9c572013-09-28 06:00:27 +0000788 /* clear tx_buffer data */
789 tx_buf->skb = NULL;
790 dma_unmap_len_set(tx_buf, len, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000791
Alexander Duycka5e9c572013-09-28 06:00:27 +0000792 /* unmap remaining buffers */
793 while (tx_desc != eop_desc) {
Scott Petersoned0980c2017-04-13 04:45:44 -0400794 i40e_trace(clean_tx_irq_unmap,
795 tx_ring, tx_desc, tx_buf);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000796
797 tx_buf++;
798 tx_desc++;
799 i++;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000800 if (unlikely(!i)) {
801 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000802 tx_buf = tx_ring->tx_bi;
803 tx_desc = I40E_TX_DESC(tx_ring, 0);
804 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000805
Alexander Duycka5e9c572013-09-28 06:00:27 +0000806 /* unmap any remaining paged data */
807 if (dma_unmap_len(tx_buf, len)) {
808 dma_unmap_page(tx_ring->dev,
809 dma_unmap_addr(tx_buf, dma),
810 dma_unmap_len(tx_buf, len),
811 DMA_TO_DEVICE);
812 dma_unmap_len_set(tx_buf, len, 0);
813 }
814 }
815
816 /* move us one more past the eop_desc for start of next pkt */
817 tx_buf++;
818 tx_desc++;
819 i++;
820 if (unlikely(!i)) {
821 i -= tx_ring->count;
822 tx_buf = tx_ring->tx_bi;
823 tx_desc = I40E_TX_DESC(tx_ring, 0);
824 }
825
Jesse Brandeburg016890b2015-02-27 09:15:31 +0000826 prefetch(tx_desc);
827
Alexander Duycka5e9c572013-09-28 06:00:27 +0000828 /* update budget accounting */
829 budget--;
830 } while (likely(budget));
831
832 i += tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000833 tx_ring->next_to_clean = i;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000834 u64_stats_update_begin(&tx_ring->syncp);
Alexander Duycka114d0a2013-09-28 06:00:43 +0000835 tx_ring->stats.bytes += total_bytes;
836 tx_ring->stats.packets += total_packets;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000837 u64_stats_update_end(&tx_ring->syncp);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000838 tx_ring->q_vector->tx.total_bytes += total_bytes;
839 tx_ring->q_vector->tx.total_packets += total_packets;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000840
Anjali Singhai58044742015-09-25 18:26:13 -0700841 if (tx_ring->flags & I40E_TXR_FLAGS_WB_ON_ITR) {
Anjali Singhai58044742015-09-25 18:26:13 -0700842 /* check to see if there are < 4 descriptors
843 * waiting to be written back, then kick the hardware to force
844 * them to be written back in case we stay in NAPI.
845 * In this mode on X722 we do not enable Interrupt.
846 */
Alan Brady17daabb2017-04-05 07:50:56 -0400847 unsigned int j = i40e_get_tx_pending(tx_ring);
Anjali Singhai58044742015-09-25 18:26:13 -0700848
849 if (budget &&
Alexander Duyck1dc8b532016-10-11 15:26:54 -0700850 ((j / WB_STRIDE) == 0) && (j > 0) &&
Jacob Keller0da36b92017-04-19 09:25:55 -0400851 !test_bit(__I40E_VSI_DOWN, vsi->state) &&
Anjali Singhai58044742015-09-25 18:26:13 -0700852 (I40E_DESC_UNUSED(tx_ring) != tx_ring->count))
853 tx_ring->arm_wb = true;
854 }
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000855
Björn Töpel74608d12017-05-24 07:55:35 +0200856 if (ring_is_xdp(tx_ring))
857 return !!budget;
858
Alexander Duycke486bdf2016-09-12 14:18:40 -0700859 /* notify netdev of completed buffers */
860 netdev_tx_completed_queue(txring_txq(tx_ring),
Alexander Duyck7070ce02013-09-28 06:00:37 +0000861 total_packets, total_bytes);
862
Jesse Brandeburgb85c94b2017-06-20 15:16:59 -0700863#define TX_WAKE_THRESHOLD ((s16)(DESC_NEEDED * 2))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000864 if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
865 (I40E_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD))) {
866 /* Make sure that anybody stopping the queue after this
867 * sees the new next_to_clean.
868 */
869 smp_mb();
870 if (__netif_subqueue_stopped(tx_ring->netdev,
871 tx_ring->queue_index) &&
Jacob Keller0da36b92017-04-19 09:25:55 -0400872 !test_bit(__I40E_VSI_DOWN, vsi->state)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000873 netif_wake_subqueue(tx_ring->netdev,
874 tx_ring->queue_index);
875 ++tx_ring->tx_stats.restart_queue;
876 }
877 }
878
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000879 return !!budget;
880}
881
882/**
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800883 * i40e_enable_wb_on_itr - Arm hardware to do a wb, interrupts are not enabled
884 * @vsi: the VSI we care about
885 * @q_vector: the vector on which to enable writeback
886 *
887 **/
888static void i40e_enable_wb_on_itr(struct i40e_vsi *vsi,
889 struct i40e_q_vector *q_vector)
890{
891 u16 flags = q_vector->tx.ring[0].flags;
892 u32 val;
893
894 if (!(flags & I40E_TXR_FLAGS_WB_ON_ITR))
895 return;
896
897 if (q_vector->arm_wb_state)
898 return;
899
900 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
901 val = I40E_PFINT_DYN_CTLN_WB_ON_ITR_MASK |
902 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK; /* set noitr */
903
904 wr32(&vsi->back->hw,
905 I40E_PFINT_DYN_CTLN(q_vector->v_idx + vsi->base_vector - 1),
906 val);
907 } else {
908 val = I40E_PFINT_DYN_CTL0_WB_ON_ITR_MASK |
909 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK; /* set noitr */
910
911 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
912 }
913 q_vector->arm_wb_state = true;
914}
915
916/**
917 * i40e_force_wb - Issue SW Interrupt so HW does a wb
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000918 * @vsi: the VSI we care about
919 * @q_vector: the vector on which to force writeback
920 *
921 **/
Kiran Patilb03a8c12015-09-24 18:13:15 -0400922void i40e_force_wb(struct i40e_vsi *vsi, struct i40e_q_vector *q_vector)
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000923{
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800924 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -0400925 u32 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
926 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK | /* set noitr */
927 I40E_PFINT_DYN_CTLN_SWINT_TRIG_MASK |
928 I40E_PFINT_DYN_CTLN_SW_ITR_INDX_ENA_MASK;
929 /* allow 00 to be written to the index */
930
931 wr32(&vsi->back->hw,
932 I40E_PFINT_DYN_CTLN(q_vector->v_idx +
933 vsi->base_vector - 1), val);
934 } else {
935 u32 val = I40E_PFINT_DYN_CTL0_INTENA_MASK |
936 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK | /* set noitr */
937 I40E_PFINT_DYN_CTL0_SWINT_TRIG_MASK |
938 I40E_PFINT_DYN_CTL0_SW_ITR_INDX_ENA_MASK;
939 /* allow 00 to be written to the index */
940
941 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
942 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000943}
944
945/**
946 * i40e_set_new_dynamic_itr - Find new ITR level
947 * @rc: structure containing ring performance data
948 *
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400949 * Returns true if ITR changed, false if not
950 *
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000951 * Stores a new ITR value based on packets and byte counts during
952 * the last interrupt. The advantage of per interrupt computation
953 * is faster updates and more accurate ITR for the current traffic
954 * pattern. Constants in this function were computed based on
955 * theoretical maximum wire speed and thresholds were set based on
956 * testing data as well as attempting to minimize response time
957 * while increasing bulk throughput.
958 **/
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400959static bool i40e_set_new_dynamic_itr(struct i40e_ring_container *rc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000960{
961 enum i40e_latency_range new_latency_range = rc->latency_range;
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400962 struct i40e_q_vector *qv = rc->ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000963 u32 new_itr = rc->itr;
964 int bytes_per_int;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400965 int usecs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000966
967 if (rc->total_packets == 0 || !rc->itr)
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400968 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000969
970 /* simple throttlerate management
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400971 * 0-10MB/s lowest (50000 ints/s)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000972 * 10-20MB/s low (20000 ints/s)
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400973 * 20-1249MB/s bulk (18000 ints/s)
974 * > 40000 Rx packets per second (8000 ints/s)
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400975 *
976 * The math works out because the divisor is in 10^(-6) which
977 * turns the bytes/us input value into MB/s values, but
978 * make sure to use usecs, as the register values written
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400979 * are in 2 usec increments in the ITR registers, and make sure
980 * to use the smoothed values that the countdown timer gives us.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000981 */
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400982 usecs = (rc->itr << 1) * ITR_COUNTDOWN_START;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400983 bytes_per_int = rc->total_bytes / usecs;
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400984
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400985 switch (new_latency_range) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000986 case I40E_LOWEST_LATENCY:
987 if (bytes_per_int > 10)
988 new_latency_range = I40E_LOW_LATENCY;
989 break;
990 case I40E_LOW_LATENCY:
991 if (bytes_per_int > 20)
992 new_latency_range = I40E_BULK_LATENCY;
993 else if (bytes_per_int <= 10)
994 new_latency_range = I40E_LOWEST_LATENCY;
995 break;
996 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400997 case I40E_ULTRA_LATENCY:
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400998 default:
999 if (bytes_per_int <= 20)
1000 new_latency_range = I40E_LOW_LATENCY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001001 break;
1002 }
Jesse Brandeburgc56625d2015-09-28 14:16:53 -04001003
1004 /* this is to adjust RX more aggressively when streaming small
1005 * packets. The value of 40000 was picked as it is just beyond
1006 * what the hardware can receive per second if in low latency
1007 * mode.
1008 */
1009#define RX_ULTRA_PACKET_RATE 40000
1010
1011 if ((((rc->total_packets * 1000000) / usecs) > RX_ULTRA_PACKET_RATE) &&
1012 (&qv->rx == rc))
1013 new_latency_range = I40E_ULTRA_LATENCY;
1014
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001015 rc->latency_range = new_latency_range;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001016
1017 switch (new_latency_range) {
1018 case I40E_LOWEST_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -04001019 new_itr = I40E_ITR_50K;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001020 break;
1021 case I40E_LOW_LATENCY:
1022 new_itr = I40E_ITR_20K;
1023 break;
1024 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -04001025 new_itr = I40E_ITR_18K;
1026 break;
1027 case I40E_ULTRA_LATENCY:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001028 new_itr = I40E_ITR_8K;
1029 break;
1030 default:
1031 break;
1032 }
1033
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001034 rc->total_bytes = 0;
1035 rc->total_packets = 0;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001036
1037 if (new_itr != rc->itr) {
1038 rc->itr = new_itr;
1039 return true;
1040 }
1041
1042 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001043}
1044
1045/**
Alexander Duyck0e626ff2017-04-10 05:18:43 -04001046 * i40e_rx_is_programming_status - check for programming status descriptor
1047 * @qw: qword representing status_error_len in CPU ordering
1048 *
1049 * The value of in the descriptor length field indicate if this
1050 * is a programming status descriptor for flow director or FCoE
1051 * by the value of I40E_RX_PROG_STATUS_DESC_LENGTH, otherwise
1052 * it is a packet descriptor.
1053 **/
1054static inline bool i40e_rx_is_programming_status(u64 qw)
1055{
1056 /* The Rx filter programming status and SPH bit occupy the same
1057 * spot in the descriptor. Since we don't support packet split we
1058 * can just reuse the bit as an indication that this is a
1059 * programming status descriptor.
1060 */
1061 return qw & I40E_RXD_QW1_LENGTH_SPH_MASK;
1062}
1063
1064/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001065 * i40e_clean_programming_status - clean the programming status descriptor
1066 * @rx_ring: the rx ring that has this descriptor
1067 * @rx_desc: the rx descriptor written back by HW
Alexander Duyck0e626ff2017-04-10 05:18:43 -04001068 * @qw: qword representing status_error_len in CPU ordering
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001069 *
1070 * Flow director should handle FD_FILTER_STATUS to check its filter programming
1071 * status being successful or not and take actions accordingly. FCoE should
1072 * handle its context/filter programming/invalidation status and take actions.
1073 *
1074 **/
1075static void i40e_clean_programming_status(struct i40e_ring *rx_ring,
Alexander Duyck0e626ff2017-04-10 05:18:43 -04001076 union i40e_rx_desc *rx_desc,
1077 u64 qw)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001078{
Alexander Duyck0e626ff2017-04-10 05:18:43 -04001079 u32 ntc = rx_ring->next_to_clean + 1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001080 u8 id;
1081
Alexander Duyck0e626ff2017-04-10 05:18:43 -04001082 /* fetch, update, and store next to clean */
1083 ntc = (ntc < rx_ring->count) ? ntc : 0;
1084 rx_ring->next_to_clean = ntc;
1085
1086 prefetch(I40E_RX_DESC(rx_ring, ntc));
1087
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001088 id = (qw & I40E_RX_PROG_STATUS_DESC_QW1_PROGID_MASK) >>
1089 I40E_RX_PROG_STATUS_DESC_QW1_PROGID_SHIFT;
1090
1091 if (id == I40E_RX_PROG_STATUS_DESC_FD_FILTER_STATUS)
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00001092 i40e_fd_handle_status(rx_ring, rx_desc, id);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001093}
1094
1095/**
1096 * i40e_setup_tx_descriptors - Allocate the Tx descriptors
1097 * @tx_ring: the tx ring to set up
1098 *
1099 * Return 0 on success, negative on error
1100 **/
1101int i40e_setup_tx_descriptors(struct i40e_ring *tx_ring)
1102{
1103 struct device *dev = tx_ring->dev;
1104 int bi_size;
1105
1106 if (!dev)
1107 return -ENOMEM;
1108
Jesse Brandeburge908f812015-07-23 16:54:42 -04001109 /* warn if we are about to overwrite the pointer */
1110 WARN_ON(tx_ring->tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001111 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
1112 tx_ring->tx_bi = kzalloc(bi_size, GFP_KERNEL);
1113 if (!tx_ring->tx_bi)
1114 goto err;
1115
1116 /* round up to nearest 4K */
1117 tx_ring->size = tx_ring->count * sizeof(struct i40e_tx_desc);
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +00001118 /* add u32 for head writeback, align after this takes care of
1119 * guaranteeing this is at least one cache line in size
1120 */
1121 tx_ring->size += sizeof(u32);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001122 tx_ring->size = ALIGN(tx_ring->size, 4096);
1123 tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
1124 &tx_ring->dma, GFP_KERNEL);
1125 if (!tx_ring->desc) {
1126 dev_info(dev, "Unable to allocate memory for the Tx descriptor ring, size=%d\n",
1127 tx_ring->size);
1128 goto err;
1129 }
1130
1131 tx_ring->next_to_use = 0;
1132 tx_ring->next_to_clean = 0;
1133 return 0;
1134
1135err:
1136 kfree(tx_ring->tx_bi);
1137 tx_ring->tx_bi = NULL;
1138 return -ENOMEM;
1139}
1140
1141/**
1142 * i40e_clean_rx_ring - Free Rx buffers
1143 * @rx_ring: ring to be cleaned
1144 **/
1145void i40e_clean_rx_ring(struct i40e_ring *rx_ring)
1146{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001147 unsigned long bi_size;
1148 u16 i;
1149
1150 /* ring already cleared, nothing to do */
1151 if (!rx_ring->rx_bi)
1152 return;
1153
Scott Petersone72e5652017-02-09 23:40:25 -08001154 if (rx_ring->skb) {
1155 dev_kfree_skb(rx_ring->skb);
1156 rx_ring->skb = NULL;
1157 }
1158
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001159 /* Free all the Rx ring sk_buffs */
1160 for (i = 0; i < rx_ring->count; i++) {
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001161 struct i40e_rx_buffer *rx_bi = &rx_ring->rx_bi[i];
1162
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001163 if (!rx_bi->page)
1164 continue;
1165
Alexander Duyck59605bc2017-01-30 12:29:35 -08001166 /* Invalidate cache lines that may have been written to by
1167 * device so that we avoid corrupting memory.
1168 */
1169 dma_sync_single_range_for_cpu(rx_ring->dev,
1170 rx_bi->dma,
1171 rx_bi->page_offset,
Alexander Duyck98efd692017-04-05 07:51:01 -04001172 rx_ring->rx_buf_len,
Alexander Duyck59605bc2017-01-30 12:29:35 -08001173 DMA_FROM_DEVICE);
1174
1175 /* free resources associated with mapping */
1176 dma_unmap_page_attrs(rx_ring->dev, rx_bi->dma,
Alexander Duyck98efd692017-04-05 07:51:01 -04001177 i40e_rx_pg_size(rx_ring),
Alexander Duyck59605bc2017-01-30 12:29:35 -08001178 DMA_FROM_DEVICE,
1179 I40E_RX_DMA_ATTR);
Alexander Duyck98efd692017-04-05 07:51:01 -04001180
Alexander Duyck17936682017-02-21 15:55:39 -08001181 __page_frag_cache_drain(rx_bi->page, rx_bi->pagecnt_bias);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001182
1183 rx_bi->page = NULL;
1184 rx_bi->page_offset = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001185 }
1186
1187 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1188 memset(rx_ring->rx_bi, 0, bi_size);
1189
1190 /* Zero out the descriptor ring */
1191 memset(rx_ring->desc, 0, rx_ring->size);
1192
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001193 rx_ring->next_to_alloc = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001194 rx_ring->next_to_clean = 0;
1195 rx_ring->next_to_use = 0;
1196}
1197
1198/**
1199 * i40e_free_rx_resources - Free Rx resources
1200 * @rx_ring: ring to clean the resources from
1201 *
1202 * Free all receive software resources
1203 **/
1204void i40e_free_rx_resources(struct i40e_ring *rx_ring)
1205{
1206 i40e_clean_rx_ring(rx_ring);
Björn Töpel0c8493d2017-05-24 07:55:34 +02001207 rx_ring->xdp_prog = NULL;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001208 kfree(rx_ring->rx_bi);
1209 rx_ring->rx_bi = NULL;
1210
1211 if (rx_ring->desc) {
1212 dma_free_coherent(rx_ring->dev, rx_ring->size,
1213 rx_ring->desc, rx_ring->dma);
1214 rx_ring->desc = NULL;
1215 }
1216}
1217
1218/**
1219 * i40e_setup_rx_descriptors - Allocate Rx descriptors
1220 * @rx_ring: Rx descriptor ring (for a specific queue) to setup
1221 *
1222 * Returns 0 on success, negative on failure
1223 **/
1224int i40e_setup_rx_descriptors(struct i40e_ring *rx_ring)
1225{
1226 struct device *dev = rx_ring->dev;
1227 int bi_size;
1228
Jesse Brandeburge908f812015-07-23 16:54:42 -04001229 /* warn if we are about to overwrite the pointer */
1230 WARN_ON(rx_ring->rx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001231 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1232 rx_ring->rx_bi = kzalloc(bi_size, GFP_KERNEL);
1233 if (!rx_ring->rx_bi)
1234 goto err;
1235
Carolyn Wybornyf217d6c2015-02-09 17:42:31 -08001236 u64_stats_init(&rx_ring->syncp);
Carolyn Wyborny638702b2015-01-24 09:58:32 +00001237
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001238 /* Round up to nearest 4K */
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001239 rx_ring->size = rx_ring->count * sizeof(union i40e_32byte_rx_desc);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001240 rx_ring->size = ALIGN(rx_ring->size, 4096);
1241 rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
1242 &rx_ring->dma, GFP_KERNEL);
1243
1244 if (!rx_ring->desc) {
1245 dev_info(dev, "Unable to allocate memory for the Rx descriptor ring, size=%d\n",
1246 rx_ring->size);
1247 goto err;
1248 }
1249
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001250 rx_ring->next_to_alloc = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001251 rx_ring->next_to_clean = 0;
1252 rx_ring->next_to_use = 0;
1253
Björn Töpel0c8493d2017-05-24 07:55:34 +02001254 rx_ring->xdp_prog = rx_ring->vsi->xdp_prog;
1255
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001256 return 0;
1257err:
1258 kfree(rx_ring->rx_bi);
1259 rx_ring->rx_bi = NULL;
1260 return -ENOMEM;
1261}
1262
1263/**
1264 * i40e_release_rx_desc - Store the new tail and head values
1265 * @rx_ring: ring to bump
1266 * @val: new head index
1267 **/
1268static inline void i40e_release_rx_desc(struct i40e_ring *rx_ring, u32 val)
1269{
1270 rx_ring->next_to_use = val;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001271
1272 /* update next to alloc since we have filled the ring */
1273 rx_ring->next_to_alloc = val;
1274
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001275 /* Force memory writes to complete before letting h/w
1276 * know there are new descriptors to fetch. (Only
1277 * applicable for weak-ordered memory model archs,
1278 * such as IA-64).
1279 */
1280 wmb();
1281 writel(val, rx_ring->tail);
1282}
1283
1284/**
Alexander Duyckca9ec082017-04-05 07:51:02 -04001285 * i40e_rx_offset - Return expected offset into page to access data
1286 * @rx_ring: Ring we are requesting offset of
1287 *
1288 * Returns the offset value for ring into the data buffer.
1289 */
1290static inline unsigned int i40e_rx_offset(struct i40e_ring *rx_ring)
1291{
1292 return ring_uses_build_skb(rx_ring) ? I40E_SKB_PAD : 0;
1293}
1294
1295/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001296 * i40e_alloc_mapped_page - recycle or make a new page
1297 * @rx_ring: ring to use
1298 * @bi: rx_buffer struct to modify
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001299 *
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001300 * Returns true if the page was successfully allocated or
1301 * reused.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001302 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001303static bool i40e_alloc_mapped_page(struct i40e_ring *rx_ring,
1304 struct i40e_rx_buffer *bi)
Mitch Williamsa132af22015-01-24 09:58:35 +00001305{
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001306 struct page *page = bi->page;
1307 dma_addr_t dma;
Mitch Williamsa132af22015-01-24 09:58:35 +00001308
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001309 /* since we are recycling buffers we should seldom need to alloc */
1310 if (likely(page)) {
1311 rx_ring->rx_stats.page_reuse_count++;
1312 return true;
Mitch Williamsa132af22015-01-24 09:58:35 +00001313 }
1314
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001315 /* alloc new page for storage */
Alexander Duyck98efd692017-04-05 07:51:01 -04001316 page = dev_alloc_pages(i40e_rx_pg_order(rx_ring));
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001317 if (unlikely(!page)) {
1318 rx_ring->rx_stats.alloc_page_failed++;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001319 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001320 }
1321
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001322 /* map page for use */
Alexander Duyck59605bc2017-01-30 12:29:35 -08001323 dma = dma_map_page_attrs(rx_ring->dev, page, 0,
Alexander Duyck98efd692017-04-05 07:51:01 -04001324 i40e_rx_pg_size(rx_ring),
Alexander Duyck59605bc2017-01-30 12:29:35 -08001325 DMA_FROM_DEVICE,
1326 I40E_RX_DMA_ATTR);
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001327
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001328 /* if mapping failed free memory back to system since
1329 * there isn't much point in holding memory we can't use
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001330 */
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001331 if (dma_mapping_error(rx_ring->dev, dma)) {
Alexander Duyck98efd692017-04-05 07:51:01 -04001332 __free_pages(page, i40e_rx_pg_order(rx_ring));
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001333 rx_ring->rx_stats.alloc_page_failed++;
1334 return false;
1335 }
1336
1337 bi->dma = dma;
1338 bi->page = page;
Alexander Duyckca9ec082017-04-05 07:51:02 -04001339 bi->page_offset = i40e_rx_offset(rx_ring);
Alexander Duycka0cfc312017-03-14 10:15:24 -07001340
1341 /* initialize pagecnt_bias to 1 representing we fully own page */
Alexander Duyck17936682017-02-21 15:55:39 -08001342 bi->pagecnt_bias = 1;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001343
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001344 return true;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001345}
1346
1347/**
1348 * i40e_receive_skb - Send a completed packet up the stack
1349 * @rx_ring: rx ring in play
1350 * @skb: packet to send up
1351 * @vlan_tag: vlan tag for packet
1352 **/
1353static void i40e_receive_skb(struct i40e_ring *rx_ring,
1354 struct sk_buff *skb, u16 vlan_tag)
1355{
1356 struct i40e_q_vector *q_vector = rx_ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001357
Jesse Brandeburga149f2c2016-04-12 08:30:49 -07001358 if ((rx_ring->netdev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
1359 (vlan_tag & VLAN_VID_MASK))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001360 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlan_tag);
1361
Alexander Duyck8b650352015-09-24 09:04:32 -07001362 napi_gro_receive(&q_vector->napi, skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001363}
1364
1365/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001366 * i40e_alloc_rx_buffers - Replace used receive buffers
1367 * @rx_ring: ring to place buffers on
1368 * @cleaned_count: number of buffers to replace
1369 *
1370 * Returns false if all allocations were successful, true if any fail
1371 **/
1372bool i40e_alloc_rx_buffers(struct i40e_ring *rx_ring, u16 cleaned_count)
1373{
1374 u16 ntu = rx_ring->next_to_use;
1375 union i40e_rx_desc *rx_desc;
1376 struct i40e_rx_buffer *bi;
1377
1378 /* do nothing if no valid netdev defined */
1379 if (!rx_ring->netdev || !cleaned_count)
1380 return false;
1381
1382 rx_desc = I40E_RX_DESC(rx_ring, ntu);
1383 bi = &rx_ring->rx_bi[ntu];
1384
1385 do {
1386 if (!i40e_alloc_mapped_page(rx_ring, bi))
1387 goto no_buffers;
1388
Alexander Duyck59605bc2017-01-30 12:29:35 -08001389 /* sync the buffer for use by the device */
1390 dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
1391 bi->page_offset,
Alexander Duyck98efd692017-04-05 07:51:01 -04001392 rx_ring->rx_buf_len,
Alexander Duyck59605bc2017-01-30 12:29:35 -08001393 DMA_FROM_DEVICE);
1394
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001395 /* Refresh the desc even if buffer_addrs didn't change
1396 * because each write-back erases this info.
1397 */
1398 rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001399
1400 rx_desc++;
1401 bi++;
1402 ntu++;
1403 if (unlikely(ntu == rx_ring->count)) {
1404 rx_desc = I40E_RX_DESC(rx_ring, 0);
1405 bi = rx_ring->rx_bi;
1406 ntu = 0;
1407 }
1408
1409 /* clear the status bits for the next_to_use descriptor */
1410 rx_desc->wb.qword1.status_error_len = 0;
1411
1412 cleaned_count--;
1413 } while (cleaned_count);
1414
1415 if (rx_ring->next_to_use != ntu)
1416 i40e_release_rx_desc(rx_ring, ntu);
1417
1418 return false;
1419
1420no_buffers:
1421 if (rx_ring->next_to_use != ntu)
1422 i40e_release_rx_desc(rx_ring, ntu);
1423
1424 /* make sure to come back via polling to try again after
1425 * allocation failure
1426 */
1427 return true;
1428}
1429
1430/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001431 * i40e_rx_checksum - Indicate in skb if hw indicated a good cksum
1432 * @vsi: the VSI we care about
1433 * @skb: skb currently being received and modified
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001434 * @rx_desc: the receive descriptor
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001435 **/
1436static inline void i40e_rx_checksum(struct i40e_vsi *vsi,
1437 struct sk_buff *skb,
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001438 union i40e_rx_desc *rx_desc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001439{
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001440 struct i40e_rx_ptype_decoded decoded;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001441 u32 rx_error, rx_status;
Alexander Duyck858296c82016-06-14 15:45:42 -07001442 bool ipv4, ipv6;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001443 u8 ptype;
1444 u64 qword;
1445
1446 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1447 ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >> I40E_RXD_QW1_PTYPE_SHIFT;
1448 rx_error = (qword & I40E_RXD_QW1_ERROR_MASK) >>
1449 I40E_RXD_QW1_ERROR_SHIFT;
1450 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1451 I40E_RXD_QW1_STATUS_SHIFT;
1452 decoded = decode_rx_desc_ptype(ptype);
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001453
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001454 skb->ip_summed = CHECKSUM_NONE;
1455
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001456 skb_checksum_none_assert(skb);
1457
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001458 /* Rx csum enabled and ip headers found? */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001459 if (!(vsi->netdev->features & NETIF_F_RXCSUM))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001460 return;
1461
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001462 /* did the hardware decode the packet and checksum? */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001463 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_L3L4P_SHIFT)))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001464 return;
1465
1466 /* both known and outer_ip must be set for the below code to work */
1467 if (!(decoded.known && decoded.outer_ip))
1468 return;
1469
Alexander Duyckfad57332016-01-24 21:17:22 -08001470 ipv4 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1471 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV4);
1472 ipv6 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1473 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV6);
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001474
1475 if (ipv4 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001476 (rx_error & (BIT(I40E_RX_DESC_ERROR_IPE_SHIFT) |
1477 BIT(I40E_RX_DESC_ERROR_EIPE_SHIFT))))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001478 goto checksum_fail;
1479
Jesse Brandeburgddf1d0d2014-02-13 03:48:39 -08001480 /* likely incorrect csum if alternate IP extension headers found */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001481 if (ipv6 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001482 rx_status & BIT(I40E_RX_DESC_STATUS_IPV6EXADD_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001483 /* don't increment checksum err here, non-fatal err */
Shannon Nelson8ee75a82013-12-21 05:44:46 +00001484 return;
1485
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001486 /* there was some L4 error, count error and punt packet to the stack */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001487 if (rx_error & BIT(I40E_RX_DESC_ERROR_L4E_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001488 goto checksum_fail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001489
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001490 /* handle packets that were not able to be checksummed due
1491 * to arrival speed, in this case the stack can compute
1492 * the csum.
1493 */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001494 if (rx_error & BIT(I40E_RX_DESC_ERROR_PPRS_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001495 return;
1496
Alexander Duyck858296c82016-06-14 15:45:42 -07001497 /* If there is an outer header present that might contain a checksum
1498 * we need to bump the checksum level by 1 to reflect the fact that
1499 * we are indicating we validated the inner checksum.
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001500 */
Alexander Duyck858296c82016-06-14 15:45:42 -07001501 if (decoded.tunnel_type >= I40E_RX_PTYPE_TUNNEL_IP_GRENAT)
1502 skb->csum_level = 1;
Alexander Duyckfad57332016-01-24 21:17:22 -08001503
Alexander Duyck858296c82016-06-14 15:45:42 -07001504 /* Only report checksum unnecessary for TCP, UDP, or SCTP */
1505 switch (decoded.inner_prot) {
1506 case I40E_RX_PTYPE_INNER_PROT_TCP:
1507 case I40E_RX_PTYPE_INNER_PROT_UDP:
1508 case I40E_RX_PTYPE_INNER_PROT_SCTP:
1509 skb->ip_summed = CHECKSUM_UNNECESSARY;
1510 /* fall though */
1511 default:
1512 break;
1513 }
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001514
1515 return;
1516
1517checksum_fail:
1518 vsi->back->hw_csum_rx_error++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001519}
1520
1521/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001522 * i40e_ptype_to_htype - get a hash type
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001523 * @ptype: the ptype value from the descriptor
1524 *
1525 * Returns a hash type to be used by skb_set_hash
1526 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001527static inline int i40e_ptype_to_htype(u8 ptype)
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001528{
1529 struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype(ptype);
1530
1531 if (!decoded.known)
1532 return PKT_HASH_TYPE_NONE;
1533
1534 if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1535 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY4)
1536 return PKT_HASH_TYPE_L4;
1537 else if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1538 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY3)
1539 return PKT_HASH_TYPE_L3;
1540 else
1541 return PKT_HASH_TYPE_L2;
1542}
1543
1544/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001545 * i40e_rx_hash - set the hash value in the skb
1546 * @ring: descriptor ring
1547 * @rx_desc: specific descriptor
1548 **/
1549static inline void i40e_rx_hash(struct i40e_ring *ring,
1550 union i40e_rx_desc *rx_desc,
1551 struct sk_buff *skb,
1552 u8 rx_ptype)
1553{
1554 u32 hash;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001555 const __le64 rss_mask =
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001556 cpu_to_le64((u64)I40E_RX_DESC_FLTSTAT_RSS_HASH <<
1557 I40E_RX_DESC_STATUS_FLTSTAT_SHIFT);
1558
Mitch Williamsa876c3b2016-05-03 15:13:18 -07001559 if (!(ring->netdev->features & NETIF_F_RXHASH))
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001560 return;
1561
1562 if ((rx_desc->wb.qword1.status_error_len & rss_mask) == rss_mask) {
1563 hash = le32_to_cpu(rx_desc->wb.qword0.hi_dword.rss);
1564 skb_set_hash(skb, hash, i40e_ptype_to_htype(rx_ptype));
1565 }
1566}
1567
1568/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001569 * i40e_process_skb_fields - Populate skb header fields from Rx descriptor
1570 * @rx_ring: rx descriptor ring packet is being transacted on
1571 * @rx_desc: pointer to the EOP Rx descriptor
1572 * @skb: pointer to current skb being populated
1573 * @rx_ptype: the packet type decoded by hardware
Mitch Williamsa132af22015-01-24 09:58:35 +00001574 *
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001575 * This function checks the ring, descriptor, and packet information in
1576 * order to populate the hash, checksum, VLAN, protocol, and
1577 * other fields within the skb.
Mitch Williamsa132af22015-01-24 09:58:35 +00001578 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001579static inline
1580void i40e_process_skb_fields(struct i40e_ring *rx_ring,
1581 union i40e_rx_desc *rx_desc, struct sk_buff *skb,
1582 u8 rx_ptype)
1583{
1584 u64 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1585 u32 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1586 I40E_RXD_QW1_STATUS_SHIFT;
Jacob Keller144ed172016-10-05 09:30:42 -07001587 u32 tsynvalid = rx_status & I40E_RXD_QW1_STATUS_TSYNVALID_MASK;
1588 u32 tsyn = (rx_status & I40E_RXD_QW1_STATUS_TSYNINDX_MASK) >>
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001589 I40E_RXD_QW1_STATUS_TSYNINDX_SHIFT;
1590
Jacob Keller12490502016-10-05 09:30:44 -07001591 if (unlikely(tsynvalid))
Jacob Keller144ed172016-10-05 09:30:42 -07001592 i40e_ptp_rx_hwtstamp(rx_ring->vsi->back, skb, tsyn);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001593
1594 i40e_rx_hash(rx_ring, rx_desc, skb, rx_ptype);
1595
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001596 i40e_rx_checksum(rx_ring->vsi, skb, rx_desc);
1597
1598 skb_record_rx_queue(skb, rx_ring->queue_index);
Alexander Duycka5b268e2017-02-21 15:55:46 -08001599
1600 /* modifies the skb - consumes the enet header */
1601 skb->protocol = eth_type_trans(skb, rx_ring->netdev);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001602}
1603
1604/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001605 * i40e_cleanup_headers - Correct empty headers
1606 * @rx_ring: rx descriptor ring packet is being transacted on
1607 * @skb: pointer to current skb being fixed
Björn Töpel0c8493d2017-05-24 07:55:34 +02001608 * @rx_desc: pointer to the EOP Rx descriptor
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001609 *
1610 * Also address the case where we are pulling data in on pages only
1611 * and as such no data is present in the skb header.
1612 *
1613 * In addition if skb is not at least 60 bytes we need to pad it so that
1614 * it is large enough to qualify as a valid Ethernet frame.
1615 *
1616 * Returns true if an error was encountered and skb was freed.
1617 **/
Björn Töpel0c8493d2017-05-24 07:55:34 +02001618static bool i40e_cleanup_headers(struct i40e_ring *rx_ring, struct sk_buff *skb,
1619 union i40e_rx_desc *rx_desc)
1620
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001621{
Björn Töpel0c8493d2017-05-24 07:55:34 +02001622 /* XDP packets use error pointer so abort at this point */
1623 if (IS_ERR(skb))
1624 return true;
1625
1626 /* ERR_MASK will only have valid bits if EOP set, and
1627 * what we are doing here is actually checking
1628 * I40E_RX_DESC_ERROR_RXE_SHIFT, since it is the zeroth bit in
1629 * the error field
1630 */
1631 if (unlikely(i40e_test_staterr(rx_desc,
1632 BIT(I40E_RXD_QW1_ERROR_SHIFT)))) {
1633 dev_kfree_skb_any(skb);
1634 return true;
1635 }
1636
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001637 /* if eth_skb_pad returns an error the skb was freed */
1638 if (eth_skb_pad(skb))
1639 return true;
1640
1641 return false;
1642}
1643
1644/**
1645 * i40e_reuse_rx_page - page flip buffer and store it back on the ring
1646 * @rx_ring: rx descriptor ring to store buffers on
1647 * @old_buff: donor buffer to have page reused
1648 *
1649 * Synchronizes page for reuse by the adapter
1650 **/
1651static void i40e_reuse_rx_page(struct i40e_ring *rx_ring,
1652 struct i40e_rx_buffer *old_buff)
1653{
1654 struct i40e_rx_buffer *new_buff;
1655 u16 nta = rx_ring->next_to_alloc;
1656
1657 new_buff = &rx_ring->rx_bi[nta];
1658
1659 /* update, and store next to alloc */
1660 nta++;
1661 rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
1662
1663 /* transfer page from old buffer to new buffer */
Alexander Duyck17936682017-02-21 15:55:39 -08001664 new_buff->dma = old_buff->dma;
1665 new_buff->page = old_buff->page;
1666 new_buff->page_offset = old_buff->page_offset;
1667 new_buff->pagecnt_bias = old_buff->pagecnt_bias;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001668}
1669
1670/**
Scott Peterson9b37c932017-02-09 23:43:30 -08001671 * i40e_page_is_reusable - check if any reuse is possible
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001672 * @page: page struct to check
Scott Peterson9b37c932017-02-09 23:43:30 -08001673 *
1674 * A page is not reusable if it was allocated under low memory
1675 * conditions, or it's not in the same NUMA node as this CPU.
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001676 */
Scott Peterson9b37c932017-02-09 23:43:30 -08001677static inline bool i40e_page_is_reusable(struct page *page)
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001678{
Scott Peterson9b37c932017-02-09 23:43:30 -08001679 return (page_to_nid(page) == numa_mem_id()) &&
1680 !page_is_pfmemalloc(page);
1681}
1682
1683/**
1684 * i40e_can_reuse_rx_page - Determine if this page can be reused by
1685 * the adapter for another receive
1686 *
1687 * @rx_buffer: buffer containing the page
Scott Peterson9b37c932017-02-09 23:43:30 -08001688 *
1689 * If page is reusable, rx_buffer->page_offset is adjusted to point to
1690 * an unused region in the page.
1691 *
1692 * For small pages, @truesize will be a constant value, half the size
1693 * of the memory at page. We'll attempt to alternate between high and
1694 * low halves of the page, with one half ready for use by the hardware
1695 * and the other half being consumed by the stack. We use the page
1696 * ref count to determine whether the stack has finished consuming the
1697 * portion of this page that was passed up with a previous packet. If
1698 * the page ref count is >1, we'll assume the "other" half page is
1699 * still busy, and this page cannot be reused.
1700 *
1701 * For larger pages, @truesize will be the actual space used by the
1702 * received packet (adjusted upward to an even multiple of the cache
1703 * line size). This will advance through the page by the amount
1704 * actually consumed by the received packets while there is still
1705 * space for a buffer. Each region of larger pages will be used at
1706 * most once, after which the page will not be reused.
1707 *
1708 * In either case, if the page is reusable its refcount is increased.
1709 **/
Alexander Duycka0cfc312017-03-14 10:15:24 -07001710static bool i40e_can_reuse_rx_page(struct i40e_rx_buffer *rx_buffer)
Scott Peterson9b37c932017-02-09 23:43:30 -08001711{
Alexander Duycka0cfc312017-03-14 10:15:24 -07001712 unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
1713 struct page *page = rx_buffer->page;
Scott Peterson9b37c932017-02-09 23:43:30 -08001714
1715 /* Is any reuse possible? */
1716 if (unlikely(!i40e_page_is_reusable(page)))
1717 return false;
1718
1719#if (PAGE_SIZE < 8192)
1720 /* if we are only owner of page we can reuse it */
Alexander Duycka0cfc312017-03-14 10:15:24 -07001721 if (unlikely((page_count(page) - pagecnt_bias) > 1))
Scott Peterson9b37c932017-02-09 23:43:30 -08001722 return false;
Scott Peterson9b37c932017-02-09 23:43:30 -08001723#else
Alexander Duyck98efd692017-04-05 07:51:01 -04001724#define I40E_LAST_OFFSET \
1725 (SKB_WITH_OVERHEAD(PAGE_SIZE) - I40E_RXBUFFER_2048)
1726 if (rx_buffer->page_offset > I40E_LAST_OFFSET)
Scott Peterson9b37c932017-02-09 23:43:30 -08001727 return false;
1728#endif
1729
Alexander Duyck17936682017-02-21 15:55:39 -08001730 /* If we have drained the page fragment pool we need to update
1731 * the pagecnt_bias and page count so that we fully restock the
1732 * number of references the driver holds.
1733 */
Alexander Duycka0cfc312017-03-14 10:15:24 -07001734 if (unlikely(!pagecnt_bias)) {
Alexander Duyck17936682017-02-21 15:55:39 -08001735 page_ref_add(page, USHRT_MAX);
1736 rx_buffer->pagecnt_bias = USHRT_MAX;
1737 }
Alexander Duycka0cfc312017-03-14 10:15:24 -07001738
Scott Peterson9b37c932017-02-09 23:43:30 -08001739 return true;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001740}
1741
1742/**
1743 * i40e_add_rx_frag - Add contents of Rx buffer to sk_buff
1744 * @rx_ring: rx descriptor ring to transact packets on
1745 * @rx_buffer: buffer containing page to add
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001746 * @skb: sk_buff to place the data into
Alexander Duycka0cfc312017-03-14 10:15:24 -07001747 * @size: packet length from rx_desc
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001748 *
1749 * This function will add the data contained in rx_buffer->page to the skb.
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001750 * It will just attach the page as a frag to the skb.
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001751 *
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001752 * The function will then update the page offset.
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001753 **/
Alexander Duycka0cfc312017-03-14 10:15:24 -07001754static void i40e_add_rx_frag(struct i40e_ring *rx_ring,
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001755 struct i40e_rx_buffer *rx_buffer,
Alexander Duycka0cfc312017-03-14 10:15:24 -07001756 struct sk_buff *skb,
1757 unsigned int size)
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001758{
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001759#if (PAGE_SIZE < 8192)
Alexander Duyck98efd692017-04-05 07:51:01 -04001760 unsigned int truesize = i40e_rx_pg_size(rx_ring) / 2;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001761#else
Alexander Duyckca9ec082017-04-05 07:51:02 -04001762 unsigned int truesize = SKB_DATA_ALIGN(size + i40e_rx_offset(rx_ring));
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001763#endif
Scott Peterson9b37c932017-02-09 23:43:30 -08001764
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001765 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
1766 rx_buffer->page_offset, size, truesize);
Scott Peterson9b37c932017-02-09 23:43:30 -08001767
Alexander Duycka0cfc312017-03-14 10:15:24 -07001768 /* page is being used so we must update the page offset */
1769#if (PAGE_SIZE < 8192)
1770 rx_buffer->page_offset ^= truesize;
1771#else
1772 rx_buffer->page_offset += truesize;
1773#endif
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001774}
1775
1776/**
Alexander Duyck9a064122017-03-14 10:15:23 -07001777 * i40e_get_rx_buffer - Fetch Rx buffer and synchronize data for use
1778 * @rx_ring: rx descriptor ring to transact packets on
1779 * @size: size of buffer to add to skb
1780 *
1781 * This function will pull an Rx buffer from the ring and synchronize it
1782 * for use by the CPU.
1783 */
1784static struct i40e_rx_buffer *i40e_get_rx_buffer(struct i40e_ring *rx_ring,
1785 const unsigned int size)
1786{
1787 struct i40e_rx_buffer *rx_buffer;
1788
1789 rx_buffer = &rx_ring->rx_bi[rx_ring->next_to_clean];
1790 prefetchw(rx_buffer->page);
1791
1792 /* we are reusing so sync this buffer for CPU use */
1793 dma_sync_single_range_for_cpu(rx_ring->dev,
1794 rx_buffer->dma,
1795 rx_buffer->page_offset,
1796 size,
1797 DMA_FROM_DEVICE);
1798
Alexander Duycka0cfc312017-03-14 10:15:24 -07001799 /* We have pulled a buffer for use, so decrement pagecnt_bias */
1800 rx_buffer->pagecnt_bias--;
1801
Alexander Duyck9a064122017-03-14 10:15:23 -07001802 return rx_buffer;
1803}
1804
1805/**
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001806 * i40e_construct_skb - Allocate skb and populate it
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001807 * @rx_ring: rx descriptor ring to transact packets on
Alexander Duyck9a064122017-03-14 10:15:23 -07001808 * @rx_buffer: rx buffer to pull data from
Björn Töpel0c8493d2017-05-24 07:55:34 +02001809 * @xdp: xdp_buff pointing to the data
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001810 *
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001811 * This function allocates an skb. It then populates it with the page
1812 * data from the current receive descriptor, taking care to set up the
1813 * skb correctly.
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001814 */
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001815static struct sk_buff *i40e_construct_skb(struct i40e_ring *rx_ring,
1816 struct i40e_rx_buffer *rx_buffer,
Björn Töpel0c8493d2017-05-24 07:55:34 +02001817 struct xdp_buff *xdp)
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001818{
Björn Töpel0c8493d2017-05-24 07:55:34 +02001819 unsigned int size = xdp->data_end - xdp->data;
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001820#if (PAGE_SIZE < 8192)
Alexander Duyck98efd692017-04-05 07:51:01 -04001821 unsigned int truesize = i40e_rx_pg_size(rx_ring) / 2;
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001822#else
1823 unsigned int truesize = SKB_DATA_ALIGN(size);
1824#endif
1825 unsigned int headlen;
1826 struct sk_buff *skb;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001827
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001828 /* prefetch first cache line of first page */
Björn Töpel0c8493d2017-05-24 07:55:34 +02001829 prefetch(xdp->data);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001830#if L1_CACHE_BYTES < 128
Björn Töpel0c8493d2017-05-24 07:55:34 +02001831 prefetch(xdp->data + L1_CACHE_BYTES);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001832#endif
1833
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001834 /* allocate a skb to store the frags */
1835 skb = __napi_alloc_skb(&rx_ring->q_vector->napi,
1836 I40E_RX_HDR_SIZE,
1837 GFP_ATOMIC | __GFP_NOWARN);
1838 if (unlikely(!skb))
1839 return NULL;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001840
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001841 /* Determine available headroom for copy */
1842 headlen = size;
1843 if (headlen > I40E_RX_HDR_SIZE)
Björn Töpel0c8493d2017-05-24 07:55:34 +02001844 headlen = eth_get_headlen(xdp->data, I40E_RX_HDR_SIZE);
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001845
1846 /* align pull length to size of long to optimize memcpy performance */
Björn Töpel0c8493d2017-05-24 07:55:34 +02001847 memcpy(__skb_put(skb, headlen), xdp->data,
1848 ALIGN(headlen, sizeof(long)));
Alexander Duyckfa2343e2017-03-14 10:15:25 -07001849
1850 /* update all of the pointers */
1851 size -= headlen;
1852 if (size) {
1853 skb_add_rx_frag(skb, 0, rx_buffer->page,
1854 rx_buffer->page_offset + headlen,
1855 size, truesize);
1856
1857 /* buffer is used by skb, update page_offset */
1858#if (PAGE_SIZE < 8192)
1859 rx_buffer->page_offset ^= truesize;
1860#else
1861 rx_buffer->page_offset += truesize;
1862#endif
1863 } else {
1864 /* buffer is unused, reset bias back to rx_buffer */
1865 rx_buffer->pagecnt_bias++;
1866 }
Alexander Duycka0cfc312017-03-14 10:15:24 -07001867
1868 return skb;
1869}
1870
1871/**
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001872 * i40e_build_skb - Build skb around an existing buffer
1873 * @rx_ring: Rx descriptor ring to transact packets on
1874 * @rx_buffer: Rx buffer to pull data from
Björn Töpel0c8493d2017-05-24 07:55:34 +02001875 * @xdp: xdp_buff pointing to the data
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001876 *
1877 * This function builds an skb around an existing Rx buffer, taking care
1878 * to set up the skb correctly and avoid any memcpy overhead.
1879 */
1880static struct sk_buff *i40e_build_skb(struct i40e_ring *rx_ring,
1881 struct i40e_rx_buffer *rx_buffer,
Björn Töpel0c8493d2017-05-24 07:55:34 +02001882 struct xdp_buff *xdp)
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001883{
Björn Töpel0c8493d2017-05-24 07:55:34 +02001884 unsigned int size = xdp->data_end - xdp->data;
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001885#if (PAGE_SIZE < 8192)
1886 unsigned int truesize = i40e_rx_pg_size(rx_ring) / 2;
1887#else
Björn Töpel2aae9182017-05-15 06:52:00 +02001888 unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
1889 SKB_DATA_ALIGN(I40E_SKB_PAD + size);
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001890#endif
1891 struct sk_buff *skb;
1892
1893 /* prefetch first cache line of first page */
Björn Töpel0c8493d2017-05-24 07:55:34 +02001894 prefetch(xdp->data);
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001895#if L1_CACHE_BYTES < 128
Björn Töpel0c8493d2017-05-24 07:55:34 +02001896 prefetch(xdp->data + L1_CACHE_BYTES);
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001897#endif
1898 /* build an skb around the page buffer */
Björn Töpel0c8493d2017-05-24 07:55:34 +02001899 skb = build_skb(xdp->data_hard_start, truesize);
Alexander Duyckf8b45b72017-04-05 07:51:03 -04001900 if (unlikely(!skb))
1901 return NULL;
1902
1903 /* update pointers within the skb to store the data */
1904 skb_reserve(skb, I40E_SKB_PAD);
1905 __skb_put(skb, size);
1906
1907 /* buffer is used by skb, update page_offset */
1908#if (PAGE_SIZE < 8192)
1909 rx_buffer->page_offset ^= truesize;
1910#else
1911 rx_buffer->page_offset += truesize;
1912#endif
1913
1914 return skb;
1915}
1916
1917/**
Alexander Duycka0cfc312017-03-14 10:15:24 -07001918 * i40e_put_rx_buffer - Clean up used buffer and either recycle or free
1919 * @rx_ring: rx descriptor ring to transact packets on
1920 * @rx_buffer: rx buffer to pull data from
1921 *
1922 * This function will clean up the contents of the rx_buffer. It will
1923 * either recycle the bufer or unmap it and free the associated resources.
1924 */
1925static void i40e_put_rx_buffer(struct i40e_ring *rx_ring,
1926 struct i40e_rx_buffer *rx_buffer)
1927{
1928 if (i40e_can_reuse_rx_page(rx_buffer)) {
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001929 /* hand second half of page back to the ring */
1930 i40e_reuse_rx_page(rx_ring, rx_buffer);
1931 rx_ring->rx_stats.page_reuse_count++;
1932 } else {
1933 /* we are not reusing the buffer so unmap it */
Alexander Duyck98efd692017-04-05 07:51:01 -04001934 dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
1935 i40e_rx_pg_size(rx_ring),
Alexander Duyck59605bc2017-01-30 12:29:35 -08001936 DMA_FROM_DEVICE, I40E_RX_DMA_ATTR);
Alexander Duyck17936682017-02-21 15:55:39 -08001937 __page_frag_cache_drain(rx_buffer->page,
1938 rx_buffer->pagecnt_bias);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001939 }
1940
1941 /* clear contents of buffer_info */
1942 rx_buffer->page = NULL;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001943}
1944
1945/**
1946 * i40e_is_non_eop - process handling of non-EOP buffers
1947 * @rx_ring: Rx ring being processed
1948 * @rx_desc: Rx descriptor for current buffer
1949 * @skb: Current socket buffer containing buffer in progress
1950 *
1951 * This function updates next to clean. If the buffer is an EOP buffer
1952 * this function exits returning false, otherwise it will place the
1953 * sk_buff in the next buffer to be chained and return true indicating
1954 * that this is in fact a non-EOP buffer.
1955 **/
1956static bool i40e_is_non_eop(struct i40e_ring *rx_ring,
1957 union i40e_rx_desc *rx_desc,
1958 struct sk_buff *skb)
1959{
1960 u32 ntc = rx_ring->next_to_clean + 1;
1961
1962 /* fetch, update, and store next to clean */
1963 ntc = (ntc < rx_ring->count) ? ntc : 0;
1964 rx_ring->next_to_clean = ntc;
1965
1966 prefetch(I40E_RX_DESC(rx_ring, ntc));
1967
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001968 /* if we are the last buffer then there is nothing else to do */
1969#define I40E_RXD_EOF BIT(I40E_RX_DESC_STATUS_EOF_SHIFT)
1970 if (likely(i40e_test_staterr(rx_desc, I40E_RXD_EOF)))
1971 return false;
1972
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001973 rx_ring->rx_stats.non_eop_descs++;
1974
1975 return true;
1976}
1977
Björn Töpel0c8493d2017-05-24 07:55:34 +02001978#define I40E_XDP_PASS 0
1979#define I40E_XDP_CONSUMED 1
Björn Töpel74608d12017-05-24 07:55:35 +02001980#define I40E_XDP_TX 2
1981
1982static int i40e_xmit_xdp_ring(struct xdp_buff *xdp,
1983 struct i40e_ring *xdp_ring);
Björn Töpel0c8493d2017-05-24 07:55:34 +02001984
1985/**
1986 * i40e_run_xdp - run an XDP program
1987 * @rx_ring: Rx ring being processed
1988 * @xdp: XDP buffer containing the frame
1989 **/
1990static struct sk_buff *i40e_run_xdp(struct i40e_ring *rx_ring,
1991 struct xdp_buff *xdp)
1992{
1993 int result = I40E_XDP_PASS;
Björn Töpel74608d12017-05-24 07:55:35 +02001994 struct i40e_ring *xdp_ring;
Björn Töpel0c8493d2017-05-24 07:55:34 +02001995 struct bpf_prog *xdp_prog;
1996 u32 act;
1997
1998 rcu_read_lock();
1999 xdp_prog = READ_ONCE(rx_ring->xdp_prog);
2000
2001 if (!xdp_prog)
2002 goto xdp_out;
2003
2004 act = bpf_prog_run_xdp(xdp_prog, xdp);
2005 switch (act) {
2006 case XDP_PASS:
2007 break;
Björn Töpel74608d12017-05-24 07:55:35 +02002008 case XDP_TX:
2009 xdp_ring = rx_ring->vsi->xdp_rings[rx_ring->queue_index];
2010 result = i40e_xmit_xdp_ring(xdp, xdp_ring);
2011 break;
Björn Töpel0c8493d2017-05-24 07:55:34 +02002012 default:
2013 bpf_warn_invalid_xdp_action(act);
Björn Töpel0c8493d2017-05-24 07:55:34 +02002014 case XDP_ABORTED:
2015 trace_xdp_exception(rx_ring->netdev, xdp_prog, act);
2016 /* fallthrough -- handle aborts by dropping packet */
2017 case XDP_DROP:
2018 result = I40E_XDP_CONSUMED;
2019 break;
2020 }
2021xdp_out:
2022 rcu_read_unlock();
2023 return ERR_PTR(-result);
2024}
2025
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002026/**
Björn Töpel74608d12017-05-24 07:55:35 +02002027 * i40e_rx_buffer_flip - adjusted rx_buffer to point to an unused region
2028 * @rx_ring: Rx ring
2029 * @rx_buffer: Rx buffer to adjust
2030 * @size: Size of adjustment
2031 **/
2032static void i40e_rx_buffer_flip(struct i40e_ring *rx_ring,
2033 struct i40e_rx_buffer *rx_buffer,
2034 unsigned int size)
2035{
2036#if (PAGE_SIZE < 8192)
2037 unsigned int truesize = i40e_rx_pg_size(rx_ring) / 2;
2038
2039 rx_buffer->page_offset ^= truesize;
2040#else
2041 unsigned int truesize = SKB_DATA_ALIGN(i40e_rx_offset(rx_ring) + size);
2042
2043 rx_buffer->page_offset += truesize;
2044#endif
2045}
2046
2047/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002048 * i40e_clean_rx_irq - Clean completed descriptors from Rx ring - bounce buf
2049 * @rx_ring: rx descriptor ring to transact packets on
2050 * @budget: Total limit on number of packets to process
2051 *
2052 * This function provides a "bounce buffer" approach to Rx interrupt
2053 * processing. The advantage to this is that on systems that have
2054 * expensive overhead for IOMMU access this provides a means of avoiding
2055 * it by maintaining the mapping of the page to the system.
2056 *
2057 * Returns amount of work completed
2058 **/
2059static int i40e_clean_rx_irq(struct i40e_ring *rx_ring, int budget)
Mitch Williamsa132af22015-01-24 09:58:35 +00002060{
2061 unsigned int total_rx_bytes = 0, total_rx_packets = 0;
Scott Petersone72e5652017-02-09 23:40:25 -08002062 struct sk_buff *skb = rx_ring->skb;
Mitch Williamsa132af22015-01-24 09:58:35 +00002063 u16 cleaned_count = I40E_DESC_UNUSED(rx_ring);
Björn Töpel74608d12017-05-24 07:55:35 +02002064 bool failure = false, xdp_xmit = false;
Mitch Williamsa132af22015-01-24 09:58:35 +00002065
Jesse Brandeburgb85c94b2017-06-20 15:16:59 -07002066 while (likely(total_rx_packets < (unsigned int)budget)) {
Alexander Duyck9a064122017-03-14 10:15:23 -07002067 struct i40e_rx_buffer *rx_buffer;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002068 union i40e_rx_desc *rx_desc;
Björn Töpel0c8493d2017-05-24 07:55:34 +02002069 struct xdp_buff xdp;
Alexander Duyckd57c0e02017-03-14 10:15:22 -07002070 unsigned int size;
Mitch Williamsa132af22015-01-24 09:58:35 +00002071 u16 vlan_tag;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002072 u8 rx_ptype;
2073 u64 qword;
2074
Mitch Williamsa132af22015-01-24 09:58:35 +00002075 /* return some buffers to hardware, one at a time is too slow */
2076 if (cleaned_count >= I40E_RX_BUFFER_WRITE) {
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08002077 failure = failure ||
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002078 i40e_alloc_rx_buffers(rx_ring, cleaned_count);
Mitch Williamsa132af22015-01-24 09:58:35 +00002079 cleaned_count = 0;
2080 }
2081
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002082 rx_desc = I40E_RX_DESC(rx_ring, rx_ring->next_to_clean);
2083
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002084 /* status_error_len will always be zero for unused descriptors
2085 * because it's cleared in cleanup, and overlaps with hdr_addr
2086 * which is always zero because packet split isn't used, if the
Alexander Duyckd57c0e02017-03-14 10:15:22 -07002087 * hardware wrote DD then the length will be non-zero
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002088 */
Alexander Duyckd57c0e02017-03-14 10:15:22 -07002089 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002090
Mitch Williamsa132af22015-01-24 09:58:35 +00002091 /* This memory barrier is needed to keep us from reading
Alexander Duyckd57c0e02017-03-14 10:15:22 -07002092 * any other fields out of the rx_desc until we have
2093 * verified the descriptor has been written back.
Mitch Williamsa132af22015-01-24 09:58:35 +00002094 */
Alexander Duyck67317162015-04-08 18:49:43 -07002095 dma_rmb();
Mitch Williamsa132af22015-01-24 09:58:35 +00002096
Alexander Duyck0e626ff2017-04-10 05:18:43 -04002097 if (unlikely(i40e_rx_is_programming_status(qword))) {
2098 i40e_clean_programming_status(rx_ring, rx_desc, qword);
2099 continue;
2100 }
2101 size = (qword & I40E_RXD_QW1_LENGTH_PBUF_MASK) >>
2102 I40E_RXD_QW1_LENGTH_PBUF_SHIFT;
2103 if (!size)
2104 break;
2105
Scott Petersoned0980c2017-04-13 04:45:44 -04002106 i40e_trace(clean_rx_irq, rx_ring, rx_desc, skb);
Alexander Duyck9a064122017-03-14 10:15:23 -07002107 rx_buffer = i40e_get_rx_buffer(rx_ring, size);
2108
Alexander Duyckfa2343e2017-03-14 10:15:25 -07002109 /* retrieve a buffer from the ring */
Björn Töpel0c8493d2017-05-24 07:55:34 +02002110 if (!skb) {
2111 xdp.data = page_address(rx_buffer->page) +
2112 rx_buffer->page_offset;
2113 xdp.data_hard_start = xdp.data -
2114 i40e_rx_offset(rx_ring);
2115 xdp.data_end = xdp.data + size;
2116
2117 skb = i40e_run_xdp(rx_ring, &xdp);
2118 }
2119
2120 if (IS_ERR(skb)) {
Björn Töpel74608d12017-05-24 07:55:35 +02002121 if (PTR_ERR(skb) == -I40E_XDP_TX) {
2122 xdp_xmit = true;
2123 i40e_rx_buffer_flip(rx_ring, rx_buffer, size);
2124 } else {
2125 rx_buffer->pagecnt_bias++;
2126 }
Björn Töpel0c8493d2017-05-24 07:55:34 +02002127 total_rx_bytes += size;
2128 total_rx_packets++;
Björn Töpel0c8493d2017-05-24 07:55:34 +02002129 } else if (skb) {
Alexander Duyckfa2343e2017-03-14 10:15:25 -07002130 i40e_add_rx_frag(rx_ring, rx_buffer, skb, size);
Björn Töpel0c8493d2017-05-24 07:55:34 +02002131 } else if (ring_uses_build_skb(rx_ring)) {
2132 skb = i40e_build_skb(rx_ring, rx_buffer, &xdp);
2133 } else {
2134 skb = i40e_construct_skb(rx_ring, rx_buffer, &xdp);
2135 }
Alexander Duyckfa2343e2017-03-14 10:15:25 -07002136
2137 /* exit if we failed to retrieve a buffer */
2138 if (!skb) {
2139 rx_ring->rx_stats.alloc_buff_failed++;
2140 rx_buffer->pagecnt_bias++;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002141 break;
Alexander Duyckfa2343e2017-03-14 10:15:25 -07002142 }
Mitch Williamsa132af22015-01-24 09:58:35 +00002143
Alexander Duycka0cfc312017-03-14 10:15:24 -07002144 i40e_put_rx_buffer(rx_ring, rx_buffer);
Mitch Williamsa132af22015-01-24 09:58:35 +00002145 cleaned_count++;
2146
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002147 if (i40e_is_non_eop(rx_ring, rx_desc, skb))
Mitch Williamsa132af22015-01-24 09:58:35 +00002148 continue;
Mitch Williamsa132af22015-01-24 09:58:35 +00002149
Björn Töpel0c8493d2017-05-24 07:55:34 +02002150 if (i40e_cleanup_headers(rx_ring, skb, rx_desc)) {
Scott Petersone72e5652017-02-09 23:40:25 -08002151 skb = NULL;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002152 continue;
Scott Petersone72e5652017-02-09 23:40:25 -08002153 }
Mitch Williamsa132af22015-01-24 09:58:35 +00002154
2155 /* probably a little skewed due to removing CRC */
2156 total_rx_bytes += skb->len;
Mitch Williamsa132af22015-01-24 09:58:35 +00002157
Alexander Duyck99dad8b2016-09-27 11:28:50 -07002158 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
2159 rx_ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >>
2160 I40E_RXD_QW1_PTYPE_SHIFT;
2161
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002162 /* populate checksum, VLAN, and protocol */
2163 i40e_process_skb_fields(rx_ring, rx_desc, skb, rx_ptype);
Mitch Williamsa132af22015-01-24 09:58:35 +00002164
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002165 vlan_tag = (qword & BIT(I40E_RX_DESC_STATUS_L2TAG1P_SHIFT)) ?
2166 le16_to_cpu(rx_desc->wb.qword0.lo_dword.l2tag1) : 0;
2167
Scott Petersoned0980c2017-04-13 04:45:44 -04002168 i40e_trace(clean_rx_irq_rx, rx_ring, rx_desc, skb);
Mitch Williamsa132af22015-01-24 09:58:35 +00002169 i40e_receive_skb(rx_ring, skb, vlan_tag);
Scott Petersone72e5652017-02-09 23:40:25 -08002170 skb = NULL;
Mitch Williamsa132af22015-01-24 09:58:35 +00002171
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002172 /* update budget accounting */
2173 total_rx_packets++;
2174 }
Mitch Williamsa132af22015-01-24 09:58:35 +00002175
Björn Töpel74608d12017-05-24 07:55:35 +02002176 if (xdp_xmit) {
2177 struct i40e_ring *xdp_ring;
2178
2179 xdp_ring = rx_ring->vsi->xdp_rings[rx_ring->queue_index];
2180
2181 /* Force memory writes to complete before letting h/w
2182 * know there are new descriptors to fetch.
2183 */
2184 wmb();
2185
2186 writel(xdp_ring->next_to_use, xdp_ring->tail);
2187 }
2188
Scott Petersone72e5652017-02-09 23:40:25 -08002189 rx_ring->skb = skb;
2190
Mitch Williamsa132af22015-01-24 09:58:35 +00002191 u64_stats_update_begin(&rx_ring->syncp);
2192 rx_ring->stats.packets += total_rx_packets;
2193 rx_ring->stats.bytes += total_rx_bytes;
2194 u64_stats_update_end(&rx_ring->syncp);
2195 rx_ring->q_vector->rx.total_packets += total_rx_packets;
2196 rx_ring->q_vector->rx.total_bytes += total_rx_bytes;
2197
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002198 /* guarantee a trip back through this routine if there was a failure */
Jesse Brandeburgb85c94b2017-06-20 15:16:59 -07002199 return failure ? budget : (int)total_rx_packets;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002200}
2201
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002202static u32 i40e_buildreg_itr(const int type, const u16 itr)
2203{
2204 u32 val;
2205
2206 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08002207 /* Don't clear PBA because that can cause lost interrupts that
2208 * came in while we were cleaning/polling
2209 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002210 (type << I40E_PFINT_DYN_CTLN_ITR_INDX_SHIFT) |
2211 (itr << I40E_PFINT_DYN_CTLN_INTERVAL_SHIFT);
2212
2213 return val;
2214}
2215
2216/* a small macro to shorten up some long lines */
2217#define INTREG I40E_PFINT_DYN_CTLN
Carolyn Wyborny3c234c42016-12-12 15:44:12 -08002218static inline int get_rx_itr(struct i40e_vsi *vsi, int idx)
Jacob Keller65e87c02016-09-12 14:18:44 -07002219{
Carolyn Wyborny3c234c42016-12-12 15:44:12 -08002220 return vsi->rx_rings[idx]->rx_itr_setting;
Jacob Keller65e87c02016-09-12 14:18:44 -07002221}
2222
Carolyn Wyborny3c234c42016-12-12 15:44:12 -08002223static inline int get_tx_itr(struct i40e_vsi *vsi, int idx)
Jacob Keller65e87c02016-09-12 14:18:44 -07002224{
Carolyn Wyborny3c234c42016-12-12 15:44:12 -08002225 return vsi->tx_rings[idx]->tx_itr_setting;
Jacob Keller65e87c02016-09-12 14:18:44 -07002226}
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002227
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002228/**
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002229 * i40e_update_enable_itr - Update itr and re-enable MSIX interrupt
2230 * @vsi: the VSI we care about
2231 * @q_vector: q_vector for which itr is being updated and interrupt enabled
2232 *
2233 **/
2234static inline void i40e_update_enable_itr(struct i40e_vsi *vsi,
2235 struct i40e_q_vector *q_vector)
2236{
2237 struct i40e_hw *hw = &vsi->back->hw;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002238 bool rx = false, tx = false;
2239 u32 rxval, txval;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002240 int vector;
Kan Lianga75e8002016-02-19 09:24:04 -05002241 int idx = q_vector->v_idx;
Jacob Keller65e87c02016-09-12 14:18:44 -07002242 int rx_itr_setting, tx_itr_setting;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002243
2244 vector = (q_vector->v_idx + vsi->base_vector);
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002245
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04002246 /* avoid dynamic calculation if in countdown mode OR if
2247 * all dynamic is disabled
2248 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002249 rxval = txval = i40e_buildreg_itr(I40E_ITR_NONE, 0);
2250
Carolyn Wyborny3c234c42016-12-12 15:44:12 -08002251 rx_itr_setting = get_rx_itr(vsi, idx);
2252 tx_itr_setting = get_tx_itr(vsi, idx);
Jacob Keller65e87c02016-09-12 14:18:44 -07002253
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04002254 if (q_vector->itr_countdown > 0 ||
Jacob Keller65e87c02016-09-12 14:18:44 -07002255 (!ITR_IS_DYNAMIC(rx_itr_setting) &&
2256 !ITR_IS_DYNAMIC(tx_itr_setting))) {
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04002257 goto enable_int;
2258 }
2259
Jacob Keller65e87c02016-09-12 14:18:44 -07002260 if (ITR_IS_DYNAMIC(tx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002261 rx = i40e_set_new_dynamic_itr(&q_vector->rx);
2262 rxval = i40e_buildreg_itr(I40E_RX_ITR, q_vector->rx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002263 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002264
Jacob Keller65e87c02016-09-12 14:18:44 -07002265 if (ITR_IS_DYNAMIC(tx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002266 tx = i40e_set_new_dynamic_itr(&q_vector->tx);
2267 txval = i40e_buildreg_itr(I40E_TX_ITR, q_vector->tx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002268 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002269
2270 if (rx || tx) {
2271 /* get the higher of the two ITR adjustments and
2272 * use the same value for both ITR registers
2273 * when in adaptive mode (Rx and/or Tx)
2274 */
2275 u16 itr = max(q_vector->tx.itr, q_vector->rx.itr);
2276
2277 q_vector->tx.itr = q_vector->rx.itr = itr;
2278 txval = i40e_buildreg_itr(I40E_TX_ITR, itr);
2279 tx = true;
2280 rxval = i40e_buildreg_itr(I40E_RX_ITR, itr);
2281 rx = true;
2282 }
2283
2284 /* only need to enable the interrupt once, but need
2285 * to possibly update both ITR values
2286 */
2287 if (rx) {
2288 /* set the INTENA_MSK_MASK so that this first write
2289 * won't actually enable the interrupt, instead just
2290 * updating the ITR (it's bit 31 PF and VF)
2291 */
2292 rxval |= BIT(31);
2293 /* don't check _DOWN because interrupt isn't being enabled */
2294 wr32(hw, INTREG(vector - 1), rxval);
2295 }
2296
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04002297enable_int:
Jacob Keller0da36b92017-04-19 09:25:55 -04002298 if (!test_bit(__I40E_VSI_DOWN, vsi->state))
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04002299 wr32(hw, INTREG(vector - 1), txval);
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04002300
2301 if (q_vector->itr_countdown)
2302 q_vector->itr_countdown--;
2303 else
2304 q_vector->itr_countdown = ITR_COUNTDOWN_START;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002305}
2306
2307/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002308 * i40e_napi_poll - NAPI polling Rx/Tx cleanup routine
2309 * @napi: napi struct with our devices info in it
2310 * @budget: amount of work driver is allowed to do this pass, in packets
2311 *
2312 * This function will clean all queues associated with a q_vector.
2313 *
2314 * Returns the amount of work done
2315 **/
2316int i40e_napi_poll(struct napi_struct *napi, int budget)
2317{
2318 struct i40e_q_vector *q_vector =
2319 container_of(napi, struct i40e_q_vector, napi);
2320 struct i40e_vsi *vsi = q_vector->vsi;
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002321 struct i40e_ring *ring;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002322 bool clean_complete = true;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002323 bool arm_wb = false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002324 int budget_per_ring;
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002325 int work_done = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002326
Jacob Keller0da36b92017-04-19 09:25:55 -04002327 if (test_bit(__I40E_VSI_DOWN, vsi->state)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002328 napi_complete(napi);
2329 return 0;
2330 }
2331
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002332 /* Since the actual Tx work is minimal, we can give the Tx a larger
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002333 * budget and be more aggressive about cleaning up the Tx descriptors.
2334 */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002335 i40e_for_each_ring(ring, q_vector->tx) {
Alexander Duycka619afe2016-03-07 09:30:03 -08002336 if (!i40e_clean_tx_irq(vsi, ring, budget)) {
Alexander Duyckf2edaaa2016-03-07 09:29:57 -08002337 clean_complete = false;
2338 continue;
2339 }
2340 arm_wb |= ring->arm_wb;
Jesse Brandeburg0deda862015-07-23 16:54:34 -04002341 ring->arm_wb = false;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002342 }
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002343
Alexander Duyckc67cace2015-09-24 09:04:26 -07002344 /* Handle case where we are called by netpoll with a budget of 0 */
2345 if (budget <= 0)
2346 goto tx_only;
2347
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002348 /* We attempt to distribute budget to each Rx queue fairly, but don't
2349 * allow the budget to go below 1 because that would exit polling early.
2350 */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002351 budget_per_ring = max(budget/q_vector->num_ringpairs, 1);
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002352
Mitch Williamsa132af22015-01-24 09:58:35 +00002353 i40e_for_each_ring(ring, q_vector->rx) {
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002354 int cleaned = i40e_clean_rx_irq(ring, budget_per_ring);
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002355
2356 work_done += cleaned;
Alexander Duyckf2edaaa2016-03-07 09:29:57 -08002357 /* if we clean as many as budgeted, we must not be done */
2358 if (cleaned >= budget_per_ring)
2359 clean_complete = false;
Mitch Williamsa132af22015-01-24 09:58:35 +00002360 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002361
2362 /* If work not completed, return budget and polling will return */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002363 if (!clean_complete) {
Alan Brady96db7762016-09-14 16:24:38 -07002364 const cpumask_t *aff_mask = &q_vector->affinity_mask;
2365 int cpu_id = smp_processor_id();
2366
2367 /* It is possible that the interrupt affinity has changed but,
2368 * if the cpu is pegged at 100%, polling will never exit while
2369 * traffic continues and the interrupt will be stuck on this
2370 * cpu. We check to make sure affinity is correct before we
2371 * continue to poll, otherwise we must stop polling so the
2372 * interrupt can move to the correct cpu.
2373 */
2374 if (likely(cpumask_test_cpu(cpu_id, aff_mask) ||
2375 !(vsi->back->flags & I40E_FLAG_MSIX_ENABLED))) {
Alexander Duyckc67cace2015-09-24 09:04:26 -07002376tx_only:
Alan Brady96db7762016-09-14 16:24:38 -07002377 if (arm_wb) {
2378 q_vector->tx.ring[0].tx_stats.tx_force_wb++;
2379 i40e_enable_wb_on_itr(vsi, q_vector);
2380 }
2381 return budget;
Anjali Singhai Jain164c9f52015-10-21 19:47:08 -04002382 }
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002383 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002384
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -04002385 if (vsi->back->flags & I40E_TXR_FLAGS_WB_ON_ITR)
2386 q_vector->arm_wb_state = false;
2387
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002388 /* Work is done so exit the polling mode and re-enable the interrupt */
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002389 napi_complete_done(napi, work_done);
Alan Brady96db7762016-09-14 16:24:38 -07002390
2391 /* If we're prematurely stopping polling to fix the interrupt
2392 * affinity we want to make sure polling starts back up so we
2393 * issue a call to i40e_force_wb which triggers a SW interrupt.
2394 */
2395 if (!clean_complete)
2396 i40e_force_wb(vsi, q_vector);
2397 else if (!(vsi->back->flags & I40E_FLAG_MSIX_ENABLED))
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08002398 i40e_irq_dynamic_enable_icr0(vsi->back, false);
Alan Brady96db7762016-09-14 16:24:38 -07002399 else
2400 i40e_update_enable_itr(vsi, q_vector);
2401
Alexander Duyck6beb84a2016-11-08 13:05:16 -08002402 return min(work_done, budget - 1);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002403}
2404
2405/**
2406 * i40e_atr - Add a Flow Director ATR filter
2407 * @tx_ring: ring to add programming descriptor to
2408 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002409 * @tx_flags: send tx flags
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002410 **/
2411static void i40e_atr(struct i40e_ring *tx_ring, struct sk_buff *skb,
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002412 u32 tx_flags)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002413{
2414 struct i40e_filter_program_desc *fdir_desc;
2415 struct i40e_pf *pf = tx_ring->vsi->back;
2416 union {
2417 unsigned char *network;
2418 struct iphdr *ipv4;
2419 struct ipv6hdr *ipv6;
2420 } hdr;
2421 struct tcphdr *th;
2422 unsigned int hlen;
2423 u32 flex_ptype, dtype_cmd;
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002424 int l4_proto;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002425 u16 i;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002426
2427 /* make sure ATR is enabled */
Jesse Brandeburg60ea5f82014-01-17 15:36:34 -08002428 if (!(pf->flags & I40E_FLAG_FD_ATR_ENABLED))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002429 return;
2430
Jacob Keller47994c12017-04-19 09:25:57 -04002431 if (pf->flags & I40E_FLAG_FD_ATR_AUTO_DISABLED)
Anjali Singhai Jain04294e32015-02-27 09:15:28 +00002432 return;
2433
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002434 /* if sampling is disabled do nothing */
2435 if (!tx_ring->atr_sample_rate)
2436 return;
2437
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002438 /* Currently only IPv4/IPv6 with TCP is supported */
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002439 if (!(tx_flags & (I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6)))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002440 return;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002441
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002442 /* snag network header to get L4 type and address */
2443 hdr.network = (tx_flags & I40E_TX_FLAGS_UDP_TUNNEL) ?
2444 skb_inner_network_header(skb) : skb_network_header(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002445
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002446 /* Note: tx_flags gets modified to reflect inner protocols in
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002447 * tx_enable_csum function if encap is enabled.
2448 */
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002449 if (tx_flags & I40E_TX_FLAGS_IPV4) {
2450 /* access ihl as u8 to avoid unaligned access on ia64 */
2451 hlen = (hdr.network[0] & 0x0F) << 2;
2452 l4_proto = hdr.ipv4->protocol;
2453 } else {
Jesse Brandeburg601a2e72017-06-20 15:16:58 -07002454 /* find the start of the innermost ipv6 header */
2455 unsigned int inner_hlen = hdr.network - skb->data;
2456 unsigned int h_offset = inner_hlen;
2457
2458 /* this function updates h_offset to the end of the header */
2459 l4_proto =
2460 ipv6_find_hdr(skb, &h_offset, IPPROTO_TCP, NULL, NULL);
2461 /* hlen will contain our best estimate of the tcp header */
2462 hlen = h_offset - inner_hlen;
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002463 }
2464
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002465 if (l4_proto != IPPROTO_TCP)
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002466 return;
2467
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002468 th = (struct tcphdr *)(hdr.network + hlen);
2469
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002470 /* Due to lack of space, no more new filters can be programmed */
Jacob Keller47994c12017-04-19 09:25:57 -04002471 if (th->syn && (pf->flags & I40E_FLAG_FD_ATR_AUTO_DISABLED))
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002472 return;
Jacob Keller6964e532017-06-12 15:38:36 -07002473 if (pf->flags & I40E_FLAG_HW_ATR_EVICT_ENABLED) {
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002474 /* HW ATR eviction will take care of removing filters on FIN
2475 * and RST packets.
2476 */
2477 if (th->fin || th->rst)
2478 return;
2479 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002480
2481 tx_ring->atr_count++;
2482
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002483 /* sample on all syn/fin/rst packets or once every atr sample rate */
2484 if (!th->fin &&
2485 !th->syn &&
2486 !th->rst &&
2487 (tx_ring->atr_count < tx_ring->atr_sample_rate))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002488 return;
2489
2490 tx_ring->atr_count = 0;
2491
2492 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002493 i = tx_ring->next_to_use;
2494 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
2495
2496 i++;
2497 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002498
2499 flex_ptype = (tx_ring->queue_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT) &
2500 I40E_TXD_FLTR_QW0_QINDEX_MASK;
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002501 flex_ptype |= (tx_flags & I40E_TX_FLAGS_IPV4) ?
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002502 (I40E_FILTER_PCTYPE_NONF_IPV4_TCP <<
2503 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT) :
2504 (I40E_FILTER_PCTYPE_NONF_IPV6_TCP <<
2505 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT);
2506
2507 flex_ptype |= tx_ring->vsi->id << I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT;
2508
2509 dtype_cmd = I40E_TX_DESC_DTYPE_FILTER_PROG;
2510
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002511 dtype_cmd |= (th->fin || th->rst) ?
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002512 (I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
2513 I40E_TXD_FLTR_QW1_PCMD_SHIFT) :
2514 (I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
2515 I40E_TXD_FLTR_QW1_PCMD_SHIFT);
2516
2517 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_DEST_DIRECT_PACKET_QINDEX <<
2518 I40E_TXD_FLTR_QW1_DEST_SHIFT;
2519
2520 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_FD_STATUS_FD_ID <<
2521 I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT;
2522
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002523 dtype_cmd |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002524 if (!(tx_flags & I40E_TX_FLAGS_UDP_TUNNEL))
Anjali Singhai Jain60ccd452015-04-16 20:06:01 -04002525 dtype_cmd |=
2526 ((u32)I40E_FD_ATR_STAT_IDX(pf->hw.pf_id) <<
2527 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2528 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
2529 else
2530 dtype_cmd |=
2531 ((u32)I40E_FD_ATR_TUNNEL_STAT_IDX(pf->hw.pf_id) <<
2532 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2533 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002534
Jacob Keller6964e532017-06-12 15:38:36 -07002535 if (pf->flags & I40E_FLAG_HW_ATR_EVICT_ENABLED)
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002536 dtype_cmd |= I40E_TXD_FLTR_QW1_ATR_MASK;
2537
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002538 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(flex_ptype);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002539 fdir_desc->rsvd = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002540 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dtype_cmd);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002541 fdir_desc->fd_id = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002542}
2543
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002544/**
2545 * i40e_tx_prepare_vlan_flags - prepare generic TX VLAN tagging flags for HW
2546 * @skb: send buffer
2547 * @tx_ring: ring to send buffer on
2548 * @flags: the tx flags to be set
2549 *
2550 * Checks the skb and set up correspondingly several generic transmit flags
2551 * related to VLAN tagging for the HW, such as VLAN, DCB, etc.
2552 *
2553 * Returns error code indicate the frame should be dropped upon error and the
2554 * otherwise returns 0 to indicate the flags has been set properly.
2555 **/
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002556static inline int i40e_tx_prepare_vlan_flags(struct sk_buff *skb,
2557 struct i40e_ring *tx_ring,
2558 u32 *flags)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002559{
2560 __be16 protocol = skb->protocol;
2561 u32 tx_flags = 0;
2562
Greg Rose31eaacc2015-03-31 00:45:03 -07002563 if (protocol == htons(ETH_P_8021Q) &&
2564 !(tx_ring->netdev->features & NETIF_F_HW_VLAN_CTAG_TX)) {
2565 /* When HW VLAN acceleration is turned off by the user the
2566 * stack sets the protocol to 8021q so that the driver
2567 * can take any steps required to support the SW only
2568 * VLAN handling. In our case the driver doesn't need
2569 * to take any further steps so just set the protocol
2570 * to the encapsulated ethertype.
2571 */
2572 skb->protocol = vlan_get_protocol(skb);
2573 goto out;
2574 }
2575
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002576 /* if we have a HW VLAN tag being added, default to the HW one */
Jiri Pirkodf8a39d2015-01-13 17:13:44 +01002577 if (skb_vlan_tag_present(skb)) {
2578 tx_flags |= skb_vlan_tag_get(skb) << I40E_TX_FLAGS_VLAN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002579 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2580 /* else if it is a SW VLAN, check the next protocol and store the tag */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002581 } else if (protocol == htons(ETH_P_8021Q)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002582 struct vlan_hdr *vhdr, _vhdr;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04002583
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002584 vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
2585 if (!vhdr)
2586 return -EINVAL;
2587
2588 protocol = vhdr->h_vlan_encapsulated_proto;
2589 tx_flags |= ntohs(vhdr->h_vlan_TCI) << I40E_TX_FLAGS_VLAN_SHIFT;
2590 tx_flags |= I40E_TX_FLAGS_SW_VLAN;
2591 }
2592
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002593 if (!(tx_ring->vsi->back->flags & I40E_FLAG_DCB_ENABLED))
2594 goto out;
2595
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002596 /* Insert 802.1p priority into VLAN header */
Vasu Dev38e00432014-08-01 13:27:03 -07002597 if ((tx_flags & (I40E_TX_FLAGS_HW_VLAN | I40E_TX_FLAGS_SW_VLAN)) ||
2598 (skb->priority != TC_PRIO_CONTROL)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002599 tx_flags &= ~I40E_TX_FLAGS_VLAN_PRIO_MASK;
2600 tx_flags |= (skb->priority & 0x7) <<
2601 I40E_TX_FLAGS_VLAN_PRIO_SHIFT;
2602 if (tx_flags & I40E_TX_FLAGS_SW_VLAN) {
2603 struct vlan_ethhdr *vhdr;
Francois Romieudd225bc2014-03-30 03:14:48 +00002604 int rc;
2605
2606 rc = skb_cow_head(skb, 0);
2607 if (rc < 0)
2608 return rc;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002609 vhdr = (struct vlan_ethhdr *)skb->data;
2610 vhdr->h_vlan_TCI = htons(tx_flags >>
2611 I40E_TX_FLAGS_VLAN_SHIFT);
2612 } else {
2613 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2614 }
2615 }
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002616
2617out:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002618 *flags = tx_flags;
2619 return 0;
2620}
2621
2622/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002623 * i40e_tso - set up the tso context descriptor
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002624 * @first: pointer to first Tx buffer for xmit
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002625 * @hdr_len: ptr to the size of the packet header
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002626 * @cd_type_cmd_tso_mss: Quad Word 1
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002627 *
2628 * Returns 0 if no TSO can happen, 1 if tso is going, or error
2629 **/
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002630static int i40e_tso(struct i40e_tx_buffer *first, u8 *hdr_len,
2631 u64 *cd_type_cmd_tso_mss)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002632{
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002633 struct sk_buff *skb = first->skb;
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002634 u64 cd_cmd, cd_tso_len, cd_mss;
Alexander Duyckc7770192016-01-24 21:16:35 -08002635 union {
2636 struct iphdr *v4;
2637 struct ipv6hdr *v6;
2638 unsigned char *hdr;
2639 } ip;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002640 union {
2641 struct tcphdr *tcp;
Alexander Duyck54532052016-01-24 21:17:29 -08002642 struct udphdr *udp;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002643 unsigned char *hdr;
2644 } l4;
2645 u32 paylen, l4_offset;
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002646 u16 gso_segs, gso_size;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002647 int err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002648
Shannon Nelsone9f65632016-01-04 10:33:04 -08002649 if (skb->ip_summed != CHECKSUM_PARTIAL)
2650 return 0;
2651
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002652 if (!skb_is_gso(skb))
2653 return 0;
2654
Francois Romieudd225bc2014-03-30 03:14:48 +00002655 err = skb_cow_head(skb, 0);
2656 if (err < 0)
2657 return err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002658
Alexander Duyckc7770192016-01-24 21:16:35 -08002659 ip.hdr = skb_network_header(skb);
2660 l4.hdr = skb_transport_header(skb);
Anjali Singhaidf230752014-12-19 02:58:16 +00002661
Alexander Duyckc7770192016-01-24 21:16:35 -08002662 /* initialize outer IP header fields */
2663 if (ip.v4->version == 4) {
2664 ip.v4->tot_len = 0;
2665 ip.v4->check = 0;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002666 } else {
Alexander Duyckc7770192016-01-24 21:16:35 -08002667 ip.v6->payload_len = 0;
2668 }
2669
Alexander Duyck577389a2016-04-02 00:06:56 -07002670 if (skb_shinfo(skb)->gso_type & (SKB_GSO_GRE |
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002671 SKB_GSO_GRE_CSUM |
Tom Herbert7e133182016-05-18 09:06:10 -07002672 SKB_GSO_IPXIP4 |
Alexander Duyckbf2d1df2016-05-18 10:44:53 -07002673 SKB_GSO_IPXIP6 |
Alexander Duyck577389a2016-04-02 00:06:56 -07002674 SKB_GSO_UDP_TUNNEL |
Alexander Duyck54532052016-01-24 21:17:29 -08002675 SKB_GSO_UDP_TUNNEL_CSUM)) {
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002676 if (!(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) &&
2677 (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM)) {
2678 l4.udp->len = 0;
2679
Alexander Duyck54532052016-01-24 21:17:29 -08002680 /* determine offset of outer transport header */
2681 l4_offset = l4.hdr - skb->data;
2682
2683 /* remove payload length from outer checksum */
Alexander Duyck24d41e52016-03-18 16:06:47 -07002684 paylen = skb->len - l4_offset;
Jacob Kellerb9c015d2016-12-12 15:44:17 -08002685 csum_replace_by_diff(&l4.udp->check,
2686 (__force __wsum)htonl(paylen));
Alexander Duyck54532052016-01-24 21:17:29 -08002687 }
2688
Alexander Duyckc7770192016-01-24 21:16:35 -08002689 /* reset pointers to inner headers */
2690 ip.hdr = skb_inner_network_header(skb);
2691 l4.hdr = skb_inner_transport_header(skb);
2692
2693 /* initialize inner IP header fields */
2694 if (ip.v4->version == 4) {
2695 ip.v4->tot_len = 0;
2696 ip.v4->check = 0;
2697 } else {
2698 ip.v6->payload_len = 0;
2699 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002700 }
2701
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002702 /* determine offset of inner transport header */
2703 l4_offset = l4.hdr - skb->data;
2704
2705 /* remove payload length from inner checksum */
Alexander Duyck24d41e52016-03-18 16:06:47 -07002706 paylen = skb->len - l4_offset;
Jacob Kellerb9c015d2016-12-12 15:44:17 -08002707 csum_replace_by_diff(&l4.tcp->check, (__force __wsum)htonl(paylen));
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002708
2709 /* compute length of segmentation header */
2710 *hdr_len = (l4.tcp->doff * 4) + l4_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002711
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002712 /* pull values out of skb_shinfo */
2713 gso_size = skb_shinfo(skb)->gso_size;
2714 gso_segs = skb_shinfo(skb)->gso_segs;
2715
2716 /* update GSO size and bytecount with header size */
2717 first->gso_segs = gso_segs;
2718 first->bytecount += (first->gso_segs - 1) * *hdr_len;
2719
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002720 /* find the field values */
2721 cd_cmd = I40E_TX_CTX_DESC_TSO;
2722 cd_tso_len = skb->len - *hdr_len;
Alexander Duyck52ea3e82016-11-28 16:05:59 -08002723 cd_mss = gso_size;
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002724 *cd_type_cmd_tso_mss |= (cd_cmd << I40E_TXD_CTX_QW1_CMD_SHIFT) |
2725 (cd_tso_len << I40E_TXD_CTX_QW1_TSO_LEN_SHIFT) |
2726 (cd_mss << I40E_TXD_CTX_QW1_MSS_SHIFT);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002727 return 1;
2728}
2729
2730/**
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002731 * i40e_tsyn - set up the tsyn context descriptor
2732 * @tx_ring: ptr to the ring to send
2733 * @skb: ptr to the skb we're sending
2734 * @tx_flags: the collected send information
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002735 * @cd_type_cmd_tso_mss: Quad Word 1
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002736 *
2737 * Returns 0 if no Tx timestamp can happen and 1 if the timestamp will happen
2738 **/
2739static int i40e_tsyn(struct i40e_ring *tx_ring, struct sk_buff *skb,
2740 u32 tx_flags, u64 *cd_type_cmd_tso_mss)
2741{
2742 struct i40e_pf *pf;
2743
2744 if (likely(!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)))
2745 return 0;
2746
2747 /* Tx timestamps cannot be sampled when doing TSO */
2748 if (tx_flags & I40E_TX_FLAGS_TSO)
2749 return 0;
2750
2751 /* only timestamp the outbound packet if the user has requested it and
2752 * we are not already transmitting a packet to be timestamped
2753 */
2754 pf = i40e_netdev_to_pf(tx_ring->netdev);
Jacob Keller22b47772014-12-14 01:55:09 +00002755 if (!(pf->flags & I40E_FLAG_PTP))
2756 return 0;
2757
Jakub Kicinski9ce34f02014-03-15 14:55:42 +00002758 if (pf->ptp_tx &&
Jacob Keller0da36b92017-04-19 09:25:55 -04002759 !test_and_set_bit_lock(__I40E_PTP_TX_IN_PROGRESS, pf->state)) {
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002760 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
Jacob Keller0bc07062017-05-03 10:29:02 -07002761 pf->ptp_tx_start = jiffies;
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002762 pf->ptp_tx_skb = skb_get(skb);
2763 } else {
Jacob Keller2955fac2017-05-03 10:28:58 -07002764 pf->tx_hwtstamp_skipped++;
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002765 return 0;
2766 }
2767
2768 *cd_type_cmd_tso_mss |= (u64)I40E_TX_CTX_DESC_TSYN <<
2769 I40E_TXD_CTX_QW1_CMD_SHIFT;
2770
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002771 return 1;
2772}
2773
2774/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002775 * i40e_tx_enable_csum - Enable Tx checksum offloads
2776 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002777 * @tx_flags: pointer to Tx flags currently set
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002778 * @td_cmd: Tx descriptor command bits to set
2779 * @td_offset: Tx descriptor header offsets to set
Jean Sacren554f4542015-10-13 01:06:28 -06002780 * @tx_ring: Tx descriptor ring
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002781 * @cd_tunneling: ptr to context desc bits
2782 **/
Alexander Duyck529f1f62016-01-24 21:17:10 -08002783static int i40e_tx_enable_csum(struct sk_buff *skb, u32 *tx_flags,
2784 u32 *td_cmd, u32 *td_offset,
2785 struct i40e_ring *tx_ring,
2786 u32 *cd_tunneling)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002787{
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002788 union {
2789 struct iphdr *v4;
2790 struct ipv6hdr *v6;
2791 unsigned char *hdr;
2792 } ip;
2793 union {
2794 struct tcphdr *tcp;
2795 struct udphdr *udp;
2796 unsigned char *hdr;
2797 } l4;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002798 unsigned char *exthdr;
Jesse Brandeburgd1bd7432016-04-01 03:56:04 -07002799 u32 offset, cmd = 0;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002800 __be16 frag_off;
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002801 u8 l4_proto = 0;
2802
Alexander Duyck529f1f62016-01-24 21:17:10 -08002803 if (skb->ip_summed != CHECKSUM_PARTIAL)
2804 return 0;
2805
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002806 ip.hdr = skb_network_header(skb);
2807 l4.hdr = skb_transport_header(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002808
Alexander Duyck475b4202016-01-24 21:17:01 -08002809 /* compute outer L2 header size */
2810 offset = ((ip.hdr - skb->data) / 2) << I40E_TX_DESC_LENGTH_MACLEN_SHIFT;
2811
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002812 if (skb->encapsulation) {
Jesse Brandeburgd1bd7432016-04-01 03:56:04 -07002813 u32 tunnel = 0;
Alexander Duycka0064722016-01-24 21:16:48 -08002814 /* define outer network header type */
2815 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002816 tunnel |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2817 I40E_TX_CTX_EXT_IP_IPV4 :
2818 I40E_TX_CTX_EXT_IP_IPV4_NO_CSUM;
2819
Alexander Duycka0064722016-01-24 21:16:48 -08002820 l4_proto = ip.v4->protocol;
2821 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002822 tunnel |= I40E_TX_CTX_EXT_IP_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002823
2824 exthdr = ip.hdr + sizeof(*ip.v6);
Alexander Duycka0064722016-01-24 21:16:48 -08002825 l4_proto = ip.v6->nexthdr;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002826 if (l4.hdr != exthdr)
2827 ipv6_skip_exthdr(skb, exthdr - skb->data,
2828 &l4_proto, &frag_off);
Alexander Duycka0064722016-01-24 21:16:48 -08002829 }
2830
2831 /* define outer transport */
2832 switch (l4_proto) {
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002833 case IPPROTO_UDP:
Alexander Duyck475b4202016-01-24 21:17:01 -08002834 tunnel |= I40E_TXD_CTX_UDP_TUNNELING;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002835 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002836 break;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002837 case IPPROTO_GRE:
Alexander Duyck475b4202016-01-24 21:17:01 -08002838 tunnel |= I40E_TXD_CTX_GRE_TUNNELING;
Alexander Duycka0064722016-01-24 21:16:48 -08002839 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002840 break;
Alexander Duyck577389a2016-04-02 00:06:56 -07002841 case IPPROTO_IPIP:
2842 case IPPROTO_IPV6:
2843 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
2844 l4.hdr = skb_inner_network_header(skb);
2845 break;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002846 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002847 if (*tx_flags & I40E_TX_FLAGS_TSO)
2848 return -1;
2849
2850 skb_checksum_help(skb);
2851 return 0;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002852 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002853
Alexander Duyck577389a2016-04-02 00:06:56 -07002854 /* compute outer L3 header size */
2855 tunnel |= ((l4.hdr - ip.hdr) / 4) <<
2856 I40E_TXD_CTX_QW0_EXT_IPLEN_SHIFT;
2857
2858 /* switch IP header pointer from outer to inner header */
2859 ip.hdr = skb_inner_network_header(skb);
2860
Alexander Duyck475b4202016-01-24 21:17:01 -08002861 /* compute tunnel header size */
2862 tunnel |= ((ip.hdr - l4.hdr) / 2) <<
2863 I40E_TXD_CTX_QW0_NATLEN_SHIFT;
2864
Alexander Duyck54532052016-01-24 21:17:29 -08002865 /* indicate if we need to offload outer UDP header */
2866 if ((*tx_flags & I40E_TX_FLAGS_TSO) &&
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002867 !(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) &&
Alexander Duyck54532052016-01-24 21:17:29 -08002868 (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM))
2869 tunnel |= I40E_TXD_CTX_QW0_L4T_CS_MASK;
2870
Alexander Duyck475b4202016-01-24 21:17:01 -08002871 /* record tunnel offload values */
2872 *cd_tunneling |= tunnel;
2873
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002874 /* switch L4 header pointer from outer to inner */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002875 l4.hdr = skb_inner_transport_header(skb);
Alexander Duycka0064722016-01-24 21:16:48 -08002876 l4_proto = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002877
Alexander Duycka0064722016-01-24 21:16:48 -08002878 /* reset type as we transition from outer to inner headers */
2879 *tx_flags &= ~(I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6);
2880 if (ip.v4->version == 4)
2881 *tx_flags |= I40E_TX_FLAGS_IPV4;
2882 if (ip.v6->version == 6)
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002883 *tx_flags |= I40E_TX_FLAGS_IPV6;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002884 }
2885
2886 /* Enable IP checksum offloads */
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002887 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002888 l4_proto = ip.v4->protocol;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002889 /* the stack computes the IP header already, the only time we
2890 * need the hardware to recompute it is in the case of TSO.
2891 */
Alexander Duyck475b4202016-01-24 21:17:01 -08002892 cmd |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2893 I40E_TX_DESC_CMD_IIPT_IPV4_CSUM :
2894 I40E_TX_DESC_CMD_IIPT_IPV4;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002895 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002896 cmd |= I40E_TX_DESC_CMD_IIPT_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002897
2898 exthdr = ip.hdr + sizeof(*ip.v6);
2899 l4_proto = ip.v6->nexthdr;
2900 if (l4.hdr != exthdr)
2901 ipv6_skip_exthdr(skb, exthdr - skb->data,
2902 &l4_proto, &frag_off);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002903 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002904
Alexander Duyck475b4202016-01-24 21:17:01 -08002905 /* compute inner L3 header size */
2906 offset |= ((l4.hdr - ip.hdr) / 4) << I40E_TX_DESC_LENGTH_IPLEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002907
2908 /* Enable L4 checksum offloads */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002909 switch (l4_proto) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002910 case IPPROTO_TCP:
2911 /* enable checksum offloads */
Alexander Duyck475b4202016-01-24 21:17:01 -08002912 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_TCP;
2913 offset |= l4.tcp->doff << I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002914 break;
2915 case IPPROTO_SCTP:
2916 /* enable SCTP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002917 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_SCTP;
2918 offset |= (sizeof(struct sctphdr) >> 2) <<
2919 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002920 break;
2921 case IPPROTO_UDP:
2922 /* enable UDP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002923 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_UDP;
2924 offset |= (sizeof(struct udphdr) >> 2) <<
2925 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002926 break;
2927 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002928 if (*tx_flags & I40E_TX_FLAGS_TSO)
2929 return -1;
2930 skb_checksum_help(skb);
2931 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002932 }
Alexander Duyck475b4202016-01-24 21:17:01 -08002933
2934 *td_cmd |= cmd;
2935 *td_offset |= offset;
Alexander Duyck529f1f62016-01-24 21:17:10 -08002936
2937 return 1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002938}
2939
2940/**
2941 * i40e_create_tx_ctx Build the Tx context descriptor
2942 * @tx_ring: ring to create the descriptor on
2943 * @cd_type_cmd_tso_mss: Quad Word 1
2944 * @cd_tunneling: Quad Word 0 - bits 0-31
2945 * @cd_l2tag2: Quad Word 0 - bits 32-63
2946 **/
2947static void i40e_create_tx_ctx(struct i40e_ring *tx_ring,
2948 const u64 cd_type_cmd_tso_mss,
2949 const u32 cd_tunneling, const u32 cd_l2tag2)
2950{
2951 struct i40e_tx_context_desc *context_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002952 int i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002953
Jesse Brandeburgff40dd52014-02-14 02:14:41 +00002954 if ((cd_type_cmd_tso_mss == I40E_TX_DESC_DTYPE_CONTEXT) &&
2955 !cd_tunneling && !cd_l2tag2)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002956 return;
2957
2958 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002959 context_desc = I40E_TX_CTXTDESC(tx_ring, i);
2960
2961 i++;
2962 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002963
2964 /* cpu_to_le32 and assign to struct fields */
2965 context_desc->tunneling_params = cpu_to_le32(cd_tunneling);
2966 context_desc->l2tag2 = cpu_to_le16(cd_l2tag2);
Jesse Brandeburg3efbbb22014-06-04 20:41:54 +00002967 context_desc->rsvd = cpu_to_le16(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002968 context_desc->type_cmd_tso_mss = cpu_to_le64(cd_type_cmd_tso_mss);
2969}
2970
2971/**
Eric Dumazet4567dc12014-10-07 13:30:23 -07002972 * __i40e_maybe_stop_tx - 2nd level check for tx stop conditions
2973 * @tx_ring: the ring to be checked
2974 * @size: the size buffer we want to assure is available
2975 *
2976 * Returns -EBUSY if a stop is needed, else 0
2977 **/
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002978int __i40e_maybe_stop_tx(struct i40e_ring *tx_ring, int size)
Eric Dumazet4567dc12014-10-07 13:30:23 -07002979{
2980 netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
2981 /* Memory barrier before checking head and tail */
2982 smp_mb();
2983
2984 /* Check again in a case another CPU has just made room available. */
2985 if (likely(I40E_DESC_UNUSED(tx_ring) < size))
2986 return -EBUSY;
2987
2988 /* A reprieve! - use start_queue because it doesn't call schedule */
2989 netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
2990 ++tx_ring->tx_stats.restart_queue;
2991 return 0;
2992}
2993
2994/**
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002995 * __i40e_chk_linearize - Check if there are more than 8 buffers per packet
Anjali Singhai71da6192015-02-21 06:42:35 +00002996 * @skb: send buffer
Anjali Singhai71da6192015-02-21 06:42:35 +00002997 *
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002998 * Note: Our HW can't DMA more than 8 buffers to build a packet on the wire
2999 * and so we need to figure out the cases where we need to linearize the skb.
3000 *
3001 * For TSO we need to count the TSO header and segment payload separately.
3002 * As such we need to check cases where we have 7 fragments or more as we
3003 * can potentially require 9 DMA transactions, 1 for the TSO header, 1 for
3004 * the segment payload in the first descriptor, and another 7 for the
3005 * fragments.
Anjali Singhai71da6192015-02-21 06:42:35 +00003006 **/
Alexander Duyck2d374902016-02-17 11:02:50 -08003007bool __i40e_chk_linearize(struct sk_buff *skb)
Anjali Singhai71da6192015-02-21 06:42:35 +00003008{
Alexander Duyck2d374902016-02-17 11:02:50 -08003009 const struct skb_frag_struct *frag, *stale;
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003010 int nr_frags, sum;
Anjali Singhai71da6192015-02-21 06:42:35 +00003011
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003012 /* no need to check if number of frags is less than 7 */
Alexander Duyck2d374902016-02-17 11:02:50 -08003013 nr_frags = skb_shinfo(skb)->nr_frags;
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003014 if (nr_frags < (I40E_MAX_BUFFER_TXD - 1))
Alexander Duyck2d374902016-02-17 11:02:50 -08003015 return false;
Anjali Singhai71da6192015-02-21 06:42:35 +00003016
Alexander Duyck2d374902016-02-17 11:02:50 -08003017 /* We need to walk through the list and validate that each group
Alexander Duyck841493a2016-09-06 18:05:04 -07003018 * of 6 fragments totals at least gso_size.
Alexander Duyck2d374902016-02-17 11:02:50 -08003019 */
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003020 nr_frags -= I40E_MAX_BUFFER_TXD - 2;
Alexander Duyck2d374902016-02-17 11:02:50 -08003021 frag = &skb_shinfo(skb)->frags[0];
3022
3023 /* Initialize size to the negative value of gso_size minus 1. We
3024 * use this as the worst case scenerio in which the frag ahead
3025 * of us only provides one byte which is why we are limited to 6
3026 * descriptors for a single transmit as the header and previous
3027 * fragment are already consuming 2 descriptors.
3028 */
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003029 sum = 1 - skb_shinfo(skb)->gso_size;
Alexander Duyck2d374902016-02-17 11:02:50 -08003030
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003031 /* Add size of frags 0 through 4 to create our initial sum */
3032 sum += skb_frag_size(frag++);
3033 sum += skb_frag_size(frag++);
3034 sum += skb_frag_size(frag++);
3035 sum += skb_frag_size(frag++);
3036 sum += skb_frag_size(frag++);
Alexander Duyck2d374902016-02-17 11:02:50 -08003037
3038 /* Walk through fragments adding latest fragment, testing it, and
3039 * then removing stale fragments from the sum.
3040 */
3041 stale = &skb_shinfo(skb)->frags[0];
3042 for (;;) {
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003043 sum += skb_frag_size(frag++);
Alexander Duyck2d374902016-02-17 11:02:50 -08003044
3045 /* if sum is negative we failed to make sufficient progress */
3046 if (sum < 0)
3047 return true;
3048
Alexander Duyck841493a2016-09-06 18:05:04 -07003049 if (!nr_frags--)
Alexander Duyck2d374902016-02-17 11:02:50 -08003050 break;
3051
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07003052 sum -= skb_frag_size(stale++);
Anjali Singhai71da6192015-02-21 06:42:35 +00003053 }
3054
Alexander Duyck2d374902016-02-17 11:02:50 -08003055 return false;
Anjali Singhai71da6192015-02-21 06:42:35 +00003056}
3057
3058/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003059 * i40e_tx_map - Build the Tx descriptor
3060 * @tx_ring: ring to send buffer on
3061 * @skb: send buffer
3062 * @first: first buffer info buffer to use
3063 * @tx_flags: collected send information
3064 * @hdr_len: size of the packet header
3065 * @td_cmd: the command field in the descriptor
3066 * @td_offset: offset for checksum or crc
Jacob Keller69077572017-05-03 10:28:54 -07003067 *
3068 * Returns 0 on success, -1 on failure to DMA
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003069 **/
Jacob Keller69077572017-05-03 10:28:54 -07003070static inline int i40e_tx_map(struct i40e_ring *tx_ring, struct sk_buff *skb,
3071 struct i40e_tx_buffer *first, u32 tx_flags,
3072 const u8 hdr_len, u32 td_cmd, u32 td_offset)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003073{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003074 unsigned int data_len = skb->data_len;
3075 unsigned int size = skb_headlen(skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +00003076 struct skb_frag_struct *frag;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003077 struct i40e_tx_buffer *tx_bi;
3078 struct i40e_tx_desc *tx_desc;
Alexander Duycka5e9c572013-09-28 06:00:27 +00003079 u16 i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003080 u32 td_tag = 0;
3081 dma_addr_t dma;
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003082 u16 desc_count = 1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003083
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003084 if (tx_flags & I40E_TX_FLAGS_HW_VLAN) {
3085 td_cmd |= I40E_TX_DESC_CMD_IL2TAG1;
3086 td_tag = (tx_flags & I40E_TX_FLAGS_VLAN_MASK) >>
3087 I40E_TX_FLAGS_VLAN_SHIFT;
3088 }
3089
Alexander Duycka5e9c572013-09-28 06:00:27 +00003090 first->tx_flags = tx_flags;
3091
3092 dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
3093
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003094 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +00003095 tx_bi = first;
3096
3097 for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003098 unsigned int max_data = I40E_MAX_DATA_PER_TXD_ALIGNED;
3099
Alexander Duycka5e9c572013-09-28 06:00:27 +00003100 if (dma_mapping_error(tx_ring->dev, dma))
3101 goto dma_error;
3102
3103 /* record length, and DMA address */
3104 dma_unmap_len_set(tx_bi, len, size);
3105 dma_unmap_addr_set(tx_bi, dma, dma);
3106
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003107 /* align size to end of page */
3108 max_data += -dma & (I40E_MAX_READ_REQ_SIZE - 1);
Alexander Duycka5e9c572013-09-28 06:00:27 +00003109 tx_desc->buffer_addr = cpu_to_le64(dma);
3110
3111 while (unlikely(size > I40E_MAX_DATA_PER_TXD)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003112 tx_desc->cmd_type_offset_bsz =
3113 build_ctob(td_cmd, td_offset,
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003114 max_data, td_tag);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003115
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003116 tx_desc++;
3117 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07003118 desc_count++;
3119
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003120 if (i == tx_ring->count) {
3121 tx_desc = I40E_TX_DESC(tx_ring, 0);
3122 i = 0;
3123 }
Alexander Duycka5e9c572013-09-28 06:00:27 +00003124
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003125 dma += max_data;
3126 size -= max_data;
Alexander Duycka5e9c572013-09-28 06:00:27 +00003127
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003128 max_data = I40E_MAX_DATA_PER_TXD_ALIGNED;
Alexander Duycka5e9c572013-09-28 06:00:27 +00003129 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003130 }
3131
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003132 if (likely(!data_len))
3133 break;
3134
Alexander Duycka5e9c572013-09-28 06:00:27 +00003135 tx_desc->cmd_type_offset_bsz = build_ctob(td_cmd, td_offset,
3136 size, td_tag);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003137
3138 tx_desc++;
3139 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07003140 desc_count++;
3141
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003142 if (i == tx_ring->count) {
3143 tx_desc = I40E_TX_DESC(tx_ring, 0);
3144 i = 0;
3145 }
3146
Alexander Duycka5e9c572013-09-28 06:00:27 +00003147 size = skb_frag_size(frag);
3148 data_len -= size;
3149
3150 dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
3151 DMA_TO_DEVICE);
3152
3153 tx_bi = &tx_ring->tx_bi[i];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003154 }
3155
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003156 netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
Alexander Duycka5e9c572013-09-28 06:00:27 +00003157
3158 i++;
3159 if (i == tx_ring->count)
3160 i = 0;
3161
3162 tx_ring->next_to_use = i;
3163
Eric Dumazet4567dc12014-10-07 13:30:23 -07003164 i40e_maybe_stop_tx(tx_ring, DESC_NEEDED);
Anjali Singhai58044742015-09-25 18:26:13 -07003165
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003166 /* write last descriptor with EOP bit */
3167 td_cmd |= I40E_TX_DESC_CMD_EOP;
3168
3169 /* We can OR these values together as they both are checked against
3170 * 4 below and at this point desc_count will be used as a boolean value
3171 * after this if/else block.
3172 */
3173 desc_count |= ++tx_ring->packet_stride;
3174
Anjali Singhai58044742015-09-25 18:26:13 -07003175 /* Algorithm to optimize tail and RS bit setting:
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003176 * if queue is stopped
3177 * mark RS bit
3178 * reset packet counter
3179 * else if xmit_more is supported and is true
3180 * advance packet counter to 4
3181 * reset desc_count to 0
Anjali Singhai58044742015-09-25 18:26:13 -07003182 *
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003183 * if desc_count >= 4
3184 * mark RS bit
3185 * reset packet counter
3186 * if desc_count > 0
3187 * update tail
Anjali Singhai58044742015-09-25 18:26:13 -07003188 *
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003189 * Note: If there are less than 4 descriptors
Anjali Singhai58044742015-09-25 18:26:13 -07003190 * pending and interrupts were disabled the service task will
3191 * trigger a force WB.
3192 */
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003193 if (netif_xmit_stopped(txring_txq(tx_ring))) {
3194 goto do_rs;
3195 } else if (skb->xmit_more) {
3196 /* set stride to arm on next packet and reset desc_count */
3197 tx_ring->packet_stride = WB_STRIDE;
3198 desc_count = 0;
3199 } else if (desc_count >= WB_STRIDE) {
3200do_rs:
3201 /* write last descriptor with RS bit set */
3202 td_cmd |= I40E_TX_DESC_CMD_RS;
Anjali Singhai58044742015-09-25 18:26:13 -07003203 tx_ring->packet_stride = 0;
Anjali Singhai58044742015-09-25 18:26:13 -07003204 }
Anjali Singhai58044742015-09-25 18:26:13 -07003205
3206 tx_desc->cmd_type_offset_bsz =
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003207 build_ctob(td_cmd, td_offset, size, td_tag);
3208
3209 /* Force memory writes to complete before letting h/w know there
3210 * are new descriptors to fetch.
3211 *
3212 * We also use this memory barrier to make certain all of the
3213 * status bits have been updated before next_to_watch is written.
3214 */
3215 wmb();
3216
3217 /* set next_to_watch value indicating a packet is present */
3218 first->next_to_watch = tx_desc;
Anjali Singhai58044742015-09-25 18:26:13 -07003219
Alexander Duycka5e9c572013-09-28 06:00:27 +00003220 /* notify HW of packet */
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003221 if (desc_count) {
Anjali Singhai58044742015-09-25 18:26:13 -07003222 writel(i, tx_ring->tail);
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003223
3224 /* we need this if more than one processor can write to our tail
3225 * at a time, it synchronizes IO on IA64/Altix systems
3226 */
3227 mmiowb();
Anjali Singhai58044742015-09-25 18:26:13 -07003228 }
Alexander Duyck1dc8b532016-10-11 15:26:54 -07003229
Jacob Keller69077572017-05-03 10:28:54 -07003230 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003231
3232dma_error:
Alexander Duycka5e9c572013-09-28 06:00:27 +00003233 dev_info(tx_ring->dev, "TX DMA map failed\n");
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003234
3235 /* clear dma mappings for failed tx_bi map */
3236 for (;;) {
3237 tx_bi = &tx_ring->tx_bi[i];
Alexander Duycka5e9c572013-09-28 06:00:27 +00003238 i40e_unmap_and_free_tx_resource(tx_ring, tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003239 if (tx_bi == first)
3240 break;
3241 if (i == 0)
3242 i = tx_ring->count;
3243 i--;
3244 }
3245
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003246 tx_ring->next_to_use = i;
Jacob Keller69077572017-05-03 10:28:54 -07003247
3248 return -1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003249}
3250
3251/**
Björn Töpel74608d12017-05-24 07:55:35 +02003252 * i40e_xmit_xdp_ring - transmits an XDP buffer to an XDP Tx ring
3253 * @xdp: data to transmit
3254 * @xdp_ring: XDP Tx ring
3255 **/
3256static int i40e_xmit_xdp_ring(struct xdp_buff *xdp,
3257 struct i40e_ring *xdp_ring)
3258{
3259 u32 size = xdp->data_end - xdp->data;
3260 u16 i = xdp_ring->next_to_use;
3261 struct i40e_tx_buffer *tx_bi;
3262 struct i40e_tx_desc *tx_desc;
3263 dma_addr_t dma;
3264
3265 if (!unlikely(I40E_DESC_UNUSED(xdp_ring))) {
3266 xdp_ring->tx_stats.tx_busy++;
3267 return I40E_XDP_CONSUMED;
3268 }
3269
3270 dma = dma_map_single(xdp_ring->dev, xdp->data, size, DMA_TO_DEVICE);
3271 if (dma_mapping_error(xdp_ring->dev, dma))
3272 return I40E_XDP_CONSUMED;
3273
3274 tx_bi = &xdp_ring->tx_bi[i];
3275 tx_bi->bytecount = size;
3276 tx_bi->gso_segs = 1;
3277 tx_bi->raw_buf = xdp->data;
3278
3279 /* record length, and DMA address */
3280 dma_unmap_len_set(tx_bi, len, size);
3281 dma_unmap_addr_set(tx_bi, dma, dma);
3282
3283 tx_desc = I40E_TX_DESC(xdp_ring, i);
3284 tx_desc->buffer_addr = cpu_to_le64(dma);
3285 tx_desc->cmd_type_offset_bsz = build_ctob(I40E_TX_DESC_CMD_ICRC
3286 | I40E_TXD_CMD,
3287 0, size, 0);
3288
3289 /* Make certain all of the status bits have been updated
3290 * before next_to_watch is written.
3291 */
3292 smp_wmb();
3293
3294 i++;
3295 if (i == xdp_ring->count)
3296 i = 0;
3297
3298 tx_bi->next_to_watch = tx_desc;
3299 xdp_ring->next_to_use = i;
3300
3301 return I40E_XDP_TX;
3302}
3303
3304/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003305 * i40e_xmit_frame_ring - Sends buffer on Tx ring
3306 * @skb: send buffer
3307 * @tx_ring: ring to send buffer on
3308 *
3309 * Returns NETDEV_TX_OK if sent, else an error code
3310 **/
3311static netdev_tx_t i40e_xmit_frame_ring(struct sk_buff *skb,
3312 struct i40e_ring *tx_ring)
3313{
3314 u64 cd_type_cmd_tso_mss = I40E_TX_DESC_DTYPE_CONTEXT;
3315 u32 cd_tunneling = 0, cd_l2tag2 = 0;
3316 struct i40e_tx_buffer *first;
3317 u32 td_offset = 0;
3318 u32 tx_flags = 0;
3319 __be16 protocol;
3320 u32 td_cmd = 0;
3321 u8 hdr_len = 0;
Alexander Duyck4ec441d2016-02-17 11:02:43 -08003322 int tso, count;
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00003323 int tsyn;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04003324
Jesse Brandeburgb74118f2015-10-26 19:44:30 -04003325 /* prefetch the data, we'll need it later */
3326 prefetch(skb->data);
3327
Scott Petersoned0980c2017-04-13 04:45:44 -04003328 i40e_trace(xmit_frame_ring, skb, tx_ring);
3329
Alexander Duyck4ec441d2016-02-17 11:02:43 -08003330 count = i40e_xmit_descriptor_count(skb);
Alexander Duyck2d374902016-02-17 11:02:50 -08003331 if (i40e_chk_linearize(skb, count)) {
Alexander Duyck52ea3e82016-11-28 16:05:59 -08003332 if (__skb_linearize(skb)) {
3333 dev_kfree_skb_any(skb);
3334 return NETDEV_TX_OK;
3335 }
Alexander Duyck5c4654d2016-02-19 12:17:08 -08003336 count = i40e_txd_use_count(skb->len);
Alexander Duyck2d374902016-02-17 11:02:50 -08003337 tx_ring->tx_stats.tx_linearize++;
3338 }
Alexander Duyck4ec441d2016-02-17 11:02:43 -08003339
3340 /* need: 1 descriptor per page * PAGE_SIZE/I40E_MAX_DATA_PER_TXD,
3341 * + 1 desc for skb_head_len/I40E_MAX_DATA_PER_TXD,
3342 * + 4 desc gap to avoid the cache line where head is,
3343 * + 1 desc for context descriptor,
3344 * otherwise try next time
3345 */
3346 if (i40e_maybe_stop_tx(tx_ring, count + 4 + 1)) {
3347 tx_ring->tx_stats.tx_busy++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003348 return NETDEV_TX_BUSY;
Alexander Duyck4ec441d2016-02-17 11:02:43 -08003349 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003350
Alexander Duyck52ea3e82016-11-28 16:05:59 -08003351 /* record the location of the first descriptor for this packet */
3352 first = &tx_ring->tx_bi[tx_ring->next_to_use];
3353 first->skb = skb;
3354 first->bytecount = skb->len;
3355 first->gso_segs = 1;
3356
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003357 /* prepare the xmit flags */
3358 if (i40e_tx_prepare_vlan_flags(skb, tx_ring, &tx_flags))
3359 goto out_drop;
3360
3361 /* obtain protocol of skb */
Vlad Yasevich3d34dd02014-08-25 10:34:52 -04003362 protocol = vlan_get_protocol(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003363
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003364 /* setup IPv4/IPv6 offloads */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00003365 if (protocol == htons(ETH_P_IP))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003366 tx_flags |= I40E_TX_FLAGS_IPV4;
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00003367 else if (protocol == htons(ETH_P_IPV6))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003368 tx_flags |= I40E_TX_FLAGS_IPV6;
3369
Alexander Duyck52ea3e82016-11-28 16:05:59 -08003370 tso = i40e_tso(first, &hdr_len, &cd_type_cmd_tso_mss);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003371
3372 if (tso < 0)
3373 goto out_drop;
3374 else if (tso)
3375 tx_flags |= I40E_TX_FLAGS_TSO;
3376
Alexander Duyck3bc67972016-02-17 11:02:56 -08003377 /* Always offload the checksum, since it's in the data descriptor */
3378 tso = i40e_tx_enable_csum(skb, &tx_flags, &td_cmd, &td_offset,
3379 tx_ring, &cd_tunneling);
3380 if (tso < 0)
3381 goto out_drop;
3382
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00003383 tsyn = i40e_tsyn(tx_ring, skb, tx_flags, &cd_type_cmd_tso_mss);
3384
3385 if (tsyn)
3386 tx_flags |= I40E_TX_FLAGS_TSYN;
3387
Jakub Kicinski259afec2014-03-15 14:55:37 +00003388 skb_tx_timestamp(skb);
3389
Alexander Duyckb1941302013-09-28 06:00:32 +00003390 /* always enable CRC insertion offload */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003391 td_cmd |= I40E_TX_DESC_CMD_ICRC;
3392
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003393 i40e_create_tx_ctx(tx_ring, cd_type_cmd_tso_mss,
3394 cd_tunneling, cd_l2tag2);
3395
3396 /* Add Flow Director ATR if it's enabled.
3397 *
3398 * NOTE: this must always be directly before the data descriptor.
3399 */
Alexander Duyck6b037cd2016-01-24 21:17:36 -08003400 i40e_atr(tx_ring, skb, tx_flags);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003401
Jacob Keller69077572017-05-03 10:28:54 -07003402 if (i40e_tx_map(tx_ring, skb, first, tx_flags, hdr_len,
3403 td_cmd, td_offset))
3404 goto cleanup_tx_tstamp;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003405
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003406 return NETDEV_TX_OK;
3407
3408out_drop:
Scott Petersoned0980c2017-04-13 04:45:44 -04003409 i40e_trace(xmit_frame_ring_drop, first->skb, tx_ring);
Alexander Duyck52ea3e82016-11-28 16:05:59 -08003410 dev_kfree_skb_any(first->skb);
3411 first->skb = NULL;
Jacob Keller69077572017-05-03 10:28:54 -07003412cleanup_tx_tstamp:
3413 if (unlikely(tx_flags & I40E_TX_FLAGS_TSYN)) {
3414 struct i40e_pf *pf = i40e_netdev_to_pf(tx_ring->netdev);
3415
3416 dev_kfree_skb_any(pf->ptp_tx_skb);
3417 pf->ptp_tx_skb = NULL;
3418 clear_bit_unlock(__I40E_PTP_TX_IN_PROGRESS, pf->state);
3419 }
3420
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003421 return NETDEV_TX_OK;
3422}
3423
3424/**
3425 * i40e_lan_xmit_frame - Selects the correct VSI and Tx queue to send buffer
3426 * @skb: send buffer
3427 * @netdev: network interface device structure
3428 *
3429 * Returns NETDEV_TX_OK if sent, else an error code
3430 **/
3431netdev_tx_t i40e_lan_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
3432{
3433 struct i40e_netdev_priv *np = netdev_priv(netdev);
3434 struct i40e_vsi *vsi = np->vsi;
Alexander Duyck9f65e152013-09-28 06:00:58 +00003435 struct i40e_ring *tx_ring = vsi->tx_rings[skb->queue_mapping];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003436
3437 /* hardware can't handle really short frames, hardware padding works
3438 * beyond this point
3439 */
Alexander Duycka94d9e22014-12-03 08:17:39 -08003440 if (skb_put_padto(skb, I40E_MIN_TX_LEN))
3441 return NETDEV_TX_OK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003442
3443 return i40e_xmit_frame_ring(skb, tx_ring);
3444}