blob: 1955c849a45277e421a945abf2b847539f4f1b9a [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)
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000043#define I40E_FD_CLEAN_DELAY 10
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000044/**
45 * i40e_program_fdir_filter - Program a Flow Director filter
Joseph Gasparakis17a73f62014-02-12 01:45:30 +000046 * @fdir_data: Packet data that will be filter parameters
47 * @raw_packet: the pre-allocated packet buffer for FDir
Jeff Kirsherb40c82e62015-02-27 09:18:34 +000048 * @pf: The PF pointer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000049 * @add: True for add/update, False for remove
50 **/
Joseph Gasparakis17a73f62014-02-12 01:45:30 +000051int i40e_program_fdir_filter(struct i40e_fdir_filter *fdir_data, u8 *raw_packet,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000052 struct i40e_pf *pf, bool add)
53{
54 struct i40e_filter_program_desc *fdir_desc;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000055 struct i40e_tx_buffer *tx_buf, *first;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000056 struct i40e_tx_desc *tx_desc;
57 struct i40e_ring *tx_ring;
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +000058 unsigned int fpt, dcc;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000059 struct i40e_vsi *vsi;
60 struct device *dev;
61 dma_addr_t dma;
62 u32 td_cmd = 0;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000063 u16 delay = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000064 u16 i;
65
66 /* find existing FDIR VSI */
67 vsi = NULL;
Mitch Williams505682c2014-05-20 08:01:37 +000068 for (i = 0; i < pf->num_alloc_vsi; i++)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000069 if (pf->vsi[i] && pf->vsi[i]->type == I40E_VSI_FDIR)
70 vsi = pf->vsi[i];
71 if (!vsi)
72 return -ENOENT;
73
Alexander Duyck9f65e152013-09-28 06:00:58 +000074 tx_ring = vsi->tx_rings[0];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000075 dev = tx_ring->dev;
76
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000077 /* we need two descriptors to add/del a filter and we can wait */
78 do {
79 if (I40E_DESC_UNUSED(tx_ring) > 1)
80 break;
81 msleep_interruptible(1);
82 delay++;
83 } while (delay < I40E_FD_CLEAN_DELAY);
84
85 if (!(I40E_DESC_UNUSED(tx_ring) > 1))
86 return -EAGAIN;
87
Joseph Gasparakis17a73f62014-02-12 01:45:30 +000088 dma = dma_map_single(dev, raw_packet,
89 I40E_FDIR_MAX_RAW_PACKET_SIZE, DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +000090 if (dma_mapping_error(dev, dma))
91 goto dma_fail;
92
93 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +000094 i = tx_ring->next_to_use;
95 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000096 first = &tx_ring->tx_bi[i];
97 memset(first, 0, sizeof(struct i40e_tx_buffer));
Alexander Duyckfc4ac672013-09-28 06:00:22 +000098
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +000099 tx_ring->next_to_use = ((i + 1) < tx_ring->count) ? i + 1 : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000100
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000101 fpt = (fdir_data->q_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT) &
102 I40E_TXD_FLTR_QW0_QINDEX_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000103
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000104 fpt |= (fdir_data->flex_off << I40E_TXD_FLTR_QW0_FLEXOFF_SHIFT) &
105 I40E_TXD_FLTR_QW0_FLEXOFF_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000106
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000107 fpt |= (fdir_data->pctype << I40E_TXD_FLTR_QW0_PCTYPE_SHIFT) &
108 I40E_TXD_FLTR_QW0_PCTYPE_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000109
110 /* Use LAN VSI Id if not programmed by user */
111 if (fdir_data->dest_vsi == 0)
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000112 fpt |= (pf->vsi[pf->lan_vsi]->id) <<
113 I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000114 else
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000115 fpt |= ((u32)fdir_data->dest_vsi <<
116 I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT) &
117 I40E_TXD_FLTR_QW0_DEST_VSI_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000118
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000119 dcc = I40E_TX_DESC_DTYPE_FILTER_PROG;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000120
121 if (add)
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000122 dcc |= I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
123 I40E_TXD_FLTR_QW1_PCMD_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000124 else
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000125 dcc |= I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
126 I40E_TXD_FLTR_QW1_PCMD_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000127
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000128 dcc |= (fdir_data->dest_ctl << I40E_TXD_FLTR_QW1_DEST_SHIFT) &
129 I40E_TXD_FLTR_QW1_DEST_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000130
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000131 dcc |= (fdir_data->fd_status << I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT) &
132 I40E_TXD_FLTR_QW1_FD_STATUS_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000133
134 if (fdir_data->cnt_index != 0) {
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000135 dcc |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
136 dcc |= ((u32)fdir_data->cnt_index <<
137 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +0000138 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000139 }
140
Jesse Brandeburg99753ea2014-06-04 04:22:49 +0000141 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(fpt);
142 fdir_desc->rsvd = cpu_to_le32(0);
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000143 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dcc);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000144 fdir_desc->fd_id = cpu_to_le32(fdir_data->fd_id);
145
146 /* Now program a dummy descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000147 i = tx_ring->next_to_use;
148 tx_desc = I40E_TX_DESC(tx_ring, i);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000149 tx_buf = &tx_ring->tx_bi[i];
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000150
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000151 tx_ring->next_to_use = ((i + 1) < tx_ring->count) ? i + 1 : 0;
152
153 memset(tx_buf, 0, sizeof(struct i40e_tx_buffer));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000154
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000155 /* record length, and DMA address */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000156 dma_unmap_len_set(tx_buf, len, I40E_FDIR_MAX_RAW_PACKET_SIZE);
Anjali Singhai Jain298deef2013-11-28 06:39:33 +0000157 dma_unmap_addr_set(tx_buf, dma, dma);
158
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000159 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgeaefbd02013-09-28 07:13:54 +0000160 td_cmd = I40E_TXD_CMD | I40E_TX_DESC_CMD_DUMMY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000161
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000162 tx_buf->tx_flags = I40E_TX_FLAGS_FD_SB;
163 tx_buf->raw_buf = (void *)raw_packet;
164
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000165 tx_desc->cmd_type_offset_bsz =
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000166 build_ctob(td_cmd, 0, I40E_FDIR_MAX_RAW_PACKET_SIZE, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000167
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000168 /* Force memory writes to complete before letting h/w
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000169 * know there are new descriptors to fetch.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000170 */
171 wmb();
172
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000173 /* Mark the data descriptor to be watched */
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000174 first->next_to_watch = tx_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +0000175
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000176 writel(tx_ring->next_to_use, tx_ring->tail);
177 return 0;
178
179dma_fail:
180 return -1;
181}
182
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000183#define IP_HEADER_OFFSET 14
184#define I40E_UDPIP_DUMMY_PACKET_LEN 42
185/**
186 * i40e_add_del_fdir_udpv4 - Add/Remove UDPv4 filters
187 * @vsi: pointer to the targeted VSI
188 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000189 * @add: true adds a filter, false removes it
190 *
191 * Returns 0 if the filters were successfully added or removed
192 **/
193static int i40e_add_del_fdir_udpv4(struct i40e_vsi *vsi,
194 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000195 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000196{
197 struct i40e_pf *pf = vsi->back;
198 struct udphdr *udp;
199 struct iphdr *ip;
200 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000201 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000202 int ret;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000203 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
204 0x45, 0, 0, 0x1c, 0, 0, 0x40, 0, 0x40, 0x11, 0, 0, 0, 0, 0, 0,
205 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
206
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000207 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
208 if (!raw_packet)
209 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000210 memcpy(raw_packet, packet, I40E_UDPIP_DUMMY_PACKET_LEN);
211
212 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
213 udp = (struct udphdr *)(raw_packet + IP_HEADER_OFFSET
214 + sizeof(struct iphdr));
215
216 ip->daddr = fd_data->dst_ip[0];
217 udp->dest = fd_data->dst_port;
218 ip->saddr = fd_data->src_ip[0];
219 udp->source = fd_data->src_port;
220
Kevin Scottb2d36c02014-04-09 05:58:59 +0000221 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_UDP;
222 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
223 if (ret) {
224 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000225 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
226 fd_data->pctype, fd_data->fd_id, ret);
Kevin Scottb2d36c02014-04-09 05:58:59 +0000227 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000228 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000229 if (add)
230 dev_info(&pf->pdev->dev,
231 "Filter OK for PCTYPE %d loc = %d\n",
232 fd_data->pctype, fd_data->fd_id);
233 else
234 dev_info(&pf->pdev->dev,
235 "Filter deleted for PCTYPE %d loc = %d\n",
236 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000237 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800238 if (err)
239 kfree(raw_packet);
240
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000241 return err ? -EOPNOTSUPP : 0;
242}
243
244#define I40E_TCPIP_DUMMY_PACKET_LEN 54
245/**
246 * i40e_add_del_fdir_tcpv4 - Add/Remove TCPv4 filters
247 * @vsi: pointer to the targeted VSI
248 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000249 * @add: true adds a filter, false removes it
250 *
251 * Returns 0 if the filters were successfully added or removed
252 **/
253static int i40e_add_del_fdir_tcpv4(struct i40e_vsi *vsi,
254 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000255 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000256{
257 struct i40e_pf *pf = vsi->back;
258 struct tcphdr *tcp;
259 struct iphdr *ip;
260 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000261 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000262 int ret;
263 /* Dummy packet */
264 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
265 0x45, 0, 0, 0x28, 0, 0, 0x40, 0, 0x40, 0x6, 0, 0, 0, 0, 0, 0,
266 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x80, 0x11,
267 0x0, 0x72, 0, 0, 0, 0};
268
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000269 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
270 if (!raw_packet)
271 return -ENOMEM;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000272 memcpy(raw_packet, packet, I40E_TCPIP_DUMMY_PACKET_LEN);
273
274 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
275 tcp = (struct tcphdr *)(raw_packet + IP_HEADER_OFFSET
276 + sizeof(struct iphdr));
277
278 ip->daddr = fd_data->dst_ip[0];
279 tcp->dest = fd_data->dst_port;
280 ip->saddr = fd_data->src_ip[0];
281 tcp->source = fd_data->src_port;
282
283 if (add) {
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000284 pf->fd_tcp_rule++;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000285 if (pf->flags & I40E_FLAG_FD_ATR_ENABLED) {
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400286 if (I40E_DEBUG_FD & pf->hw.debug_mask)
287 dev_info(&pf->pdev->dev, "Forcing ATR off, sideband rules for TCP/IPv4 flow being applied\n");
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000288 pf->flags &= ~I40E_FLAG_FD_ATR_ENABLED;
289 }
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000290 } else {
291 pf->fd_tcp_rule = (pf->fd_tcp_rule > 0) ?
292 (pf->fd_tcp_rule - 1) : 0;
293 if (pf->fd_tcp_rule == 0) {
294 pf->flags |= I40E_FLAG_FD_ATR_ENABLED;
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400295 if (I40E_DEBUG_FD & pf->hw.debug_mask)
296 dev_info(&pf->pdev->dev, "ATR re-enabled due to no sideband TCP/IPv4 rules\n");
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000297 }
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000298 }
299
Kevin Scottb2d36c02014-04-09 05:58:59 +0000300 fd_data->pctype = I40E_FILTER_PCTYPE_NONF_IPV4_TCP;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000301 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
302
303 if (ret) {
304 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000305 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
306 fd_data->pctype, fd_data->fd_id, ret);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000307 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000308 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000309 if (add)
310 dev_info(&pf->pdev->dev, "Filter OK for PCTYPE %d loc = %d)\n",
311 fd_data->pctype, fd_data->fd_id);
312 else
313 dev_info(&pf->pdev->dev,
314 "Filter deleted for PCTYPE %d loc = %d\n",
315 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000316 }
317
Kiran Patila42e7a32015-11-06 15:26:03 -0800318 if (err)
319 kfree(raw_packet);
320
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000321 return err ? -EOPNOTSUPP : 0;
322}
323
324/**
325 * i40e_add_del_fdir_sctpv4 - Add/Remove SCTPv4 Flow Director filters for
326 * a specific flow spec
327 * @vsi: pointer to the targeted VSI
328 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000329 * @add: true adds a filter, false removes it
330 *
Jesse Brandeburg4eeb1ff2015-11-18 17:35:42 -0800331 * Returns 0 if the filters were successfully added or removed
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000332 **/
333static int i40e_add_del_fdir_sctpv4(struct i40e_vsi *vsi,
334 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000335 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000336{
337 return -EOPNOTSUPP;
338}
339
340#define I40E_IP_DUMMY_PACKET_LEN 34
341/**
342 * i40e_add_del_fdir_ipv4 - Add/Remove IPv4 Flow Director filters for
343 * a specific flow spec
344 * @vsi: pointer to the targeted VSI
345 * @fd_data: the flow director data required for the FDir descriptor
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000346 * @add: true adds a filter, false removes it
347 *
348 * Returns 0 if the filters were successfully added or removed
349 **/
350static int i40e_add_del_fdir_ipv4(struct i40e_vsi *vsi,
351 struct i40e_fdir_filter *fd_data,
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000352 bool add)
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000353{
354 struct i40e_pf *pf = vsi->back;
355 struct iphdr *ip;
356 bool err = false;
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000357 u8 *raw_packet;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000358 int ret;
359 int i;
360 static char packet[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x08, 0,
361 0x45, 0, 0, 0x14, 0, 0, 0x40, 0, 0x40, 0x10, 0, 0, 0, 0, 0, 0,
362 0, 0, 0, 0};
363
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000364 for (i = I40E_FILTER_PCTYPE_NONF_IPV4_OTHER;
365 i <= I40E_FILTER_PCTYPE_FRAG_IPV4; i++) {
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000366 raw_packet = kzalloc(I40E_FDIR_MAX_RAW_PACKET_SIZE, GFP_KERNEL);
367 if (!raw_packet)
368 return -ENOMEM;
369 memcpy(raw_packet, packet, I40E_IP_DUMMY_PACKET_LEN);
370 ip = (struct iphdr *)(raw_packet + IP_HEADER_OFFSET);
371
372 ip->saddr = fd_data->src_ip[0];
373 ip->daddr = fd_data->dst_ip[0];
374 ip->protocol = 0;
375
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000376 fd_data->pctype = i;
377 ret = i40e_program_fdir_filter(fd_data, raw_packet, pf, add);
378
379 if (ret) {
380 dev_info(&pf->pdev->dev,
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000381 "PCTYPE:%d, Filter command send failed for fd_id:%d (ret = %d)\n",
382 fd_data->pctype, fd_data->fd_id, ret);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000383 err = true;
Anjali Singhai Jain4205d372015-02-27 09:15:27 +0000384 } else if (I40E_DEBUG_FD & pf->hw.debug_mask) {
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000385 if (add)
386 dev_info(&pf->pdev->dev,
387 "Filter OK for PCTYPE %d loc = %d\n",
388 fd_data->pctype, fd_data->fd_id);
389 else
390 dev_info(&pf->pdev->dev,
391 "Filter deleted for PCTYPE %d loc = %d\n",
392 fd_data->pctype, fd_data->fd_id);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000393 }
394 }
395
Kiran Patila42e7a32015-11-06 15:26:03 -0800396 if (err)
397 kfree(raw_packet);
398
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000399 return err ? -EOPNOTSUPP : 0;
400}
401
402/**
403 * i40e_add_del_fdir - Build raw packets to add/del fdir filter
404 * @vsi: pointer to the targeted VSI
405 * @cmd: command to get or set RX flow classification rules
406 * @add: true adds a filter, false removes it
407 *
408 **/
409int i40e_add_del_fdir(struct i40e_vsi *vsi,
410 struct i40e_fdir_filter *input, bool add)
411{
412 struct i40e_pf *pf = vsi->back;
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000413 int ret;
414
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000415 switch (input->flow_type & ~FLOW_EXT) {
416 case TCP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000417 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000418 break;
419 case UDP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000420 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000421 break;
422 case SCTP_V4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000423 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000424 break;
425 case IPV4_FLOW:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000426 ret = i40e_add_del_fdir_ipv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000427 break;
428 case IP_USER_FLOW:
429 switch (input->ip4_proto) {
430 case IPPROTO_TCP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000431 ret = i40e_add_del_fdir_tcpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000432 break;
433 case IPPROTO_UDP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000434 ret = i40e_add_del_fdir_udpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000435 break;
436 case IPPROTO_SCTP:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000437 ret = i40e_add_del_fdir_sctpv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000438 break;
439 default:
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000440 ret = i40e_add_del_fdir_ipv4(vsi, input, add);
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000441 break;
442 }
443 break;
444 default:
Jakub Kicinskic5ffe7e2014-04-02 10:33:22 +0000445 dev_info(&pf->pdev->dev, "Could not specify spec type %d\n",
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000446 input->flow_type);
447 ret = -EINVAL;
448 }
449
Anjali Singhai Jain49d7d932014-06-04 08:45:15 +0000450 /* The buffer allocated here is freed by the i40e_clean_tx_ring() */
Joseph Gasparakis17a73f62014-02-12 01:45:30 +0000451 return ret;
452}
453
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000454/**
455 * i40e_fd_handle_status - check the Programming Status for FD
456 * @rx_ring: the Rx ring for this descriptor
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000457 * @rx_desc: the Rx descriptor for programming Status, not a packet descriptor.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000458 * @prog_id: the id originally used for programming
459 *
460 * This is used to verify if the FD programming or invalidation
461 * requested by SW to the HW is successful or not and take actions accordingly.
462 **/
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000463static void i40e_fd_handle_status(struct i40e_ring *rx_ring,
464 union i40e_rx_desc *rx_desc, u8 prog_id)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000465{
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000466 struct i40e_pf *pf = rx_ring->vsi->back;
467 struct pci_dev *pdev = pf->pdev;
468 u32 fcnt_prog, fcnt_avail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000469 u32 error;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000470 u64 qw;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000471
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000472 qw = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000473 error = (qw & I40E_RX_PROG_STATUS_DESC_QW1_ERROR_MASK) >>
474 I40E_RX_PROG_STATUS_DESC_QW1_ERROR_SHIFT;
475
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400476 if (error == BIT(I40E_RX_PROG_STATUS_DESC_FD_TBL_FULL_SHIFT)) {
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400477 pf->fd_inv = le32_to_cpu(rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jainf7233c52014-07-09 07:46:16 +0000478 if ((rx_desc->wb.qword0.hi_dword.fd_id != 0) ||
479 (I40E_DEBUG_FD & pf->hw.debug_mask))
480 dev_warn(&pdev->dev, "ntuple filter loc = %d, could not be added\n",
Carolyn Wyborny3487b6c2015-08-27 11:42:38 -0400481 pf->fd_inv);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000482
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000483 /* Check if the programming error is for ATR.
484 * If so, auto disable ATR and set a state for
485 * flush in progress. Next time we come here if flush is in
486 * progress do nothing, once flush is complete the state will
487 * be cleared.
488 */
489 if (test_bit(__I40E_FD_FLUSH_REQUESTED, &pf->state))
490 return;
491
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000492 pf->fd_add_err++;
493 /* store the current atr filter count */
494 pf->fd_atr_cnt = i40e_get_current_atr_cnt(pf);
495
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000496 if ((rx_desc->wb.qword0.hi_dword.fd_id == 0) &&
497 (pf->auto_disable_flags & I40E_FLAG_FD_SB_ENABLED)) {
498 pf->auto_disable_flags |= I40E_FLAG_FD_ATR_ENABLED;
499 set_bit(__I40E_FD_FLUSH_REQUESTED, &pf->state);
500 }
501
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000502 /* filter programming failed most likely due to table full */
Anjali Singhai Jain04294e32015-02-27 09:15:28 +0000503 fcnt_prog = i40e_get_global_fd_count(pf);
Anjali Singhai Jain12957382014-06-04 04:22:47 +0000504 fcnt_avail = pf->fdir_pf_filter_count;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000505 /* If ATR is running fcnt_prog can quickly change,
506 * if we are very close to full, it makes sense to disable
507 * FD ATR/SB and then re-enable it when there is room.
508 */
509 if (fcnt_prog >= (fcnt_avail - I40E_FDIR_BUFFER_FULL_MARGIN)) {
Anjali Singhai Jain1e1be8f2014-07-10 08:03:26 +0000510 if ((pf->flags & I40E_FLAG_FD_SB_ENABLED) &&
Anjali Singhai Jainb814ba62014-06-04 20:41:48 +0000511 !(pf->auto_disable_flags &
Anjali Singhai Jainb814ba62014-06-04 20:41:48 +0000512 I40E_FLAG_FD_SB_ENABLED)) {
Anjali Singhai Jain2e4875e2015-04-16 20:06:06 -0400513 if (I40E_DEBUG_FD & pf->hw.debug_mask)
514 dev_warn(&pdev->dev, "FD filter space full, new ntuple rules will not be added\n");
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000515 pf->auto_disable_flags |=
516 I40E_FLAG_FD_SB_ENABLED;
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000517 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000518 }
Jesse Brandeburg41a1d042015-06-04 16:24:02 -0400519 } else if (error == BIT(I40E_RX_PROG_STATUS_DESC_NO_FD_ENTRY_SHIFT)) {
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000520 if (I40E_DEBUG_FD & pf->hw.debug_mask)
Carolyn Wybornye99bdd32014-07-09 07:46:12 +0000521 dev_info(&pdev->dev, "ntuple filter fd_id = %d, could not be removed\n",
Anjali Singhai Jain13c28842014-03-06 09:00:04 +0000522 rx_desc->wb.qword0.hi_dword.fd_id);
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000523 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000524}
525
526/**
Alexander Duycka5e9c572013-09-28 06:00:27 +0000527 * i40e_unmap_and_free_tx_resource - Release a Tx buffer
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000528 * @ring: the ring that owns the buffer
529 * @tx_buffer: the buffer to free
530 **/
Alexander Duycka5e9c572013-09-28 06:00:27 +0000531static void i40e_unmap_and_free_tx_resource(struct i40e_ring *ring,
532 struct i40e_tx_buffer *tx_buffer)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000533{
Alexander Duycka5e9c572013-09-28 06:00:27 +0000534 if (tx_buffer->skb) {
Kiran Patila42e7a32015-11-06 15:26:03 -0800535 dev_kfree_skb_any(tx_buffer->skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000536 if (dma_unmap_len(tx_buffer, len))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000537 dma_unmap_single(ring->dev,
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000538 dma_unmap_addr(tx_buffer, dma),
539 dma_unmap_len(tx_buffer, len),
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000540 DMA_TO_DEVICE);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000541 } else if (dma_unmap_len(tx_buffer, len)) {
542 dma_unmap_page(ring->dev,
543 dma_unmap_addr(tx_buffer, dma),
544 dma_unmap_len(tx_buffer, len),
545 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000546 }
Kiran Patila42e7a32015-11-06 15:26:03 -0800547
548 if (tx_buffer->tx_flags & I40E_TX_FLAGS_FD_SB)
549 kfree(tx_buffer->raw_buf);
550
Alexander Duycka5e9c572013-09-28 06:00:27 +0000551 tx_buffer->next_to_watch = NULL;
552 tx_buffer->skb = NULL;
Alexander Duyck35a1e2a2013-09-28 06:00:17 +0000553 dma_unmap_len_set(tx_buffer, len, 0);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000554 /* tx_buffer must be completely set up in the transmit path */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000555}
556
557/**
558 * i40e_clean_tx_ring - Free any empty Tx buffers
559 * @tx_ring: ring to be cleaned
560 **/
561void i40e_clean_tx_ring(struct i40e_ring *tx_ring)
562{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000563 unsigned long bi_size;
564 u16 i;
565
566 /* ring already cleared, nothing to do */
567 if (!tx_ring->tx_bi)
568 return;
569
570 /* Free all the Tx ring sk_buffs */
Alexander Duycka5e9c572013-09-28 06:00:27 +0000571 for (i = 0; i < tx_ring->count; i++)
572 i40e_unmap_and_free_tx_resource(tx_ring, &tx_ring->tx_bi[i]);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000573
574 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
575 memset(tx_ring->tx_bi, 0, bi_size);
576
577 /* Zero out the descriptor ring */
578 memset(tx_ring->desc, 0, tx_ring->size);
579
580 tx_ring->next_to_use = 0;
581 tx_ring->next_to_clean = 0;
Alexander Duyck7070ce02013-09-28 06:00:37 +0000582
583 if (!tx_ring->netdev)
584 return;
585
586 /* cleanup Tx queue statistics */
587 netdev_tx_reset_queue(netdev_get_tx_queue(tx_ring->netdev,
588 tx_ring->queue_index));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000589}
590
591/**
592 * i40e_free_tx_resources - Free Tx resources per queue
593 * @tx_ring: Tx descriptor ring for a specific queue
594 *
595 * Free all transmit software resources
596 **/
597void i40e_free_tx_resources(struct i40e_ring *tx_ring)
598{
599 i40e_clean_tx_ring(tx_ring);
600 kfree(tx_ring->tx_bi);
601 tx_ring->tx_bi = NULL;
602
603 if (tx_ring->desc) {
604 dma_free_coherent(tx_ring->dev, tx_ring->size,
605 tx_ring->desc, tx_ring->dma);
606 tx_ring->desc = NULL;
607 }
608}
609
Jesse Brandeburga68de582015-02-24 05:26:03 +0000610/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000611 * i40e_get_tx_pending - how many tx descriptors not processed
612 * @tx_ring: the ring of descriptors
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800613 * @in_sw: is tx_pending being checked in SW or HW
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000614 *
615 * Since there is no access to the ring head register
616 * in XL710, we need to use our local copies
617 **/
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800618u32 i40e_get_tx_pending(struct i40e_ring *ring, bool in_sw)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000619{
Jesse Brandeburga68de582015-02-24 05:26:03 +0000620 u32 head, tail;
621
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800622 if (!in_sw)
623 head = i40e_get_head(ring);
624 else
625 head = ring->next_to_clean;
Jesse Brandeburga68de582015-02-24 05:26:03 +0000626 tail = readl(ring->tail);
627
628 if (head != tail)
629 return (head < tail) ?
630 tail - head : (tail + ring->count - head);
631
632 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000633}
634
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000635#define WB_STRIDE 0x3
636
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000637/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000638 * i40e_clean_tx_irq - Reclaim resources after transmit completes
639 * @tx_ring: tx ring to clean
640 * @budget: how many cleans we're allowed
641 *
642 * Returns true if there's any budget left (e.g. the clean is finished)
643 **/
644static bool i40e_clean_tx_irq(struct i40e_ring *tx_ring, int budget)
645{
646 u16 i = tx_ring->next_to_clean;
647 struct i40e_tx_buffer *tx_buf;
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000648 struct i40e_tx_desc *tx_head;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000649 struct i40e_tx_desc *tx_desc;
650 unsigned int total_packets = 0;
651 unsigned int total_bytes = 0;
652
653 tx_buf = &tx_ring->tx_bi[i];
654 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +0000655 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000656
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000657 tx_head = I40E_TX_DESC(tx_ring, i40e_get_head(tx_ring));
658
Alexander Duycka5e9c572013-09-28 06:00:27 +0000659 do {
660 struct i40e_tx_desc *eop_desc = tx_buf->next_to_watch;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000661
662 /* if next_to_watch is not set then there is no work pending */
663 if (!eop_desc)
664 break;
665
Alexander Duycka5e9c572013-09-28 06:00:27 +0000666 /* prevent any other reads prior to eop_desc */
667 read_barrier_depends();
668
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000669 /* we have caught up to head, no work left to do */
670 if (tx_head == tx_desc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000671 break;
672
Alexander Duyckc304fda2013-09-28 06:00:12 +0000673 /* clear next_to_watch to prevent false hangs */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000674 tx_buf->next_to_watch = NULL;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000675
Alexander Duycka5e9c572013-09-28 06:00:27 +0000676 /* update the statistics for this packet */
677 total_bytes += tx_buf->bytecount;
678 total_packets += tx_buf->gso_segs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000679
Alexander Duycka5e9c572013-09-28 06:00:27 +0000680 /* free the skb */
Rick Jonesa81fb042014-09-17 03:56:20 +0000681 dev_consume_skb_any(tx_buf->skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000682
Alexander Duycka5e9c572013-09-28 06:00:27 +0000683 /* unmap skb header data */
684 dma_unmap_single(tx_ring->dev,
685 dma_unmap_addr(tx_buf, dma),
686 dma_unmap_len(tx_buf, len),
687 DMA_TO_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000688
Alexander Duycka5e9c572013-09-28 06:00:27 +0000689 /* clear tx_buffer data */
690 tx_buf->skb = NULL;
691 dma_unmap_len_set(tx_buf, len, 0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000692
Alexander Duycka5e9c572013-09-28 06:00:27 +0000693 /* unmap remaining buffers */
694 while (tx_desc != eop_desc) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000695
696 tx_buf++;
697 tx_desc++;
698 i++;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000699 if (unlikely(!i)) {
700 i -= tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000701 tx_buf = tx_ring->tx_bi;
702 tx_desc = I40E_TX_DESC(tx_ring, 0);
703 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000704
Alexander Duycka5e9c572013-09-28 06:00:27 +0000705 /* unmap any remaining paged data */
706 if (dma_unmap_len(tx_buf, len)) {
707 dma_unmap_page(tx_ring->dev,
708 dma_unmap_addr(tx_buf, dma),
709 dma_unmap_len(tx_buf, len),
710 DMA_TO_DEVICE);
711 dma_unmap_len_set(tx_buf, len, 0);
712 }
713 }
714
715 /* move us one more past the eop_desc for start of next pkt */
716 tx_buf++;
717 tx_desc++;
718 i++;
719 if (unlikely(!i)) {
720 i -= tx_ring->count;
721 tx_buf = tx_ring->tx_bi;
722 tx_desc = I40E_TX_DESC(tx_ring, 0);
723 }
724
Jesse Brandeburg016890b2015-02-27 09:15:31 +0000725 prefetch(tx_desc);
726
Alexander Duycka5e9c572013-09-28 06:00:27 +0000727 /* update budget accounting */
728 budget--;
729 } while (likely(budget));
730
731 i += tx_ring->count;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000732 tx_ring->next_to_clean = i;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000733 u64_stats_update_begin(&tx_ring->syncp);
Alexander Duycka114d0a2013-09-28 06:00:43 +0000734 tx_ring->stats.bytes += total_bytes;
735 tx_ring->stats.packets += total_packets;
Alexander Duyck980e9b12013-09-28 06:01:03 +0000736 u64_stats_update_end(&tx_ring->syncp);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000737 tx_ring->q_vector->tx.total_bytes += total_bytes;
738 tx_ring->q_vector->tx.total_packets += total_packets;
Alexander Duycka5e9c572013-09-28 06:00:27 +0000739
Anjali Singhai58044742015-09-25 18:26:13 -0700740 if (tx_ring->flags & I40E_TXR_FLAGS_WB_ON_ITR) {
741 unsigned int j = 0;
742
743 /* check to see if there are < 4 descriptors
744 * waiting to be written back, then kick the hardware to force
745 * them to be written back in case we stay in NAPI.
746 * In this mode on X722 we do not enable Interrupt.
747 */
Anjali Singhai Jaindd353102016-01-15 14:33:12 -0800748 j = i40e_get_tx_pending(tx_ring, false);
Anjali Singhai58044742015-09-25 18:26:13 -0700749
750 if (budget &&
751 ((j / (WB_STRIDE + 1)) == 0) && (j != 0) &&
752 !test_bit(__I40E_DOWN, &tx_ring->vsi->state) &&
753 (I40E_DESC_UNUSED(tx_ring) != tx_ring->count))
754 tx_ring->arm_wb = true;
755 }
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000756
Alexander Duyck7070ce02013-09-28 06:00:37 +0000757 netdev_tx_completed_queue(netdev_get_tx_queue(tx_ring->netdev,
758 tx_ring->queue_index),
759 total_packets, total_bytes);
760
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000761#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
762 if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
763 (I40E_DESC_UNUSED(tx_ring) >= TX_WAKE_THRESHOLD))) {
764 /* Make sure that anybody stopping the queue after this
765 * sees the new next_to_clean.
766 */
767 smp_mb();
768 if (__netif_subqueue_stopped(tx_ring->netdev,
769 tx_ring->queue_index) &&
770 !test_bit(__I40E_DOWN, &tx_ring->vsi->state)) {
771 netif_wake_subqueue(tx_ring->netdev,
772 tx_ring->queue_index);
773 ++tx_ring->tx_stats.restart_queue;
774 }
775 }
776
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000777 return !!budget;
778}
779
780/**
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800781 * i40e_enable_wb_on_itr - Arm hardware to do a wb, interrupts are not enabled
782 * @vsi: the VSI we care about
783 * @q_vector: the vector on which to enable writeback
784 *
785 **/
786static void i40e_enable_wb_on_itr(struct i40e_vsi *vsi,
787 struct i40e_q_vector *q_vector)
788{
789 u16 flags = q_vector->tx.ring[0].flags;
790 u32 val;
791
792 if (!(flags & I40E_TXR_FLAGS_WB_ON_ITR))
793 return;
794
795 if (q_vector->arm_wb_state)
796 return;
797
798 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
799 val = I40E_PFINT_DYN_CTLN_WB_ON_ITR_MASK |
800 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK; /* set noitr */
801
802 wr32(&vsi->back->hw,
803 I40E_PFINT_DYN_CTLN(q_vector->v_idx + vsi->base_vector - 1),
804 val);
805 } else {
806 val = I40E_PFINT_DYN_CTL0_WB_ON_ITR_MASK |
807 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK; /* set noitr */
808
809 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
810 }
811 q_vector->arm_wb_state = true;
812}
813
814/**
815 * i40e_force_wb - Issue SW Interrupt so HW does a wb
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000816 * @vsi: the VSI we care about
817 * @q_vector: the vector on which to force writeback
818 *
819 **/
Kiran Patilb03a8c12015-09-24 18:13:15 -0400820void i40e_force_wb(struct i40e_vsi *vsi, struct i40e_q_vector *q_vector)
Jesse Brandeburgd91649f2015-01-07 02:55:01 +0000821{
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -0800822 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -0400823 u32 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
824 I40E_PFINT_DYN_CTLN_ITR_INDX_MASK | /* set noitr */
825 I40E_PFINT_DYN_CTLN_SWINT_TRIG_MASK |
826 I40E_PFINT_DYN_CTLN_SW_ITR_INDX_ENA_MASK;
827 /* allow 00 to be written to the index */
828
829 wr32(&vsi->back->hw,
830 I40E_PFINT_DYN_CTLN(q_vector->v_idx +
831 vsi->base_vector - 1), val);
832 } else {
833 u32 val = I40E_PFINT_DYN_CTL0_INTENA_MASK |
834 I40E_PFINT_DYN_CTL0_ITR_INDX_MASK | /* set noitr */
835 I40E_PFINT_DYN_CTL0_SWINT_TRIG_MASK |
836 I40E_PFINT_DYN_CTL0_SW_ITR_INDX_ENA_MASK;
837 /* allow 00 to be written to the index */
838
839 wr32(&vsi->back->hw, I40E_PFINT_DYN_CTL0, val);
840 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000841}
842
843/**
844 * i40e_set_new_dynamic_itr - Find new ITR level
845 * @rc: structure containing ring performance data
846 *
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400847 * Returns true if ITR changed, false if not
848 *
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000849 * Stores a new ITR value based on packets and byte counts during
850 * the last interrupt. The advantage of per interrupt computation
851 * is faster updates and more accurate ITR for the current traffic
852 * pattern. Constants in this function were computed based on
853 * theoretical maximum wire speed and thresholds were set based on
854 * testing data as well as attempting to minimize response time
855 * while increasing bulk throughput.
856 **/
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400857static bool i40e_set_new_dynamic_itr(struct i40e_ring_container *rc)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000858{
859 enum i40e_latency_range new_latency_range = rc->latency_range;
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400860 struct i40e_q_vector *qv = rc->ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000861 u32 new_itr = rc->itr;
862 int bytes_per_int;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400863 int usecs;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000864
865 if (rc->total_packets == 0 || !rc->itr)
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400866 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000867
868 /* simple throttlerate management
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400869 * 0-10MB/s lowest (50000 ints/s)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000870 * 10-20MB/s low (20000 ints/s)
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400871 * 20-1249MB/s bulk (18000 ints/s)
872 * > 40000 Rx packets per second (8000 ints/s)
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400873 *
874 * The math works out because the divisor is in 10^(-6) which
875 * turns the bytes/us input value into MB/s values, but
876 * make sure to use usecs, as the register values written
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400877 * are in 2 usec increments in the ITR registers, and make sure
878 * to use the smoothed values that the countdown timer gives us.
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000879 */
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400880 usecs = (rc->itr << 1) * ITR_COUNTDOWN_START;
Jesse Brandeburg51cc6d92015-09-28 14:16:52 -0400881 bytes_per_int = rc->total_bytes / usecs;
Jesse Brandeburgee2319c2015-09-28 14:16:54 -0400882
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400883 switch (new_latency_range) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000884 case I40E_LOWEST_LATENCY:
885 if (bytes_per_int > 10)
886 new_latency_range = I40E_LOW_LATENCY;
887 break;
888 case I40E_LOW_LATENCY:
889 if (bytes_per_int > 20)
890 new_latency_range = I40E_BULK_LATENCY;
891 else if (bytes_per_int <= 10)
892 new_latency_range = I40E_LOWEST_LATENCY;
893 break;
894 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400895 case I40E_ULTRA_LATENCY:
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400896 default:
897 if (bytes_per_int <= 20)
898 new_latency_range = I40E_LOW_LATENCY;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000899 break;
900 }
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400901
902 /* this is to adjust RX more aggressively when streaming small
903 * packets. The value of 40000 was picked as it is just beyond
904 * what the hardware can receive per second if in low latency
905 * mode.
906 */
907#define RX_ULTRA_PACKET_RATE 40000
908
909 if ((((rc->total_packets * 1000000) / usecs) > RX_ULTRA_PACKET_RATE) &&
910 (&qv->rx == rc))
911 new_latency_range = I40E_ULTRA_LATENCY;
912
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -0400913 rc->latency_range = new_latency_range;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000914
915 switch (new_latency_range) {
916 case I40E_LOWEST_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400917 new_itr = I40E_ITR_50K;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000918 break;
919 case I40E_LOW_LATENCY:
920 new_itr = I40E_ITR_20K;
921 break;
922 case I40E_BULK_LATENCY:
Jesse Brandeburgc56625d2015-09-28 14:16:53 -0400923 new_itr = I40E_ITR_18K;
924 break;
925 case I40E_ULTRA_LATENCY:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000926 new_itr = I40E_ITR_8K;
927 break;
928 default:
929 break;
930 }
931
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000932 rc->total_bytes = 0;
933 rc->total_packets = 0;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -0400934
935 if (new_itr != rc->itr) {
936 rc->itr = new_itr;
937 return true;
938 }
939
940 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000941}
942
943/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000944 * i40e_clean_programming_status - clean the programming status descriptor
945 * @rx_ring: the rx ring that has this descriptor
946 * @rx_desc: the rx descriptor written back by HW
947 *
948 * Flow director should handle FD_FILTER_STATUS to check its filter programming
949 * status being successful or not and take actions accordingly. FCoE should
950 * handle its context/filter programming/invalidation status and take actions.
951 *
952 **/
953static void i40e_clean_programming_status(struct i40e_ring *rx_ring,
954 union i40e_rx_desc *rx_desc)
955{
956 u64 qw;
957 u8 id;
958
959 qw = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
960 id = (qw & I40E_RX_PROG_STATUS_DESC_QW1_PROGID_MASK) >>
961 I40E_RX_PROG_STATUS_DESC_QW1_PROGID_SHIFT;
962
963 if (id == I40E_RX_PROG_STATUS_DESC_FD_FILTER_STATUS)
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +0000964 i40e_fd_handle_status(rx_ring, rx_desc, id);
Vasu Dev38e00432014-08-01 13:27:03 -0700965#ifdef I40E_FCOE
966 else if ((id == I40E_RX_PROG_STATUS_DESC_FCOE_CTXT_PROG_STATUS) ||
967 (id == I40E_RX_PROG_STATUS_DESC_FCOE_CTXT_INVL_STATUS))
968 i40e_fcoe_handle_status(rx_ring, rx_desc, id);
969#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000970}
971
972/**
973 * i40e_setup_tx_descriptors - Allocate the Tx descriptors
974 * @tx_ring: the tx ring to set up
975 *
976 * Return 0 on success, negative on error
977 **/
978int i40e_setup_tx_descriptors(struct i40e_ring *tx_ring)
979{
980 struct device *dev = tx_ring->dev;
981 int bi_size;
982
983 if (!dev)
984 return -ENOMEM;
985
Jesse Brandeburge908f812015-07-23 16:54:42 -0400986 /* warn if we are about to overwrite the pointer */
987 WARN_ON(tx_ring->tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000988 bi_size = sizeof(struct i40e_tx_buffer) * tx_ring->count;
989 tx_ring->tx_bi = kzalloc(bi_size, GFP_KERNEL);
990 if (!tx_ring->tx_bi)
991 goto err;
992
993 /* round up to nearest 4K */
994 tx_ring->size = tx_ring->count * sizeof(struct i40e_tx_desc);
Jesse Brandeburg1943d8b2014-02-14 02:14:40 +0000995 /* add u32 for head writeback, align after this takes care of
996 * guaranteeing this is at least one cache line in size
997 */
998 tx_ring->size += sizeof(u32);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +0000999 tx_ring->size = ALIGN(tx_ring->size, 4096);
1000 tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
1001 &tx_ring->dma, GFP_KERNEL);
1002 if (!tx_ring->desc) {
1003 dev_info(dev, "Unable to allocate memory for the Tx descriptor ring, size=%d\n",
1004 tx_ring->size);
1005 goto err;
1006 }
1007
1008 tx_ring->next_to_use = 0;
1009 tx_ring->next_to_clean = 0;
1010 return 0;
1011
1012err:
1013 kfree(tx_ring->tx_bi);
1014 tx_ring->tx_bi = NULL;
1015 return -ENOMEM;
1016}
1017
1018/**
1019 * i40e_clean_rx_ring - Free Rx buffers
1020 * @rx_ring: ring to be cleaned
1021 **/
1022void i40e_clean_rx_ring(struct i40e_ring *rx_ring)
1023{
1024 struct device *dev = rx_ring->dev;
1025 struct i40e_rx_buffer *rx_bi;
1026 unsigned long bi_size;
1027 u16 i;
1028
1029 /* ring already cleared, nothing to do */
1030 if (!rx_ring->rx_bi)
1031 return;
1032
Mitch Williamsa132af22015-01-24 09:58:35 +00001033 if (ring_is_ps_enabled(rx_ring)) {
1034 int bufsz = ALIGN(rx_ring->rx_hdr_len, 256) * rx_ring->count;
1035
1036 rx_bi = &rx_ring->rx_bi[0];
1037 if (rx_bi->hdr_buf) {
1038 dma_free_coherent(dev,
1039 bufsz,
1040 rx_bi->hdr_buf,
1041 rx_bi->dma);
1042 for (i = 0; i < rx_ring->count; i++) {
1043 rx_bi = &rx_ring->rx_bi[i];
1044 rx_bi->dma = 0;
Shannon Nelson37a29732015-02-27 09:15:19 +00001045 rx_bi->hdr_buf = NULL;
Mitch Williamsa132af22015-01-24 09:58:35 +00001046 }
1047 }
1048 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001049 /* Free all the Rx ring sk_buffs */
1050 for (i = 0; i < rx_ring->count; i++) {
1051 rx_bi = &rx_ring->rx_bi[i];
1052 if (rx_bi->dma) {
1053 dma_unmap_single(dev,
1054 rx_bi->dma,
1055 rx_ring->rx_buf_len,
1056 DMA_FROM_DEVICE);
1057 rx_bi->dma = 0;
1058 }
1059 if (rx_bi->skb) {
1060 dev_kfree_skb(rx_bi->skb);
1061 rx_bi->skb = NULL;
1062 }
1063 if (rx_bi->page) {
1064 if (rx_bi->page_dma) {
1065 dma_unmap_page(dev,
1066 rx_bi->page_dma,
Mitch Williamsf16704e2016-01-13 16:51:49 -08001067 PAGE_SIZE,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001068 DMA_FROM_DEVICE);
1069 rx_bi->page_dma = 0;
1070 }
1071 __free_page(rx_bi->page);
1072 rx_bi->page = NULL;
1073 rx_bi->page_offset = 0;
1074 }
1075 }
1076
1077 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1078 memset(rx_ring->rx_bi, 0, bi_size);
1079
1080 /* Zero out the descriptor ring */
1081 memset(rx_ring->desc, 0, rx_ring->size);
1082
1083 rx_ring->next_to_clean = 0;
1084 rx_ring->next_to_use = 0;
1085}
1086
1087/**
1088 * i40e_free_rx_resources - Free Rx resources
1089 * @rx_ring: ring to clean the resources from
1090 *
1091 * Free all receive software resources
1092 **/
1093void i40e_free_rx_resources(struct i40e_ring *rx_ring)
1094{
1095 i40e_clean_rx_ring(rx_ring);
1096 kfree(rx_ring->rx_bi);
1097 rx_ring->rx_bi = NULL;
1098
1099 if (rx_ring->desc) {
1100 dma_free_coherent(rx_ring->dev, rx_ring->size,
1101 rx_ring->desc, rx_ring->dma);
1102 rx_ring->desc = NULL;
1103 }
1104}
1105
1106/**
Mitch Williamsa132af22015-01-24 09:58:35 +00001107 * i40e_alloc_rx_headers - allocate rx header buffers
1108 * @rx_ring: ring to alloc buffers
1109 *
1110 * Allocate rx header buffers for the entire ring. As these are static,
1111 * this is only called when setting up a new ring.
1112 **/
1113void i40e_alloc_rx_headers(struct i40e_ring *rx_ring)
1114{
1115 struct device *dev = rx_ring->dev;
1116 struct i40e_rx_buffer *rx_bi;
1117 dma_addr_t dma;
1118 void *buffer;
1119 int buf_size;
1120 int i;
1121
1122 if (rx_ring->rx_bi[0].hdr_buf)
1123 return;
1124 /* Make sure the buffers don't cross cache line boundaries. */
1125 buf_size = ALIGN(rx_ring->rx_hdr_len, 256);
1126 buffer = dma_alloc_coherent(dev, buf_size * rx_ring->count,
1127 &dma, GFP_KERNEL);
1128 if (!buffer)
1129 return;
1130 for (i = 0; i < rx_ring->count; i++) {
1131 rx_bi = &rx_ring->rx_bi[i];
1132 rx_bi->dma = dma + (i * buf_size);
1133 rx_bi->hdr_buf = buffer + (i * buf_size);
1134 }
1135}
1136
1137/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001138 * i40e_setup_rx_descriptors - Allocate Rx descriptors
1139 * @rx_ring: Rx descriptor ring (for a specific queue) to setup
1140 *
1141 * Returns 0 on success, negative on failure
1142 **/
1143int i40e_setup_rx_descriptors(struct i40e_ring *rx_ring)
1144{
1145 struct device *dev = rx_ring->dev;
1146 int bi_size;
1147
Jesse Brandeburge908f812015-07-23 16:54:42 -04001148 /* warn if we are about to overwrite the pointer */
1149 WARN_ON(rx_ring->rx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001150 bi_size = sizeof(struct i40e_rx_buffer) * rx_ring->count;
1151 rx_ring->rx_bi = kzalloc(bi_size, GFP_KERNEL);
1152 if (!rx_ring->rx_bi)
1153 goto err;
1154
Carolyn Wybornyf217d6c2015-02-09 17:42:31 -08001155 u64_stats_init(&rx_ring->syncp);
Carolyn Wyborny638702b2015-01-24 09:58:32 +00001156
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001157 /* Round up to nearest 4K */
1158 rx_ring->size = ring_is_16byte_desc_enabled(rx_ring)
1159 ? rx_ring->count * sizeof(union i40e_16byte_rx_desc)
1160 : rx_ring->count * sizeof(union i40e_32byte_rx_desc);
1161 rx_ring->size = ALIGN(rx_ring->size, 4096);
1162 rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
1163 &rx_ring->dma, GFP_KERNEL);
1164
1165 if (!rx_ring->desc) {
1166 dev_info(dev, "Unable to allocate memory for the Rx descriptor ring, size=%d\n",
1167 rx_ring->size);
1168 goto err;
1169 }
1170
1171 rx_ring->next_to_clean = 0;
1172 rx_ring->next_to_use = 0;
1173
1174 return 0;
1175err:
1176 kfree(rx_ring->rx_bi);
1177 rx_ring->rx_bi = NULL;
1178 return -ENOMEM;
1179}
1180
1181/**
1182 * i40e_release_rx_desc - Store the new tail and head values
1183 * @rx_ring: ring to bump
1184 * @val: new head index
1185 **/
1186static inline void i40e_release_rx_desc(struct i40e_ring *rx_ring, u32 val)
1187{
1188 rx_ring->next_to_use = val;
1189 /* Force memory writes to complete before letting h/w
1190 * know there are new descriptors to fetch. (Only
1191 * applicable for weak-ordered memory model archs,
1192 * such as IA-64).
1193 */
1194 wmb();
1195 writel(val, rx_ring->tail);
1196}
1197
1198/**
Mitch Williamsa132af22015-01-24 09:58:35 +00001199 * i40e_alloc_rx_buffers_ps - Replace used receive buffers; packet split
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001200 * @rx_ring: ring to place buffers on
1201 * @cleaned_count: number of buffers to replace
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001202 *
1203 * Returns true if any errors on allocation
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001204 **/
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001205bool i40e_alloc_rx_buffers_ps(struct i40e_ring *rx_ring, u16 cleaned_count)
Mitch Williamsa132af22015-01-24 09:58:35 +00001206{
1207 u16 i = rx_ring->next_to_use;
1208 union i40e_rx_desc *rx_desc;
1209 struct i40e_rx_buffer *bi;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001210 const int current_node = numa_node_id();
Mitch Williamsa132af22015-01-24 09:58:35 +00001211
1212 /* do nothing if no valid netdev defined */
1213 if (!rx_ring->netdev || !cleaned_count)
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001214 return false;
Mitch Williamsa132af22015-01-24 09:58:35 +00001215
1216 while (cleaned_count--) {
1217 rx_desc = I40E_RX_DESC(rx_ring, i);
1218 bi = &rx_ring->rx_bi[i];
1219
1220 if (bi->skb) /* desc is in use */
1221 goto no_buffers;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001222
1223 /* If we've been moved to a different NUMA node, release the
1224 * page so we can get a new one on the current node.
1225 */
1226 if (bi->page && page_to_nid(bi->page) != current_node) {
1227 dma_unmap_page(rx_ring->dev,
1228 bi->page_dma,
1229 PAGE_SIZE,
1230 DMA_FROM_DEVICE);
1231 __free_page(bi->page);
1232 bi->page = NULL;
1233 bi->page_dma = 0;
1234 rx_ring->rx_stats.realloc_count++;
1235 } else if (bi->page) {
1236 rx_ring->rx_stats.page_reuse_count++;
1237 }
1238
Mitch Williamsa132af22015-01-24 09:58:35 +00001239 if (!bi->page) {
1240 bi->page = alloc_page(GFP_ATOMIC);
1241 if (!bi->page) {
1242 rx_ring->rx_stats.alloc_page_failed++;
1243 goto no_buffers;
1244 }
Mitch Williamsa132af22015-01-24 09:58:35 +00001245 bi->page_dma = dma_map_page(rx_ring->dev,
1246 bi->page,
Mitch Williamsf16704e2016-01-13 16:51:49 -08001247 0,
1248 PAGE_SIZE,
Mitch Williamsa132af22015-01-24 09:58:35 +00001249 DMA_FROM_DEVICE);
Mitch Williamsf16704e2016-01-13 16:51:49 -08001250 if (dma_mapping_error(rx_ring->dev, bi->page_dma)) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001251 rx_ring->rx_stats.alloc_page_failed++;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001252 __free_page(bi->page);
1253 bi->page = NULL;
Mitch Williamsa132af22015-01-24 09:58:35 +00001254 bi->page_dma = 0;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001255 bi->page_offset = 0;
Mitch Williamsa132af22015-01-24 09:58:35 +00001256 goto no_buffers;
1257 }
Mitch Williamsf16704e2016-01-13 16:51:49 -08001258 bi->page_offset = 0;
Mitch Williamsa132af22015-01-24 09:58:35 +00001259 }
1260
Mitch Williamsa132af22015-01-24 09:58:35 +00001261 /* Refresh the desc even if buffer_addrs didn't change
1262 * because each write-back erases this info.
1263 */
Mitch Williamsf16704e2016-01-13 16:51:49 -08001264 rx_desc->read.pkt_addr =
1265 cpu_to_le64(bi->page_dma + bi->page_offset);
Mitch Williamsa132af22015-01-24 09:58:35 +00001266 rx_desc->read.hdr_addr = cpu_to_le64(bi->dma);
1267 i++;
1268 if (i == rx_ring->count)
1269 i = 0;
1270 }
1271
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001272 if (rx_ring->next_to_use != i)
1273 i40e_release_rx_desc(rx_ring, i);
1274
1275 return false;
1276
Mitch Williamsa132af22015-01-24 09:58:35 +00001277no_buffers:
1278 if (rx_ring->next_to_use != i)
1279 i40e_release_rx_desc(rx_ring, i);
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001280
1281 /* make sure to come back via polling to try again after
1282 * allocation failure
1283 */
1284 return true;
Mitch Williamsa132af22015-01-24 09:58:35 +00001285}
1286
1287/**
1288 * i40e_alloc_rx_buffers_1buf - Replace used receive buffers; single buffer
1289 * @rx_ring: ring to place buffers on
1290 * @cleaned_count: number of buffers to replace
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001291 *
1292 * Returns true if any errors on allocation
Mitch Williamsa132af22015-01-24 09:58:35 +00001293 **/
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001294bool i40e_alloc_rx_buffers_1buf(struct i40e_ring *rx_ring, u16 cleaned_count)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001295{
1296 u16 i = rx_ring->next_to_use;
1297 union i40e_rx_desc *rx_desc;
1298 struct i40e_rx_buffer *bi;
1299 struct sk_buff *skb;
1300
1301 /* do nothing if no valid netdev defined */
1302 if (!rx_ring->netdev || !cleaned_count)
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001303 return false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001304
1305 while (cleaned_count--) {
1306 rx_desc = I40E_RX_DESC(rx_ring, i);
1307 bi = &rx_ring->rx_bi[i];
1308 skb = bi->skb;
1309
1310 if (!skb) {
Jesse Brandeburgdd1a5df2016-01-13 16:51:48 -08001311 skb = __netdev_alloc_skb_ip_align(rx_ring->netdev,
1312 rx_ring->rx_buf_len,
1313 GFP_ATOMIC |
1314 __GFP_NOWARN);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001315 if (!skb) {
Mitch Williams420136c2013-12-18 13:45:59 +00001316 rx_ring->rx_stats.alloc_buff_failed++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001317 goto no_buffers;
1318 }
1319 /* initialize queue mapping */
1320 skb_record_rx_queue(skb, rx_ring->queue_index);
1321 bi->skb = skb;
1322 }
1323
1324 if (!bi->dma) {
1325 bi->dma = dma_map_single(rx_ring->dev,
1326 skb->data,
1327 rx_ring->rx_buf_len,
1328 DMA_FROM_DEVICE);
1329 if (dma_mapping_error(rx_ring->dev, bi->dma)) {
Mitch Williams420136c2013-12-18 13:45:59 +00001330 rx_ring->rx_stats.alloc_buff_failed++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001331 bi->dma = 0;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001332 dev_kfree_skb(bi->skb);
1333 bi->skb = NULL;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001334 goto no_buffers;
1335 }
1336 }
1337
Mitch Williamsa132af22015-01-24 09:58:35 +00001338 rx_desc->read.pkt_addr = cpu_to_le64(bi->dma);
1339 rx_desc->read.hdr_addr = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001340 i++;
1341 if (i == rx_ring->count)
1342 i = 0;
1343 }
1344
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001345 if (rx_ring->next_to_use != i)
1346 i40e_release_rx_desc(rx_ring, i);
1347
1348 return false;
1349
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001350no_buffers:
1351 if (rx_ring->next_to_use != i)
1352 i40e_release_rx_desc(rx_ring, i);
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001353
1354 /* make sure to come back via polling to try again after
1355 * allocation failure
1356 */
1357 return true;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001358}
1359
1360/**
1361 * i40e_receive_skb - Send a completed packet up the stack
1362 * @rx_ring: rx ring in play
1363 * @skb: packet to send up
1364 * @vlan_tag: vlan tag for packet
1365 **/
1366static void i40e_receive_skb(struct i40e_ring *rx_ring,
1367 struct sk_buff *skb, u16 vlan_tag)
1368{
1369 struct i40e_q_vector *q_vector = rx_ring->q_vector;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001370
1371 if (vlan_tag & VLAN_VID_MASK)
1372 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlan_tag);
1373
Alexander Duyck8b650352015-09-24 09:04:32 -07001374 napi_gro_receive(&q_vector->napi, skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001375}
1376
1377/**
1378 * i40e_rx_checksum - Indicate in skb if hw indicated a good cksum
1379 * @vsi: the VSI we care about
1380 * @skb: skb currently being received and modified
1381 * @rx_status: status value of last descriptor in packet
1382 * @rx_error: error value of last descriptor in packet
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001383 * @rx_ptype: ptype value of last descriptor in packet
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001384 **/
1385static inline void i40e_rx_checksum(struct i40e_vsi *vsi,
1386 struct sk_buff *skb,
1387 u32 rx_status,
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001388 u32 rx_error,
1389 u16 rx_ptype)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001390{
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001391 struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype(rx_ptype);
Alexander Duyckfad57332016-01-24 21:17:22 -08001392 bool ipv4, ipv6, ipv4_tunnel, ipv6_tunnel;
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001393
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001394 skb->ip_summed = CHECKSUM_NONE;
1395
1396 /* Rx csum enabled and ip headers found? */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001397 if (!(vsi->netdev->features & NETIF_F_RXCSUM))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001398 return;
1399
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001400 /* did the hardware decode the packet and checksum? */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001401 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_L3L4P_SHIFT)))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001402 return;
1403
1404 /* both known and outer_ip must be set for the below code to work */
1405 if (!(decoded.known && decoded.outer_ip))
1406 return;
1407
Alexander Duyckfad57332016-01-24 21:17:22 -08001408 ipv4 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1409 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV4);
1410 ipv6 = (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP) &&
1411 (decoded.outer_ip_ver == I40E_RX_PTYPE_OUTER_IPV6);
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001412
1413 if (ipv4 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001414 (rx_error & (BIT(I40E_RX_DESC_ERROR_IPE_SHIFT) |
1415 BIT(I40E_RX_DESC_ERROR_EIPE_SHIFT))))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001416 goto checksum_fail;
1417
Jesse Brandeburgddf1d0d2014-02-13 03:48:39 -08001418 /* likely incorrect csum if alternate IP extension headers found */
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001419 if (ipv6 &&
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001420 rx_status & BIT(I40E_RX_DESC_STATUS_IPV6EXADD_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001421 /* don't increment checksum err here, non-fatal err */
Shannon Nelson8ee75a82013-12-21 05:44:46 +00001422 return;
1423
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001424 /* there was some L4 error, count error and punt packet to the stack */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001425 if (rx_error & BIT(I40E_RX_DESC_ERROR_L4E_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001426 goto checksum_fail;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001427
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001428 /* handle packets that were not able to be checksummed due
1429 * to arrival speed, in this case the stack can compute
1430 * the csum.
1431 */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001432 if (rx_error & BIT(I40E_RX_DESC_ERROR_PPRS_SHIFT))
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001433 return;
1434
Alexander Duycka9c9a812016-01-24 21:16:13 -08001435 /* The hardware supported by this driver does not validate outer
1436 * checksums for tunneled VXLAN or GENEVE frames. I don't agree
1437 * with it but the specification states that you "MAY validate", it
1438 * doesn't make it a hard requirement so if we have validated the
1439 * inner checksum report CHECKSUM_UNNECESSARY.
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001440 */
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001441
Alexander Duyckfad57332016-01-24 21:17:22 -08001442 ipv4_tunnel = (rx_ptype >= I40E_RX_PTYPE_GRENAT4_MAC_PAY3) &&
1443 (rx_ptype <= I40E_RX_PTYPE_GRENAT4_MACVLAN_IPV6_ICMP_PAY4);
1444 ipv6_tunnel = (rx_ptype >= I40E_RX_PTYPE_GRENAT6_MAC_PAY3) &&
1445 (rx_ptype <= I40E_RX_PTYPE_GRENAT6_MACVLAN_IPV6_ICMP_PAY4);
1446
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001447 skb->ip_summed = CHECKSUM_UNNECESSARY;
Tom Herbertfa4ba692014-08-27 21:27:32 -07001448 skb->csum_level = ipv4_tunnel || ipv6_tunnel;
Jesse Brandeburg8a3c91c2014-05-20 08:01:43 +00001449
1450 return;
1451
1452checksum_fail:
1453 vsi->back->hw_csum_rx_error++;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001454}
1455
1456/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001457 * i40e_ptype_to_htype - get a hash type
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001458 * @ptype: the ptype value from the descriptor
1459 *
1460 * Returns a hash type to be used by skb_set_hash
1461 **/
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001462static inline enum pkt_hash_types i40e_ptype_to_htype(u8 ptype)
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001463{
1464 struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype(ptype);
1465
1466 if (!decoded.known)
1467 return PKT_HASH_TYPE_NONE;
1468
1469 if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1470 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY4)
1471 return PKT_HASH_TYPE_L4;
1472 else if (decoded.outer_ip == I40E_RX_PTYPE_OUTER_IP &&
1473 decoded.payload_layer == I40E_RX_PTYPE_PAYLOAD_LAYER_PAY3)
1474 return PKT_HASH_TYPE_L3;
1475 else
1476 return PKT_HASH_TYPE_L2;
1477}
1478
1479/**
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001480 * i40e_rx_hash - set the hash value in the skb
1481 * @ring: descriptor ring
1482 * @rx_desc: specific descriptor
1483 **/
1484static inline void i40e_rx_hash(struct i40e_ring *ring,
1485 union i40e_rx_desc *rx_desc,
1486 struct sk_buff *skb,
1487 u8 rx_ptype)
1488{
1489 u32 hash;
1490 const __le64 rss_mask =
1491 cpu_to_le64((u64)I40E_RX_DESC_FLTSTAT_RSS_HASH <<
1492 I40E_RX_DESC_STATUS_FLTSTAT_SHIFT);
1493
1494 if (ring->netdev->features & NETIF_F_RXHASH)
1495 return;
1496
1497 if ((rx_desc->wb.qword1.status_error_len & rss_mask) == rss_mask) {
1498 hash = le32_to_cpu(rx_desc->wb.qword0.hi_dword.rss);
1499 skb_set_hash(skb, hash, i40e_ptype_to_htype(rx_ptype));
1500 }
1501}
1502
1503/**
Mitch Williamsa132af22015-01-24 09:58:35 +00001504 * i40e_clean_rx_irq_ps - Reclaim resources after receive; packet split
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001505 * @rx_ring: rx ring to clean
1506 * @budget: how many cleans we're allowed
1507 *
1508 * Returns true if there's any budget left (e.g. the clean is finished)
1509 **/
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001510static int i40e_clean_rx_irq_ps(struct i40e_ring *rx_ring, const int budget)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001511{
1512 unsigned int total_rx_bytes = 0, total_rx_packets = 0;
1513 u16 rx_packet_len, rx_header_len, rx_sph, rx_hbo;
1514 u16 cleaned_count = I40E_DESC_UNUSED(rx_ring);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001515 struct i40e_vsi *vsi = rx_ring->vsi;
1516 u16 i = rx_ring->next_to_clean;
1517 union i40e_rx_desc *rx_desc;
1518 u32 rx_error, rx_status;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001519 bool failure = false;
Jesse Brandeburg206812b2014-02-12 01:45:33 +00001520 u8 rx_ptype;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001521 u64 qword;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001522 u32 copysize;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001523
Eric W. Biederman390f86d2014-03-14 17:59:10 -07001524 if (budget <= 0)
1525 return 0;
1526
Mitch Williamsa132af22015-01-24 09:58:35 +00001527 do {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001528 struct i40e_rx_buffer *rx_bi;
1529 struct sk_buff *skb;
1530 u16 vlan_tag;
Mitch Williamsa132af22015-01-24 09:58:35 +00001531 /* return some buffers to hardware, one at a time is too slow */
1532 if (cleaned_count >= I40E_RX_BUFFER_WRITE) {
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001533 failure = failure ||
1534 i40e_alloc_rx_buffers_ps(rx_ring,
1535 cleaned_count);
Mitch Williamsa132af22015-01-24 09:58:35 +00001536 cleaned_count = 0;
1537 }
1538
1539 i = rx_ring->next_to_clean;
1540 rx_desc = I40E_RX_DESC(rx_ring, i);
1541 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1542 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1543 I40E_RXD_QW1_STATUS_SHIFT;
1544
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001545 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_DD_SHIFT)))
Mitch Williamsa132af22015-01-24 09:58:35 +00001546 break;
1547
1548 /* This memory barrier is needed to keep us from reading
1549 * any other fields out of the rx_desc until we know the
1550 * DD bit is set.
1551 */
Alexander Duyck67317162015-04-08 18:49:43 -07001552 dma_rmb();
Mitch Williamsf16704e2016-01-13 16:51:49 -08001553 /* sync header buffer for reading */
1554 dma_sync_single_range_for_cpu(rx_ring->dev,
1555 rx_ring->rx_bi[0].dma,
1556 i * rx_ring->rx_hdr_len,
1557 rx_ring->rx_hdr_len,
1558 DMA_FROM_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001559 if (i40e_rx_is_programming_status(qword)) {
1560 i40e_clean_programming_status(rx_ring, rx_desc);
Mitch Williamsa132af22015-01-24 09:58:35 +00001561 I40E_RX_INCREMENT(rx_ring, i);
1562 continue;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001563 }
1564 rx_bi = &rx_ring->rx_bi[i];
1565 skb = rx_bi->skb;
Mitch Williamsa132af22015-01-24 09:58:35 +00001566 if (likely(!skb)) {
Jesse Brandeburgdd1a5df2016-01-13 16:51:48 -08001567 skb = __netdev_alloc_skb_ip_align(rx_ring->netdev,
1568 rx_ring->rx_hdr_len,
1569 GFP_ATOMIC |
1570 __GFP_NOWARN);
Jesse Brandeburg8b6ed9c2015-03-31 00:45:01 -07001571 if (!skb) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001572 rx_ring->rx_stats.alloc_buff_failed++;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001573 failure = true;
Jesse Brandeburg8b6ed9c2015-03-31 00:45:01 -07001574 break;
1575 }
1576
Mitch Williamsa132af22015-01-24 09:58:35 +00001577 /* initialize queue mapping */
1578 skb_record_rx_queue(skb, rx_ring->queue_index);
1579 /* we are reusing so sync this buffer for CPU use */
1580 dma_sync_single_range_for_cpu(rx_ring->dev,
Jesse Brandeburg3578fa02016-01-04 10:33:03 -08001581 rx_ring->rx_bi[0].dma,
1582 i * rx_ring->rx_hdr_len,
Mitch Williamsa132af22015-01-24 09:58:35 +00001583 rx_ring->rx_hdr_len,
1584 DMA_FROM_DEVICE);
1585 }
Mitch Williams829af3a2013-12-18 13:46:00 +00001586 rx_packet_len = (qword & I40E_RXD_QW1_LENGTH_PBUF_MASK) >>
1587 I40E_RXD_QW1_LENGTH_PBUF_SHIFT;
1588 rx_header_len = (qword & I40E_RXD_QW1_LENGTH_HBUF_MASK) >>
1589 I40E_RXD_QW1_LENGTH_HBUF_SHIFT;
1590 rx_sph = (qword & I40E_RXD_QW1_LENGTH_SPH_MASK) >>
1591 I40E_RXD_QW1_LENGTH_SPH_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001592
Mitch Williams829af3a2013-12-18 13:46:00 +00001593 rx_error = (qword & I40E_RXD_QW1_ERROR_MASK) >>
1594 I40E_RXD_QW1_ERROR_SHIFT;
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001595 rx_hbo = rx_error & BIT(I40E_RX_DESC_ERROR_HBO_SHIFT);
1596 rx_error &= ~BIT(I40E_RX_DESC_ERROR_HBO_SHIFT);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001597
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001598 rx_ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >>
1599 I40E_RXD_QW1_PTYPE_SHIFT;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001600 /* sync half-page for reading */
1601 dma_sync_single_range_for_cpu(rx_ring->dev,
1602 rx_bi->page_dma,
1603 rx_bi->page_offset,
1604 PAGE_SIZE / 2,
1605 DMA_FROM_DEVICE);
1606 prefetch(page_address(rx_bi->page) + rx_bi->page_offset);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001607 rx_bi->skb = NULL;
Mitch Williamsa132af22015-01-24 09:58:35 +00001608 cleaned_count++;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001609 copysize = 0;
Mitch Williamsa132af22015-01-24 09:58:35 +00001610 if (rx_hbo || rx_sph) {
1611 int len;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04001612
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001613 if (rx_hbo)
1614 len = I40E_RX_HDR_SIZE;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001615 else
Mitch Williamsa132af22015-01-24 09:58:35 +00001616 len = rx_header_len;
1617 memcpy(__skb_put(skb, len), rx_bi->hdr_buf, len);
1618 } else if (skb->len == 0) {
1619 int len;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001620 unsigned char *va = page_address(rx_bi->page) +
1621 rx_bi->page_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001622
Mitch Williamsf16704e2016-01-13 16:51:49 -08001623 len = min(rx_packet_len, rx_ring->rx_hdr_len);
1624 memcpy(__skb_put(skb, len), va, len);
1625 copysize = len;
Mitch Williamsa132af22015-01-24 09:58:35 +00001626 rx_packet_len -= len;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001627 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001628 /* Get the rest of the data if this was a header split */
Mitch Williamsa132af22015-01-24 09:58:35 +00001629 if (rx_packet_len) {
Mitch Williamsf16704e2016-01-13 16:51:49 -08001630 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags,
1631 rx_bi->page,
1632 rx_bi->page_offset + copysize,
1633 rx_packet_len, I40E_RXBUFFER_2048);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001634
Mitch Williamsf16704e2016-01-13 16:51:49 -08001635 /* If the page count is more than 2, then both halves
1636 * of the page are used and we need to free it. Do it
1637 * here instead of in the alloc code. Otherwise one
1638 * of the half-pages might be released between now and
1639 * then, and we wouldn't know which one to use.
Mitch Williams16fd08b2016-01-15 14:33:15 -08001640 * Don't call get_page and free_page since those are
1641 * both expensive atomic operations that just change
1642 * the refcount in opposite directions. Just give the
1643 * page to the stack; he can have our refcount.
Mitch Williamsf16704e2016-01-13 16:51:49 -08001644 */
1645 if (page_count(rx_bi->page) > 2) {
1646 dma_unmap_page(rx_ring->dev,
1647 rx_bi->page_dma,
1648 PAGE_SIZE,
1649 DMA_FROM_DEVICE);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001650 rx_bi->page = NULL;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001651 rx_bi->page_dma = 0;
1652 rx_ring->rx_stats.realloc_count++;
Mitch Williams16fd08b2016-01-15 14:33:15 -08001653 } else {
1654 get_page(rx_bi->page);
1655 /* switch to the other half-page here; the
1656 * allocation code programs the right addr
1657 * into HW. If we haven't used this half-page,
1658 * the address won't be changed, and HW can
1659 * just use it next time through.
1660 */
1661 rx_bi->page_offset ^= PAGE_SIZE / 2;
Mitch Williamsf16704e2016-01-13 16:51:49 -08001662 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001663
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001664 }
Mitch Williamsa132af22015-01-24 09:58:35 +00001665 I40E_RX_INCREMENT(rx_ring, i);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001666
1667 if (unlikely(
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001668 !(rx_status & BIT(I40E_RX_DESC_STATUS_EOF_SHIFT)))) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001669 struct i40e_rx_buffer *next_buffer;
1670
1671 next_buffer = &rx_ring->rx_bi[i];
Mitch Williamsa132af22015-01-24 09:58:35 +00001672 next_buffer->skb = skb;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001673 rx_ring->rx_stats.non_eop_descs++;
Mitch Williamsa132af22015-01-24 09:58:35 +00001674 continue;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001675 }
1676
1677 /* ERR_MASK will only have valid bits if EOP set */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001678 if (unlikely(rx_error & BIT(I40E_RX_DESC_ERROR_RXE_SHIFT))) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001679 dev_kfree_skb_any(skb);
Mitch Williamsa132af22015-01-24 09:58:35 +00001680 continue;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001681 }
1682
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001683 i40e_rx_hash(rx_ring, rx_desc, skb, rx_ptype);
1684
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00001685 if (unlikely(rx_status & I40E_RXD_QW1_STATUS_TSYNVALID_MASK)) {
1686 i40e_ptp_rx_hwtstamp(vsi->back, skb, (rx_status &
1687 I40E_RXD_QW1_STATUS_TSYNINDX_MASK) >>
1688 I40E_RXD_QW1_STATUS_TSYNINDX_SHIFT);
1689 rx_ring->last_rx_timestamp = jiffies;
1690 }
1691
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001692 /* probably a little skewed due to removing CRC */
1693 total_rx_bytes += skb->len;
1694 total_rx_packets++;
1695
1696 skb->protocol = eth_type_trans(skb, rx_ring->netdev);
Joseph Gasparakis8144f0f2013-12-28 05:27:57 +00001697
1698 i40e_rx_checksum(vsi, skb, rx_status, rx_error, rx_ptype);
1699
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001700 vlan_tag = rx_status & BIT(I40E_RX_DESC_STATUS_L2TAG1P_SHIFT)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001701 ? le16_to_cpu(rx_desc->wb.qword0.lo_dword.l2tag1)
1702 : 0;
Vasu Dev38e00432014-08-01 13:27:03 -07001703#ifdef I40E_FCOE
1704 if (!i40e_fcoe_handle_offload(rx_ring, rx_desc, skb)) {
1705 dev_kfree_skb_any(skb);
Mitch Williamsa132af22015-01-24 09:58:35 +00001706 continue;
Vasu Dev38e00432014-08-01 13:27:03 -07001707 }
1708#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001709 i40e_receive_skb(rx_ring, skb, vlan_tag);
1710
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001711 rx_desc->wb.qword1.status_error_len = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001712
Mitch Williamsa132af22015-01-24 09:58:35 +00001713 } while (likely(total_rx_packets < budget));
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001714
Alexander Duyck980e9b12013-09-28 06:01:03 +00001715 u64_stats_update_begin(&rx_ring->syncp);
Alexander Duycka114d0a2013-09-28 06:00:43 +00001716 rx_ring->stats.packets += total_rx_packets;
1717 rx_ring->stats.bytes += total_rx_bytes;
Alexander Duyck980e9b12013-09-28 06:01:03 +00001718 u64_stats_update_end(&rx_ring->syncp);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001719 rx_ring->q_vector->rx.total_packets += total_rx_packets;
1720 rx_ring->q_vector->rx.total_bytes += total_rx_bytes;
1721
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001722 return failure ? budget : total_rx_packets;
Mitch Williamsa132af22015-01-24 09:58:35 +00001723}
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001724
Mitch Williamsa132af22015-01-24 09:58:35 +00001725/**
1726 * i40e_clean_rx_irq_1buf - Reclaim resources after receive; single buffer
1727 * @rx_ring: rx ring to clean
1728 * @budget: how many cleans we're allowed
1729 *
1730 * Returns number of packets cleaned
1731 **/
1732static int i40e_clean_rx_irq_1buf(struct i40e_ring *rx_ring, int budget)
1733{
1734 unsigned int total_rx_bytes = 0, total_rx_packets = 0;
1735 u16 cleaned_count = I40E_DESC_UNUSED(rx_ring);
1736 struct i40e_vsi *vsi = rx_ring->vsi;
1737 union i40e_rx_desc *rx_desc;
1738 u32 rx_error, rx_status;
1739 u16 rx_packet_len;
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001740 bool failure = false;
Mitch Williamsa132af22015-01-24 09:58:35 +00001741 u8 rx_ptype;
1742 u64 qword;
1743 u16 i;
1744
1745 do {
1746 struct i40e_rx_buffer *rx_bi;
1747 struct sk_buff *skb;
1748 u16 vlan_tag;
1749 /* return some buffers to hardware, one at a time is too slow */
1750 if (cleaned_count >= I40E_RX_BUFFER_WRITE) {
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001751 failure = failure ||
1752 i40e_alloc_rx_buffers_1buf(rx_ring,
1753 cleaned_count);
Mitch Williamsa132af22015-01-24 09:58:35 +00001754 cleaned_count = 0;
1755 }
1756
1757 i = rx_ring->next_to_clean;
1758 rx_desc = I40E_RX_DESC(rx_ring, i);
1759 qword = le64_to_cpu(rx_desc->wb.qword1.status_error_len);
1760 rx_status = (qword & I40E_RXD_QW1_STATUS_MASK) >>
1761 I40E_RXD_QW1_STATUS_SHIFT;
1762
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001763 if (!(rx_status & BIT(I40E_RX_DESC_STATUS_DD_SHIFT)))
Mitch Williamsa132af22015-01-24 09:58:35 +00001764 break;
1765
1766 /* This memory barrier is needed to keep us from reading
1767 * any other fields out of the rx_desc until we know the
1768 * DD bit is set.
1769 */
Alexander Duyck67317162015-04-08 18:49:43 -07001770 dma_rmb();
Mitch Williamsa132af22015-01-24 09:58:35 +00001771
1772 if (i40e_rx_is_programming_status(qword)) {
1773 i40e_clean_programming_status(rx_ring, rx_desc);
1774 I40E_RX_INCREMENT(rx_ring, i);
1775 continue;
1776 }
1777 rx_bi = &rx_ring->rx_bi[i];
1778 skb = rx_bi->skb;
1779 prefetch(skb->data);
1780
1781 rx_packet_len = (qword & I40E_RXD_QW1_LENGTH_PBUF_MASK) >>
1782 I40E_RXD_QW1_LENGTH_PBUF_SHIFT;
1783
1784 rx_error = (qword & I40E_RXD_QW1_ERROR_MASK) >>
1785 I40E_RXD_QW1_ERROR_SHIFT;
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001786 rx_error &= ~BIT(I40E_RX_DESC_ERROR_HBO_SHIFT);
Mitch Williamsa132af22015-01-24 09:58:35 +00001787
1788 rx_ptype = (qword & I40E_RXD_QW1_PTYPE_MASK) >>
1789 I40E_RXD_QW1_PTYPE_SHIFT;
1790 rx_bi->skb = NULL;
1791 cleaned_count++;
1792
1793 /* Get the header and possibly the whole packet
1794 * If this is an skb from previous receive dma will be 0
1795 */
1796 skb_put(skb, rx_packet_len);
1797 dma_unmap_single(rx_ring->dev, rx_bi->dma, rx_ring->rx_buf_len,
1798 DMA_FROM_DEVICE);
1799 rx_bi->dma = 0;
1800
1801 I40E_RX_INCREMENT(rx_ring, i);
1802
1803 if (unlikely(
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001804 !(rx_status & BIT(I40E_RX_DESC_STATUS_EOF_SHIFT)))) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001805 rx_ring->rx_stats.non_eop_descs++;
1806 continue;
1807 }
1808
1809 /* ERR_MASK will only have valid bits if EOP set */
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001810 if (unlikely(rx_error & BIT(I40E_RX_DESC_ERROR_RXE_SHIFT))) {
Mitch Williamsa132af22015-01-24 09:58:35 +00001811 dev_kfree_skb_any(skb);
Mitch Williamsa132af22015-01-24 09:58:35 +00001812 continue;
1813 }
1814
Anjali Singhai Jain857942f2015-12-09 15:50:21 -08001815 i40e_rx_hash(rx_ring, rx_desc, skb, rx_ptype);
Mitch Williamsa132af22015-01-24 09:58:35 +00001816 if (unlikely(rx_status & I40E_RXD_QW1_STATUS_TSYNVALID_MASK)) {
1817 i40e_ptp_rx_hwtstamp(vsi->back, skb, (rx_status &
1818 I40E_RXD_QW1_STATUS_TSYNINDX_MASK) >>
1819 I40E_RXD_QW1_STATUS_TSYNINDX_SHIFT);
1820 rx_ring->last_rx_timestamp = jiffies;
1821 }
1822
1823 /* probably a little skewed due to removing CRC */
1824 total_rx_bytes += skb->len;
1825 total_rx_packets++;
1826
1827 skb->protocol = eth_type_trans(skb, rx_ring->netdev);
1828
1829 i40e_rx_checksum(vsi, skb, rx_status, rx_error, rx_ptype);
1830
Jesse Brandeburg41a1d042015-06-04 16:24:02 -04001831 vlan_tag = rx_status & BIT(I40E_RX_DESC_STATUS_L2TAG1P_SHIFT)
Mitch Williamsa132af22015-01-24 09:58:35 +00001832 ? le16_to_cpu(rx_desc->wb.qword0.lo_dword.l2tag1)
1833 : 0;
1834#ifdef I40E_FCOE
1835 if (!i40e_fcoe_handle_offload(rx_ring, rx_desc, skb)) {
1836 dev_kfree_skb_any(skb);
1837 continue;
1838 }
1839#endif
1840 i40e_receive_skb(rx_ring, skb, vlan_tag);
1841
Mitch Williamsa132af22015-01-24 09:58:35 +00001842 rx_desc->wb.qword1.status_error_len = 0;
1843 } while (likely(total_rx_packets < budget));
1844
1845 u64_stats_update_begin(&rx_ring->syncp);
1846 rx_ring->stats.packets += total_rx_packets;
1847 rx_ring->stats.bytes += total_rx_bytes;
1848 u64_stats_update_end(&rx_ring->syncp);
1849 rx_ring->q_vector->rx.total_packets += total_rx_packets;
1850 rx_ring->q_vector->rx.total_bytes += total_rx_bytes;
1851
Jesse Brandeburgc2e245a2016-01-13 16:51:46 -08001852 return failure ? budget : total_rx_packets;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001853}
1854
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001855static u32 i40e_buildreg_itr(const int type, const u16 itr)
1856{
1857 u32 val;
1858
1859 val = I40E_PFINT_DYN_CTLN_INTENA_MASK |
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08001860 /* Don't clear PBA because that can cause lost interrupts that
1861 * came in while we were cleaning/polling
1862 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001863 (type << I40E_PFINT_DYN_CTLN_ITR_INDX_SHIFT) |
1864 (itr << I40E_PFINT_DYN_CTLN_INTERVAL_SHIFT);
1865
1866 return val;
1867}
1868
1869/* a small macro to shorten up some long lines */
1870#define INTREG I40E_PFINT_DYN_CTLN
1871
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001872/**
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001873 * i40e_update_enable_itr - Update itr and re-enable MSIX interrupt
1874 * @vsi: the VSI we care about
1875 * @q_vector: q_vector for which itr is being updated and interrupt enabled
1876 *
1877 **/
1878static inline void i40e_update_enable_itr(struct i40e_vsi *vsi,
1879 struct i40e_q_vector *q_vector)
1880{
1881 struct i40e_hw *hw = &vsi->back->hw;
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001882 bool rx = false, tx = false;
1883 u32 rxval, txval;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001884 int vector;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001885
1886 vector = (q_vector->v_idx + vsi->base_vector);
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001887
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001888 /* avoid dynamic calculation if in countdown mode OR if
1889 * all dynamic is disabled
1890 */
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001891 rxval = txval = i40e_buildreg_itr(I40E_ITR_NONE, 0);
1892
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001893 if (q_vector->itr_countdown > 0 ||
1894 (!ITR_IS_DYNAMIC(vsi->rx_itr_setting) &&
1895 !ITR_IS_DYNAMIC(vsi->tx_itr_setting))) {
1896 goto enable_int;
1897 }
1898
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001899 if (ITR_IS_DYNAMIC(vsi->rx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001900 rx = i40e_set_new_dynamic_itr(&q_vector->rx);
1901 rxval = i40e_buildreg_itr(I40E_RX_ITR, q_vector->rx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001902 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001903
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001904 if (ITR_IS_DYNAMIC(vsi->tx_itr_setting)) {
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001905 tx = i40e_set_new_dynamic_itr(&q_vector->tx);
1906 txval = i40e_buildreg_itr(I40E_TX_ITR, q_vector->tx.itr);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001907 }
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001908
1909 if (rx || tx) {
1910 /* get the higher of the two ITR adjustments and
1911 * use the same value for both ITR registers
1912 * when in adaptive mode (Rx and/or Tx)
1913 */
1914 u16 itr = max(q_vector->tx.itr, q_vector->rx.itr);
1915
1916 q_vector->tx.itr = q_vector->rx.itr = itr;
1917 txval = i40e_buildreg_itr(I40E_TX_ITR, itr);
1918 tx = true;
1919 rxval = i40e_buildreg_itr(I40E_RX_ITR, itr);
1920 rx = true;
1921 }
1922
1923 /* only need to enable the interrupt once, but need
1924 * to possibly update both ITR values
1925 */
1926 if (rx) {
1927 /* set the INTENA_MSK_MASK so that this first write
1928 * won't actually enable the interrupt, instead just
1929 * updating the ITR (it's bit 31 PF and VF)
1930 */
1931 rxval |= BIT(31);
1932 /* don't check _DOWN because interrupt isn't being enabled */
1933 wr32(hw, INTREG(vector - 1), rxval);
1934 }
1935
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001936enable_int:
Jesse Brandeburg8f5e39c2015-09-28 14:16:51 -04001937 if (!test_bit(__I40E_DOWN, &vsi->state))
1938 wr32(hw, INTREG(vector - 1), txval);
Jesse Brandeburgee2319c2015-09-28 14:16:54 -04001939
1940 if (q_vector->itr_countdown)
1941 q_vector->itr_countdown--;
1942 else
1943 q_vector->itr_countdown = ITR_COUNTDOWN_START;
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04001944}
1945
1946/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001947 * i40e_napi_poll - NAPI polling Rx/Tx cleanup routine
1948 * @napi: napi struct with our devices info in it
1949 * @budget: amount of work driver is allowed to do this pass, in packets
1950 *
1951 * This function will clean all queues associated with a q_vector.
1952 *
1953 * Returns the amount of work done
1954 **/
1955int i40e_napi_poll(struct napi_struct *napi, int budget)
1956{
1957 struct i40e_q_vector *q_vector =
1958 container_of(napi, struct i40e_q_vector, napi);
1959 struct i40e_vsi *vsi = q_vector->vsi;
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001960 struct i40e_ring *ring;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001961 bool clean_complete = true;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00001962 bool arm_wb = false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001963 int budget_per_ring;
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07001964 int work_done = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001965
1966 if (test_bit(__I40E_DOWN, &vsi->state)) {
1967 napi_complete(napi);
1968 return 0;
1969 }
1970
Kiran Patil9c6c1252015-11-06 15:26:02 -08001971 /* Clear hung_detected bit */
1972 clear_bit(I40E_Q_VECTOR_HUNG_DETECT, &q_vector->hung_detected);
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001973 /* Since the actual Tx work is minimal, we can give the Tx a larger
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001974 * budget and be more aggressive about cleaning up the Tx descriptors.
1975 */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00001976 i40e_for_each_ring(ring, q_vector->tx) {
Mitch Williams1a36d7f2016-01-13 16:51:50 -08001977 clean_complete = clean_complete &&
1978 i40e_clean_tx_irq(ring, vsi->work_limit);
Mitch Williams44cdb792015-11-06 15:26:11 -08001979 arm_wb = arm_wb || ring->arm_wb;
Jesse Brandeburg0deda862015-07-23 16:54:34 -04001980 ring->arm_wb = false;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00001981 }
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001982
Alexander Duyckc67cace2015-09-24 09:04:26 -07001983 /* Handle case where we are called by netpoll with a budget of 0 */
1984 if (budget <= 0)
1985 goto tx_only;
1986
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001987 /* We attempt to distribute budget to each Rx queue fairly, but don't
1988 * allow the budget to go below 1 because that would exit polling early.
1989 */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00001990 budget_per_ring = max(budget/q_vector->num_ringpairs, 1);
Alexander Duyckcd0b6fa2013-09-28 06:00:53 +00001991
Mitch Williamsa132af22015-01-24 09:58:35 +00001992 i40e_for_each_ring(ring, q_vector->rx) {
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07001993 int cleaned;
1994
Mitch Williamsa132af22015-01-24 09:58:35 +00001995 if (ring_is_ps_enabled(ring))
1996 cleaned = i40e_clean_rx_irq_ps(ring, budget_per_ring);
1997 else
1998 cleaned = i40e_clean_rx_irq_1buf(ring, budget_per_ring);
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07001999
2000 work_done += cleaned;
Mitch Williamsa132af22015-01-24 09:58:35 +00002001 /* if we didn't clean as many as budgeted, we must be done */
Mitch Williams1a36d7f2016-01-13 16:51:50 -08002002 clean_complete = clean_complete && (budget_per_ring > cleaned);
Mitch Williamsa132af22015-01-24 09:58:35 +00002003 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002004
2005 /* If work not completed, return budget and polling will return */
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002006 if (!clean_complete) {
Alexander Duyckc67cace2015-09-24 09:04:26 -07002007tx_only:
Anjali Singhai Jain164c9f52015-10-21 19:47:08 -04002008 if (arm_wb) {
2009 q_vector->tx.ring[0].tx_stats.tx_force_wb++;
Anjali Singhai Jainecc6a232016-01-13 16:51:43 -08002010 i40e_enable_wb_on_itr(vsi, q_vector);
Anjali Singhai Jain164c9f52015-10-21 19:47:08 -04002011 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002012 return budget;
Jesse Brandeburgd91649f2015-01-07 02:55:01 +00002013 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002014
Anjali Singhai Jain8e0764b2015-06-05 12:20:30 -04002015 if (vsi->back->flags & I40E_TXR_FLAGS_WB_ON_ITR)
2016 q_vector->arm_wb_state = false;
2017
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002018 /* Work is done so exit the polling mode and re-enable the interrupt */
Jesse Brandeburg32b3e082015-09-24 16:35:47 -07002019 napi_complete_done(napi, work_done);
Carolyn Wybornyde32e3e2015-06-10 13:42:07 -04002020 if (vsi->back->flags & I40E_FLAG_MSIX_ENABLED) {
2021 i40e_update_enable_itr(vsi, q_vector);
2022 } else { /* Legacy mode */
Jesse Brandeburg40d72a52016-01-13 16:51:45 -08002023 i40e_irq_dynamic_enable_icr0(vsi->back, false);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002024 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002025 return 0;
2026}
2027
2028/**
2029 * i40e_atr - Add a Flow Director ATR filter
2030 * @tx_ring: ring to add programming descriptor to
2031 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002032 * @tx_flags: send tx flags
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002033 * @protocol: wire protocol
2034 **/
2035static void i40e_atr(struct i40e_ring *tx_ring, struct sk_buff *skb,
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002036 u32 tx_flags, __be16 protocol)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002037{
2038 struct i40e_filter_program_desc *fdir_desc;
2039 struct i40e_pf *pf = tx_ring->vsi->back;
2040 union {
2041 unsigned char *network;
2042 struct iphdr *ipv4;
2043 struct ipv6hdr *ipv6;
2044 } hdr;
2045 struct tcphdr *th;
2046 unsigned int hlen;
2047 u32 flex_ptype, dtype_cmd;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002048 u16 i;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002049
2050 /* make sure ATR is enabled */
Jesse Brandeburg60ea5f82014-01-17 15:36:34 -08002051 if (!(pf->flags & I40E_FLAG_FD_ATR_ENABLED))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002052 return;
2053
Anjali Singhai Jain04294e32015-02-27 09:15:28 +00002054 if ((pf->auto_disable_flags & I40E_FLAG_FD_ATR_ENABLED))
2055 return;
2056
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002057 /* if sampling is disabled do nothing */
2058 if (!tx_ring->atr_sample_rate)
2059 return;
2060
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002061 if (!(tx_flags & (I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6)))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002062 return;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002063
Singhai, Anjali6a899022015-12-14 12:21:18 -08002064 if (!(tx_flags & I40E_TX_FLAGS_UDP_TUNNEL)) {
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002065 /* snag network header to get L4 type and address */
2066 hdr.network = skb_network_header(skb);
2067
2068 /* Currently only IPv4/IPv6 with TCP is supported
2069 * access ihl as u8 to avoid unaligned access on ia64
2070 */
2071 if (tx_flags & I40E_TX_FLAGS_IPV4)
2072 hlen = (hdr.network[0] & 0x0F) << 2;
2073 else if (protocol == htons(ETH_P_IPV6))
2074 hlen = sizeof(struct ipv6hdr);
2075 else
2076 return;
2077 } else {
2078 hdr.network = skb_inner_network_header(skb);
2079 hlen = skb_inner_network_header_len(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002080 }
2081
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002082 /* Currently only IPv4/IPv6 with TCP is supported
2083 * Note: tx_flags gets modified to reflect inner protocols in
2084 * tx_enable_csum function if encap is enabled.
2085 */
2086 if ((tx_flags & I40E_TX_FLAGS_IPV4) &&
2087 (hdr.ipv4->protocol != IPPROTO_TCP))
2088 return;
2089 else if ((tx_flags & I40E_TX_FLAGS_IPV6) &&
2090 (hdr.ipv6->nexthdr != IPPROTO_TCP))
2091 return;
2092
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002093 th = (struct tcphdr *)(hdr.network + hlen);
2094
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002095 /* Due to lack of space, no more new filters can be programmed */
2096 if (th->syn && (pf->auto_disable_flags & I40E_FLAG_FD_ATR_ENABLED))
2097 return;
Anjali Singhai Jain72b74862016-01-08 17:50:21 -08002098 if ((pf->flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE) &&
2099 (!(pf->auto_disable_flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE))) {
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002100 /* HW ATR eviction will take care of removing filters on FIN
2101 * and RST packets.
2102 */
2103 if (th->fin || th->rst)
2104 return;
2105 }
Anjali Singhai Jain55a5e602014-02-12 06:33:25 +00002106
2107 tx_ring->atr_count++;
2108
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002109 /* sample on all syn/fin/rst packets or once every atr sample rate */
2110 if (!th->fin &&
2111 !th->syn &&
2112 !th->rst &&
2113 (tx_ring->atr_count < tx_ring->atr_sample_rate))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002114 return;
2115
2116 tx_ring->atr_count = 0;
2117
2118 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002119 i = tx_ring->next_to_use;
2120 fdir_desc = I40E_TX_FDIRDESC(tx_ring, i);
2121
2122 i++;
2123 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002124
2125 flex_ptype = (tx_ring->queue_index << I40E_TXD_FLTR_QW0_QINDEX_SHIFT) &
2126 I40E_TXD_FLTR_QW0_QINDEX_MASK;
2127 flex_ptype |= (protocol == htons(ETH_P_IP)) ?
2128 (I40E_FILTER_PCTYPE_NONF_IPV4_TCP <<
2129 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT) :
2130 (I40E_FILTER_PCTYPE_NONF_IPV6_TCP <<
2131 I40E_TXD_FLTR_QW0_PCTYPE_SHIFT);
2132
2133 flex_ptype |= tx_ring->vsi->id << I40E_TXD_FLTR_QW0_DEST_VSI_SHIFT;
2134
2135 dtype_cmd = I40E_TX_DESC_DTYPE_FILTER_PROG;
2136
Anjali Singhai Jaince806782014-03-06 08:59:54 +00002137 dtype_cmd |= (th->fin || th->rst) ?
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002138 (I40E_FILTER_PROGRAM_DESC_PCMD_REMOVE <<
2139 I40E_TXD_FLTR_QW1_PCMD_SHIFT) :
2140 (I40E_FILTER_PROGRAM_DESC_PCMD_ADD_UPDATE <<
2141 I40E_TXD_FLTR_QW1_PCMD_SHIFT);
2142
2143 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_DEST_DIRECT_PACKET_QINDEX <<
2144 I40E_TXD_FLTR_QW1_DEST_SHIFT;
2145
2146 dtype_cmd |= I40E_FILTER_PROGRAM_DESC_FD_STATUS_FD_ID <<
2147 I40E_TXD_FLTR_QW1_FD_STATUS_SHIFT;
2148
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002149 dtype_cmd |= I40E_TXD_FLTR_QW1_CNT_ENA_MASK;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002150 if (!(tx_flags & I40E_TX_FLAGS_UDP_TUNNEL))
Anjali Singhai Jain60ccd452015-04-16 20:06:01 -04002151 dtype_cmd |=
2152 ((u32)I40E_FD_ATR_STAT_IDX(pf->hw.pf_id) <<
2153 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2154 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
2155 else
2156 dtype_cmd |=
2157 ((u32)I40E_FD_ATR_TUNNEL_STAT_IDX(pf->hw.pf_id) <<
2158 I40E_TXD_FLTR_QW1_CNTINDEX_SHIFT) &
2159 I40E_TXD_FLTR_QW1_CNTINDEX_MASK;
Anjali Singhai Jain433c47d2014-05-22 06:32:17 +00002160
Anjali Singhai Jain72b74862016-01-08 17:50:21 -08002161 if ((pf->flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE) &&
2162 (!(pf->auto_disable_flags & I40E_FLAG_HW_ATR_EVICT_CAPABLE)))
Anjali Singhai Jain52eb95e2015-06-05 12:20:33 -04002163 dtype_cmd |= I40E_TXD_FLTR_QW1_ATR_MASK;
2164
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002165 fdir_desc->qindex_flex_ptype_vsi = cpu_to_le32(flex_ptype);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002166 fdir_desc->rsvd = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002167 fdir_desc->dtype_cmd_cntindex = cpu_to_le32(dtype_cmd);
Jesse Brandeburg99753ea2014-06-04 04:22:49 +00002168 fdir_desc->fd_id = cpu_to_le32(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002169}
2170
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002171/**
2172 * i40e_tx_prepare_vlan_flags - prepare generic TX VLAN tagging flags for HW
2173 * @skb: send buffer
2174 * @tx_ring: ring to send buffer on
2175 * @flags: the tx flags to be set
2176 *
2177 * Checks the skb and set up correspondingly several generic transmit flags
2178 * related to VLAN tagging for the HW, such as VLAN, DCB, etc.
2179 *
2180 * Returns error code indicate the frame should be dropped upon error and the
2181 * otherwise returns 0 to indicate the flags has been set properly.
2182 **/
Vasu Dev38e00432014-08-01 13:27:03 -07002183#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002184inline int i40e_tx_prepare_vlan_flags(struct sk_buff *skb,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002185 struct i40e_ring *tx_ring,
2186 u32 *flags)
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002187#else
2188static inline int i40e_tx_prepare_vlan_flags(struct sk_buff *skb,
2189 struct i40e_ring *tx_ring,
2190 u32 *flags)
Vasu Dev38e00432014-08-01 13:27:03 -07002191#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002192{
2193 __be16 protocol = skb->protocol;
2194 u32 tx_flags = 0;
2195
Greg Rose31eaacc2015-03-31 00:45:03 -07002196 if (protocol == htons(ETH_P_8021Q) &&
2197 !(tx_ring->netdev->features & NETIF_F_HW_VLAN_CTAG_TX)) {
2198 /* When HW VLAN acceleration is turned off by the user the
2199 * stack sets the protocol to 8021q so that the driver
2200 * can take any steps required to support the SW only
2201 * VLAN handling. In our case the driver doesn't need
2202 * to take any further steps so just set the protocol
2203 * to the encapsulated ethertype.
2204 */
2205 skb->protocol = vlan_get_protocol(skb);
2206 goto out;
2207 }
2208
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002209 /* if we have a HW VLAN tag being added, default to the HW one */
Jiri Pirkodf8a39d2015-01-13 17:13:44 +01002210 if (skb_vlan_tag_present(skb)) {
2211 tx_flags |= skb_vlan_tag_get(skb) << I40E_TX_FLAGS_VLAN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002212 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2213 /* else if it is a SW VLAN, check the next protocol and store the tag */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002214 } else if (protocol == htons(ETH_P_8021Q)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002215 struct vlan_hdr *vhdr, _vhdr;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04002216
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002217 vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
2218 if (!vhdr)
2219 return -EINVAL;
2220
2221 protocol = vhdr->h_vlan_encapsulated_proto;
2222 tx_flags |= ntohs(vhdr->h_vlan_TCI) << I40E_TX_FLAGS_VLAN_SHIFT;
2223 tx_flags |= I40E_TX_FLAGS_SW_VLAN;
2224 }
2225
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002226 if (!(tx_ring->vsi->back->flags & I40E_FLAG_DCB_ENABLED))
2227 goto out;
2228
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002229 /* Insert 802.1p priority into VLAN header */
Vasu Dev38e00432014-08-01 13:27:03 -07002230 if ((tx_flags & (I40E_TX_FLAGS_HW_VLAN | I40E_TX_FLAGS_SW_VLAN)) ||
2231 (skb->priority != TC_PRIO_CONTROL)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002232 tx_flags &= ~I40E_TX_FLAGS_VLAN_PRIO_MASK;
2233 tx_flags |= (skb->priority & 0x7) <<
2234 I40E_TX_FLAGS_VLAN_PRIO_SHIFT;
2235 if (tx_flags & I40E_TX_FLAGS_SW_VLAN) {
2236 struct vlan_ethhdr *vhdr;
Francois Romieudd225bc2014-03-30 03:14:48 +00002237 int rc;
2238
2239 rc = skb_cow_head(skb, 0);
2240 if (rc < 0)
2241 return rc;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002242 vhdr = (struct vlan_ethhdr *)skb->data;
2243 vhdr->h_vlan_TCI = htons(tx_flags >>
2244 I40E_TX_FLAGS_VLAN_SHIFT);
2245 } else {
2246 tx_flags |= I40E_TX_FLAGS_HW_VLAN;
2247 }
2248 }
Neerav Parikhd40d00b2015-02-24 06:58:40 +00002249
2250out:
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002251 *flags = tx_flags;
2252 return 0;
2253}
2254
2255/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002256 * i40e_tso - set up the tso context descriptor
2257 * @tx_ring: ptr to the ring to send
2258 * @skb: ptr to the skb we're sending
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002259 * @hdr_len: ptr to the size of the packet header
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002260 * @cd_type_cmd_tso_mss: Quad Word 1
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002261 *
2262 * Returns 0 if no TSO can happen, 1 if tso is going, or error
2263 **/
2264static int i40e_tso(struct i40e_ring *tx_ring, struct sk_buff *skb,
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002265 u8 *hdr_len, u64 *cd_type_cmd_tso_mss)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002266{
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002267 u64 cd_cmd, cd_tso_len, cd_mss;
Alexander Duyckc7770192016-01-24 21:16:35 -08002268 union {
2269 struct iphdr *v4;
2270 struct ipv6hdr *v6;
2271 unsigned char *hdr;
2272 } ip;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002273 union {
2274 struct tcphdr *tcp;
Alexander Duyck54532052016-01-24 21:17:29 -08002275 struct udphdr *udp;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002276 unsigned char *hdr;
2277 } l4;
2278 u32 paylen, l4_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002279 int err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002280
Shannon Nelsone9f65632016-01-04 10:33:04 -08002281 if (skb->ip_summed != CHECKSUM_PARTIAL)
2282 return 0;
2283
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002284 if (!skb_is_gso(skb))
2285 return 0;
2286
Francois Romieudd225bc2014-03-30 03:14:48 +00002287 err = skb_cow_head(skb, 0);
2288 if (err < 0)
2289 return err;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002290
Alexander Duyckc7770192016-01-24 21:16:35 -08002291 ip.hdr = skb_network_header(skb);
2292 l4.hdr = skb_transport_header(skb);
Anjali Singhaidf230752014-12-19 02:58:16 +00002293
Alexander Duyckc7770192016-01-24 21:16:35 -08002294 /* initialize outer IP header fields */
2295 if (ip.v4->version == 4) {
2296 ip.v4->tot_len = 0;
2297 ip.v4->check = 0;
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002298 } else {
Alexander Duyckc7770192016-01-24 21:16:35 -08002299 ip.v6->payload_len = 0;
2300 }
2301
Alexander Duyck54532052016-01-24 21:17:29 -08002302 if (skb_shinfo(skb)->gso_type & (SKB_GSO_UDP_TUNNEL | SKB_GSO_GRE |
2303 SKB_GSO_UDP_TUNNEL_CSUM)) {
2304 if (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM) {
2305 /* determine offset of outer transport header */
2306 l4_offset = l4.hdr - skb->data;
2307
2308 /* remove payload length from outer checksum */
2309 paylen = (__force u16)l4.udp->check;
2310 paylen += ntohs(1) * (u16)~(skb->len - l4_offset);
2311 l4.udp->check = ~csum_fold((__force __wsum)paylen);
2312 }
2313
Alexander Duyckc7770192016-01-24 21:16:35 -08002314 /* reset pointers to inner headers */
2315 ip.hdr = skb_inner_network_header(skb);
2316 l4.hdr = skb_inner_transport_header(skb);
2317
2318 /* initialize inner IP header fields */
2319 if (ip.v4->version == 4) {
2320 ip.v4->tot_len = 0;
2321 ip.v4->check = 0;
2322 } else {
2323 ip.v6->payload_len = 0;
2324 }
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002325 }
2326
Alexander Duyckc49a7bc2016-01-24 21:16:28 -08002327 /* determine offset of inner transport header */
2328 l4_offset = l4.hdr - skb->data;
2329
2330 /* remove payload length from inner checksum */
2331 paylen = (__force u16)l4.tcp->check;
2332 paylen += ntohs(1) * (u16)~(skb->len - l4_offset);
2333 l4.tcp->check = ~csum_fold((__force __wsum)paylen);
2334
2335 /* compute length of segmentation header */
2336 *hdr_len = (l4.tcp->doff * 4) + l4_offset;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002337
2338 /* find the field values */
2339 cd_cmd = I40E_TX_CTX_DESC_TSO;
2340 cd_tso_len = skb->len - *hdr_len;
2341 cd_mss = skb_shinfo(skb)->gso_size;
Alexander Duyck03f9d6a2016-01-24 21:16:20 -08002342 *cd_type_cmd_tso_mss |= (cd_cmd << I40E_TXD_CTX_QW1_CMD_SHIFT) |
2343 (cd_tso_len << I40E_TXD_CTX_QW1_TSO_LEN_SHIFT) |
2344 (cd_mss << I40E_TXD_CTX_QW1_MSS_SHIFT);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002345 return 1;
2346}
2347
2348/**
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002349 * i40e_tsyn - set up the tsyn context descriptor
2350 * @tx_ring: ptr to the ring to send
2351 * @skb: ptr to the skb we're sending
2352 * @tx_flags: the collected send information
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002353 * @cd_type_cmd_tso_mss: Quad Word 1
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002354 *
2355 * Returns 0 if no Tx timestamp can happen and 1 if the timestamp will happen
2356 **/
2357static int i40e_tsyn(struct i40e_ring *tx_ring, struct sk_buff *skb,
2358 u32 tx_flags, u64 *cd_type_cmd_tso_mss)
2359{
2360 struct i40e_pf *pf;
2361
2362 if (likely(!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)))
2363 return 0;
2364
2365 /* Tx timestamps cannot be sampled when doing TSO */
2366 if (tx_flags & I40E_TX_FLAGS_TSO)
2367 return 0;
2368
2369 /* only timestamp the outbound packet if the user has requested it and
2370 * we are not already transmitting a packet to be timestamped
2371 */
2372 pf = i40e_netdev_to_pf(tx_ring->netdev);
Jacob Keller22b47772014-12-14 01:55:09 +00002373 if (!(pf->flags & I40E_FLAG_PTP))
2374 return 0;
2375
Jakub Kicinski9ce34f02014-03-15 14:55:42 +00002376 if (pf->ptp_tx &&
2377 !test_and_set_bit_lock(__I40E_PTP_TX_IN_PROGRESS, &pf->state)) {
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002378 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
2379 pf->ptp_tx_skb = skb_get(skb);
2380 } else {
2381 return 0;
2382 }
2383
2384 *cd_type_cmd_tso_mss |= (u64)I40E_TX_CTX_DESC_TSYN <<
2385 I40E_TXD_CTX_QW1_CMD_SHIFT;
2386
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002387 return 1;
2388}
2389
2390/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002391 * i40e_tx_enable_csum - Enable Tx checksum offloads
2392 * @skb: send buffer
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002393 * @tx_flags: pointer to Tx flags currently set
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002394 * @td_cmd: Tx descriptor command bits to set
2395 * @td_offset: Tx descriptor header offsets to set
Jean Sacren554f4542015-10-13 01:06:28 -06002396 * @tx_ring: Tx descriptor ring
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002397 * @cd_tunneling: ptr to context desc bits
2398 **/
Alexander Duyck529f1f62016-01-24 21:17:10 -08002399static int i40e_tx_enable_csum(struct sk_buff *skb, u32 *tx_flags,
2400 u32 *td_cmd, u32 *td_offset,
2401 struct i40e_ring *tx_ring,
2402 u32 *cd_tunneling)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002403{
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002404 union {
2405 struct iphdr *v4;
2406 struct ipv6hdr *v6;
2407 unsigned char *hdr;
2408 } ip;
2409 union {
2410 struct tcphdr *tcp;
2411 struct udphdr *udp;
2412 unsigned char *hdr;
2413 } l4;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002414 unsigned char *exthdr;
Alexander Duyck475b4202016-01-24 21:17:01 -08002415 u32 offset, cmd = 0, tunnel = 0;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002416 __be16 frag_off;
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002417 u8 l4_proto = 0;
2418
Alexander Duyck529f1f62016-01-24 21:17:10 -08002419 if (skb->ip_summed != CHECKSUM_PARTIAL)
2420 return 0;
2421
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002422 ip.hdr = skb_network_header(skb);
2423 l4.hdr = skb_transport_header(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002424
Alexander Duyck475b4202016-01-24 21:17:01 -08002425 /* compute outer L2 header size */
2426 offset = ((ip.hdr - skb->data) / 2) << I40E_TX_DESC_LENGTH_MACLEN_SHIFT;
2427
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002428 if (skb->encapsulation) {
Alexander Duycka0064722016-01-24 21:16:48 -08002429 /* define outer network header type */
2430 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002431 tunnel |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2432 I40E_TX_CTX_EXT_IP_IPV4 :
2433 I40E_TX_CTX_EXT_IP_IPV4_NO_CSUM;
2434
Alexander Duycka0064722016-01-24 21:16:48 -08002435 l4_proto = ip.v4->protocol;
2436 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002437 tunnel |= I40E_TX_CTX_EXT_IP_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002438
2439 exthdr = ip.hdr + sizeof(*ip.v6);
Alexander Duycka0064722016-01-24 21:16:48 -08002440 l4_proto = ip.v6->nexthdr;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002441 if (l4.hdr != exthdr)
2442 ipv6_skip_exthdr(skb, exthdr - skb->data,
2443 &l4_proto, &frag_off);
Alexander Duycka0064722016-01-24 21:16:48 -08002444 }
2445
Alexander Duyck475b4202016-01-24 21:17:01 -08002446 /* compute outer L3 header size */
2447 tunnel |= ((l4.hdr - ip.hdr) / 4) <<
2448 I40E_TXD_CTX_QW0_EXT_IPLEN_SHIFT;
2449
2450 /* switch IP header pointer from outer to inner header */
2451 ip.hdr = skb_inner_network_header(skb);
2452
Alexander Duycka0064722016-01-24 21:16:48 -08002453 /* define outer transport */
2454 switch (l4_proto) {
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002455 case IPPROTO_UDP:
Alexander Duyck475b4202016-01-24 21:17:01 -08002456 tunnel |= I40E_TXD_CTX_UDP_TUNNELING;
Singhai, Anjali6a899022015-12-14 12:21:18 -08002457 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002458 break;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002459 case IPPROTO_GRE:
Alexander Duyck475b4202016-01-24 21:17:01 -08002460 tunnel |= I40E_TXD_CTX_GRE_TUNNELING;
Alexander Duycka0064722016-01-24 21:16:48 -08002461 *tx_flags |= I40E_TX_FLAGS_UDP_TUNNEL;
Shannon Nelsonc1d17912015-09-25 19:26:04 +00002462 break;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002463 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002464 if (*tx_flags & I40E_TX_FLAGS_TSO)
2465 return -1;
2466
2467 skb_checksum_help(skb);
2468 return 0;
Anjali Singhai Jain45991202015-02-27 09:15:29 +00002469 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002470
Alexander Duyck475b4202016-01-24 21:17:01 -08002471 /* compute tunnel header size */
2472 tunnel |= ((ip.hdr - l4.hdr) / 2) <<
2473 I40E_TXD_CTX_QW0_NATLEN_SHIFT;
2474
Alexander Duyck54532052016-01-24 21:17:29 -08002475 /* indicate if we need to offload outer UDP header */
2476 if ((*tx_flags & I40E_TX_FLAGS_TSO) &&
2477 (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_TUNNEL_CSUM))
2478 tunnel |= I40E_TXD_CTX_QW0_L4T_CS_MASK;
2479
Alexander Duyck475b4202016-01-24 21:17:01 -08002480 /* record tunnel offload values */
2481 *cd_tunneling |= tunnel;
2482
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002483 /* switch L4 header pointer from outer to inner */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002484 l4.hdr = skb_inner_transport_header(skb);
Alexander Duycka0064722016-01-24 21:16:48 -08002485 l4_proto = 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002486
Alexander Duycka0064722016-01-24 21:16:48 -08002487 /* reset type as we transition from outer to inner headers */
2488 *tx_flags &= ~(I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6);
2489 if (ip.v4->version == 4)
2490 *tx_flags |= I40E_TX_FLAGS_IPV4;
2491 if (ip.v6->version == 6)
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002492 *tx_flags |= I40E_TX_FLAGS_IPV6;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002493 }
2494
2495 /* Enable IP checksum offloads */
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002496 if (*tx_flags & I40E_TX_FLAGS_IPV4) {
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002497 l4_proto = ip.v4->protocol;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002498 /* the stack computes the IP header already, the only time we
2499 * need the hardware to recompute it is in the case of TSO.
2500 */
Alexander Duyck475b4202016-01-24 21:17:01 -08002501 cmd |= (*tx_flags & I40E_TX_FLAGS_TSO) ?
2502 I40E_TX_DESC_CMD_IIPT_IPV4_CSUM :
2503 I40E_TX_DESC_CMD_IIPT_IPV4;
Anjali Singhai Jain89232c32015-04-16 20:06:00 -04002504 } else if (*tx_flags & I40E_TX_FLAGS_IPV6) {
Alexander Duyck475b4202016-01-24 21:17:01 -08002505 cmd |= I40E_TX_DESC_CMD_IIPT_IPV6;
Alexander Duycka3fd9d82016-01-24 21:16:54 -08002506
2507 exthdr = ip.hdr + sizeof(*ip.v6);
2508 l4_proto = ip.v6->nexthdr;
2509 if (l4.hdr != exthdr)
2510 ipv6_skip_exthdr(skb, exthdr - skb->data,
2511 &l4_proto, &frag_off);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002512 }
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002513
Alexander Duyck475b4202016-01-24 21:17:01 -08002514 /* compute inner L3 header size */
2515 offset |= ((l4.hdr - ip.hdr) / 4) << I40E_TX_DESC_LENGTH_IPLEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002516
2517 /* Enable L4 checksum offloads */
Alexander Duyckb96b78f2016-01-24 21:16:42 -08002518 switch (l4_proto) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002519 case IPPROTO_TCP:
2520 /* enable checksum offloads */
Alexander Duyck475b4202016-01-24 21:17:01 -08002521 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_TCP;
2522 offset |= l4.tcp->doff << I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002523 break;
2524 case IPPROTO_SCTP:
2525 /* enable SCTP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002526 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_SCTP;
2527 offset |= (sizeof(struct sctphdr) >> 2) <<
2528 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002529 break;
2530 case IPPROTO_UDP:
2531 /* enable UDP checksum offload */
Alexander Duyck475b4202016-01-24 21:17:01 -08002532 cmd |= I40E_TX_DESC_CMD_L4T_EOFT_UDP;
2533 offset |= (sizeof(struct udphdr) >> 2) <<
2534 I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002535 break;
2536 default:
Alexander Duyck529f1f62016-01-24 21:17:10 -08002537 if (*tx_flags & I40E_TX_FLAGS_TSO)
2538 return -1;
2539 skb_checksum_help(skb);
2540 return 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002541 }
Alexander Duyck475b4202016-01-24 21:17:01 -08002542
2543 *td_cmd |= cmd;
2544 *td_offset |= offset;
Alexander Duyck529f1f62016-01-24 21:17:10 -08002545
2546 return 1;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002547}
2548
2549/**
2550 * i40e_create_tx_ctx Build the Tx context descriptor
2551 * @tx_ring: ring to create the descriptor on
2552 * @cd_type_cmd_tso_mss: Quad Word 1
2553 * @cd_tunneling: Quad Word 0 - bits 0-31
2554 * @cd_l2tag2: Quad Word 0 - bits 32-63
2555 **/
2556static void i40e_create_tx_ctx(struct i40e_ring *tx_ring,
2557 const u64 cd_type_cmd_tso_mss,
2558 const u32 cd_tunneling, const u32 cd_l2tag2)
2559{
2560 struct i40e_tx_context_desc *context_desc;
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002561 int i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002562
Jesse Brandeburgff40dd52014-02-14 02:14:41 +00002563 if ((cd_type_cmd_tso_mss == I40E_TX_DESC_DTYPE_CONTEXT) &&
2564 !cd_tunneling && !cd_l2tag2)
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002565 return;
2566
2567 /* grab the next descriptor */
Alexander Duyckfc4ac672013-09-28 06:00:22 +00002568 context_desc = I40E_TX_CTXTDESC(tx_ring, i);
2569
2570 i++;
2571 tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002572
2573 /* cpu_to_le32 and assign to struct fields */
2574 context_desc->tunneling_params = cpu_to_le32(cd_tunneling);
2575 context_desc->l2tag2 = cpu_to_le16(cd_l2tag2);
Jesse Brandeburg3efbbb22014-06-04 20:41:54 +00002576 context_desc->rsvd = cpu_to_le16(0);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002577 context_desc->type_cmd_tso_mss = cpu_to_le64(cd_type_cmd_tso_mss);
2578}
2579
2580/**
Eric Dumazet4567dc12014-10-07 13:30:23 -07002581 * __i40e_maybe_stop_tx - 2nd level check for tx stop conditions
2582 * @tx_ring: the ring to be checked
2583 * @size: the size buffer we want to assure is available
2584 *
2585 * Returns -EBUSY if a stop is needed, else 0
2586 **/
2587static inline int __i40e_maybe_stop_tx(struct i40e_ring *tx_ring, int size)
2588{
2589 netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
2590 /* Memory barrier before checking head and tail */
2591 smp_mb();
2592
2593 /* Check again in a case another CPU has just made room available. */
2594 if (likely(I40E_DESC_UNUSED(tx_ring) < size))
2595 return -EBUSY;
2596
2597 /* A reprieve! - use start_queue because it doesn't call schedule */
2598 netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
2599 ++tx_ring->tx_stats.restart_queue;
2600 return 0;
2601}
2602
2603/**
2604 * i40e_maybe_stop_tx - 1st level check for tx stop conditions
2605 * @tx_ring: the ring to be checked
2606 * @size: the size buffer we want to assure is available
2607 *
2608 * Returns 0 if stop is not needed
2609 **/
2610#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002611inline int i40e_maybe_stop_tx(struct i40e_ring *tx_ring, int size)
Eric Dumazet4567dc12014-10-07 13:30:23 -07002612#else
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002613static inline int i40e_maybe_stop_tx(struct i40e_ring *tx_ring, int size)
Eric Dumazet4567dc12014-10-07 13:30:23 -07002614#endif
2615{
2616 if (likely(I40E_DESC_UNUSED(tx_ring) >= size))
2617 return 0;
2618 return __i40e_maybe_stop_tx(tx_ring, size);
2619}
2620
2621/**
Anjali Singhai71da6192015-02-21 06:42:35 +00002622 * i40e_chk_linearize - Check if there are more than 8 fragments per packet
2623 * @skb: send buffer
2624 * @tx_flags: collected send information
Anjali Singhai71da6192015-02-21 06:42:35 +00002625 *
2626 * Note: Our HW can't scatter-gather more than 8 fragments to build
2627 * a packet on the wire and so we need to figure out the cases where we
2628 * need to linearize the skb.
2629 **/
Anjali Singhai Jain30520832015-05-08 15:35:52 -07002630static bool i40e_chk_linearize(struct sk_buff *skb, u32 tx_flags)
Anjali Singhai71da6192015-02-21 06:42:35 +00002631{
2632 struct skb_frag_struct *frag;
2633 bool linearize = false;
2634 unsigned int size = 0;
2635 u16 num_frags;
2636 u16 gso_segs;
2637
2638 num_frags = skb_shinfo(skb)->nr_frags;
2639 gso_segs = skb_shinfo(skb)->gso_segs;
2640
2641 if (tx_flags & (I40E_TX_FLAGS_TSO | I40E_TX_FLAGS_FSO)) {
Anjali Singhai Jain30520832015-05-08 15:35:52 -07002642 u16 j = 0;
Anjali Singhai71da6192015-02-21 06:42:35 +00002643
2644 if (num_frags < (I40E_MAX_BUFFER_TXD))
2645 goto linearize_chk_done;
2646 /* try the simple math, if we have too many frags per segment */
2647 if (DIV_ROUND_UP((num_frags + gso_segs), gso_segs) >
2648 I40E_MAX_BUFFER_TXD) {
2649 linearize = true;
2650 goto linearize_chk_done;
2651 }
2652 frag = &skb_shinfo(skb)->frags[0];
Anjali Singhai71da6192015-02-21 06:42:35 +00002653 /* we might still have more fragments per segment */
2654 do {
2655 size += skb_frag_size(frag);
2656 frag++; j++;
Anjali Singhai Jain30520832015-05-08 15:35:52 -07002657 if ((size >= skb_shinfo(skb)->gso_size) &&
2658 (j < I40E_MAX_BUFFER_TXD)) {
2659 size = (size % skb_shinfo(skb)->gso_size);
2660 j = (size) ? 1 : 0;
2661 }
Anjali Singhai71da6192015-02-21 06:42:35 +00002662 if (j == I40E_MAX_BUFFER_TXD) {
Anjali Singhai Jain30520832015-05-08 15:35:52 -07002663 linearize = true;
2664 break;
Anjali Singhai71da6192015-02-21 06:42:35 +00002665 }
2666 num_frags--;
2667 } while (num_frags);
2668 } else {
2669 if (num_frags >= I40E_MAX_BUFFER_TXD)
2670 linearize = true;
2671 }
2672
2673linearize_chk_done:
2674 return linearize;
2675}
2676
2677/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002678 * i40e_tx_map - Build the Tx descriptor
2679 * @tx_ring: ring to send buffer on
2680 * @skb: send buffer
2681 * @first: first buffer info buffer to use
2682 * @tx_flags: collected send information
2683 * @hdr_len: size of the packet header
2684 * @td_cmd: the command field in the descriptor
2685 * @td_offset: offset for checksum or crc
2686 **/
Vasu Dev38e00432014-08-01 13:27:03 -07002687#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002688inline void i40e_tx_map(struct i40e_ring *tx_ring, struct sk_buff *skb,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002689 struct i40e_tx_buffer *first, u32 tx_flags,
2690 const u8 hdr_len, u32 td_cmd, u32 td_offset)
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002691#else
2692static inline void i40e_tx_map(struct i40e_ring *tx_ring, struct sk_buff *skb,
2693 struct i40e_tx_buffer *first, u32 tx_flags,
2694 const u8 hdr_len, u32 td_cmd, u32 td_offset)
Vasu Dev38e00432014-08-01 13:27:03 -07002695#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002696{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002697 unsigned int data_len = skb->data_len;
2698 unsigned int size = skb_headlen(skb);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002699 struct skb_frag_struct *frag;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002700 struct i40e_tx_buffer *tx_bi;
2701 struct i40e_tx_desc *tx_desc;
Alexander Duycka5e9c572013-09-28 06:00:27 +00002702 u16 i = tx_ring->next_to_use;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002703 u32 td_tag = 0;
2704 dma_addr_t dma;
2705 u16 gso_segs;
Anjali Singhai58044742015-09-25 18:26:13 -07002706 u16 desc_count = 0;
2707 bool tail_bump = true;
2708 bool do_rs = false;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002709
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002710 if (tx_flags & I40E_TX_FLAGS_HW_VLAN) {
2711 td_cmd |= I40E_TX_DESC_CMD_IL2TAG1;
2712 td_tag = (tx_flags & I40E_TX_FLAGS_VLAN_MASK) >>
2713 I40E_TX_FLAGS_VLAN_SHIFT;
2714 }
2715
Alexander Duycka5e9c572013-09-28 06:00:27 +00002716 if (tx_flags & (I40E_TX_FLAGS_TSO | I40E_TX_FLAGS_FSO))
2717 gso_segs = skb_shinfo(skb)->gso_segs;
2718 else
2719 gso_segs = 1;
2720
2721 /* multiply data chunks by size of headers */
2722 first->bytecount = skb->len - hdr_len + (gso_segs * hdr_len);
2723 first->gso_segs = gso_segs;
2724 first->skb = skb;
2725 first->tx_flags = tx_flags;
2726
2727 dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
2728
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002729 tx_desc = I40E_TX_DESC(tx_ring, i);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002730 tx_bi = first;
2731
2732 for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
2733 if (dma_mapping_error(tx_ring->dev, dma))
2734 goto dma_error;
2735
2736 /* record length, and DMA address */
2737 dma_unmap_len_set(tx_bi, len, size);
2738 dma_unmap_addr_set(tx_bi, dma, dma);
2739
2740 tx_desc->buffer_addr = cpu_to_le64(dma);
2741
2742 while (unlikely(size > I40E_MAX_DATA_PER_TXD)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002743 tx_desc->cmd_type_offset_bsz =
2744 build_ctob(td_cmd, td_offset,
2745 I40E_MAX_DATA_PER_TXD, td_tag);
2746
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002747 tx_desc++;
2748 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07002749 desc_count++;
2750
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002751 if (i == tx_ring->count) {
2752 tx_desc = I40E_TX_DESC(tx_ring, 0);
2753 i = 0;
2754 }
Alexander Duycka5e9c572013-09-28 06:00:27 +00002755
2756 dma += I40E_MAX_DATA_PER_TXD;
2757 size -= I40E_MAX_DATA_PER_TXD;
2758
2759 tx_desc->buffer_addr = cpu_to_le64(dma);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002760 }
2761
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002762 if (likely(!data_len))
2763 break;
2764
Alexander Duycka5e9c572013-09-28 06:00:27 +00002765 tx_desc->cmd_type_offset_bsz = build_ctob(td_cmd, td_offset,
2766 size, td_tag);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002767
2768 tx_desc++;
2769 i++;
Anjali Singhai58044742015-09-25 18:26:13 -07002770 desc_count++;
2771
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002772 if (i == tx_ring->count) {
2773 tx_desc = I40E_TX_DESC(tx_ring, 0);
2774 i = 0;
2775 }
2776
Alexander Duycka5e9c572013-09-28 06:00:27 +00002777 size = skb_frag_size(frag);
2778 data_len -= size;
2779
2780 dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
2781 DMA_TO_DEVICE);
2782
2783 tx_bi = &tx_ring->tx_bi[i];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002784 }
2785
Alexander Duycka5e9c572013-09-28 06:00:27 +00002786 /* set next_to_watch value indicating a packet is present */
2787 first->next_to_watch = tx_desc;
2788
2789 i++;
2790 if (i == tx_ring->count)
2791 i = 0;
2792
2793 tx_ring->next_to_use = i;
2794
Anjali Singhai58044742015-09-25 18:26:13 -07002795 netdev_tx_sent_queue(netdev_get_tx_queue(tx_ring->netdev,
2796 tx_ring->queue_index),
2797 first->bytecount);
Eric Dumazet4567dc12014-10-07 13:30:23 -07002798 i40e_maybe_stop_tx(tx_ring, DESC_NEEDED);
Anjali Singhai58044742015-09-25 18:26:13 -07002799
2800 /* Algorithm to optimize tail and RS bit setting:
2801 * if xmit_more is supported
2802 * if xmit_more is true
2803 * do not update tail and do not mark RS bit.
2804 * if xmit_more is false and last xmit_more was false
2805 * if every packet spanned less than 4 desc
2806 * then set RS bit on 4th packet and update tail
2807 * on every packet
2808 * else
2809 * update tail and set RS bit on every packet.
2810 * if xmit_more is false and last_xmit_more was true
2811 * update tail and set RS bit.
2812 *
2813 * Optimization: wmb to be issued only in case of tail update.
2814 * Also optimize the Descriptor WB path for RS bit with the same
2815 * algorithm.
2816 *
2817 * Note: If there are less than 4 packets
2818 * pending and interrupts were disabled the service task will
2819 * trigger a force WB.
2820 */
2821 if (skb->xmit_more &&
2822 !netif_xmit_stopped(netdev_get_tx_queue(tx_ring->netdev,
2823 tx_ring->queue_index))) {
2824 tx_ring->flags |= I40E_TXR_FLAGS_LAST_XMIT_MORE_SET;
2825 tail_bump = false;
2826 } else if (!skb->xmit_more &&
2827 !netif_xmit_stopped(netdev_get_tx_queue(tx_ring->netdev,
2828 tx_ring->queue_index)) &&
2829 (!(tx_ring->flags & I40E_TXR_FLAGS_LAST_XMIT_MORE_SET)) &&
2830 (tx_ring->packet_stride < WB_STRIDE) &&
2831 (desc_count < WB_STRIDE)) {
2832 tx_ring->packet_stride++;
2833 } else {
2834 tx_ring->packet_stride = 0;
2835 tx_ring->flags &= ~I40E_TXR_FLAGS_LAST_XMIT_MORE_SET;
2836 do_rs = true;
2837 }
2838 if (do_rs)
2839 tx_ring->packet_stride = 0;
2840
2841 tx_desc->cmd_type_offset_bsz =
2842 build_ctob(td_cmd, td_offset, size, td_tag) |
2843 cpu_to_le64((u64)(do_rs ? I40E_TXD_CMD :
2844 I40E_TX_DESC_CMD_EOP) <<
2845 I40E_TXD_QW1_CMD_SHIFT);
2846
Alexander Duycka5e9c572013-09-28 06:00:27 +00002847 /* notify HW of packet */
Anjali Singhai58044742015-09-25 18:26:13 -07002848 if (!tail_bump)
Jesse Brandeburg489ce7a2015-04-27 14:57:08 -04002849 prefetchw(tx_desc + 1);
Alexander Duycka5e9c572013-09-28 06:00:27 +00002850
Anjali Singhai58044742015-09-25 18:26:13 -07002851 if (tail_bump) {
2852 /* Force memory writes to complete before letting h/w
2853 * know there are new descriptors to fetch. (Only
2854 * applicable for weak-ordered memory model archs,
2855 * such as IA-64).
2856 */
2857 wmb();
2858 writel(i, tx_ring->tail);
2859 }
2860
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002861 return;
2862
2863dma_error:
Alexander Duycka5e9c572013-09-28 06:00:27 +00002864 dev_info(tx_ring->dev, "TX DMA map failed\n");
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002865
2866 /* clear dma mappings for failed tx_bi map */
2867 for (;;) {
2868 tx_bi = &tx_ring->tx_bi[i];
Alexander Duycka5e9c572013-09-28 06:00:27 +00002869 i40e_unmap_and_free_tx_resource(tx_ring, tx_bi);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002870 if (tx_bi == first)
2871 break;
2872 if (i == 0)
2873 i = tx_ring->count;
2874 i--;
2875 }
2876
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002877 tx_ring->next_to_use = i;
2878}
2879
2880/**
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002881 * i40e_xmit_descriptor_count - calculate number of tx descriptors needed
2882 * @skb: send buffer
2883 * @tx_ring: ring to send buffer on
2884 *
2885 * Returns number of data descriptors needed for this skb. Returns 0 to indicate
2886 * there is not enough descriptors available in this ring since we need at least
2887 * one descriptor.
2888 **/
Vasu Dev38e00432014-08-01 13:27:03 -07002889#ifdef I40E_FCOE
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002890inline int i40e_xmit_descriptor_count(struct sk_buff *skb,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002891 struct i40e_ring *tx_ring)
Jesse Brandeburg3e587cf2015-04-16 20:06:10 -04002892#else
2893static inline int i40e_xmit_descriptor_count(struct sk_buff *skb,
2894 struct i40e_ring *tx_ring)
Vasu Dev38e00432014-08-01 13:27:03 -07002895#endif
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002896{
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002897 unsigned int f;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002898 int count = 0;
2899
2900 /* need: 1 descriptor per page * PAGE_SIZE/I40E_MAX_DATA_PER_TXD,
2901 * + 1 desc for skb_head_len/I40E_MAX_DATA_PER_TXD,
Jesse Brandeburgbe560522014-02-06 05:51:13 +00002902 * + 4 desc gap to avoid the cache line where head is,
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002903 * + 1 desc for context descriptor,
2904 * otherwise try next time
2905 */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002906 for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
2907 count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
Jesse Brandeburg980093e2014-05-10 04:49:12 +00002908
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002909 count += TXD_USE_COUNT(skb_headlen(skb));
Jesse Brandeburgbe560522014-02-06 05:51:13 +00002910 if (i40e_maybe_stop_tx(tx_ring, count + 4 + 1)) {
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002911 tx_ring->tx_stats.tx_busy++;
2912 return 0;
2913 }
2914 return count;
2915}
2916
2917/**
2918 * i40e_xmit_frame_ring - Sends buffer on Tx ring
2919 * @skb: send buffer
2920 * @tx_ring: ring to send buffer on
2921 *
2922 * Returns NETDEV_TX_OK if sent, else an error code
2923 **/
2924static netdev_tx_t i40e_xmit_frame_ring(struct sk_buff *skb,
2925 struct i40e_ring *tx_ring)
2926{
2927 u64 cd_type_cmd_tso_mss = I40E_TX_DESC_DTYPE_CONTEXT;
2928 u32 cd_tunneling = 0, cd_l2tag2 = 0;
2929 struct i40e_tx_buffer *first;
2930 u32 td_offset = 0;
2931 u32 tx_flags = 0;
2932 __be16 protocol;
2933 u32 td_cmd = 0;
2934 u8 hdr_len = 0;
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002935 int tsyn;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002936 int tso;
Jesse Brandeburg6995b362015-08-28 17:55:54 -04002937
Jesse Brandeburgb74118f2015-10-26 19:44:30 -04002938 /* prefetch the data, we'll need it later */
2939 prefetch(skb->data);
2940
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002941 if (0 == i40e_xmit_descriptor_count(skb, tx_ring))
2942 return NETDEV_TX_BUSY;
2943
2944 /* prepare the xmit flags */
2945 if (i40e_tx_prepare_vlan_flags(skb, tx_ring, &tx_flags))
2946 goto out_drop;
2947
2948 /* obtain protocol of skb */
Vlad Yasevich3d34dd02014-08-25 10:34:52 -04002949 protocol = vlan_get_protocol(skb);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002950
2951 /* record the location of the first descriptor for this packet */
2952 first = &tx_ring->tx_bi[tx_ring->next_to_use];
2953
2954 /* setup IPv4/IPv6 offloads */
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002955 if (protocol == htons(ETH_P_IP))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002956 tx_flags |= I40E_TX_FLAGS_IPV4;
Jesse Brandeburg0e2fe46c2013-11-28 06:39:29 +00002957 else if (protocol == htons(ETH_P_IPV6))
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002958 tx_flags |= I40E_TX_FLAGS_IPV6;
2959
Shannon Nelson9c883bd2015-10-21 19:47:02 -04002960 tso = i40e_tso(tx_ring, skb, &hdr_len, &cd_type_cmd_tso_mss);
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002961
2962 if (tso < 0)
2963 goto out_drop;
2964 else if (tso)
2965 tx_flags |= I40E_TX_FLAGS_TSO;
2966
Jacob Kellerbeb0dff2014-01-11 05:43:19 +00002967 tsyn = i40e_tsyn(tx_ring, skb, tx_flags, &cd_type_cmd_tso_mss);
2968
2969 if (tsyn)
2970 tx_flags |= I40E_TX_FLAGS_TSYN;
2971
Anjali Singhai Jain2fc3d712015-08-27 11:42:29 -04002972 if (i40e_chk_linearize(skb, tx_flags)) {
Anjali Singhai71da6192015-02-21 06:42:35 +00002973 if (skb_linearize(skb))
2974 goto out_drop;
Anjali Singhai Jain2fc3d712015-08-27 11:42:29 -04002975 tx_ring->tx_stats.tx_linearize++;
2976 }
Jakub Kicinski259afec2014-03-15 14:55:37 +00002977 skb_tx_timestamp(skb);
2978
Alexander Duyckb1941302013-09-28 06:00:32 +00002979 /* always enable CRC insertion offload */
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002980 td_cmd |= I40E_TX_DESC_CMD_ICRC;
2981
Alexander Duyckb1941302013-09-28 06:00:32 +00002982 /* Always offload the checksum, since it's in the data descriptor */
Alexander Duyck529f1f62016-01-24 21:17:10 -08002983 tso = i40e_tx_enable_csum(skb, &tx_flags, &td_cmd, &td_offset,
2984 tx_ring, &cd_tunneling);
2985 if (tso < 0)
2986 goto out_drop;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00002987
2988 i40e_create_tx_ctx(tx_ring, cd_type_cmd_tso_mss,
2989 cd_tunneling, cd_l2tag2);
2990
2991 /* Add Flow Director ATR if it's enabled.
2992 *
2993 * NOTE: this must always be directly before the data descriptor.
2994 */
2995 i40e_atr(tx_ring, skb, tx_flags, protocol);
2996
2997 i40e_tx_map(tx_ring, skb, first, tx_flags, hdr_len,
2998 td_cmd, td_offset);
2999
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003000 return NETDEV_TX_OK;
3001
3002out_drop:
3003 dev_kfree_skb_any(skb);
3004 return NETDEV_TX_OK;
3005}
3006
3007/**
3008 * i40e_lan_xmit_frame - Selects the correct VSI and Tx queue to send buffer
3009 * @skb: send buffer
3010 * @netdev: network interface device structure
3011 *
3012 * Returns NETDEV_TX_OK if sent, else an error code
3013 **/
3014netdev_tx_t i40e_lan_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
3015{
3016 struct i40e_netdev_priv *np = netdev_priv(netdev);
3017 struct i40e_vsi *vsi = np->vsi;
Alexander Duyck9f65e152013-09-28 06:00:58 +00003018 struct i40e_ring *tx_ring = vsi->tx_rings[skb->queue_mapping];
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003019
3020 /* hardware can't handle really short frames, hardware padding works
3021 * beyond this point
3022 */
Alexander Duycka94d9e22014-12-03 08:17:39 -08003023 if (skb_put_padto(skb, I40E_MIN_TX_LEN))
3024 return NETDEV_TX_OK;
Jesse Brandeburgfd0a05c2013-09-11 08:39:51 +00003025
3026 return i40e_xmit_frame_ring(skb, tx_ring);
3027}