blob: af36c44c484470b048272cc7bab3acfbd8dee6cf [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>
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000029#include "i40e.h"
Jesse Brandeburg206812b2014-02-12 01:45:33 +000030#include "i40e_prototype.h"
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000031
32static inline __le64 build_ctob(u32 td_cmd, u32 td_offset, unsigned int size,
33 u32 td_tag)
34{
35 return cpu_to_le64(I40E_TX_DESC_DTYPE_DATA |
36 ((u64)td_cmd << I40E_TXD_QW1_CMD_SHIFT) |
37 ((u64)td_offset << I40E_TXD_QW1_OFFSET_SHIFT) |
38 ((u64)size << I40E_TXD_QW1_TX_BUF_SZ_SHIFT) |
39 ((u64)td_tag << I40E_TXD_QW1_L2TAG1_SHIFT));
40}
41
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +000042#define I40E_TXD_CMD (I40E_TX_DESC_CMD_EOP | I40E_TX_DESC_CMD_RS)
Alexander Duyck5e02f282016-09-12 14:18:41 -070043/**
44 * i40e_fdir - Generate a Flow Director descriptor based on fdata
45 * @tx_ring: Tx ring to send buffer on
46 * @fdata: Flow director filter data
47 * @add: Indicate if we are adding a rule or deleting one
48 *
49 **/
50static void i40e_fdir(struct i40e_ring *tx_ring,
51 struct i40e_fdir_filter *fdata, bool add)
52{
53 struct i40e_filter_program_desc *fdir_desc;
54 struct i40e_pf *pf = tx_ring->vsi->back;
55 u32 flex_ptype, dtype_cmd;
56 u16 i;
57
58 /* grab the next descriptor */
59 i = tx_ring->next_to_use;
60 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
61
62 i++;
63 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
64
65 flex_ptype = I40E_TXD_FLTR_QW0_QINDEX_MASK &
66 (fdata->q_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT);
67
68 flex_ptype |= I40E_TXD_FLTR_QW0_FLEXOFF_MASK &
69 (fdata->flex_off << I40E_TXD_FLTR_QW0_FLEXOFF_SHIFT);
70
71 flex_ptype |= I40E_TXD_FLTR_QW0_PCTYPE_MASK &
72 (fdata->pctype << I40E_TXD_FLTR_QW0_PCTYPE_SHIFT);
73
74 /* Use LAN VSI Id if not programmed by user */
75 flex_ptype |= I40E_TXD_FLTR_QW0_DEST_VSI_MASK &
76 ((u32)(fdata->dest_vsi ? : pf->vsi[pf->lan_vsi]->id) <<
77 I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT);
78
79 dtype_cmd = I40E_TX_DESC_DTYPE_FILTER_PROG;
80
81 dtype_cmd |= add ?
82 I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
83 I40E_TXD_FLTR_QW1_PCMD_SHIFT :
84 I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
85 I40E_TXD_FLTR_QW1_PCMD_SHIFT;
86
87 dtype_cmd |= I40E_TXD_FLTR_QW1_DEST_MASK &
88 (fdata->dest_ctl << I40E_TXD_FLTR_QW1_DEST_SHIFT);
89
90 dtype_cmd |= I40E_TXD_FLTR_QW1_FD_STATUS_MASK &
91 (fdata->fd_status << I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT);
92
93 if (fdata->cnt_index) {
94 dtype_cmd |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
95 dtype_cmd |= I40E_TXD_FLTR_QW1_CNTINDEX_MASK &
96 ((u32)fdata->cnt_index <<
97 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT);
98 }
99
100 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(flex_ptype);
101 fdir_desc->rsvd = cpu_to_le32(0);
102 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dtype_cmd);
103 fdir_desc->fd_id = cpu_to_le32(fdata->fd_id);
104}
105
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000106#define I40E_FD_CLEAN_DELAY 10
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000107/**
108 * i40e_program_fdir_filter - Program a Flow Director filter
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000109 * @fdir_data: Packet data that will be filter parameters
110 * @raw_packet: the pre-allocated packet buffer for FDir
Jeff Kirsherb40c82e62015-02-27 09:18:34 +0000111 * @pf: The PF pointer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000112 * @add: True for add/update, False for remove
113 **/
Alexander Duyck1eb846a2016-09-12 14:18:42 -0700114static int i40e_program_fdir_filter(struct i40e_fdir_filter *fdir_data,
115 u8 *raw_packet, struct i40e_pf *pf,
116 bool add)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000117{
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000118 struct i40e_tx_buffer *tx_buf, *first;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000119 struct i40e_tx_desc *tx_desc;
120 struct i40e_ring *tx_ring;
121 struct i40e_vsi *vsi;
122 struct device *dev;
123 dma_addr_t dma;
124 u32 td_cmd = 0;
125 u16 i;
126
127 /* find existing FDIR VSI */
128 vsi = NULL;
Mitch Williams505682c2014-05-20 08:01:37 +0000129 for (i = 0; i < pf->num_alloc_vsi; i++)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000130 if (pf->vsi[i] && pf->vsi[i]->type == I40E_VSI_FDIR)
131 vsi = pf->vsi[i];
132 if (!vsi)
133 return -ENOENT;
134
Alexander Duyck9f65e152013-09-28 06:00:58 +0000135 tx_ring = vsi->tx_rings[0];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000136 dev = tx_ring->dev;
137
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000138 /* we need two descriptors to add/del a filter and we can wait */
Alexander Duycked245402016-09-14 16:24:32 -0700139 for (i = I40E_FD_CLEAN_DELAY; I40E_DESC_UNUSED(tx_ring) < 2; i--) {
140 if (!i)
141 return -EAGAIN;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000142 msleep_interruptible(1);
Alexander Duycked245402016-09-14 16:24:32 -0700143 }
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000144
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000145 dma = dma_map_single(dev, raw_packet,
146 I40E_FDIR_MAX_RAW_PACKET_SIZE, DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000147 if (dma_mapping_error(dev, dma))
148 goto dma_fail;
149
150 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000151 i = tx_ring->next_to_use;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000152 first = &tx_ring->tx_bi[i];
Alexander Duyck5e02f282016-09-12 14:18:41 -0700153 i40e_fdir(tx_ring, fdir_data, add);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000154
155 /* Now program a dummy descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000156 i = tx_ring->next_to_use;
157 tx_desc = I40E_TX_DESC(tx_ring, i);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000158 tx_buf = &tx_ring->tx_bi[i];
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000159
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000160 tx_ring->next_to_use = ((i + 1) < tx_ring->count) ? i + 1 : 0;
161
162 memset(tx_buf, 0, sizeof(struct i40e_tx_buffer));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000163
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000164 /* record length, and DMA address */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000165 dma_unmap_len_set(tx_buf, len, I40E_FDIR_MAX_RAW_PACKET_SIZE);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000166 dma_unmap_addr_set(tx_buf, dma, dma);
167
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000168 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000169 td_cmd = I40E_TXD_CMD | I40E_TX_DESC_CMD_DUMMY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000170
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000171 tx_buf->tx_flags = I40E_TX_FLAGS_FD_SB;
172 tx_buf->raw_buf = (void *)raw_packet;
173
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000174 tx_desc->cmd_type_offset_bsz =
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000175 build_ctob(td_cmd, 0, I40E_FDIR_MAX_RAW_PACKET_SIZE, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000176
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000177 /* Force memory writes to complete before letting h/w
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000178 * know there are new descriptors to fetch.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000179 */
180 wmb();
181
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000182 /* Mark the data descriptor to be watched */
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000183 first->next_to_watch = tx_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000184
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000185 writel(tx_ring->next_to_use, tx_ring->tail);
186 return 0;
187
188dma_fail:
189 return -1;
190}
191
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000192#define IP_HEADER_OFFSET 14
193#define I40E_UDPIP_DUMMY_PACKET_LEN 42
194/**
195 * i40e_add_del_fdir_udpv4 - Add/Remove UDPv4 filters
196 * @vsi: pointer to the targeted VSI
197 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000198 * @add: true adds a filter, false removes it
199 *
200 * Returns 0 if the filters were successfully added or removed
201 **/
202static int i40e_add_del_fdir_udpv4(struct i40e_vsi *vsi,
203 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000204 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000205{
206 struct i40e_pf *pf = vsi->back;
207 struct udphdr *udp;
208 struct iphdr *ip;
209 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000210 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000211 int ret;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000212 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
213 0x45, 0, 0, 0x1c, 0, 0, 0x40, 0, 0x40, 0x11, 0, 0, 0, 0, 0, 0,
214 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
215
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000216 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
217 if (!raw_packet)
218 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000219 memcpy(raw_packet, packet, I40E_UDPIP_DUMMY_PACKET_LEN);
220
221 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
222 udp = (struct udphdr *)(raw_packet + IP_HEADER_OFFSET
223 + sizeof(struct iphdr));
224
225 ip->daddr = fd_data->dst_ip[0];
226 udp->dest = fd_data->dst_port;
227 ip->saddr = fd_data->src_ip[0];
228 udp->source = fd_data->src_port;
229
Kevin Scottb2d36c02014-04-09 05:58:59 +0000230 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
231 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
232 if (ret) {
233 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000234 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
235 fd_data->pctype, fd_data->fd_id, ret);
Kevin Scottb2d36c02014-04-09 05:58:59 +0000236 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000237 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000238 if (add)
239 dev_info(&pf->pdev->dev,
240 "Filter OK for PCTYPE %d loc = %d\n",
241 fd_data->pctype, fd_data->fd_id);
242 else
243 dev_info(&pf->pdev->dev,
244 "Filter deleted for PCTYPE %d loc = %d\n",
245 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000246 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800247 if (err)
248 kfree(raw_packet);
249
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000250 return err ? -EOPNOTSUPP : 0;
251}
252
253#define I40E_TCPIP_DUMMY_PACKET_LEN 54
254/**
255 * i40e_add_del_fdir_tcpv4 - Add/Remove TCPv4 filters
256 * @vsi: pointer to the targeted VSI
257 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000258 * @add: true adds a filter, false removes it
259 *
260 * Returns 0 if the filters were successfully added or removed
261 **/
262static int i40e_add_del_fdir_tcpv4(struct i40e_vsi *vsi,
263 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000264 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000265{
266 struct i40e_pf *pf = vsi->back;
267 struct tcphdr *tcp;
268 struct iphdr *ip;
269 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000270 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000271 int ret;
272 /* Dummy packet */
273 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
274 0x45, 0, 0, 0x28, 0, 0, 0x40, 0, 0x40, 0x6, 0, 0, 0, 0, 0, 0,
275 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x80, 0x11,
276 0x0, 0x72, 0, 0, 0, 0};
277
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000278 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
279 if (!raw_packet)
280 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000281 memcpy(raw_packet, packet, I40E_TCPIP_DUMMY_PACKET_LEN);
282
283 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
284 tcp = (struct tcphdr *)(raw_packet + IP_HEADER_OFFSET
285 + sizeof(struct iphdr));
286
287 ip->daddr = fd_data->dst_ip[0];
288 tcp->dest = fd_data->dst_port;
289 ip->saddr = fd_data->src_ip[0];
290 tcp->source = fd_data->src_port;
291
292 if (add) {
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000293 pf->fd_tcp_rule++;
Jacob Keller234dc4e2016-09-06 18:05:09 -0700294 if ((pf->flags & I40E_FLAG_FD_ATR_ENABLED) &&
295 I40E_DEBUG_FD & pf->hw.debug_mask)
296 dev_info(&pf->pdev->dev, "Forcing ATR off, sideband rules for TCP/IPv4 flow being applied\n");
297 pf->auto_disable_flags |= I40E_FLAG_FD_ATR_ENABLED;
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000298 } else {
299 pf->fd_tcp_rule = (pf->fd_tcp_rule > 0) ?
300 (pf->fd_tcp_rule - 1) : 0;
301 if (pf->fd_tcp_rule == 0) {
Jacob Keller234dc4e2016-09-06 18:05:09 -0700302 if ((pf->flags & I40E_FLAG_FD_ATR_ENABLED) &&
303 I40E_DEBUG_FD & pf->hw.debug_mask)
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400304 dev_info(&pf->pdev->dev, "ATR re-enabled due to no sideband TCP/IPv4 rules\n");
Jacob Keller234dc4e2016-09-06 18:05:09 -0700305 pf->auto_disable_flags &= ~I40E_FLAG_FD_ATR_ENABLED;
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000306 }
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000307 }
308
Kevin Scottb2d36c02014-04-09 05:58:59 +0000309 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000310 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
311
312 if (ret) {
313 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000314 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
315 fd_data->pctype, fd_data->fd_id, ret);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000316 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000317 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000318 if (add)
319 dev_info(&pf->pdev->dev, "Filter OK for PCTYPE %d loc = %d)\n",
320 fd_data->pctype, fd_data->fd_id);
321 else
322 dev_info(&pf->pdev->dev,
323 "Filter deleted for PCTYPE %d loc = %d\n",
324 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000325 }
326
Kiran Patila42e7a32015-11-06 15:26:03 -0800327 if (err)
328 kfree(raw_packet);
329
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000330 return err ? -EOPNOTSUPP : 0;
331}
332
333/**
334 * i40e_add_del_fdir_sctpv4 - Add/Remove SCTPv4 Flow Director filters for
335 * a specific flow spec
336 * @vsi: pointer to the targeted VSI
337 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000338 * @add: true adds a filter, false removes it
339 *
Jesse Brandeburg4eeb1ff2015-11-18 17:35:42 -0800340 * Returns 0 if the filters were successfully added or removed
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000341 **/
342static int i40e_add_del_fdir_sctpv4(struct i40e_vsi *vsi,
343 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000344 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000345{
346 return -EOPNOTSUPP;
347}
348
349#define I40E_IP_DUMMY_PACKET_LEN 34
350/**
351 * i40e_add_del_fdir_ipv4 - Add/Remove IPv4 Flow Director filters for
352 * a specific flow spec
353 * @vsi: pointer to the targeted VSI
354 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000355 * @add: true adds a filter, false removes it
356 *
357 * Returns 0 if the filters were successfully added or removed
358 **/
359static int i40e_add_del_fdir_ipv4(struct i40e_vsi *vsi,
360 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000361 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000362{
363 struct i40e_pf *pf = vsi->back;
364 struct iphdr *ip;
365 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000366 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000367 int ret;
368 int i;
369 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
370 0x45, 0, 0, 0x14, 0, 0, 0x40, 0, 0x40, 0x10, 0, 0, 0, 0, 0, 0,
371 0, 0, 0, 0};
372
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000373 for (i = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER;
374 i <= I40E_FILTER_PCTYPE_FRAG_IPV4; i++) {
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000375 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
376 if (!raw_packet)
377 return -ENOMEM;
378 memcpy(raw_packet, packet, I40E_IP_DUMMY_PACKET_LEN);
379 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
380
381 ip->saddr = fd_data->src_ip[0];
382 ip->daddr = fd_data->dst_ip[0];
383 ip->protocol = 0;
384
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000385 fd_data->pctype = i;
386 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
387
388 if (ret) {
389 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000390 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
391 fd_data->pctype, fd_data->fd_id, ret);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000392 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000393 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000394 if (add)
395 dev_info(&pf->pdev->dev,
396 "Filter OK for PCTYPE %d loc = %d\n",
397 fd_data->pctype, fd_data->fd_id);
398 else
399 dev_info(&pf->pdev->dev,
400 "Filter deleted for PCTYPE %d loc = %d\n",
401 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000402 }
403 }
404
Kiran Patila42e7a32015-11-06 15:26:03 -0800405 if (err)
406 kfree(raw_packet);
407
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000408 return err ? -EOPNOTSUPP : 0;
409}
410
411/**
412 * i40e_add_del_fdir - Build raw packets to add/del fdir filter
413 * @vsi: pointer to the targeted VSI
414 * @cmd: command to get or set RX flow classification rules
415 * @add: true adds a filter, false removes it
416 *
417 **/
418int i40e_add_del_fdir(struct i40e_vsi *vsi,
419 struct i40e_fdir_filter *input, bool add)
420{
421 struct i40e_pf *pf = vsi->back;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000422 int ret;
423
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000424 switch (input->flow_type & ~FLOW_EXT) {
425 case TCP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000426 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000427 break;
428 case UDP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000429 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000430 break;
431 case SCTP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000432 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000433 break;
434 case IPV4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000435 ret = i40e_add_del_fdir_ipv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000436 break;
437 case IP_USER_FLOW:
438 switch (input->ip4_proto) {
439 case IPPROTO_TCP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000440 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000441 break;
442 case IPPROTO_UDP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000443 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000444 break;
445 case IPPROTO_SCTP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000446 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000447 break;
448 default:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000449 ret = i40e_add_del_fdir_ipv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000450 break;
451 }
452 break;
453 default:
Jakub Kicinskic5ffe7e2014-04-02 10:33:22 +0000454 dev_info(&pf->pdev->dev, "Could not specify spec type %d\n",
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000455 input->flow_type);
456 ret = -EINVAL;
457 }
458
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000459 /* The buffer allocated here is freed by the i40e_clean_tx_ring() */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000460 return ret;
461}
462
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000463/**
464 * i40e_fd_handle_status - check the Programming Status for FD
465 * @rx_ring: the Rx ring for this descriptor
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000466 * @rx_desc: the Rx descriptor for programming Status, not a packet descriptor.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000467 * @prog_id: the id originally used for programming
468 *
469 * This is used to verify if the FD programming or invalidation
470 * requested by SW to the HW is successful or not and take actions accordingly.
471 **/
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000472static void i40e_fd_handle_status(struct i40e_ring *rx_ring,
473 union i40e_rx_desc *rx_desc, u8 prog_id)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000474{
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000475 struct i40e_pf *pf = rx_ring->vsi->back;
476 struct pci_dev *pdev = pf->pdev;
477 u32 fcnt_prog, fcnt_avail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000478 u32 error;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000479 u64 qw;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000480
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000481 qw = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000482 error = (qw & I40E_RX_PROG_STATUS_DESC_QW1_ERROR_MASK) >>
483 I40E_RX_PROG_STATUS_DESC_QW1_ERROR_SHIFT;
484
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400485 if (error == BIT(I40E_RX_PROG_STATUS_DESC_FD_TBL_FULL_SHIFT)) {
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400486 pf->fd_inv = le32_to_cpu(rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000487 if ((rx_desc->wb.qword0.hi_dword.fd_id != 0) ||
488 (I40E_DEBUG_FD & pf->hw.debug_mask))
489 dev_warn(&pdev->dev, "ntuple filter loc = %d, could not be added\n",
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400490 pf->fd_inv);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000491
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000492 /* Check if the programming error is for ATR.
493 * If so, auto disable ATR and set a state for
494 * flush in progress. Next time we come here if flush is in
495 * progress do nothing, once flush is complete the state will
496 * be cleared.
497 */
498 if (test_bit(__I40E_FD_FLUSH_REQUESTED, &pf->state))
499 return;
500
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000501 pf->fd_add_err++;
502 /* store the current atr filter count */
503 pf->fd_atr_cnt = i40e_get_current_atr_cnt(pf);
504
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000505 if ((rx_desc->wb.qword0.hi_dword.fd_id == 0) &&
506 (pf->auto_disable_flags & I40E_FLAG_FD_SB_ENABLED)) {
507 pf->auto_disable_flags |= I40E_FLAG_FD_ATR_ENABLED;
508 set_bit(__I40E_FD_FLUSH_REQUESTED, &pf->state);
509 }
510
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000511 /* filter programming failed most likely due to table full */
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000512 fcnt_prog = i40e_get_global_fd_count(pf);
Anjali Singhai Jain12957382014-06-04 04:22:47 +0000513 fcnt_avail = pf->fdir_pf_filter_count;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000514 /* If ATR is running fcnt_prog can quickly change,
515 * if we are very close to full, it makes sense to disable
516 * FD ATR/SB and then re-enable it when there is room.
517 */
518 if (fcnt_prog >= (fcnt_avail - I40E_FDIR_BUFFER_FULL_MARGIN)) {
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000519 if ((pf->flags & I40E_FLAG_FD_SB_ENABLED) &&
Anjali Singhai Jainb814ba62014-06-04 20:41:48 +0000520 !(pf->auto_disable_flags &
Anjali Singhai Jainb814ba62014-06-04 20:41:48 +0000521 I40E_FLAG_FD_SB_ENABLED)) {
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400522 if (I40E_DEBUG_FD & pf->hw.debug_mask)
523 dev_warn(&pdev->dev, "FD filter space full, new ntuple rules will not be added\n");
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000524 pf->auto_disable_flags |=
525 I40E_FLAG_FD_SB_ENABLED;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000526 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000527 }
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400528 } else if (error == BIT(I40E_RX_PROG_STATUS_DESC_NO_FD_ENTRY_SHIFT)) {
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000529 if (I40E_DEBUG_FD & pf->hw.debug_mask)
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000530 dev_info(&pdev->dev, "ntuple filter fd_id = %d, could not be removed\n",
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000531 rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000532 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000533}
534
535/**
Alexander Duycka5e9c572013-09-28 06:00:27 +0000536 * i40e_unmap_and_free_tx_resource - Release a Tx buffer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000537 * @ring: the ring that owns the buffer
538 * @tx_buffer: the buffer to free
539 **/
Alexander Duycka5e9c572013-09-28 06:00:27 +0000540static void i40e_unmap_and_free_tx_resource(struct i40e_ring *ring,
541 struct i40e_tx_buffer *tx_buffer)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000542{
Alexander Duycka5e9c572013-09-28 06:00:27 +0000543 if (tx_buffer->skb) {
Alexander Duyck64bfd682016-09-12 14:18:39 -0700544 if (tx_buffer->tx_flags & I40E_TX_FLAGS_FD_SB)
545 kfree(tx_buffer->raw_buf);
546 else
547 dev_kfree_skb_any(tx_buffer->skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000548 if (dma_unmap_len(tx_buffer, len))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000549 dma_unmap_single(ring->dev,
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000550 dma_unmap_addr(tx_buffer, dma),
551 dma_unmap_len(tx_buffer, len),
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000552 DMA_TO_DEVICE);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000553 } else if (dma_unmap_len(tx_buffer, len)) {
554 dma_unmap_page(ring->dev,
555 dma_unmap_addr(tx_buffer, dma),
556 dma_unmap_len(tx_buffer, len),
557 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000558 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800559
Alexander Duycka5e9c572013-09-28 06:00:27 +0000560 tx_buffer->next_to_watch = NULL;
561 tx_buffer->skb = NULL;
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000562 dma_unmap_len_set(tx_buffer, len, 0);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000563 /* tx_buffer must be completely set up in the transmit path */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000564}
565
566/**
567 * i40e_clean_tx_ring - Free any empty Tx buffers
568 * @tx_ring: ring to be cleaned
569 **/
570void i40e_clean_tx_ring(struct i40e_ring *tx_ring)
571{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000572 unsigned long bi_size;
573 u16 i;
574
575 /* ring already cleared, nothing to do */
576 if (!tx_ring->tx_bi)
577 return;
578
579 /* Free all the Tx ring sk_buffs */
Alexander Duycka5e9c572013-09-28 06:00:27 +0000580 for (i = 0; i < tx_ring->count; i++)
581 i40e_unmap_and_free_tx_resource(tx_ring, &tx_ring->tx_bi[i]);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000582
583 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
584 memset(tx_ring->tx_bi, 0, bi_size);
585
586 /* Zero out the descriptor ring */
587 memset(tx_ring->desc, 0, tx_ring->size);
588
589 tx_ring->next_to_use = 0;
590 tx_ring->next_to_clean = 0;
Alexander Duyck7070ce02013-09-28 06:00:37 +0000591
592 if (!tx_ring->netdev)
593 return;
594
595 /* cleanup Tx queue statistics */
Alexander Duycke486bdf2016-09-12 14:18:40 -0700596 netdev_tx_reset_queue(txring_txq(tx_ring));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000597}
598
599/**
600 * i40e_free_tx_resources - Free Tx resources per queue
601 * @tx_ring: Tx descriptor ring for a specific queue
602 *
603 * Free all transmit software resources
604 **/
605void i40e_free_tx_resources(struct i40e_ring *tx_ring)
606{
607 i40e_clean_tx_ring(tx_ring);
608 kfree(tx_ring->tx_bi);
609 tx_ring->tx_bi = NULL;
610
611 if (tx_ring->desc) {
612 dma_free_coherent(tx_ring->dev, tx_ring->size,
613 tx_ring->desc, tx_ring->dma);
614 tx_ring->desc = NULL;
615 }
616}
617
Jesse Brandeburga68de582015-02-24 05:26:03 +0000618/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000619 * i40e_get_tx_pending - how many tx descriptors not processed
620 * @tx_ring: the ring of descriptors
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800621 * @in_sw: is tx_pending being checked in SW or HW
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000622 *
623 * Since there is no access to the ring head register
624 * in XL710, we need to use our local copies
625 **/
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800626u32 i40e_get_tx_pending(struct i40e_ring *ring, bool in_sw)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000627{
Jesse Brandeburga68de582015-02-24 05:26:03 +0000628 u32 head, tail;
629
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800630 if (!in_sw)
631 head = i40e_get_head(ring);
632 else
633 head = ring->next_to_clean;
Jesse Brandeburga68de582015-02-24 05:26:03 +0000634 tail = readl(ring->tail);
635
636 if (head != tail)
637 return (head < tail) ?
638 tail - head : (tail + ring->count - head);
639
640 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000641}
642
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000643#define WB_STRIDE 0x3
644
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000645/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000646 * i40e_clean_tx_irq - Reclaim resources after transmit completes
Alexander Duycka619afe2016-03-07 09:30:03 -0800647 * @vsi: the VSI we care about
648 * @tx_ring: Tx ring to clean
649 * @napi_budget: Used to determine if we are in netpoll
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000650 *
651 * Returns true if there's any budget left (e.g. the clean is finished)
652 **/
Alexander Duycka619afe2016-03-07 09:30:03 -0800653static bool i40e_clean_tx_irq(struct i40e_vsi *vsi,
654 struct i40e_ring *tx_ring, int napi_budget)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000655{
656 u16 i = tx_ring->next_to_clean;
657 struct i40e_tx_buffer *tx_buf;
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000658 struct i40e_tx_desc *tx_head;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000659 struct i40e_tx_desc *tx_desc;
Alexander Duycka619afe2016-03-07 09:30:03 -0800660 unsigned int total_bytes = 0, total_packets = 0;
661 unsigned int budget = vsi->work_limit;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000662
663 tx_buf = &tx_ring->tx_bi[i];
664 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000665 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000666
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000667 tx_head = I40E_TX_DESC(tx_ring, i40e_get_head(tx_ring));
668
Alexander Duycka5e9c572013-09-28 06:00:27 +0000669 do {
670 struct i40e_tx_desc *eop_desc = tx_buf->next_to_watch;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000671
672 /* if next_to_watch is not set then there is no work pending */
673 if (!eop_desc)
674 break;
675
Alexander Duycka5e9c572013-09-28 06:00:27 +0000676 /* prevent any other reads prior to eop_desc */
677 read_barrier_depends();
678
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000679 /* we have caught up to head, no work left to do */
680 if (tx_head == tx_desc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000681 break;
682
Alexander Duyckc304fda2013-09-28 06:00:12 +0000683 /* clear next_to_watch to prevent false hangs */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000684 tx_buf->next_to_watch = NULL;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000685
Alexander Duycka5e9c572013-09-28 06:00:27 +0000686 /* update the statistics for this packet */
687 total_bytes += tx_buf->bytecount;
688 total_packets += tx_buf->gso_segs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000689
Alexander Duycka5e9c572013-09-28 06:00:27 +0000690 /* free the skb */
Alexander Duycka619afe2016-03-07 09:30:03 -0800691 napi_consume_skb(tx_buf->skb, napi_budget);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000692
Alexander Duycka5e9c572013-09-28 06:00:27 +0000693 /* unmap skb header data */
694 dma_unmap_single(tx_ring->dev,
695 dma_unmap_addr(tx_buf, dma),
696 dma_unmap_len(tx_buf, len),
697 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000698
Alexander Duycka5e9c572013-09-28 06:00:27 +0000699 /* clear tx_buffer data */
700 tx_buf->skb = NULL;
701 dma_unmap_len_set(tx_buf, len, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000702
Alexander Duycka5e9c572013-09-28 06:00:27 +0000703 /* unmap remaining buffers */
704 while (tx_desc != eop_desc) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000705
706 tx_buf++;
707 tx_desc++;
708 i++;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000709 if (unlikely(!i)) {
710 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000711 tx_buf = tx_ring->tx_bi;
712 tx_desc = I40E_TX_DESC(tx_ring, 0);
713 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000714
Alexander Duycka5e9c572013-09-28 06:00:27 +0000715 /* unmap any remaining paged data */
716 if (dma_unmap_len(tx_buf, len)) {
717 dma_unmap_page(tx_ring->dev,
718 dma_unmap_addr(tx_buf, dma),
719 dma_unmap_len(tx_buf, len),
720 DMA_TO_DEVICE);
721 dma_unmap_len_set(tx_buf, len, 0);
722 }
723 }
724
725 /* move us one more past the eop_desc for start of next pkt */
726 tx_buf++;
727 tx_desc++;
728 i++;
729 if (unlikely(!i)) {
730 i -= tx_ring->count;
731 tx_buf = tx_ring->tx_bi;
732 tx_desc = I40E_TX_DESC(tx_ring, 0);
733 }
734
Jesse Brandeburg016890b2015-02-27 09:15:31 +0000735 prefetch(tx_desc);
736
Alexander Duycka5e9c572013-09-28 06:00:27 +0000737 /* update budget accounting */
738 budget--;
739 } while (likely(budget));
740
741 i += tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000742 tx_ring->next_to_clean = i;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000743 u64_stats_update_begin(&tx_ring->syncp);
Alexander Duycka114d0a2013-09-28 06:00:43 +0000744 tx_ring->stats.bytes += total_bytes;
745 tx_ring->stats.packets += total_packets;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000746 u64_stats_update_end(&tx_ring->syncp);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000747 tx_ring->q_vector->tx.total_bytes += total_bytes;
748 tx_ring->q_vector->tx.total_packets += total_packets;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000749
Anjali Singhai58044742015-09-25 18:26:13 -0700750 if (tx_ring->flags & I40E_TXR_FLAGS_WB_ON_ITR) {
Anjali Singhai58044742015-09-25 18:26:13 -0700751 /* check to see if there are < 4 descriptors
752 * waiting to be written back, then kick the hardware to force
753 * them to be written back in case we stay in NAPI.
754 * In this mode on X722 we do not enable Interrupt.
755 */
Mitch Williams88dc9e62016-06-20 09:10:35 -0700756 unsigned int j = i40e_get_tx_pending(tx_ring, false);
Anjali Singhai58044742015-09-25 18:26:13 -0700757
758 if (budget &&
759 ((j / (WB_STRIDE + 1)) == 0) && (j != 0) &&
Alexander Duycka619afe2016-03-07 09:30:03 -0800760 !test_bit(__I40E_DOWN, &vsi->state) &&
Anjali Singhai58044742015-09-25 18:26:13 -0700761 (I40E_DESC_UNUSED(tx_ring) != tx_ring->count))
762 tx_ring->arm_wb = true;
763 }
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000764
Alexander Duycke486bdf2016-09-12 14:18:40 -0700765 /* notify netdev of completed buffers */
766 netdev_tx_completed_queue(txring_txq(tx_ring),
Alexander Duyck7070ce02013-09-28 06:00:37 +0000767 total_packets, total_bytes);
768
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000769#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
770 if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
771 (I40E_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD))) {
772 /* Make sure that anybody stopping the queue after this
773 * sees the new next_to_clean.
774 */
775 smp_mb();
776 if (__netif_subqueue_stopped(tx_ring->netdev,
777 tx_ring->queue_index) &&
Alexander Duycka619afe2016-03-07 09:30:03 -0800778 !test_bit(__I40E_DOWN, &vsi->state)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000779 netif_wake_subqueue(tx_ring->netdev,
780 tx_ring->queue_index);
781 ++tx_ring->tx_stats.restart_queue;
782 }
783 }
784
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000785 return !!budget;
786}
787
788/**
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800789 * i40e_enable_wb_on_itr - Arm hardware to do a wb, interrupts are not enabled
790 * @vsi: the VSI we care about
791 * @q_vector: the vector on which to enable writeback
792 *
793 **/
794static void i40e_enable_wb_on_itr(struct i40e_vsi *vsi,
795 struct i40e_q_vector *q_vector)
796{
797 u16 flags = q_vector->tx.ring[0].flags;
798 u32 val;
799
800 if (!(flags & I40E_TXR_FLAGS_WB_ON_ITR))
801 return;
802
803 if (q_vector->arm_wb_state)
804 return;
805
806 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
807 val = I40E_PFINT_DYN_CTLN_WB_ON_ITR_MASK |
808 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK; /* set noitr */
809
810 wr32(&vsi->back->hw,
811 I40E_PFINT_DYN_CTLN(q_vector->v_idx + vsi->base_vector - 1),
812 val);
813 } else {
814 val = I40E_PFINT_DYN_CTL0_WB_ON_ITR_MASK |
815 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK; /* set noitr */
816
817 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
818 }
819 q_vector->arm_wb_state = true;
820}
821
822/**
823 * i40e_force_wb - Issue SW Interrupt so HW does a wb
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000824 * @vsi: the VSI we care about
825 * @q_vector: the vector on which to force writeback
826 *
827 **/
Kiran Patilb03a8c12015-09-24 18:13:15 -0400828void i40e_force_wb(struct i40e_vsi *vsi, struct i40e_q_vector *q_vector)
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000829{
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800830 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -0400831 u32 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
832 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK | /* set noitr */
833 I40E_PFINT_DYN_CTLN_SWINT_TRIG_MASK |
834 I40E_PFINT_DYN_CTLN_SW_ITR_INDX_ENA_MASK;
835 /* allow 00 to be written to the index */
836
837 wr32(&vsi->back->hw,
838 I40E_PFINT_DYN_CTLN(q_vector->v_idx +
839 vsi->base_vector - 1), val);
840 } else {
841 u32 val = I40E_PFINT_DYN_CTL0_INTENA_MASK |
842 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK | /* set noitr */
843 I40E_PFINT_DYN_CTL0_SWINT_TRIG_MASK |
844 I40E_PFINT_DYN_CTL0_SW_ITR_INDX_ENA_MASK;
845 /* allow 00 to be written to the index */
846
847 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
848 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000849}
850
851/**
852 * i40e_set_new_dynamic_itr - Find new ITR level
853 * @rc: structure containing ring performance data
854 *
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400855 * Returns true if ITR changed, false if not
856 *
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000857 * Stores a new ITR value based on packets and byte counts during
858 * the last interrupt. The advantage of per interrupt computation
859 * is faster updates and more accurate ITR for the current traffic
860 * pattern. Constants in this function were computed based on
861 * theoretical maximum wire speed and thresholds were set based on
862 * testing data as well as attempting to minimize response time
863 * while increasing bulk throughput.
864 **/
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400865static bool i40e_set_new_dynamic_itr(struct i40e_ring_container *rc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000866{
867 enum i40e_latency_range new_latency_range = rc->latency_range;
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400868 struct i40e_q_vector *qv = rc->ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000869 u32 new_itr = rc->itr;
870 int bytes_per_int;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400871 int usecs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000872
873 if (rc->total_packets == 0 || !rc->itr)
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400874 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000875
876 /* simple throttlerate management
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400877 * 0-10MB/s lowest (50000 ints/s)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000878 * 10-20MB/s low (20000 ints/s)
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400879 * 20-1249MB/s bulk (18000 ints/s)
880 * > 40000 Rx packets per second (8000 ints/s)
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400881 *
882 * The math works out because the divisor is in 10^(-6) which
883 * turns the bytes/us input value into MB/s values, but
884 * make sure to use usecs, as the register values written
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400885 * are in 2 usec increments in the ITR registers, and make sure
886 * to use the smoothed values that the countdown timer gives us.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000887 */
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400888 usecs = (rc->itr << 1) * ITR_COUNTDOWN_START;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400889 bytes_per_int = rc->total_bytes / usecs;
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400890
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400891 switch (new_latency_range) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000892 case I40E_LOWEST_LATENCY:
893 if (bytes_per_int > 10)
894 new_latency_range = I40E_LOW_LATENCY;
895 break;
896 case I40E_LOW_LATENCY:
897 if (bytes_per_int > 20)
898 new_latency_range = I40E_BULK_LATENCY;
899 else if (bytes_per_int <= 10)
900 new_latency_range = I40E_LOWEST_LATENCY;
901 break;
902 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400903 case I40E_ULTRA_LATENCY:
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400904 default:
905 if (bytes_per_int <= 20)
906 new_latency_range = I40E_LOW_LATENCY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000907 break;
908 }
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400909
910 /* this is to adjust RX more aggressively when streaming small
911 * packets. The value of 40000 was picked as it is just beyond
912 * what the hardware can receive per second if in low latency
913 * mode.
914 */
915#define RX_ULTRA_PACKET_RATE 40000
916
917 if ((((rc->total_packets * 1000000) / usecs) > RX_ULTRA_PACKET_RATE) &&
918 (&qv->rx == rc))
919 new_latency_range = I40E_ULTRA_LATENCY;
920
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400921 rc->latency_range = new_latency_range;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000922
923 switch (new_latency_range) {
924 case I40E_LOWEST_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400925 new_itr = I40E_ITR_50K;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000926 break;
927 case I40E_LOW_LATENCY:
928 new_itr = I40E_ITR_20K;
929 break;
930 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400931 new_itr = I40E_ITR_18K;
932 break;
933 case I40E_ULTRA_LATENCY:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000934 new_itr = I40E_ITR_8K;
935 break;
936 default:
937 break;
938 }
939
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000940 rc->total_bytes = 0;
941 rc->total_packets = 0;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400942
943 if (new_itr != rc->itr) {
944 rc->itr = new_itr;
945 return true;
946 }
947
948 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000949}
950
951/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000952 * i40e_clean_programming_status - clean the programming status descriptor
953 * @rx_ring: the rx ring that has this descriptor
954 * @rx_desc: the rx descriptor written back by HW
955 *
956 * Flow director should handle FD_FILTER_STATUS to check its filter programming
957 * status being successful or not and take actions accordingly. FCoE should
958 * handle its context/filter programming/invalidation status and take actions.
959 *
960 **/
961static void i40e_clean_programming_status(struct i40e_ring *rx_ring,
962 union i40e_rx_desc *rx_desc)
963{
964 u64 qw;
965 u8 id;
966
967 qw = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
968 id = (qw & I40E_RX_PROG_STATUS_DESC_QW1_PROGID_MASK) >>
969 I40E_RX_PROG_STATUS_DESC_QW1_PROGID_SHIFT;
970
971 if (id == I40E_RX_PROG_STATUS_DESC_FD_FILTER_STATUS)
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000972 i40e_fd_handle_status(rx_ring, rx_desc, id);
Vasu Dev38e00432014-08-01 13:27:03 -0700973#ifdef I40E_FCOE
974 else if ((id == I40E_RX_PROG_STATUS_DESC_FCOE_CTXT_PROG_STATUS) ||
975 (id == I40E_RX_PROG_STATUS_DESC_FCOE_CTXT_INVL_STATUS))
976 i40e_fcoe_handle_status(rx_ring, rx_desc, id);
977#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000978}
979
980/**
981 * i40e_setup_tx_descriptors - Allocate the Tx descriptors
982 * @tx_ring: the tx ring to set up
983 *
984 * Return 0 on success, negative on error
985 **/
986int i40e_setup_tx_descriptors(struct i40e_ring *tx_ring)
987{
988 struct device *dev = tx_ring->dev;
989 int bi_size;
990
991 if (!dev)
992 return -ENOMEM;
993
Jesse Brandeburge908f812015-07-23 16:54:42 -0400994 /* warn if we are about to overwrite the pointer */
995 WARN_ON(tx_ring->tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000996 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
997 tx_ring->tx_bi = kzalloc(bi_size, GFP_KERNEL);
998 if (!tx_ring->tx_bi)
999 goto err;
1000
1001 /* round up to nearest 4K */
1002 tx_ring->size = tx_ring->count * sizeof(struct i40e_tx_desc);
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +00001003 /* add u32 for head writeback, align after this takes care of
1004 * guaranteeing this is at least one cache line in size
1005 */
1006 tx_ring->size += sizeof(u32);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001007 tx_ring->size = ALIGN(tx_ring->size, 4096);
1008 tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
1009 &tx_ring->dma, GFP_KERNEL);
1010 if (!tx_ring->desc) {
1011 dev_info(dev, "Unable to allocate memory for the Tx descriptor ring, size=%d\n",
1012 tx_ring->size);
1013 goto err;
1014 }
1015
1016 tx_ring->next_to_use = 0;
1017 tx_ring->next_to_clean = 0;
1018 return 0;
1019
1020err:
1021 kfree(tx_ring->tx_bi);
1022 tx_ring->tx_bi = NULL;
1023 return -ENOMEM;
1024}
1025
1026/**
1027 * i40e_clean_rx_ring - Free Rx buffers
1028 * @rx_ring: ring to be cleaned
1029 **/
1030void i40e_clean_rx_ring(struct i40e_ring *rx_ring)
1031{
1032 struct device *dev = rx_ring->dev;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001033 unsigned long bi_size;
1034 u16 i;
1035
1036 /* ring already cleared, nothing to do */
1037 if (!rx_ring->rx_bi)
1038 return;
1039
1040 /* Free all the Rx ring sk_buffs */
1041 for (i = 0; i < rx_ring->count; i++) {
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001042 struct i40e_rx_buffer *rx_bi = &rx_ring->rx_bi[i];
1043
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001044 if (rx_bi->skb) {
1045 dev_kfree_skb(rx_bi->skb);
1046 rx_bi->skb = NULL;
1047 }
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001048 if (!rx_bi->page)
1049 continue;
1050
1051 dma_unmap_page(dev, rx_bi->dma, PAGE_SIZE, DMA_FROM_DEVICE);
1052 __free_pages(rx_bi->page, 0);
1053
1054 rx_bi->page = NULL;
1055 rx_bi->page_offset = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001056 }
1057
1058 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1059 memset(rx_ring->rx_bi, 0, bi_size);
1060
1061 /* Zero out the descriptor ring */
1062 memset(rx_ring->desc, 0, rx_ring->size);
1063
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001064 rx_ring->next_to_alloc = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001065 rx_ring->next_to_clean = 0;
1066 rx_ring->next_to_use = 0;
1067}
1068
1069/**
1070 * i40e_free_rx_resources - Free Rx resources
1071 * @rx_ring: ring to clean the resources from
1072 *
1073 * Free all receive software resources
1074 **/
1075void i40e_free_rx_resources(struct i40e_ring *rx_ring)
1076{
1077 i40e_clean_rx_ring(rx_ring);
1078 kfree(rx_ring->rx_bi);
1079 rx_ring->rx_bi = NULL;
1080
1081 if (rx_ring->desc) {
1082 dma_free_coherent(rx_ring->dev, rx_ring->size,
1083 rx_ring->desc, rx_ring->dma);
1084 rx_ring->desc = NULL;
1085 }
1086}
1087
1088/**
1089 * i40e_setup_rx_descriptors - Allocate Rx descriptors
1090 * @rx_ring: Rx descriptor ring (for a specific queue) to setup
1091 *
1092 * Returns 0 on success, negative on failure
1093 **/
1094int i40e_setup_rx_descriptors(struct i40e_ring *rx_ring)
1095{
1096 struct device *dev = rx_ring->dev;
1097 int bi_size;
1098
Jesse Brandeburge908f812015-07-23 16:54:42 -04001099 /* warn if we are about to overwrite the pointer */
1100 WARN_ON(rx_ring->rx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001101 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1102 rx_ring->rx_bi = kzalloc(bi_size, GFP_KERNEL);
1103 if (!rx_ring->rx_bi)
1104 goto err;
1105
Carolyn Wybornyf217d6c2015-02-09 17:42:31 -08001106 u64_stats_init(&rx_ring->syncp);
Carolyn Wyborny638702b2015-01-24 09:58:32 +00001107
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001108 /* Round up to nearest 4K */
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001109 rx_ring->size = rx_ring->count * sizeof(union i40e_32byte_rx_desc);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001110 rx_ring->size = ALIGN(rx_ring->size, 4096);
1111 rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
1112 &rx_ring->dma, GFP_KERNEL);
1113
1114 if (!rx_ring->desc) {
1115 dev_info(dev, "Unable to allocate memory for the Rx descriptor ring, size=%d\n",
1116 rx_ring->size);
1117 goto err;
1118 }
1119
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001120 rx_ring->next_to_alloc = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001121 rx_ring->next_to_clean = 0;
1122 rx_ring->next_to_use = 0;
1123
1124 return 0;
1125err:
1126 kfree(rx_ring->rx_bi);
1127 rx_ring->rx_bi = NULL;
1128 return -ENOMEM;
1129}
1130
1131/**
1132 * i40e_release_rx_desc - Store the new tail and head values
1133 * @rx_ring: ring to bump
1134 * @val: new head index
1135 **/
1136static inline void i40e_release_rx_desc(struct i40e_ring *rx_ring, u32 val)
1137{
1138 rx_ring->next_to_use = val;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001139
1140 /* update next to alloc since we have filled the ring */
1141 rx_ring->next_to_alloc = val;
1142
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001143 /* Force memory writes to complete before letting h/w
1144 * know there are new descriptors to fetch. (Only
1145 * applicable for weak-ordered memory model archs,
1146 * such as IA-64).
1147 */
1148 wmb();
1149 writel(val, rx_ring->tail);
1150}
1151
1152/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001153 * i40e_alloc_mapped_page - recycle or make a new page
1154 * @rx_ring: ring to use
1155 * @bi: rx_buffer struct to modify
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001156 *
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001157 * Returns true if the page was successfully allocated or
1158 * reused.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001159 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001160static bool i40e_alloc_mapped_page(struct i40e_ring *rx_ring,
1161 struct i40e_rx_buffer *bi)
Mitch Williamsa132af22015-01-24 09:58:35 +00001162{
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001163 struct page *page = bi->page;
1164 dma_addr_t dma;
Mitch Williamsa132af22015-01-24 09:58:35 +00001165
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001166 /* since we are recycling buffers we should seldom need to alloc */
1167 if (likely(page)) {
1168 rx_ring->rx_stats.page_reuse_count++;
1169 return true;
Mitch Williamsa132af22015-01-24 09:58:35 +00001170 }
1171
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001172 /* alloc new page for storage */
1173 page = dev_alloc_page();
1174 if (unlikely(!page)) {
1175 rx_ring->rx_stats.alloc_page_failed++;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001176 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001177 }
1178
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001179 /* map page for use */
1180 dma = dma_map_page(rx_ring->dev, page, 0, PAGE_SIZE, DMA_FROM_DEVICE);
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001181
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001182 /* if mapping failed free memory back to system since
1183 * there isn't much point in holding memory we can't use
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001184 */
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001185 if (dma_mapping_error(rx_ring->dev, dma)) {
1186 __free_pages(page, 0);
1187 rx_ring->rx_stats.alloc_page_failed++;
1188 return false;
1189 }
1190
1191 bi->dma = dma;
1192 bi->page = page;
1193 bi->page_offset = 0;
1194
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001195 return true;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001196}
1197
1198/**
1199 * i40e_receive_skb - Send a completed packet up the stack
1200 * @rx_ring: rx ring in play
1201 * @skb: packet to send up
1202 * @vlan_tag: vlan tag for packet
1203 **/
1204static void i40e_receive_skb(struct i40e_ring *rx_ring,
1205 struct sk_buff *skb, u16 vlan_tag)
1206{
1207 struct i40e_q_vector *q_vector = rx_ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001208
Jesse Brandeburga149f2c2016-04-12 08:30:49 -07001209 if ((rx_ring->netdev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
1210 (vlan_tag & VLAN_VID_MASK))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001211 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlan_tag);
1212
Alexander Duyck8b650352015-09-24 09:04:32 -07001213 napi_gro_receive(&q_vector->napi, skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001214}
1215
1216/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001217 * i40e_alloc_rx_buffers - Replace used receive buffers
1218 * @rx_ring: ring to place buffers on
1219 * @cleaned_count: number of buffers to replace
1220 *
1221 * Returns false if all allocations were successful, true if any fail
1222 **/
1223bool i40e_alloc_rx_buffers(struct i40e_ring *rx_ring, u16 cleaned_count)
1224{
1225 u16 ntu = rx_ring->next_to_use;
1226 union i40e_rx_desc *rx_desc;
1227 struct i40e_rx_buffer *bi;
1228
1229 /* do nothing if no valid netdev defined */
1230 if (!rx_ring->netdev || !cleaned_count)
1231 return false;
1232
1233 rx_desc = I40E_RX_DESC(rx_ring, ntu);
1234 bi = &rx_ring->rx_bi[ntu];
1235
1236 do {
1237 if (!i40e_alloc_mapped_page(rx_ring, bi))
1238 goto no_buffers;
1239
1240 /* Refresh the desc even if buffer_addrs didn't change
1241 * because each write-back erases this info.
1242 */
1243 rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
1244 rx_desc->read.hdr_addr = 0;
1245
1246 rx_desc++;
1247 bi++;
1248 ntu++;
1249 if (unlikely(ntu == rx_ring->count)) {
1250 rx_desc = I40E_RX_DESC(rx_ring, 0);
1251 bi = rx_ring->rx_bi;
1252 ntu = 0;
1253 }
1254
1255 /* clear the status bits for the next_to_use descriptor */
1256 rx_desc->wb.qword1.status_error_len = 0;
1257
1258 cleaned_count--;
1259 } while (cleaned_count);
1260
1261 if (rx_ring->next_to_use != ntu)
1262 i40e_release_rx_desc(rx_ring, ntu);
1263
1264 return false;
1265
1266no_buffers:
1267 if (rx_ring->next_to_use != ntu)
1268 i40e_release_rx_desc(rx_ring, ntu);
1269
1270 /* make sure to come back via polling to try again after
1271 * allocation failure
1272 */
1273 return true;
1274}
1275
1276/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001277 * i40e_rx_checksum - Indicate in skb if hw indicated a good cksum
1278 * @vsi: the VSI we care about
1279 * @skb: skb currently being received and modified
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001280 * @rx_desc: the receive descriptor
1281 *
1282 * skb->protocol must be set before this function is called
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001283 **/
1284static inline void i40e_rx_checksum(struct i40e_vsi *vsi,
1285 struct sk_buff *skb,
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001286 union i40e_rx_desc *rx_desc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001287{
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001288 struct i40e_rx_ptype_decoded decoded;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001289 u32 rx_error, rx_status;
Alexander Duyck858296c82016-06-14 15:45:42 -07001290 bool ipv4, ipv6;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001291 u8 ptype;
1292 u64 qword;
1293
1294 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1295 ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >> I40E_RXD_QW1_PTYPE_SHIFT;
1296 rx_error = (qword & I40E_RXD_QW1_ERROR_MASK) >>
1297 I40E_RXD_QW1_ERROR_SHIFT;
1298 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1299 I40E_RXD_QW1_STATUS_SHIFT;
1300 decoded = decode_rx_desc_ptype(ptype);
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001301
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001302 skb->ip_summed = CHECKSUM_NONE;
1303
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001304 skb_checksum_none_assert(skb);
1305
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001306 /* Rx csum enabled and ip headers found? */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001307 if (!(vsi->netdev->features & NETIF_F_RXCSUM))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001308 return;
1309
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001310 /* did the hardware decode the packet and checksum? */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001311 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_L3L4P_SHIFT)))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001312 return;
1313
1314 /* both known and outer_ip must be set for the below code to work */
1315 if (!(decoded.known && decoded.outer_ip))
1316 return;
1317
Alexander Duyckfad57332016-01-24 21:17:22 -08001318 ipv4 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1319 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV4);
1320 ipv6 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1321 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV6);
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001322
1323 if (ipv4 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001324 (rx_error & (BIT(I40E_RX_DESC_ERROR_IPE_SHIFT) |
1325 BIT(I40E_RX_DESC_ERROR_EIPE_SHIFT))))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001326 goto checksum_fail;
1327
Jesse Brandeburgddf1d0d2014-02-13 03:48:39 -08001328 /* likely incorrect csum if alternate IP extension headers found */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001329 if (ipv6 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001330 rx_status & BIT(I40E_RX_DESC_STATUS_IPV6EXADD_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001331 /* don't increment checksum err here, non-fatal err */
Shannon Nelson8ee75a82013-12-21 05:44:46 +00001332 return;
1333
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001334 /* there was some L4 error, count error and punt packet to the stack */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001335 if (rx_error & BIT(I40E_RX_DESC_ERROR_L4E_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001336 goto checksum_fail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001337
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001338 /* handle packets that were not able to be checksummed due
1339 * to arrival speed, in this case the stack can compute
1340 * the csum.
1341 */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001342 if (rx_error & BIT(I40E_RX_DESC_ERROR_PPRS_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001343 return;
1344
Alexander Duyck858296c82016-06-14 15:45:42 -07001345 /* If there is an outer header present that might contain a checksum
1346 * we need to bump the checksum level by 1 to reflect the fact that
1347 * we are indicating we validated the inner checksum.
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001348 */
Alexander Duyck858296c82016-06-14 15:45:42 -07001349 if (decoded.tunnel_type >= I40E_RX_PTYPE_TUNNEL_IP_GRENAT)
1350 skb->csum_level = 1;
Alexander Duyckfad57332016-01-24 21:17:22 -08001351
Alexander Duyck858296c82016-06-14 15:45:42 -07001352 /* Only report checksum unnecessary for TCP, UDP, or SCTP */
1353 switch (decoded.inner_prot) {
1354 case I40E_RX_PTYPE_INNER_PROT_TCP:
1355 case I40E_RX_PTYPE_INNER_PROT_UDP:
1356 case I40E_RX_PTYPE_INNER_PROT_SCTP:
1357 skb->ip_summed = CHECKSUM_UNNECESSARY;
1358 /* fall though */
1359 default:
1360 break;
1361 }
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001362
1363 return;
1364
1365checksum_fail:
1366 vsi->back->hw_csum_rx_error++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001367}
1368
1369/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001370 * i40e_ptype_to_htype - get a hash type
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001371 * @ptype: the ptype value from the descriptor
1372 *
1373 * Returns a hash type to be used by skb_set_hash
1374 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001375static inline int i40e_ptype_to_htype(u8 ptype)
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001376{
1377 struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype(ptype);
1378
1379 if (!decoded.known)
1380 return PKT_HASH_TYPE_NONE;
1381
1382 if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1383 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY4)
1384 return PKT_HASH_TYPE_L4;
1385 else if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1386 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY3)
1387 return PKT_HASH_TYPE_L3;
1388 else
1389 return PKT_HASH_TYPE_L2;
1390}
1391
1392/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001393 * i40e_rx_hash - set the hash value in the skb
1394 * @ring: descriptor ring
1395 * @rx_desc: specific descriptor
1396 **/
1397static inline void i40e_rx_hash(struct i40e_ring *ring,
1398 union i40e_rx_desc *rx_desc,
1399 struct sk_buff *skb,
1400 u8 rx_ptype)
1401{
1402 u32 hash;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001403 const __le64 rss_mask =
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001404 cpu_to_le64((u64)I40E_RX_DESC_FLTSTAT_RSS_HASH <<
1405 I40E_RX_DESC_STATUS_FLTSTAT_SHIFT);
1406
Mitch Williamsa876c3b2016-05-03 15:13:18 -07001407 if (!(ring->netdev->features & NETIF_F_RXHASH))
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001408 return;
1409
1410 if ((rx_desc->wb.qword1.status_error_len & rss_mask) == rss_mask) {
1411 hash = le32_to_cpu(rx_desc->wb.qword0.hi_dword.rss);
1412 skb_set_hash(skb, hash, i40e_ptype_to_htype(rx_ptype));
1413 }
1414}
1415
1416/**
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001417 * i40e_process_skb_fields - Populate skb header fields from Rx descriptor
1418 * @rx_ring: rx descriptor ring packet is being transacted on
1419 * @rx_desc: pointer to the EOP Rx descriptor
1420 * @skb: pointer to current skb being populated
1421 * @rx_ptype: the packet type decoded by hardware
Mitch Williamsa132af22015-01-24 09:58:35 +00001422 *
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001423 * This function checks the ring, descriptor, and packet information in
1424 * order to populate the hash, checksum, VLAN, protocol, and
1425 * other fields within the skb.
Mitch Williamsa132af22015-01-24 09:58:35 +00001426 **/
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001427static inline
1428void i40e_process_skb_fields(struct i40e_ring *rx_ring,
1429 union i40e_rx_desc *rx_desc, struct sk_buff *skb,
1430 u8 rx_ptype)
1431{
1432 u64 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1433 u32 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1434 I40E_RXD_QW1_STATUS_SHIFT;
1435 u32 rsyn = (rx_status & I40E_RXD_QW1_STATUS_TSYNINDX_MASK) >>
1436 I40E_RXD_QW1_STATUS_TSYNINDX_SHIFT;
1437
1438 if (unlikely(rsyn)) {
1439 i40e_ptp_rx_hwtstamp(rx_ring->vsi->back, skb, rsyn);
1440 rx_ring->last_rx_timestamp = jiffies;
1441 }
1442
1443 i40e_rx_hash(rx_ring, rx_desc, skb, rx_ptype);
1444
1445 /* modifies the skb - consumes the enet header */
1446 skb->protocol = eth_type_trans(skb, rx_ring->netdev);
1447
1448 i40e_rx_checksum(rx_ring->vsi, skb, rx_desc);
1449
1450 skb_record_rx_queue(skb, rx_ring->queue_index);
1451}
1452
1453/**
1454 * i40e_pull_tail - i40e specific version of skb_pull_tail
1455 * @rx_ring: rx descriptor ring packet is being transacted on
1456 * @skb: pointer to current skb being adjusted
1457 *
1458 * This function is an i40e specific version of __pskb_pull_tail. The
1459 * main difference between this version and the original function is that
1460 * this function can make several assumptions about the state of things
1461 * that allow for significant optimizations versus the standard function.
1462 * As a result we can do things like drop a frag and maintain an accurate
1463 * truesize for the skb.
1464 */
1465static void i40e_pull_tail(struct i40e_ring *rx_ring, struct sk_buff *skb)
1466{
1467 struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
1468 unsigned char *va;
1469 unsigned int pull_len;
1470
1471 /* it is valid to use page_address instead of kmap since we are
1472 * working with pages allocated out of the lomem pool per
1473 * alloc_page(GFP_ATOMIC)
1474 */
1475 va = skb_frag_address(frag);
1476
1477 /* we need the header to contain the greater of either ETH_HLEN or
1478 * 60 bytes if the skb->len is less than 60 for skb_pad.
1479 */
1480 pull_len = eth_get_headlen(va, I40E_RX_HDR_SIZE);
1481
1482 /* align pull length to size of long to optimize memcpy performance */
1483 skb_copy_to_linear_data(skb, va, ALIGN(pull_len, sizeof(long)));
1484
1485 /* update all of the pointers */
1486 skb_frag_size_sub(frag, pull_len);
1487 frag->page_offset += pull_len;
1488 skb->data_len -= pull_len;
1489 skb->tail += pull_len;
1490}
1491
1492/**
1493 * i40e_cleanup_headers - Correct empty headers
1494 * @rx_ring: rx descriptor ring packet is being transacted on
1495 * @skb: pointer to current skb being fixed
1496 *
1497 * Also address the case where we are pulling data in on pages only
1498 * and as such no data is present in the skb header.
1499 *
1500 * In addition if skb is not at least 60 bytes we need to pad it so that
1501 * it is large enough to qualify as a valid Ethernet frame.
1502 *
1503 * Returns true if an error was encountered and skb was freed.
1504 **/
1505static bool i40e_cleanup_headers(struct i40e_ring *rx_ring, struct sk_buff *skb)
1506{
1507 /* place header in linear portion of buffer */
1508 if (skb_is_nonlinear(skb))
1509 i40e_pull_tail(rx_ring, skb);
1510
1511 /* if eth_skb_pad returns an error the skb was freed */
1512 if (eth_skb_pad(skb))
1513 return true;
1514
1515 return false;
1516}
1517
1518/**
1519 * i40e_reuse_rx_page - page flip buffer and store it back on the ring
1520 * @rx_ring: rx descriptor ring to store buffers on
1521 * @old_buff: donor buffer to have page reused
1522 *
1523 * Synchronizes page for reuse by the adapter
1524 **/
1525static void i40e_reuse_rx_page(struct i40e_ring *rx_ring,
1526 struct i40e_rx_buffer *old_buff)
1527{
1528 struct i40e_rx_buffer *new_buff;
1529 u16 nta = rx_ring->next_to_alloc;
1530
1531 new_buff = &rx_ring->rx_bi[nta];
1532
1533 /* update, and store next to alloc */
1534 nta++;
1535 rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
1536
1537 /* transfer page from old buffer to new buffer */
1538 *new_buff = *old_buff;
1539}
1540
1541/**
1542 * i40e_page_is_reserved - check if reuse is possible
1543 * @page: page struct to check
1544 */
1545static inline bool i40e_page_is_reserved(struct page *page)
1546{
1547 return (page_to_nid(page) != numa_mem_id()) || page_is_pfmemalloc(page);
1548}
1549
1550/**
1551 * i40e_add_rx_frag - Add contents of Rx buffer to sk_buff
1552 * @rx_ring: rx descriptor ring to transact packets on
1553 * @rx_buffer: buffer containing page to add
1554 * @rx_desc: descriptor containing length of buffer written by hardware
1555 * @skb: sk_buff to place the data into
1556 *
1557 * This function will add the data contained in rx_buffer->page to the skb.
1558 * This is done either through a direct copy if the data in the buffer is
1559 * less than the skb header size, otherwise it will just attach the page as
1560 * a frag to the skb.
1561 *
1562 * The function will then update the page offset if necessary and return
1563 * true if the buffer can be reused by the adapter.
1564 **/
1565static bool i40e_add_rx_frag(struct i40e_ring *rx_ring,
1566 struct i40e_rx_buffer *rx_buffer,
1567 union i40e_rx_desc *rx_desc,
1568 struct sk_buff *skb)
1569{
1570 struct page *page = rx_buffer->page;
1571 u64 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1572 unsigned int size = (qword & I40E_RXD_QW1_LENGTH_PBUF_MASK) >>
1573 I40E_RXD_QW1_LENGTH_PBUF_SHIFT;
1574#if (PAGE_SIZE < 8192)
1575 unsigned int truesize = I40E_RXBUFFER_2048;
1576#else
1577 unsigned int truesize = ALIGN(size, L1_CACHE_BYTES);
1578 unsigned int last_offset = PAGE_SIZE - I40E_RXBUFFER_2048;
1579#endif
1580
1581 /* will the data fit in the skb we allocated? if so, just
1582 * copy it as it is pretty small anyway
1583 */
1584 if ((size <= I40E_RX_HDR_SIZE) && !skb_is_nonlinear(skb)) {
1585 unsigned char *va = page_address(page) + rx_buffer->page_offset;
1586
1587 memcpy(__skb_put(skb, size), va, ALIGN(size, sizeof(long)));
1588
1589 /* page is not reserved, we can reuse buffer as-is */
1590 if (likely(!i40e_page_is_reserved(page)))
1591 return true;
1592
1593 /* this page cannot be reused so discard it */
1594 __free_pages(page, 0);
1595 return false;
1596 }
1597
1598 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page,
1599 rx_buffer->page_offset, size, truesize);
1600
1601 /* avoid re-using remote pages */
1602 if (unlikely(i40e_page_is_reserved(page)))
1603 return false;
1604
1605#if (PAGE_SIZE < 8192)
1606 /* if we are only owner of page we can reuse it */
1607 if (unlikely(page_count(page) != 1))
1608 return false;
1609
1610 /* flip page offset to other buffer */
1611 rx_buffer->page_offset ^= truesize;
1612#else
1613 /* move offset up to the next cache line */
1614 rx_buffer->page_offset += truesize;
1615
1616 if (rx_buffer->page_offset > last_offset)
1617 return false;
1618#endif
1619
1620 /* Even if we own the page, we are not allowed to use atomic_set()
1621 * This would break get_page_unless_zero() users.
1622 */
1623 get_page(rx_buffer->page);
1624
1625 return true;
1626}
1627
1628/**
1629 * i40e_fetch_rx_buffer - Allocate skb and populate it
1630 * @rx_ring: rx descriptor ring to transact packets on
1631 * @rx_desc: descriptor containing info written by hardware
1632 *
1633 * This function allocates an skb on the fly, and populates it with the page
1634 * data from the current receive descriptor, taking care to set up the skb
1635 * correctly, as well as handling calling the page recycle function if
1636 * necessary.
1637 */
1638static inline
1639struct sk_buff *i40e_fetch_rx_buffer(struct i40e_ring *rx_ring,
1640 union i40e_rx_desc *rx_desc)
1641{
1642 struct i40e_rx_buffer *rx_buffer;
1643 struct sk_buff *skb;
1644 struct page *page;
1645
1646 rx_buffer = &rx_ring->rx_bi[rx_ring->next_to_clean];
1647 page = rx_buffer->page;
1648 prefetchw(page);
1649
1650 skb = rx_buffer->skb;
1651
1652 if (likely(!skb)) {
1653 void *page_addr = page_address(page) + rx_buffer->page_offset;
1654
1655 /* prefetch first cache line of first page */
1656 prefetch(page_addr);
1657#if L1_CACHE_BYTES < 128
1658 prefetch(page_addr + L1_CACHE_BYTES);
1659#endif
1660
1661 /* allocate a skb to store the frags */
1662 skb = __napi_alloc_skb(&rx_ring->q_vector->napi,
1663 I40E_RX_HDR_SIZE,
1664 GFP_ATOMIC | __GFP_NOWARN);
1665 if (unlikely(!skb)) {
1666 rx_ring->rx_stats.alloc_buff_failed++;
1667 return NULL;
1668 }
1669
1670 /* we will be copying header into skb->data in
1671 * pskb_may_pull so it is in our interest to prefetch
1672 * it now to avoid a possible cache miss
1673 */
1674 prefetchw(skb->data);
1675 } else {
1676 rx_buffer->skb = NULL;
1677 }
1678
1679 /* we are reusing so sync this buffer for CPU use */
1680 dma_sync_single_range_for_cpu(rx_ring->dev,
1681 rx_buffer->dma,
1682 rx_buffer->page_offset,
1683 I40E_RXBUFFER_2048,
1684 DMA_FROM_DEVICE);
1685
1686 /* pull page into skb */
1687 if (i40e_add_rx_frag(rx_ring, rx_buffer, rx_desc, skb)) {
1688 /* hand second half of page back to the ring */
1689 i40e_reuse_rx_page(rx_ring, rx_buffer);
1690 rx_ring->rx_stats.page_reuse_count++;
1691 } else {
1692 /* we are not reusing the buffer so unmap it */
1693 dma_unmap_page(rx_ring->dev, rx_buffer->dma, PAGE_SIZE,
1694 DMA_FROM_DEVICE);
1695 }
1696
1697 /* clear contents of buffer_info */
1698 rx_buffer->page = NULL;
1699
1700 return skb;
1701}
1702
1703/**
1704 * i40e_is_non_eop - process handling of non-EOP buffers
1705 * @rx_ring: Rx ring being processed
1706 * @rx_desc: Rx descriptor for current buffer
1707 * @skb: Current socket buffer containing buffer in progress
1708 *
1709 * This function updates next to clean. If the buffer is an EOP buffer
1710 * this function exits returning false, otherwise it will place the
1711 * sk_buff in the next buffer to be chained and return true indicating
1712 * that this is in fact a non-EOP buffer.
1713 **/
1714static bool i40e_is_non_eop(struct i40e_ring *rx_ring,
1715 union i40e_rx_desc *rx_desc,
1716 struct sk_buff *skb)
1717{
1718 u32 ntc = rx_ring->next_to_clean + 1;
1719
1720 /* fetch, update, and store next to clean */
1721 ntc = (ntc < rx_ring->count) ? ntc : 0;
1722 rx_ring->next_to_clean = ntc;
1723
1724 prefetch(I40E_RX_DESC(rx_ring, ntc));
1725
1726#define staterrlen rx_desc->wb.qword1.status_error_len
1727 if (unlikely(i40e_rx_is_programming_status(le64_to_cpu(staterrlen)))) {
1728 i40e_clean_programming_status(rx_ring, rx_desc);
1729 rx_ring->rx_bi[ntc].skb = skb;
1730 return true;
1731 }
1732 /* if we are the last buffer then there is nothing else to do */
1733#define I40E_RXD_EOF BIT(I40E_RX_DESC_STATUS_EOF_SHIFT)
1734 if (likely(i40e_test_staterr(rx_desc, I40E_RXD_EOF)))
1735 return false;
1736
1737 /* place skb in next buffer to be received */
1738 rx_ring->rx_bi[ntc].skb = skb;
1739 rx_ring->rx_stats.non_eop_descs++;
1740
1741 return true;
1742}
1743
1744/**
1745 * i40e_clean_rx_irq - Clean completed descriptors from Rx ring - bounce buf
1746 * @rx_ring: rx descriptor ring to transact packets on
1747 * @budget: Total limit on number of packets to process
1748 *
1749 * This function provides a "bounce buffer" approach to Rx interrupt
1750 * processing. The advantage to this is that on systems that have
1751 * expensive overhead for IOMMU access this provides a means of avoiding
1752 * it by maintaining the mapping of the page to the system.
1753 *
1754 * Returns amount of work completed
1755 **/
1756static int i40e_clean_rx_irq(struct i40e_ring *rx_ring, int budget)
Mitch Williamsa132af22015-01-24 09:58:35 +00001757{
1758 unsigned int total_rx_bytes = 0, total_rx_packets = 0;
1759 u16 cleaned_count = I40E_DESC_UNUSED(rx_ring);
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001760 bool failure = false;
Mitch Williamsa132af22015-01-24 09:58:35 +00001761
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001762 while (likely(total_rx_packets < budget)) {
1763 union i40e_rx_desc *rx_desc;
Mitch Williamsa132af22015-01-24 09:58:35 +00001764 struct sk_buff *skb;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001765 u32 rx_status;
Mitch Williamsa132af22015-01-24 09:58:35 +00001766 u16 vlan_tag;
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001767 u8 rx_ptype;
1768 u64 qword;
1769
Mitch Williamsa132af22015-01-24 09:58:35 +00001770 /* return some buffers to hardware, one at a time is too slow */
1771 if (cleaned_count >= I40E_RX_BUFFER_WRITE) {
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001772 failure = failure ||
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001773 i40e_alloc_rx_buffers(rx_ring, cleaned_count);
Mitch Williamsa132af22015-01-24 09:58:35 +00001774 cleaned_count = 0;
1775 }
1776
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001777 rx_desc = I40E_RX_DESC(rx_ring, rx_ring->next_to_clean);
1778
Mitch Williamsa132af22015-01-24 09:58:35 +00001779 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001780 rx_ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >>
1781 I40E_RXD_QW1_PTYPE_SHIFT;
Mitch Williamsa132af22015-01-24 09:58:35 +00001782 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001783 I40E_RXD_QW1_STATUS_SHIFT;
Mitch Williamsa132af22015-01-24 09:58:35 +00001784
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001785 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_DD_SHIFT)))
Mitch Williamsa132af22015-01-24 09:58:35 +00001786 break;
1787
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001788 /* status_error_len will always be zero for unused descriptors
1789 * because it's cleared in cleanup, and overlaps with hdr_addr
1790 * which is always zero because packet split isn't used, if the
1791 * hardware wrote DD then it will be non-zero
1792 */
1793 if (!rx_desc->wb.qword1.status_error_len)
1794 break;
1795
Mitch Williamsa132af22015-01-24 09:58:35 +00001796 /* This memory barrier is needed to keep us from reading
1797 * any other fields out of the rx_desc until we know the
1798 * DD bit is set.
1799 */
Alexander Duyck67317162015-04-08 18:49:43 -07001800 dma_rmb();
Mitch Williamsa132af22015-01-24 09:58:35 +00001801
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001802 skb = i40e_fetch_rx_buffer(rx_ring, rx_desc);
1803 if (!skb)
1804 break;
Mitch Williamsa132af22015-01-24 09:58:35 +00001805
Mitch Williamsa132af22015-01-24 09:58:35 +00001806 cleaned_count++;
1807
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001808 if (i40e_is_non_eop(rx_ring, rx_desc, skb))
Mitch Williamsa132af22015-01-24 09:58:35 +00001809 continue;
Mitch Williamsa132af22015-01-24 09:58:35 +00001810
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001811 /* ERR_MASK will only have valid bits if EOP set, and
1812 * what we are doing here is actually checking
1813 * I40E_RX_DESC_ERROR_RXE_SHIFT, since it is the zeroth bit in
1814 * the error field
1815 */
1816 if (unlikely(i40e_test_staterr(rx_desc, BIT(I40E_RXD_QW1_ERROR_SHIFT)))) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001817 dev_kfree_skb_any(skb);
Mitch Williamsa132af22015-01-24 09:58:35 +00001818 continue;
1819 }
1820
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001821 if (i40e_cleanup_headers(rx_ring, skb))
1822 continue;
Mitch Williamsa132af22015-01-24 09:58:35 +00001823
1824 /* probably a little skewed due to removing CRC */
1825 total_rx_bytes += skb->len;
Mitch Williamsa132af22015-01-24 09:58:35 +00001826
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001827 /* populate checksum, VLAN, and protocol */
1828 i40e_process_skb_fields(rx_ring, rx_desc, skb, rx_ptype);
Mitch Williamsa132af22015-01-24 09:58:35 +00001829
Mitch Williamsa132af22015-01-24 09:58:35 +00001830#ifdef I40E_FCOE
Jesse Brandeburg1f15d662016-04-01 03:56:06 -07001831 if (unlikely(
1832 i40e_rx_is_fcoe(rx_ptype) &&
1833 !i40e_fcoe_handle_offload(rx_ring, rx_desc, skb))) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001834 dev_kfree_skb_any(skb);
1835 continue;
1836 }
1837#endif
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001838
1839 vlan_tag = (qword & BIT(I40E_RX_DESC_STATUS_L2TAG1P_SHIFT)) ?
1840 le16_to_cpu(rx_desc->wb.qword0.lo_dword.l2tag1) : 0;
1841
Mitch Williamsa132af22015-01-24 09:58:35 +00001842 i40e_receive_skb(rx_ring, skb, vlan_tag);
1843
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001844 /* update budget accounting */
1845 total_rx_packets++;
1846 }
Mitch Williamsa132af22015-01-24 09:58:35 +00001847
1848 u64_stats_update_begin(&rx_ring->syncp);
1849 rx_ring->stats.packets += total_rx_packets;
1850 rx_ring->stats.bytes += total_rx_bytes;
1851 u64_stats_update_end(&rx_ring->syncp);
1852 rx_ring->q_vector->rx.total_packets += total_rx_packets;
1853 rx_ring->q_vector->rx.total_bytes += total_rx_bytes;
1854
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07001855 /* guarantee a trip back through this routine if there was a failure */
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001856 return failure ? budget : total_rx_packets;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001857}
1858
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001859static u32 i40e_buildreg_itr(const int type, const u16 itr)
1860{
1861 u32 val;
1862
1863 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08001864 /* Don't clear PBA because that can cause lost interrupts that
1865 * came in while we were cleaning/polling
1866 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001867 (type << I40E_PFINT_DYN_CTLN_ITR_INDX_SHIFT) |
1868 (itr << I40E_PFINT_DYN_CTLN_INTERVAL_SHIFT);
1869
1870 return val;
1871}
1872
1873/* a small macro to shorten up some long lines */
1874#define INTREG I40E_PFINT_DYN_CTLN
Jacob Keller65e87c02016-09-12 14:18:44 -07001875static inline int get_rx_itr_enabled(struct i40e_vsi *vsi, int idx)
1876{
1877 return !!(vsi->rx_rings[idx]->rx_itr_setting);
1878}
1879
1880static inline int get_tx_itr_enabled(struct i40e_vsi *vsi, int idx)
1881{
1882 return !!(vsi->tx_rings[idx]->tx_itr_setting);
1883}
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001884
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001885/**
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001886 * i40e_update_enable_itr - Update itr and re-enable MSIX interrupt
1887 * @vsi: the VSI we care about
1888 * @q_vector: q_vector for which itr is being updated and interrupt enabled
1889 *
1890 **/
1891static inline void i40e_update_enable_itr(struct i40e_vsi *vsi,
1892 struct i40e_q_vector *q_vector)
1893{
1894 struct i40e_hw *hw = &vsi->back->hw;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001895 bool rx = false, tx = false;
1896 u32 rxval, txval;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001897 int vector;
Kan Lianga75e8002016-02-19 09:24:04 -05001898 int idx = q_vector->v_idx;
Jacob Keller65e87c02016-09-12 14:18:44 -07001899 int rx_itr_setting, tx_itr_setting;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001900
1901 vector = (q_vector->v_idx + vsi->base_vector);
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001902
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001903 /* avoid dynamic calculation if in countdown mode OR if
1904 * all dynamic is disabled
1905 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001906 rxval = txval = i40e_buildreg_itr(I40E_ITR_NONE, 0);
1907
Jacob Keller65e87c02016-09-12 14:18:44 -07001908 rx_itr_setting = get_rx_itr_enabled(vsi, idx);
1909 tx_itr_setting = get_tx_itr_enabled(vsi, idx);
1910
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001911 if (q_vector->itr_countdown > 0 ||
Jacob Keller65e87c02016-09-12 14:18:44 -07001912 (!ITR_IS_DYNAMIC(rx_itr_setting) &&
1913 !ITR_IS_DYNAMIC(tx_itr_setting))) {
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001914 goto enable_int;
1915 }
1916
Jacob Keller65e87c02016-09-12 14:18:44 -07001917 if (ITR_IS_DYNAMIC(tx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001918 rx = i40e_set_new_dynamic_itr(&q_vector->rx);
1919 rxval = i40e_buildreg_itr(I40E_RX_ITR, q_vector->rx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001920 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001921
Jacob Keller65e87c02016-09-12 14:18:44 -07001922 if (ITR_IS_DYNAMIC(tx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001923 tx = i40e_set_new_dynamic_itr(&q_vector->tx);
1924 txval = i40e_buildreg_itr(I40E_TX_ITR, q_vector->tx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001925 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001926
1927 if (rx || tx) {
1928 /* get the higher of the two ITR adjustments and
1929 * use the same value for both ITR registers
1930 * when in adaptive mode (Rx and/or Tx)
1931 */
1932 u16 itr = max(q_vector->tx.itr, q_vector->rx.itr);
1933
1934 q_vector->tx.itr = q_vector->rx.itr = itr;
1935 txval = i40e_buildreg_itr(I40E_TX_ITR, itr);
1936 tx = true;
1937 rxval = i40e_buildreg_itr(I40E_RX_ITR, itr);
1938 rx = true;
1939 }
1940
1941 /* only need to enable the interrupt once, but need
1942 * to possibly update both ITR values
1943 */
1944 if (rx) {
1945 /* set the INTENA_MSK_MASK so that this first write
1946 * won't actually enable the interrupt, instead just
1947 * updating the ITR (it's bit 31 PF and VF)
1948 */
1949 rxval |= BIT(31);
1950 /* don't check _DOWN because interrupt isn't being enabled */
1951 wr32(hw, INTREG(vector - 1), rxval);
1952 }
1953
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001954enable_int:
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001955 if (!test_bit(__I40E_DOWN, &vsi->state))
1956 wr32(hw, INTREG(vector - 1), txval);
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001957
1958 if (q_vector->itr_countdown)
1959 q_vector->itr_countdown--;
1960 else
1961 q_vector->itr_countdown = ITR_COUNTDOWN_START;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001962}
1963
1964/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001965 * i40e_napi_poll - NAPI polling Rx/Tx cleanup routine
1966 * @napi: napi struct with our devices info in it
1967 * @budget: amount of work driver is allowed to do this pass, in packets
1968 *
1969 * This function will clean all queues associated with a q_vector.
1970 *
1971 * Returns the amount of work done
1972 **/
1973int i40e_napi_poll(struct napi_struct *napi, int budget)
1974{
1975 struct i40e_q_vector *q_vector =
1976 container_of(napi, struct i40e_q_vector, napi);
1977 struct i40e_vsi *vsi = q_vector->vsi;
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001978 struct i40e_ring *ring;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001979 bool clean_complete = true;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00001980 bool arm_wb = false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001981 int budget_per_ring;
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07001982 int work_done = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001983
1984 if (test_bit(__I40E_DOWN, &vsi->state)) {
1985 napi_complete(napi);
1986 return 0;
1987 }
1988
Kiran Patil9c6c1252015-11-06 15:26:02 -08001989 /* Clear hung_detected bit */
1990 clear_bit(I40E_Q_VECTOR_HUNG_DETECT, &q_vector->hung_detected);
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001991 /* Since the actual Tx work is minimal, we can give the Tx a larger
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001992 * budget and be more aggressive about cleaning up the Tx descriptors.
1993 */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00001994 i40e_for_each_ring(ring, q_vector->tx) {
Alexander Duycka619afe2016-03-07 09:30:03 -08001995 if (!i40e_clean_tx_irq(vsi, ring, budget)) {
Alexander Duyckf2edaaa2016-03-07 09:29:57 -08001996 clean_complete = false;
1997 continue;
1998 }
1999 arm_wb |= ring->arm_wb;
Jesse Brandeburg0deda862015-07-23 16:54:34 -04002000 ring->arm_wb = false;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002001 }
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002002
Alexander Duyckc67cace2015-09-24 09:04:26 -07002003 /* Handle case where we are called by netpoll with a budget of 0 */
2004 if (budget <= 0)
2005 goto tx_only;
2006
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002007 /* We attempt to distribute budget to each Rx queue fairly, but don't
2008 * allow the budget to go below 1 because that would exit polling early.
2009 */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002010 budget_per_ring = max(budget/q_vector->num_ringpairs, 1);
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00002011
Mitch Williamsa132af22015-01-24 09:58:35 +00002012 i40e_for_each_ring(ring, q_vector->rx) {
Jesse Brandeburg1a557afc2016-04-20 19:43:37 -07002013 int cleaned = i40e_clean_rx_irq(ring, budget_per_ring);
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002014
2015 work_done += cleaned;
Alexander Duyckf2edaaa2016-03-07 09:29:57 -08002016 /* if we clean as many as budgeted, we must not be done */
2017 if (cleaned >= budget_per_ring)
2018 clean_complete = false;
Mitch Williamsa132af22015-01-24 09:58:35 +00002019 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002020
2021 /* If work not completed, return budget and polling will return */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002022 if (!clean_complete) {
Alexander Duyckc67cace2015-09-24 09:04:26 -07002023tx_only:
Anjali Singhai Jain164c9f52015-10-21 19:47:08 -04002024 if (arm_wb) {
2025 q_vector->tx.ring[0].tx_stats.tx_force_wb++;
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -08002026 i40e_enable_wb_on_itr(vsi, q_vector);
Anjali Singhai Jain164c9f52015-10-21 19:47:08 -04002027 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002028 return budget;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002029 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002030
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -04002031 if (vsi->back->flags & I40E_TXR_FLAGS_WB_ON_ITR)
2032 q_vector->arm_wb_state = false;
2033
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002034 /* Work is done so exit the polling mode and re-enable the interrupt */
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002035 napi_complete_done(napi, work_done);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002036 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
2037 i40e_update_enable_itr(vsi, q_vector);
2038 } else { /* Legacy mode */
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08002039 i40e_irq_dynamic_enable_icr0(vsi->back, false);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002040 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002041 return 0;
2042}
2043
2044/**
2045 * i40e_atr - Add a Flow Director ATR filter
2046 * @tx_ring: ring to add programming descriptor to
2047 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002048 * @tx_flags: send tx flags
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002049 **/
2050static void i40e_atr(struct i40e_ring *tx_ring, struct sk_buff *skb,
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002051 u32 tx_flags)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002052{
2053 struct i40e_filter_program_desc *fdir_desc;
2054 struct i40e_pf *pf = tx_ring->vsi->back;
2055 union {
2056 unsigned char *network;
2057 struct iphdr *ipv4;
2058 struct ipv6hdr *ipv6;
2059 } hdr;
2060 struct tcphdr *th;
2061 unsigned int hlen;
2062 u32 flex_ptype, dtype_cmd;
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002063 int l4_proto;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002064 u16 i;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002065
2066 /* make sure ATR is enabled */
Jesse Brandeburg60ea5f82014-01-17 15:36:34 -08002067 if (!(pf->flags & I40E_FLAG_FD_ATR_ENABLED))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002068 return;
2069
Anjali Singhai Jain04294e32015-02-27 09:15:28 +00002070 if ((pf->auto_disable_flags & I40E_FLAG_FD_ATR_ENABLED))
2071 return;
2072
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002073 /* if sampling is disabled do nothing */
2074 if (!tx_ring->atr_sample_rate)
2075 return;
2076
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002077 /* Currently only IPv4/IPv6 with TCP is supported */
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002078 if (!(tx_flags & (I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6)))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002079 return;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002080
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002081 /* snag network header to get L4 type and address */
2082 hdr.network = (tx_flags & I40E_TX_FLAGS_UDP_TUNNEL) ?
2083 skb_inner_network_header(skb) : skb_network_header(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002084
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002085 /* Note: tx_flags gets modified to reflect inner protocols in
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002086 * tx_enable_csum function if encap is enabled.
2087 */
Alexander Duyckffcc55c2016-01-25 19:32:54 -08002088 if (tx_flags & I40E_TX_FLAGS_IPV4) {
2089 /* access ihl as u8 to avoid unaligned access on ia64 */
2090 hlen = (hdr.network[0] & 0x0F) << 2;
2091 l4_proto = hdr.ipv4->protocol;
2092 } else {
2093 hlen = hdr.network - skb->data;
2094 l4_proto = ipv6_find_hdr(skb, &hlen, IPPROTO_TCP, NULL, NULL);
2095 hlen -= hdr.network - skb->data;
2096 }
2097
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002098 if (l4_proto != IPPROTO_TCP)
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002099 return;
2100
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002101 th = (struct tcphdr *)(hdr.network + hlen);
2102
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002103 /* Due to lack of space, no more new filters can be programmed */
2104 if (th->syn && (pf->auto_disable_flags & I40E_FLAG_FD_ATR_ENABLED))
2105 return;
Anjali Singhai Jain72b74862016-01-08 17:50:21 -08002106 if ((pf->flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE) &&
2107 (!(pf->auto_disable_flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE))) {
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002108 /* HW ATR eviction will take care of removing filters on FIN
2109 * and RST packets.
2110 */
2111 if (th->fin || th->rst)
2112 return;
2113 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002114
2115 tx_ring->atr_count++;
2116
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002117 /* sample on all syn/fin/rst packets or once every atr sample rate */
2118 if (!th->fin &&
2119 !th->syn &&
2120 !th->rst &&
2121 (tx_ring->atr_count < tx_ring->atr_sample_rate))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002122 return;
2123
2124 tx_ring->atr_count = 0;
2125
2126 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002127 i = tx_ring->next_to_use;
2128 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
2129
2130 i++;
2131 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002132
2133 flex_ptype = (tx_ring->queue_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT) &
2134 I40E_TXD_FLTR_QW0_QINDEX_MASK;
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002135 flex_ptype |= (tx_flags & I40E_TX_FLAGS_IPV4) ?
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002136 (I40E_FILTER_PCTYPE_NONF_IPV4_TCP <<
2137 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT) :
2138 (I40E_FILTER_PCTYPE_NONF_IPV6_TCP <<
2139 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT);
2140
2141 flex_ptype |= tx_ring->vsi->id << I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT;
2142
2143 dtype_cmd = I40E_TX_DESC_DTYPE_FILTER_PROG;
2144
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002145 dtype_cmd |= (th->fin || th->rst) ?
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002146 (I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
2147 I40E_TXD_FLTR_QW1_PCMD_SHIFT) :
2148 (I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
2149 I40E_TXD_FLTR_QW1_PCMD_SHIFT);
2150
2151 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_DEST_DIRECT_PACKET_QINDEX <<
2152 I40E_TXD_FLTR_QW1_DEST_SHIFT;
2153
2154 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_FD_STATUS_FD_ID <<
2155 I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT;
2156
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002157 dtype_cmd |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002158 if (!(tx_flags & I40E_TX_FLAGS_UDP_TUNNEL))
Anjali Singhai Jain60ccd452015-04-16 20:06:01 -04002159 dtype_cmd |=
2160 ((u32)I40E_FD_ATR_STAT_IDX(pf->hw.pf_id) <<
2161 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2162 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
2163 else
2164 dtype_cmd |=
2165 ((u32)I40E_FD_ATR_TUNNEL_STAT_IDX(pf->hw.pf_id) <<
2166 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2167 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002168
Anjali Singhai Jain72b74862016-01-08 17:50:21 -08002169 if ((pf->flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE) &&
2170 (!(pf->auto_disable_flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE)))
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002171 dtype_cmd |= I40E_TXD_FLTR_QW1_ATR_MASK;
2172
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002173 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(flex_ptype);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002174 fdir_desc->rsvd = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002175 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dtype_cmd);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002176 fdir_desc->fd_id = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002177}
2178
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002179/**
2180 * i40e_tx_prepare_vlan_flags - prepare generic TX VLAN tagging flags for HW
2181 * @skb: send buffer
2182 * @tx_ring: ring to send buffer on
2183 * @flags: the tx flags to be set
2184 *
2185 * Checks the skb and set up correspondingly several generic transmit flags
2186 * related to VLAN tagging for the HW, such as VLAN, DCB, etc.
2187 *
2188 * Returns error code indicate the frame should be dropped upon error and the
2189 * otherwise returns 0 to indicate the flags has been set properly.
2190 **/
Vasu Dev38e00432014-08-01 13:27:03 -07002191#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002192inline int i40e_tx_prepare_vlan_flags(struct sk_buff *skb,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002193 struct i40e_ring *tx_ring,
2194 u32 *flags)
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002195#else
2196static inline int i40e_tx_prepare_vlan_flags(struct sk_buff *skb,
2197 struct i40e_ring *tx_ring,
2198 u32 *flags)
Vasu Dev38e00432014-08-01 13:27:03 -07002199#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002200{
2201 __be16 protocol = skb->protocol;
2202 u32 tx_flags = 0;
2203
Greg Rose31eaacc2015-03-31 00:45:03 -07002204 if (protocol == htons(ETH_P_8021Q) &&
2205 !(tx_ring->netdev->features & NETIF_F_HW_VLAN_CTAG_TX)) {
2206 /* When HW VLAN acceleration is turned off by the user the
2207 * stack sets the protocol to 8021q so that the driver
2208 * can take any steps required to support the SW only
2209 * VLAN handling. In our case the driver doesn't need
2210 * to take any further steps so just set the protocol
2211 * to the encapsulated ethertype.
2212 */
2213 skb->protocol = vlan_get_protocol(skb);
2214 goto out;
2215 }
2216
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002217 /* if we have a HW VLAN tag being added, default to the HW one */
Jiri Pirkodf8a39d2015-01-13 17:13:44 +01002218 if (skb_vlan_tag_present(skb)) {
2219 tx_flags |= skb_vlan_tag_get(skb) << I40E_TX_FLAGS_VLAN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002220 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2221 /* else if it is a SW VLAN, check the next protocol and store the tag */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002222 } else if (protocol == htons(ETH_P_8021Q)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002223 struct vlan_hdr *vhdr, _vhdr;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04002224
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002225 vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
2226 if (!vhdr)
2227 return -EINVAL;
2228
2229 protocol = vhdr->h_vlan_encapsulated_proto;
2230 tx_flags |= ntohs(vhdr->h_vlan_TCI) << I40E_TX_FLAGS_VLAN_SHIFT;
2231 tx_flags |= I40E_TX_FLAGS_SW_VLAN;
2232 }
2233
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002234 if (!(tx_ring->vsi->back->flags & I40E_FLAG_DCB_ENABLED))
2235 goto out;
2236
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002237 /* Insert 802.1p priority into VLAN header */
Vasu Dev38e00432014-08-01 13:27:03 -07002238 if ((tx_flags & (I40E_TX_FLAGS_HW_VLAN | I40E_TX_FLAGS_SW_VLAN)) ||
2239 (skb->priority != TC_PRIO_CONTROL)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002240 tx_flags &= ~I40E_TX_FLAGS_VLAN_PRIO_MASK;
2241 tx_flags |= (skb->priority & 0x7) <<
2242 I40E_TX_FLAGS_VLAN_PRIO_SHIFT;
2243 if (tx_flags & I40E_TX_FLAGS_SW_VLAN) {
2244 struct vlan_ethhdr *vhdr;
Francois Romieudd225bc2014-03-30 03:14:48 +00002245 int rc;
2246
2247 rc = skb_cow_head(skb, 0);
2248 if (rc < 0)
2249 return rc;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002250 vhdr = (struct vlan_ethhdr *)skb->data;
2251 vhdr->h_vlan_TCI = htons(tx_flags >>
2252 I40E_TX_FLAGS_VLAN_SHIFT);
2253 } else {
2254 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2255 }
2256 }
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002257
2258out:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002259 *flags = tx_flags;
2260 return 0;
2261}
2262
2263/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002264 * i40e_tso - set up the tso context descriptor
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002265 * @skb: ptr to the skb we're sending
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002266 * @hdr_len: ptr to the size of the packet header
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002267 * @cd_type_cmd_tso_mss: Quad Word 1
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002268 *
2269 * Returns 0 if no TSO can happen, 1 if tso is going, or error
2270 **/
Jesse Brandeburg84b079922016-04-01 03:56:05 -07002271static int i40e_tso(struct sk_buff *skb, u8 *hdr_len, u64 *cd_type_cmd_tso_mss)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002272{
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002273 u64 cd_cmd, cd_tso_len, cd_mss;
Alexander Duyckc7770192016-01-24 21:16:35 -08002274 union {
2275 struct iphdr *v4;
2276 struct ipv6hdr *v6;
2277 unsigned char *hdr;
2278 } ip;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002279 union {
2280 struct tcphdr *tcp;
Alexander Duyck54532052016-01-24 21:17:29 -08002281 struct udphdr *udp;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002282 unsigned char *hdr;
2283 } l4;
2284 u32 paylen, l4_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002285 int err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002286
Shannon Nelsone9f65632016-01-04 10:33:04 -08002287 if (skb->ip_summed != CHECKSUM_PARTIAL)
2288 return 0;
2289
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002290 if (!skb_is_gso(skb))
2291 return 0;
2292
Francois Romieudd225bc2014-03-30 03:14:48 +00002293 err = skb_cow_head(skb, 0);
2294 if (err < 0)
2295 return err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002296
Alexander Duyckc7770192016-01-24 21:16:35 -08002297 ip.hdr = skb_network_header(skb);
2298 l4.hdr = skb_transport_header(skb);
Anjali Singhaidf230752014-12-19 02:58:16 +00002299
Alexander Duyckc7770192016-01-24 21:16:35 -08002300 /* initialize outer IP header fields */
2301 if (ip.v4->version == 4) {
2302 ip.v4->tot_len = 0;
2303 ip.v4->check = 0;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002304 } else {
Alexander Duyckc7770192016-01-24 21:16:35 -08002305 ip.v6->payload_len = 0;
2306 }
2307
Alexander Duyck577389a2016-04-02 00:06:56 -07002308 if (skb_shinfo(skb)->gso_type & (SKB_GSO_GRE |
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002309 SKB_GSO_GRE_CSUM |
Tom Herbert7e133182016-05-18 09:06:10 -07002310 SKB_GSO_IPXIP4 |
Alexander Duyckbf2d1df2016-05-18 10:44:53 -07002311 SKB_GSO_IPXIP6 |
Alexander Duyck577389a2016-04-02 00:06:56 -07002312 SKB_GSO_UDP_TUNNEL |
Alexander Duyck54532052016-01-24 21:17:29 -08002313 SKB_GSO_UDP_TUNNEL_CSUM)) {
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002314 if (!(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) &&
2315 (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM)) {
2316 l4.udp->len = 0;
2317
Alexander Duyck54532052016-01-24 21:17:29 -08002318 /* determine offset of outer transport header */
2319 l4_offset = l4.hdr - skb->data;
2320
2321 /* remove payload length from outer checksum */
Alexander Duyck24d41e52016-03-18 16:06:47 -07002322 paylen = skb->len - l4_offset;
2323 csum_replace_by_diff(&l4.udp->check, htonl(paylen));
Alexander Duyck54532052016-01-24 21:17:29 -08002324 }
2325
Alexander Duyckc7770192016-01-24 21:16:35 -08002326 /* reset pointers to inner headers */
2327 ip.hdr = skb_inner_network_header(skb);
2328 l4.hdr = skb_inner_transport_header(skb);
2329
2330 /* initialize inner IP header fields */
2331 if (ip.v4->version == 4) {
2332 ip.v4->tot_len = 0;
2333 ip.v4->check = 0;
2334 } else {
2335 ip.v6->payload_len = 0;
2336 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002337 }
2338
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002339 /* determine offset of inner transport header */
2340 l4_offset = l4.hdr - skb->data;
2341
2342 /* remove payload length from inner checksum */
Alexander Duyck24d41e52016-03-18 16:06:47 -07002343 paylen = skb->len - l4_offset;
2344 csum_replace_by_diff(&l4.tcp->check, htonl(paylen));
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002345
2346 /* compute length of segmentation header */
2347 *hdr_len = (l4.tcp->doff * 4) + l4_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002348
2349 /* find the field values */
2350 cd_cmd = I40E_TX_CTX_DESC_TSO;
2351 cd_tso_len = skb->len - *hdr_len;
2352 cd_mss = skb_shinfo(skb)->gso_size;
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002353 *cd_type_cmd_tso_mss |= (cd_cmd << I40E_TXD_CTX_QW1_CMD_SHIFT) |
2354 (cd_tso_len << I40E_TXD_CTX_QW1_TSO_LEN_SHIFT) |
2355 (cd_mss << I40E_TXD_CTX_QW1_MSS_SHIFT);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002356 return 1;
2357}
2358
2359/**
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002360 * i40e_tsyn - set up the tsyn context descriptor
2361 * @tx_ring: ptr to the ring to send
2362 * @skb: ptr to the skb we're sending
2363 * @tx_flags: the collected send information
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002364 * @cd_type_cmd_tso_mss: Quad Word 1
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002365 *
2366 * Returns 0 if no Tx timestamp can happen and 1 if the timestamp will happen
2367 **/
2368static int i40e_tsyn(struct i40e_ring *tx_ring, struct sk_buff *skb,
2369 u32 tx_flags, u64 *cd_type_cmd_tso_mss)
2370{
2371 struct i40e_pf *pf;
2372
2373 if (likely(!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)))
2374 return 0;
2375
2376 /* Tx timestamps cannot be sampled when doing TSO */
2377 if (tx_flags & I40E_TX_FLAGS_TSO)
2378 return 0;
2379
2380 /* only timestamp the outbound packet if the user has requested it and
2381 * we are not already transmitting a packet to be timestamped
2382 */
2383 pf = i40e_netdev_to_pf(tx_ring->netdev);
Jacob Keller22b47772014-12-14 01:55:09 +00002384 if (!(pf->flags & I40E_FLAG_PTP))
2385 return 0;
2386
Jakub Kicinski9ce34f02014-03-15 14:55:42 +00002387 if (pf->ptp_tx &&
2388 !test_and_set_bit_lock(__I40E_PTP_TX_IN_PROGRESS, &pf->state)) {
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002389 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
2390 pf->ptp_tx_skb = skb_get(skb);
2391 } else {
2392 return 0;
2393 }
2394
2395 *cd_type_cmd_tso_mss |= (u64)I40E_TX_CTX_DESC_TSYN <<
2396 I40E_TXD_CTX_QW1_CMD_SHIFT;
2397
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002398 return 1;
2399}
2400
2401/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002402 * i40e_tx_enable_csum - Enable Tx checksum offloads
2403 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002404 * @tx_flags: pointer to Tx flags currently set
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002405 * @td_cmd: Tx descriptor command bits to set
2406 * @td_offset: Tx descriptor header offsets to set
Jean Sacren554f4542015-10-13 01:06:28 -06002407 * @tx_ring: Tx descriptor ring
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002408 * @cd_tunneling: ptr to context desc bits
2409 **/
Alexander Duyck529f1f62016-01-24 21:17:10 -08002410static int i40e_tx_enable_csum(struct sk_buff *skb, u32 *tx_flags,
2411 u32 *td_cmd, u32 *td_offset,
2412 struct i40e_ring *tx_ring,
2413 u32 *cd_tunneling)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002414{
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002415 union {
2416 struct iphdr *v4;
2417 struct ipv6hdr *v6;
2418 unsigned char *hdr;
2419 } ip;
2420 union {
2421 struct tcphdr *tcp;
2422 struct udphdr *udp;
2423 unsigned char *hdr;
2424 } l4;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002425 unsigned char *exthdr;
Jesse Brandeburgd1bd7432016-04-01 03:56:04 -07002426 u32 offset, cmd = 0;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002427 __be16 frag_off;
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002428 u8 l4_proto = 0;
2429
Alexander Duyck529f1f62016-01-24 21:17:10 -08002430 if (skb->ip_summed != CHECKSUM_PARTIAL)
2431 return 0;
2432
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002433 ip.hdr = skb_network_header(skb);
2434 l4.hdr = skb_transport_header(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002435
Alexander Duyck475b4202016-01-24 21:17:01 -08002436 /* compute outer L2 header size */
2437 offset = ((ip.hdr - skb->data) / 2) << I40E_TX_DESC_LENGTH_MACLEN_SHIFT;
2438
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002439 if (skb->encapsulation) {
Jesse Brandeburgd1bd7432016-04-01 03:56:04 -07002440 u32 tunnel = 0;
Alexander Duycka0064722016-01-24 21:16:48 -08002441 /* define outer network header type */
2442 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002443 tunnel |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2444 I40E_TX_CTX_EXT_IP_IPV4 :
2445 I40E_TX_CTX_EXT_IP_IPV4_NO_CSUM;
2446
Alexander Duycka0064722016-01-24 21:16:48 -08002447 l4_proto = ip.v4->protocol;
2448 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002449 tunnel |= I40E_TX_CTX_EXT_IP_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002450
2451 exthdr = ip.hdr + sizeof(*ip.v6);
Alexander Duycka0064722016-01-24 21:16:48 -08002452 l4_proto = ip.v6->nexthdr;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002453 if (l4.hdr != exthdr)
2454 ipv6_skip_exthdr(skb, exthdr - skb->data,
2455 &l4_proto, &frag_off);
Alexander Duycka0064722016-01-24 21:16:48 -08002456 }
2457
2458 /* define outer transport */
2459 switch (l4_proto) {
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002460 case IPPROTO_UDP:
Alexander Duyck475b4202016-01-24 21:17:01 -08002461 tunnel |= I40E_TXD_CTX_UDP_TUNNELING;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002462 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002463 break;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002464 case IPPROTO_GRE:
Alexander Duyck475b4202016-01-24 21:17:01 -08002465 tunnel |= I40E_TXD_CTX_GRE_TUNNELING;
Alexander Duycka0064722016-01-24 21:16:48 -08002466 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002467 break;
Alexander Duyck577389a2016-04-02 00:06:56 -07002468 case IPPROTO_IPIP:
2469 case IPPROTO_IPV6:
2470 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
2471 l4.hdr = skb_inner_network_header(skb);
2472 break;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002473 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002474 if (*tx_flags & I40E_TX_FLAGS_TSO)
2475 return -1;
2476
2477 skb_checksum_help(skb);
2478 return 0;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002479 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002480
Alexander Duyck577389a2016-04-02 00:06:56 -07002481 /* compute outer L3 header size */
2482 tunnel |= ((l4.hdr - ip.hdr) / 4) <<
2483 I40E_TXD_CTX_QW0_EXT_IPLEN_SHIFT;
2484
2485 /* switch IP header pointer from outer to inner header */
2486 ip.hdr = skb_inner_network_header(skb);
2487
Alexander Duyck475b4202016-01-24 21:17:01 -08002488 /* compute tunnel header size */
2489 tunnel |= ((ip.hdr - l4.hdr) / 2) <<
2490 I40E_TXD_CTX_QW0_NATLEN_SHIFT;
2491
Alexander Duyck54532052016-01-24 21:17:29 -08002492 /* indicate if we need to offload outer UDP header */
2493 if ((*tx_flags & I40E_TX_FLAGS_TSO) &&
Alexander Duyck1c7b4a22016-04-14 17:19:25 -04002494 !(skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) &&
Alexander Duyck54532052016-01-24 21:17:29 -08002495 (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM))
2496 tunnel |= I40E_TXD_CTX_QW0_L4T_CS_MASK;
2497
Alexander Duyck475b4202016-01-24 21:17:01 -08002498 /* record tunnel offload values */
2499 *cd_tunneling |= tunnel;
2500
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002501 /* switch L4 header pointer from outer to inner */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002502 l4.hdr = skb_inner_transport_header(skb);
Alexander Duycka0064722016-01-24 21:16:48 -08002503 l4_proto = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002504
Alexander Duycka0064722016-01-24 21:16:48 -08002505 /* reset type as we transition from outer to inner headers */
2506 *tx_flags &= ~(I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6);
2507 if (ip.v4->version == 4)
2508 *tx_flags |= I40E_TX_FLAGS_IPV4;
2509 if (ip.v6->version == 6)
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002510 *tx_flags |= I40E_TX_FLAGS_IPV6;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002511 }
2512
2513 /* Enable IP checksum offloads */
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002514 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002515 l4_proto = ip.v4->protocol;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002516 /* the stack computes the IP header already, the only time we
2517 * need the hardware to recompute it is in the case of TSO.
2518 */
Alexander Duyck475b4202016-01-24 21:17:01 -08002519 cmd |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2520 I40E_TX_DESC_CMD_IIPT_IPV4_CSUM :
2521 I40E_TX_DESC_CMD_IIPT_IPV4;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002522 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002523 cmd |= I40E_TX_DESC_CMD_IIPT_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002524
2525 exthdr = ip.hdr + sizeof(*ip.v6);
2526 l4_proto = ip.v6->nexthdr;
2527 if (l4.hdr != exthdr)
2528 ipv6_skip_exthdr(skb, exthdr - skb->data,
2529 &l4_proto, &frag_off);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002530 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002531
Alexander Duyck475b4202016-01-24 21:17:01 -08002532 /* compute inner L3 header size */
2533 offset |= ((l4.hdr - ip.hdr) / 4) << I40E_TX_DESC_LENGTH_IPLEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002534
2535 /* Enable L4 checksum offloads */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002536 switch (l4_proto) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002537 case IPPROTO_TCP:
2538 /* enable checksum offloads */
Alexander Duyck475b4202016-01-24 21:17:01 -08002539 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_TCP;
2540 offset |= l4.tcp->doff << I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002541 break;
2542 case IPPROTO_SCTP:
2543 /* enable SCTP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002544 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_SCTP;
2545 offset |= (sizeof(struct sctphdr) >> 2) <<
2546 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002547 break;
2548 case IPPROTO_UDP:
2549 /* enable UDP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002550 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_UDP;
2551 offset |= (sizeof(struct udphdr) >> 2) <<
2552 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002553 break;
2554 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002555 if (*tx_flags & I40E_TX_FLAGS_TSO)
2556 return -1;
2557 skb_checksum_help(skb);
2558 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002559 }
Alexander Duyck475b4202016-01-24 21:17:01 -08002560
2561 *td_cmd |= cmd;
2562 *td_offset |= offset;
Alexander Duyck529f1f62016-01-24 21:17:10 -08002563
2564 return 1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002565}
2566
2567/**
2568 * i40e_create_tx_ctx Build the Tx context descriptor
2569 * @tx_ring: ring to create the descriptor on
2570 * @cd_type_cmd_tso_mss: Quad Word 1
2571 * @cd_tunneling: Quad Word 0 - bits 0-31
2572 * @cd_l2tag2: Quad Word 0 - bits 32-63
2573 **/
2574static void i40e_create_tx_ctx(struct i40e_ring *tx_ring,
2575 const u64 cd_type_cmd_tso_mss,
2576 const u32 cd_tunneling, const u32 cd_l2tag2)
2577{
2578 struct i40e_tx_context_desc *context_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002579 int i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002580
Jesse Brandeburgff40dd52014-02-14 02:14:41 +00002581 if ((cd_type_cmd_tso_mss == I40E_TX_DESC_DTYPE_CONTEXT) &&
2582 !cd_tunneling && !cd_l2tag2)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002583 return;
2584
2585 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002586 context_desc = I40E_TX_CTXTDESC(tx_ring, i);
2587
2588 i++;
2589 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002590
2591 /* cpu_to_le32 and assign to struct fields */
2592 context_desc->tunneling_params = cpu_to_le32(cd_tunneling);
2593 context_desc->l2tag2 = cpu_to_le16(cd_l2tag2);
Jesse Brandeburg3efbbb22014-06-04 20:41:54 +00002594 context_desc->rsvd = cpu_to_le16(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002595 context_desc->type_cmd_tso_mss = cpu_to_le64(cd_type_cmd_tso_mss);
2596}
2597
2598/**
Eric Dumazet4567dc12014-10-07 13:30:23 -07002599 * __i40e_maybe_stop_tx - 2nd level check for tx stop conditions
2600 * @tx_ring: the ring to be checked
2601 * @size: the size buffer we want to assure is available
2602 *
2603 * Returns -EBUSY if a stop is needed, else 0
2604 **/
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002605int __i40e_maybe_stop_tx(struct i40e_ring *tx_ring, int size)
Eric Dumazet4567dc12014-10-07 13:30:23 -07002606{
2607 netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
2608 /* Memory barrier before checking head and tail */
2609 smp_mb();
2610
2611 /* Check again in a case another CPU has just made room available. */
2612 if (likely(I40E_DESC_UNUSED(tx_ring) < size))
2613 return -EBUSY;
2614
2615 /* A reprieve! - use start_queue because it doesn't call schedule */
2616 netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
2617 ++tx_ring->tx_stats.restart_queue;
2618 return 0;
2619}
2620
2621/**
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002622 * __i40e_chk_linearize - Check if there are more than 8 buffers per packet
Anjali Singhai71da6192015-02-21 06:42:35 +00002623 * @skb: send buffer
Anjali Singhai71da6192015-02-21 06:42:35 +00002624 *
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002625 * Note: Our HW can't DMA more than 8 buffers to build a packet on the wire
2626 * and so we need to figure out the cases where we need to linearize the skb.
2627 *
2628 * For TSO we need to count the TSO header and segment payload separately.
2629 * As such we need to check cases where we have 7 fragments or more as we
2630 * can potentially require 9 DMA transactions, 1 for the TSO header, 1 for
2631 * the segment payload in the first descriptor, and another 7 for the
2632 * fragments.
Anjali Singhai71da6192015-02-21 06:42:35 +00002633 **/
Alexander Duyck2d374902016-02-17 11:02:50 -08002634bool __i40e_chk_linearize(struct sk_buff *skb)
Anjali Singhai71da6192015-02-21 06:42:35 +00002635{
Alexander Duyck2d374902016-02-17 11:02:50 -08002636 const struct skb_frag_struct *frag, *stale;
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002637 int nr_frags, sum;
Anjali Singhai71da6192015-02-21 06:42:35 +00002638
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002639 /* no need to check if number of frags is less than 7 */
Alexander Duyck2d374902016-02-17 11:02:50 -08002640 nr_frags = skb_shinfo(skb)->nr_frags;
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002641 if (nr_frags < (I40E_MAX_BUFFER_TXD - 1))
Alexander Duyck2d374902016-02-17 11:02:50 -08002642 return false;
Anjali Singhai71da6192015-02-21 06:42:35 +00002643
Alexander Duyck2d374902016-02-17 11:02:50 -08002644 /* We need to walk through the list and validate that each group
Alexander Duyck841493a2016-09-06 18:05:04 -07002645 * of 6 fragments totals at least gso_size.
Alexander Duyck2d374902016-02-17 11:02:50 -08002646 */
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002647 nr_frags -= I40E_MAX_BUFFER_TXD - 2;
Alexander Duyck2d374902016-02-17 11:02:50 -08002648 frag = &skb_shinfo(skb)->frags[0];
2649
2650 /* Initialize size to the negative value of gso_size minus 1. We
2651 * use this as the worst case scenerio in which the frag ahead
2652 * of us only provides one byte which is why we are limited to 6
2653 * descriptors for a single transmit as the header and previous
2654 * fragment are already consuming 2 descriptors.
2655 */
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002656 sum = 1 - skb_shinfo(skb)->gso_size;
Alexander Duyck2d374902016-02-17 11:02:50 -08002657
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002658 /* Add size of frags 0 through 4 to create our initial sum */
2659 sum += skb_frag_size(frag++);
2660 sum += skb_frag_size(frag++);
2661 sum += skb_frag_size(frag++);
2662 sum += skb_frag_size(frag++);
2663 sum += skb_frag_size(frag++);
Alexander Duyck2d374902016-02-17 11:02:50 -08002664
2665 /* Walk through fragments adding latest fragment, testing it, and
2666 * then removing stale fragments from the sum.
2667 */
2668 stale = &skb_shinfo(skb)->frags[0];
2669 for (;;) {
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002670 sum += skb_frag_size(frag++);
Alexander Duyck2d374902016-02-17 11:02:50 -08002671
2672 /* if sum is negative we failed to make sufficient progress */
2673 if (sum < 0)
2674 return true;
2675
Alexander Duyck841493a2016-09-06 18:05:04 -07002676 if (!nr_frags--)
Alexander Duyck2d374902016-02-17 11:02:50 -08002677 break;
2678
Alexander Duyck3f3f7cb2016-03-30 16:15:37 -07002679 sum -= skb_frag_size(stale++);
Anjali Singhai71da6192015-02-21 06:42:35 +00002680 }
2681
Alexander Duyck2d374902016-02-17 11:02:50 -08002682 return false;
Anjali Singhai71da6192015-02-21 06:42:35 +00002683}
2684
2685/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002686 * i40e_tx_map - Build the Tx descriptor
2687 * @tx_ring: ring to send buffer on
2688 * @skb: send buffer
2689 * @first: first buffer info buffer to use
2690 * @tx_flags: collected send information
2691 * @hdr_len: size of the packet header
2692 * @td_cmd: the command field in the descriptor
2693 * @td_offset: offset for checksum or crc
2694 **/
Vasu Dev38e00432014-08-01 13:27:03 -07002695#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002696inline void i40e_tx_map(struct i40e_ring *tx_ring, struct sk_buff *skb,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002697 struct i40e_tx_buffer *first, u32 tx_flags,
2698 const u8 hdr_len, u32 td_cmd, u32 td_offset)
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002699#else
2700static inline void i40e_tx_map(struct i40e_ring *tx_ring, struct sk_buff *skb,
2701 struct i40e_tx_buffer *first, u32 tx_flags,
2702 const u8 hdr_len, u32 td_cmd, u32 td_offset)
Vasu Dev38e00432014-08-01 13:27:03 -07002703#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002704{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002705 unsigned int data_len = skb->data_len;
2706 unsigned int size = skb_headlen(skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002707 struct skb_frag_struct *frag;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002708 struct i40e_tx_buffer *tx_bi;
2709 struct i40e_tx_desc *tx_desc;
Alexander Duycka5e9c572013-09-28 06:00:27 +00002710 u16 i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002711 u32 td_tag = 0;
2712 dma_addr_t dma;
2713 u16 gso_segs;
Anjali Singhai58044742015-09-25 18:26:13 -07002714 u16 desc_count = 0;
2715 bool tail_bump = true;
2716 bool do_rs = false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002717
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002718 if (tx_flags & I40E_TX_FLAGS_HW_VLAN) {
2719 td_cmd |= I40E_TX_DESC_CMD_IL2TAG1;
2720 td_tag = (tx_flags & I40E_TX_FLAGS_VLAN_MASK) >>
2721 I40E_TX_FLAGS_VLAN_SHIFT;
2722 }
2723
Alexander Duycka5e9c572013-09-28 06:00:27 +00002724 if (tx_flags & (I40E_TX_FLAGS_TSO | I40E_TX_FLAGS_FSO))
2725 gso_segs = skb_shinfo(skb)->gso_segs;
2726 else
2727 gso_segs = 1;
2728
2729 /* multiply data chunks by size of headers */
2730 first->bytecount = skb->len - hdr_len + (gso_segs * hdr_len);
2731 first->gso_segs = gso_segs;
2732 first->skb = skb;
2733 first->tx_flags = tx_flags;
2734
2735 dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
2736
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002737 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002738 tx_bi = first;
2739
2740 for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002741 unsigned int max_data = I40E_MAX_DATA_PER_TXD_ALIGNED;
2742
Alexander Duycka5e9c572013-09-28 06:00:27 +00002743 if (dma_mapping_error(tx_ring->dev, dma))
2744 goto dma_error;
2745
2746 /* record length, and DMA address */
2747 dma_unmap_len_set(tx_bi, len, size);
2748 dma_unmap_addr_set(tx_bi, dma, dma);
2749
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002750 /* align size to end of page */
2751 max_data += -dma & (I40E_MAX_READ_REQ_SIZE - 1);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002752 tx_desc->buffer_addr = cpu_to_le64(dma);
2753
2754 while (unlikely(size > I40E_MAX_DATA_PER_TXD)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002755 tx_desc->cmd_type_offset_bsz =
2756 build_ctob(td_cmd, td_offset,
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002757 max_data, td_tag);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002758
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002759 tx_desc++;
2760 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07002761 desc_count++;
2762
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002763 if (i == tx_ring->count) {
2764 tx_desc = I40E_TX_DESC(tx_ring, 0);
2765 i = 0;
2766 }
Alexander Duycka5e9c572013-09-28 06:00:27 +00002767
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002768 dma += max_data;
2769 size -= max_data;
Alexander Duycka5e9c572013-09-28 06:00:27 +00002770
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002771 max_data = I40E_MAX_DATA_PER_TXD_ALIGNED;
Alexander Duycka5e9c572013-09-28 06:00:27 +00002772 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002773 }
2774
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002775 if (likely(!data_len))
2776 break;
2777
Alexander Duycka5e9c572013-09-28 06:00:27 +00002778 tx_desc->cmd_type_offset_bsz = build_ctob(td_cmd, td_offset,
2779 size, td_tag);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002780
2781 tx_desc++;
2782 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07002783 desc_count++;
2784
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002785 if (i == tx_ring->count) {
2786 tx_desc = I40E_TX_DESC(tx_ring, 0);
2787 i = 0;
2788 }
2789
Alexander Duycka5e9c572013-09-28 06:00:27 +00002790 size = skb_frag_size(frag);
2791 data_len -= size;
2792
2793 dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
2794 DMA_TO_DEVICE);
2795
2796 tx_bi = &tx_ring->tx_bi[i];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002797 }
2798
Alexander Duycka5e9c572013-09-28 06:00:27 +00002799 /* set next_to_watch value indicating a packet is present */
2800 first->next_to_watch = tx_desc;
2801
2802 i++;
2803 if (i == tx_ring->count)
2804 i = 0;
2805
2806 tx_ring->next_to_use = i;
2807
Alexander Duycke486bdf2016-09-12 14:18:40 -07002808 netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
Eric Dumazet4567dc12014-10-07 13:30:23 -07002809 i40e_maybe_stop_tx(tx_ring, DESC_NEEDED);
Anjali Singhai58044742015-09-25 18:26:13 -07002810
2811 /* Algorithm to optimize tail and RS bit setting:
2812 * if xmit_more is supported
2813 * if xmit_more is true
2814 * do not update tail and do not mark RS bit.
2815 * if xmit_more is false and last xmit_more was false
2816 * if every packet spanned less than 4 desc
2817 * then set RS bit on 4th packet and update tail
2818 * on every packet
2819 * else
2820 * update tail and set RS bit on every packet.
2821 * if xmit_more is false and last_xmit_more was true
2822 * update tail and set RS bit.
2823 *
2824 * Optimization: wmb to be issued only in case of tail update.
2825 * Also optimize the Descriptor WB path for RS bit with the same
2826 * algorithm.
2827 *
2828 * Note: If there are less than 4 packets
2829 * pending and interrupts were disabled the service task will
2830 * trigger a force WB.
2831 */
2832 if (skb->xmit_more &&
Alexander Duycke486bdf2016-09-12 14:18:40 -07002833 !netif_xmit_stopped(txring_txq(tx_ring))) {
Anjali Singhai58044742015-09-25 18:26:13 -07002834 tx_ring->flags |= I40E_TXR_FLAGS_LAST_XMIT_MORE_SET;
2835 tail_bump = false;
2836 } else if (!skb->xmit_more &&
Alexander Duycke486bdf2016-09-12 14:18:40 -07002837 !netif_xmit_stopped(txring_txq(tx_ring)) &&
Anjali Singhai58044742015-09-25 18:26:13 -07002838 (!(tx_ring->flags & I40E_TXR_FLAGS_LAST_XMIT_MORE_SET)) &&
2839 (tx_ring->packet_stride < WB_STRIDE) &&
2840 (desc_count < WB_STRIDE)) {
2841 tx_ring->packet_stride++;
2842 } else {
2843 tx_ring->packet_stride = 0;
2844 tx_ring->flags &= ~I40E_TXR_FLAGS_LAST_XMIT_MORE_SET;
2845 do_rs = true;
2846 }
2847 if (do_rs)
2848 tx_ring->packet_stride = 0;
2849
2850 tx_desc->cmd_type_offset_bsz =
2851 build_ctob(td_cmd, td_offset, size, td_tag) |
2852 cpu_to_le64((u64)(do_rs ? I40E_TXD_CMD :
2853 I40E_TX_DESC_CMD_EOP) <<
2854 I40E_TXD_QW1_CMD_SHIFT);
2855
Alexander Duycka5e9c572013-09-28 06:00:27 +00002856 /* notify HW of packet */
Carolyn Wybornyffeac832016-08-04 11:37:03 -07002857 if (!tail_bump) {
Jesse Brandeburg489ce7a2015-04-27 14:57:08 -04002858 prefetchw(tx_desc + 1);
Carolyn Wybornyffeac832016-08-04 11:37:03 -07002859 } else {
Anjali Singhai58044742015-09-25 18:26:13 -07002860 /* Force memory writes to complete before letting h/w
2861 * know there are new descriptors to fetch. (Only
2862 * applicable for weak-ordered memory model archs,
2863 * such as IA-64).
2864 */
2865 wmb();
2866 writel(i, tx_ring->tail);
2867 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002868 return;
2869
2870dma_error:
Alexander Duycka5e9c572013-09-28 06:00:27 +00002871 dev_info(tx_ring->dev, "TX DMA map failed\n");
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002872
2873 /* clear dma mappings for failed tx_bi map */
2874 for (;;) {
2875 tx_bi = &tx_ring->tx_bi[i];
Alexander Duycka5e9c572013-09-28 06:00:27 +00002876 i40e_unmap_and_free_tx_resource(tx_ring, tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002877 if (tx_bi == first)
2878 break;
2879 if (i == 0)
2880 i = tx_ring->count;
2881 i--;
2882 }
2883
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002884 tx_ring->next_to_use = i;
2885}
2886
2887/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002888 * i40e_xmit_frame_ring - Sends buffer on Tx ring
2889 * @skb: send buffer
2890 * @tx_ring: ring to send buffer on
2891 *
2892 * Returns NETDEV_TX_OK if sent, else an error code
2893 **/
2894static netdev_tx_t i40e_xmit_frame_ring(struct sk_buff *skb,
2895 struct i40e_ring *tx_ring)
2896{
2897 u64 cd_type_cmd_tso_mss = I40E_TX_DESC_DTYPE_CONTEXT;
2898 u32 cd_tunneling = 0, cd_l2tag2 = 0;
2899 struct i40e_tx_buffer *first;
2900 u32 td_offset = 0;
2901 u32 tx_flags = 0;
2902 __be16 protocol;
2903 u32 td_cmd = 0;
2904 u8 hdr_len = 0;
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002905 int tso, count;
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002906 int tsyn;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04002907
Jesse Brandeburgb74118f2015-10-26 19:44:30 -04002908 /* prefetch the data, we'll need it later */
2909 prefetch(skb->data);
2910
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002911 count = i40e_xmit_descriptor_count(skb);
Alexander Duyck2d374902016-02-17 11:02:50 -08002912 if (i40e_chk_linearize(skb, count)) {
2913 if (__skb_linearize(skb))
2914 goto out_drop;
Alexander Duyck5c4654d2016-02-19 12:17:08 -08002915 count = i40e_txd_use_count(skb->len);
Alexander Duyck2d374902016-02-17 11:02:50 -08002916 tx_ring->tx_stats.tx_linearize++;
2917 }
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002918
2919 /* need: 1 descriptor per page * PAGE_SIZE/I40E_MAX_DATA_PER_TXD,
2920 * + 1 desc for skb_head_len/I40E_MAX_DATA_PER_TXD,
2921 * + 4 desc gap to avoid the cache line where head is,
2922 * + 1 desc for context descriptor,
2923 * otherwise try next time
2924 */
2925 if (i40e_maybe_stop_tx(tx_ring, count + 4 + 1)) {
2926 tx_ring->tx_stats.tx_busy++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002927 return NETDEV_TX_BUSY;
Alexander Duyck4ec441d2016-02-17 11:02:43 -08002928 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002929
2930 /* prepare the xmit flags */
2931 if (i40e_tx_prepare_vlan_flags(skb, tx_ring, &tx_flags))
2932 goto out_drop;
2933
2934 /* obtain protocol of skb */
Vlad Yasevich3d34dd02014-08-25 10:34:52 -04002935 protocol = vlan_get_protocol(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002936
2937 /* record the location of the first descriptor for this packet */
2938 first = &tx_ring->tx_bi[tx_ring->next_to_use];
2939
2940 /* setup IPv4/IPv6 offloads */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002941 if (protocol == htons(ETH_P_IP))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002942 tx_flags |= I40E_TX_FLAGS_IPV4;
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002943 else if (protocol == htons(ETH_P_IPV6))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002944 tx_flags |= I40E_TX_FLAGS_IPV6;
2945
Jesse Brandeburg84b079922016-04-01 03:56:05 -07002946 tso = i40e_tso(skb, &hdr_len, &cd_type_cmd_tso_mss);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002947
2948 if (tso < 0)
2949 goto out_drop;
2950 else if (tso)
2951 tx_flags |= I40E_TX_FLAGS_TSO;
2952
Alexander Duyck3bc67972016-02-17 11:02:56 -08002953 /* Always offload the checksum, since it's in the data descriptor */
2954 tso = i40e_tx_enable_csum(skb, &tx_flags, &td_cmd, &td_offset,
2955 tx_ring, &cd_tunneling);
2956 if (tso < 0)
2957 goto out_drop;
2958
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002959 tsyn = i40e_tsyn(tx_ring, skb, tx_flags, &cd_type_cmd_tso_mss);
2960
2961 if (tsyn)
2962 tx_flags |= I40E_TX_FLAGS_TSYN;
2963
Jakub Kicinski259afec2014-03-15 14:55:37 +00002964 skb_tx_timestamp(skb);
2965
Alexander Duyckb1941302013-09-28 06:00:32 +00002966 /* always enable CRC insertion offload */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002967 td_cmd |= I40E_TX_DESC_CMD_ICRC;
2968
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002969 i40e_create_tx_ctx(tx_ring, cd_type_cmd_tso_mss,
2970 cd_tunneling, cd_l2tag2);
2971
2972 /* Add Flow Director ATR if it's enabled.
2973 *
2974 * NOTE: this must always be directly before the data descriptor.
2975 */
Alexander Duyck6b037cd2016-01-24 21:17:36 -08002976 i40e_atr(tx_ring, skb, tx_flags);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002977
2978 i40e_tx_map(tx_ring, skb, first, tx_flags, hdr_len,
2979 td_cmd, td_offset);
2980
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002981 return NETDEV_TX_OK;
2982
2983out_drop:
2984 dev_kfree_skb_any(skb);
2985 return NETDEV_TX_OK;
2986}
2987
2988/**
2989 * i40e_lan_xmit_frame - Selects the correct VSI and Tx queue to send buffer
2990 * @skb: send buffer
2991 * @netdev: network interface device structure
2992 *
2993 * Returns NETDEV_TX_OK if sent, else an error code
2994 **/
2995netdev_tx_t i40e_lan_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
2996{
2997 struct i40e_netdev_priv *np = netdev_priv(netdev);
2998 struct i40e_vsi *vsi = np->vsi;
Alexander Duyck9f65e152013-09-28 06:00:58 +00002999 struct i40e_ring *tx_ring = vsi->tx_rings[skb->queue_mapping];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003000
3001 /* hardware can't handle really short frames, hardware padding works
3002 * beyond this point
3003 */
Alexander Duycka94d9e22014-12-03 08:17:39 -08003004 if (skb_put_padto(skb, I40E_MIN_TX_LEN))
3005 return NETDEV_TX_OK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003006
3007 return i40e_xmit_frame_ring(skb, tx_ring);
3008}