xref: /linux/drivers/net/ethernet/intel/ixgbe/ixgbe_fcoe.c (revision 3932b9ca55b0be314a36d3e84faff3e823c081f5)
1 /*******************************************************************************
2 
3   Intel 10 Gigabit PCI Express Linux driver
4   Copyright(c) 1999 - 2014 Intel Corporation.
5 
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 
15   You should have received a copy of the GNU General Public License along with
16   this program; if not, write to the Free Software Foundation, Inc.,
17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18 
19   The full GNU General Public License is included in this distribution in
20   the file called "COPYING".
21 
22   Contact Information:
23   Linux NICS <linux.nics@intel.com>
24   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
25   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
26 
27 *******************************************************************************/
28 
29 #include "ixgbe.h"
30 #include <linux/if_ether.h>
31 #include <linux/gfp.h>
32 #include <linux/if_vlan.h>
33 #include <scsi/scsi_cmnd.h>
34 #include <scsi/scsi_device.h>
35 #include <scsi/fc/fc_fs.h>
36 #include <scsi/fc/fc_fcoe.h>
37 #include <scsi/libfc.h>
38 #include <scsi/libfcoe.h>
39 
40 /**
41  * ixgbe_fcoe_clear_ddp - clear the given ddp context
42  * @ddp: ptr to the ixgbe_fcoe_ddp
43  *
44  * Returns : none
45  *
46  */
47 static inline void ixgbe_fcoe_clear_ddp(struct ixgbe_fcoe_ddp *ddp)
48 {
49 	ddp->len = 0;
50 	ddp->err = 1;
51 	ddp->udl = NULL;
52 	ddp->udp = 0UL;
53 	ddp->sgl = NULL;
54 	ddp->sgc = 0;
55 }
56 
57 /**
58  * ixgbe_fcoe_ddp_put - free the ddp context for a given xid
59  * @netdev: the corresponding net_device
60  * @xid: the xid that corresponding ddp will be freed
61  *
62  * This is the implementation of net_device_ops.ndo_fcoe_ddp_done
63  * and it is expected to be called by ULD, i.e., FCP layer of libfc
64  * to release the corresponding ddp context when the I/O is done.
65  *
66  * Returns : data length already ddp-ed in bytes
67  */
68 int ixgbe_fcoe_ddp_put(struct net_device *netdev, u16 xid)
69 {
70 	int len;
71 	struct ixgbe_fcoe *fcoe;
72 	struct ixgbe_adapter *adapter;
73 	struct ixgbe_fcoe_ddp *ddp;
74 	u32 fcbuff;
75 
76 	if (!netdev)
77 		return 0;
78 
79 	if (xid >= IXGBE_FCOE_DDP_MAX)
80 		return 0;
81 
82 	adapter = netdev_priv(netdev);
83 	fcoe = &adapter->fcoe;
84 	ddp = &fcoe->ddp[xid];
85 	if (!ddp->udl)
86 		return 0;
87 
88 	len = ddp->len;
89 	/* if there an error, force to invalidate ddp context */
90 	if (ddp->err) {
91 		spin_lock_bh(&fcoe->lock);
92 		IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCFLT, 0);
93 		IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCFLTRW,
94 				(xid | IXGBE_FCFLTRW_WE));
95 		IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCBUFF, 0);
96 		IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCDMARW,
97 				(xid | IXGBE_FCDMARW_WE));
98 
99 		/* guaranteed to be invalidated after 100us */
100 		IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCDMARW,
101 				(xid | IXGBE_FCDMARW_RE));
102 		fcbuff = IXGBE_READ_REG(&adapter->hw, IXGBE_FCBUFF);
103 		spin_unlock_bh(&fcoe->lock);
104 		if (fcbuff & IXGBE_FCBUFF_VALID)
105 			udelay(100);
106 	}
107 	if (ddp->sgl)
108 		dma_unmap_sg(&adapter->pdev->dev, ddp->sgl, ddp->sgc,
109 			     DMA_FROM_DEVICE);
110 	if (ddp->pool) {
111 		dma_pool_free(ddp->pool, ddp->udl, ddp->udp);
112 		ddp->pool = NULL;
113 	}
114 
115 	ixgbe_fcoe_clear_ddp(ddp);
116 
117 	return len;
118 }
119 
120 /**
121  * ixgbe_fcoe_ddp_setup - called to set up ddp context
122  * @netdev: the corresponding net_device
123  * @xid: the exchange id requesting ddp
124  * @sgl: the scatter-gather list for this request
125  * @sgc: the number of scatter-gather items
126  *
127  * Returns : 1 for success and 0 for no ddp
128  */
129 static int ixgbe_fcoe_ddp_setup(struct net_device *netdev, u16 xid,
130 				struct scatterlist *sgl, unsigned int sgc,
131 				int target_mode)
132 {
133 	struct ixgbe_adapter *adapter;
134 	struct ixgbe_hw *hw;
135 	struct ixgbe_fcoe *fcoe;
136 	struct ixgbe_fcoe_ddp *ddp;
137 	struct ixgbe_fcoe_ddp_pool *ddp_pool;
138 	struct scatterlist *sg;
139 	unsigned int i, j, dmacount;
140 	unsigned int len;
141 	static const unsigned int bufflen = IXGBE_FCBUFF_MIN;
142 	unsigned int firstoff = 0;
143 	unsigned int lastsize;
144 	unsigned int thisoff = 0;
145 	unsigned int thislen = 0;
146 	u32 fcbuff, fcdmarw, fcfltrw, fcrxctl;
147 	dma_addr_t addr = 0;
148 
149 	if (!netdev || !sgl)
150 		return 0;
151 
152 	adapter = netdev_priv(netdev);
153 	if (xid >= IXGBE_FCOE_DDP_MAX) {
154 		e_warn(drv, "xid=0x%x out-of-range\n", xid);
155 		return 0;
156 	}
157 
158 	/* no DDP if we are already down or resetting */
159 	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
160 	    test_bit(__IXGBE_RESETTING, &adapter->state))
161 		return 0;
162 
163 	fcoe = &adapter->fcoe;
164 	ddp = &fcoe->ddp[xid];
165 	if (ddp->sgl) {
166 		e_err(drv, "xid 0x%x w/ non-null sgl=%p nents=%d\n",
167 		      xid, ddp->sgl, ddp->sgc);
168 		return 0;
169 	}
170 	ixgbe_fcoe_clear_ddp(ddp);
171 
172 
173 	if (!fcoe->ddp_pool) {
174 		e_warn(drv, "No ddp_pool resources allocated\n");
175 		return 0;
176 	}
177 
178 	ddp_pool = per_cpu_ptr(fcoe->ddp_pool, get_cpu());
179 	if (!ddp_pool->pool) {
180 		e_warn(drv, "xid=0x%x no ddp pool for fcoe\n", xid);
181 		goto out_noddp;
182 	}
183 
184 	/* setup dma from scsi command sgl */
185 	dmacount = dma_map_sg(&adapter->pdev->dev, sgl, sgc, DMA_FROM_DEVICE);
186 	if (dmacount == 0) {
187 		e_err(drv, "xid 0x%x DMA map error\n", xid);
188 		goto out_noddp;
189 	}
190 
191 	/* alloc the udl from per cpu ddp pool */
192 	ddp->udl = dma_pool_alloc(ddp_pool->pool, GFP_ATOMIC, &ddp->udp);
193 	if (!ddp->udl) {
194 		e_err(drv, "failed allocated ddp context\n");
195 		goto out_noddp_unmap;
196 	}
197 	ddp->pool = ddp_pool->pool;
198 	ddp->sgl = sgl;
199 	ddp->sgc = sgc;
200 
201 	j = 0;
202 	for_each_sg(sgl, sg, dmacount, i) {
203 		addr = sg_dma_address(sg);
204 		len = sg_dma_len(sg);
205 		while (len) {
206 			/* max number of buffers allowed in one DDP context */
207 			if (j >= IXGBE_BUFFCNT_MAX) {
208 				ddp_pool->noddp++;
209 				goto out_noddp_free;
210 			}
211 
212 			/* get the offset of length of current buffer */
213 			thisoff = addr & ((dma_addr_t)bufflen - 1);
214 			thislen = min((bufflen - thisoff), len);
215 			/*
216 			 * all but the 1st buffer (j == 0)
217 			 * must be aligned on bufflen
218 			 */
219 			if ((j != 0) && (thisoff))
220 				goto out_noddp_free;
221 			/*
222 			 * all but the last buffer
223 			 * ((i == (dmacount - 1)) && (thislen == len))
224 			 * must end at bufflen
225 			 */
226 			if (((i != (dmacount - 1)) || (thislen != len))
227 			    && ((thislen + thisoff) != bufflen))
228 				goto out_noddp_free;
229 
230 			ddp->udl[j] = (u64)(addr - thisoff);
231 			/* only the first buffer may have none-zero offset */
232 			if (j == 0)
233 				firstoff = thisoff;
234 			len -= thislen;
235 			addr += thislen;
236 			j++;
237 		}
238 	}
239 	/* only the last buffer may have non-full bufflen */
240 	lastsize = thisoff + thislen;
241 
242 	/*
243 	 * lastsize can not be buffer len.
244 	 * If it is then adding another buffer with lastsize = 1.
245 	 */
246 	if (lastsize == bufflen) {
247 		if (j >= IXGBE_BUFFCNT_MAX) {
248 			ddp_pool->noddp_ext_buff++;
249 			goto out_noddp_free;
250 		}
251 
252 		ddp->udl[j] = (u64)(fcoe->extra_ddp_buffer_dma);
253 		j++;
254 		lastsize = 1;
255 	}
256 	put_cpu();
257 
258 	fcbuff = (IXGBE_FCBUFF_4KB << IXGBE_FCBUFF_BUFFSIZE_SHIFT);
259 	fcbuff |= ((j & 0xff) << IXGBE_FCBUFF_BUFFCNT_SHIFT);
260 	fcbuff |= (firstoff << IXGBE_FCBUFF_OFFSET_SHIFT);
261 	/* Set WRCONTX bit to allow DDP for target */
262 	if (target_mode)
263 		fcbuff |= (IXGBE_FCBUFF_WRCONTX);
264 	fcbuff |= (IXGBE_FCBUFF_VALID);
265 
266 	fcdmarw = xid;
267 	fcdmarw |= IXGBE_FCDMARW_WE;
268 	fcdmarw |= (lastsize << IXGBE_FCDMARW_LASTSIZE_SHIFT);
269 
270 	fcfltrw = xid;
271 	fcfltrw |= IXGBE_FCFLTRW_WE;
272 
273 	/* program DMA context */
274 	hw = &adapter->hw;
275 	spin_lock_bh(&fcoe->lock);
276 
277 	/* turn on last frame indication for target mode as FCP_RSPtarget is
278 	 * supposed to send FCP_RSP when it is done. */
279 	if (target_mode && !test_bit(__IXGBE_FCOE_TARGET, &fcoe->mode)) {
280 		set_bit(__IXGBE_FCOE_TARGET, &fcoe->mode);
281 		fcrxctl = IXGBE_READ_REG(hw, IXGBE_FCRXCTRL);
282 		fcrxctl |= IXGBE_FCRXCTRL_LASTSEQH;
283 		IXGBE_WRITE_REG(hw, IXGBE_FCRXCTRL, fcrxctl);
284 	}
285 
286 	IXGBE_WRITE_REG(hw, IXGBE_FCPTRL, ddp->udp & DMA_BIT_MASK(32));
287 	IXGBE_WRITE_REG(hw, IXGBE_FCPTRH, (u64)ddp->udp >> 32);
288 	IXGBE_WRITE_REG(hw, IXGBE_FCBUFF, fcbuff);
289 	IXGBE_WRITE_REG(hw, IXGBE_FCDMARW, fcdmarw);
290 	/* program filter context */
291 	IXGBE_WRITE_REG(hw, IXGBE_FCPARAM, 0);
292 	IXGBE_WRITE_REG(hw, IXGBE_FCFLT, IXGBE_FCFLT_VALID);
293 	IXGBE_WRITE_REG(hw, IXGBE_FCFLTRW, fcfltrw);
294 
295 	spin_unlock_bh(&fcoe->lock);
296 
297 	return 1;
298 
299 out_noddp_free:
300 	dma_pool_free(ddp->pool, ddp->udl, ddp->udp);
301 	ixgbe_fcoe_clear_ddp(ddp);
302 
303 out_noddp_unmap:
304 	dma_unmap_sg(&adapter->pdev->dev, sgl, sgc, DMA_FROM_DEVICE);
305 out_noddp:
306 	put_cpu();
307 	return 0;
308 }
309 
310 /**
311  * ixgbe_fcoe_ddp_get - called to set up ddp context in initiator mode
312  * @netdev: the corresponding net_device
313  * @xid: the exchange id requesting ddp
314  * @sgl: the scatter-gather list for this request
315  * @sgc: the number of scatter-gather items
316  *
317  * This is the implementation of net_device_ops.ndo_fcoe_ddp_setup
318  * and is expected to be called from ULD, e.g., FCP layer of libfc
319  * to set up ddp for the corresponding xid of the given sglist for
320  * the corresponding I/O.
321  *
322  * Returns : 1 for success and 0 for no ddp
323  */
324 int ixgbe_fcoe_ddp_get(struct net_device *netdev, u16 xid,
325 		       struct scatterlist *sgl, unsigned int sgc)
326 {
327 	return ixgbe_fcoe_ddp_setup(netdev, xid, sgl, sgc, 0);
328 }
329 
330 /**
331  * ixgbe_fcoe_ddp_target - called to set up ddp context in target mode
332  * @netdev: the corresponding net_device
333  * @xid: the exchange id requesting ddp
334  * @sgl: the scatter-gather list for this request
335  * @sgc: the number of scatter-gather items
336  *
337  * This is the implementation of net_device_ops.ndo_fcoe_ddp_target
338  * and is expected to be called from ULD, e.g., FCP layer of libfc
339  * to set up ddp for the corresponding xid of the given sglist for
340  * the corresponding I/O. The DDP in target mode is a write I/O request
341  * from the initiator.
342  *
343  * Returns : 1 for success and 0 for no ddp
344  */
345 int ixgbe_fcoe_ddp_target(struct net_device *netdev, u16 xid,
346 			    struct scatterlist *sgl, unsigned int sgc)
347 {
348 	return ixgbe_fcoe_ddp_setup(netdev, xid, sgl, sgc, 1);
349 }
350 
351 /**
352  * ixgbe_fcoe_ddp - check ddp status and mark it done
353  * @adapter: ixgbe adapter
354  * @rx_desc: advanced rx descriptor
355  * @skb: the skb holding the received data
356  *
357  * This checks ddp status.
358  *
359  * Returns : < 0 indicates an error or not a FCiE ddp, 0 indicates
360  * not passing the skb to ULD, > 0 indicates is the length of data
361  * being ddped.
362  */
363 int ixgbe_fcoe_ddp(struct ixgbe_adapter *adapter,
364 		   union ixgbe_adv_rx_desc *rx_desc,
365 		   struct sk_buff *skb)
366 {
367 	int rc = -EINVAL;
368 	struct ixgbe_fcoe *fcoe;
369 	struct ixgbe_fcoe_ddp *ddp;
370 	struct fc_frame_header *fh;
371 	struct fcoe_crc_eof *crc;
372 	__le32 fcerr = ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_FCERR);
373 	__le32 ddp_err;
374 	u32 fctl;
375 	u16 xid;
376 
377 	if (fcerr == cpu_to_le32(IXGBE_FCERR_BADCRC))
378 		skb->ip_summed = CHECKSUM_NONE;
379 	else
380 		skb->ip_summed = CHECKSUM_UNNECESSARY;
381 
382 	if (eth_hdr(skb)->h_proto == htons(ETH_P_8021Q))
383 		fh = (struct fc_frame_header *)(skb->data +
384 			sizeof(struct vlan_hdr) + sizeof(struct fcoe_hdr));
385 	else
386 		fh = (struct fc_frame_header *)(skb->data +
387 			sizeof(struct fcoe_hdr));
388 
389 	fctl = ntoh24(fh->fh_f_ctl);
390 	if (fctl & FC_FC_EX_CTX)
391 		xid =  be16_to_cpu(fh->fh_ox_id);
392 	else
393 		xid =  be16_to_cpu(fh->fh_rx_id);
394 
395 	if (xid >= IXGBE_FCOE_DDP_MAX)
396 		return -EINVAL;
397 
398 	fcoe = &adapter->fcoe;
399 	ddp = &fcoe->ddp[xid];
400 	if (!ddp->udl)
401 		return -EINVAL;
402 
403 	ddp_err = ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_FCEOFE |
404 					      IXGBE_RXDADV_ERR_FCERR);
405 	if (ddp_err)
406 		return -EINVAL;
407 
408 	switch (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_STAT_FCSTAT)) {
409 	/* return 0 to bypass going to ULD for DDPed data */
410 	case cpu_to_le32(IXGBE_RXDADV_STAT_FCSTAT_DDP):
411 		/* update length of DDPed data */
412 		ddp->len = le32_to_cpu(rx_desc->wb.lower.hi_dword.rss);
413 		rc = 0;
414 		break;
415 	/* unmap the sg list when FCPRSP is received */
416 	case cpu_to_le32(IXGBE_RXDADV_STAT_FCSTAT_FCPRSP):
417 		dma_unmap_sg(&adapter->pdev->dev, ddp->sgl,
418 			     ddp->sgc, DMA_FROM_DEVICE);
419 		ddp->err = ddp_err;
420 		ddp->sgl = NULL;
421 		ddp->sgc = 0;
422 		/* fall through */
423 	/* if DDP length is present pass it through to ULD */
424 	case cpu_to_le32(IXGBE_RXDADV_STAT_FCSTAT_NODDP):
425 		/* update length of DDPed data */
426 		ddp->len = le32_to_cpu(rx_desc->wb.lower.hi_dword.rss);
427 		if (ddp->len)
428 			rc = ddp->len;
429 		break;
430 	/* no match will return as an error */
431 	case cpu_to_le32(IXGBE_RXDADV_STAT_FCSTAT_NOMTCH):
432 	default:
433 		break;
434 	}
435 
436 	/* In target mode, check the last data frame of the sequence.
437 	 * For DDP in target mode, data is already DDPed but the header
438 	 * indication of the last data frame ould allow is to tell if we
439 	 * got all the data and the ULP can send FCP_RSP back, as this is
440 	 * not a full fcoe frame, we fill the trailer here so it won't be
441 	 * dropped by the ULP stack.
442 	 */
443 	if ((fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA) &&
444 	    (fctl & FC_FC_END_SEQ)) {
445 		skb_linearize(skb);
446 		crc = (struct fcoe_crc_eof *)skb_put(skb, sizeof(*crc));
447 		crc->fcoe_eof = FC_EOF_T;
448 	}
449 
450 	return rc;
451 }
452 
453 /**
454  * ixgbe_fso - ixgbe FCoE Sequence Offload (FSO)
455  * @tx_ring: tx desc ring
456  * @first: first tx_buffer structure containing skb, tx_flags, and protocol
457  * @hdr_len: hdr_len to be returned
458  *
459  * This sets up large send offload for FCoE
460  *
461  * Returns : 0 indicates success, < 0 for error
462  */
463 int ixgbe_fso(struct ixgbe_ring *tx_ring,
464 	      struct ixgbe_tx_buffer *first,
465 	      u8 *hdr_len)
466 {
467 	struct sk_buff *skb = first->skb;
468 	struct fc_frame_header *fh;
469 	u32 vlan_macip_lens;
470 	u32 fcoe_sof_eof = 0;
471 	u32 mss_l4len_idx;
472 	u8 sof, eof;
473 
474 	if (skb_is_gso(skb) && (skb_shinfo(skb)->gso_type != SKB_GSO_FCOE)) {
475 		dev_err(tx_ring->dev, "Wrong gso type %d:expecting SKB_GSO_FCOE\n",
476 			skb_shinfo(skb)->gso_type);
477 		return -EINVAL;
478 	}
479 
480 	/* resets the header to point fcoe/fc */
481 	skb_set_network_header(skb, skb->mac_len);
482 	skb_set_transport_header(skb, skb->mac_len +
483 				 sizeof(struct fcoe_hdr));
484 
485 	/* sets up SOF and ORIS */
486 	sof = ((struct fcoe_hdr *)skb_network_header(skb))->fcoe_sof;
487 	switch (sof) {
488 	case FC_SOF_I2:
489 		fcoe_sof_eof = IXGBE_ADVTXD_FCOEF_ORIS;
490 		break;
491 	case FC_SOF_I3:
492 		fcoe_sof_eof = IXGBE_ADVTXD_FCOEF_SOF |
493 			       IXGBE_ADVTXD_FCOEF_ORIS;
494 		break;
495 	case FC_SOF_N2:
496 		break;
497 	case FC_SOF_N3:
498 		fcoe_sof_eof = IXGBE_ADVTXD_FCOEF_SOF;
499 		break;
500 	default:
501 		dev_warn(tx_ring->dev, "unknown sof = 0x%x\n", sof);
502 		return -EINVAL;
503 	}
504 
505 	/* the first byte of the last dword is EOF */
506 	skb_copy_bits(skb, skb->len - 4, &eof, 1);
507 	/* sets up EOF and ORIE */
508 	switch (eof) {
509 	case FC_EOF_N:
510 		fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_EOF_N;
511 		break;
512 	case FC_EOF_T:
513 		/* lso needs ORIE */
514 		if (skb_is_gso(skb))
515 			fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_EOF_N |
516 					IXGBE_ADVTXD_FCOEF_ORIE;
517 		else
518 			fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_EOF_T;
519 		break;
520 	case FC_EOF_NI:
521 		fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_EOF_NI;
522 		break;
523 	case FC_EOF_A:
524 		fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_EOF_A;
525 		break;
526 	default:
527 		dev_warn(tx_ring->dev, "unknown eof = 0x%x\n", eof);
528 		return -EINVAL;
529 	}
530 
531 	/* sets up PARINC indicating data offset */
532 	fh = (struct fc_frame_header *)skb_transport_header(skb);
533 	if (fh->fh_f_ctl[2] & FC_FC_REL_OFF)
534 		fcoe_sof_eof |= IXGBE_ADVTXD_FCOEF_PARINC;
535 
536 	/* include trailer in headlen as it is replicated per frame */
537 	*hdr_len = sizeof(struct fcoe_crc_eof);
538 
539 	/* hdr_len includes fc_hdr if FCoE LSO is enabled */
540 	if (skb_is_gso(skb)) {
541 		*hdr_len += skb_transport_offset(skb) +
542 			    sizeof(struct fc_frame_header);
543 		/* update gso_segs and bytecount */
544 		first->gso_segs = DIV_ROUND_UP(skb->len - *hdr_len,
545 					       skb_shinfo(skb)->gso_size);
546 		first->bytecount += (first->gso_segs - 1) * *hdr_len;
547 		first->tx_flags |= IXGBE_TX_FLAGS_TSO;
548 	}
549 
550 	/* set flag indicating FCOE to ixgbe_tx_map call */
551 	first->tx_flags |= IXGBE_TX_FLAGS_FCOE | IXGBE_TX_FLAGS_CC;
552 
553 	/* mss_l4len_id: use 0 for FSO as TSO, no need for L4LEN */
554 	mss_l4len_idx = skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
555 
556 	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
557 	vlan_macip_lens = skb_transport_offset(skb) +
558 			  sizeof(struct fc_frame_header);
559 	vlan_macip_lens |= (skb_transport_offset(skb) - 4)
560 			   << IXGBE_ADVTXD_MACLEN_SHIFT;
561 	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
562 
563 	/* write context desc */
564 	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, fcoe_sof_eof,
565 			  IXGBE_ADVTXT_TUCMD_FCOE, mss_l4len_idx);
566 
567 	return 0;
568 }
569 
570 static void ixgbe_fcoe_dma_pool_free(struct ixgbe_fcoe *fcoe, unsigned int cpu)
571 {
572 	struct ixgbe_fcoe_ddp_pool *ddp_pool;
573 
574 	ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
575 	if (ddp_pool->pool)
576 		dma_pool_destroy(ddp_pool->pool);
577 	ddp_pool->pool = NULL;
578 }
579 
580 static int ixgbe_fcoe_dma_pool_alloc(struct ixgbe_fcoe *fcoe,
581 				     struct device *dev,
582 				     unsigned int cpu)
583 {
584 	struct ixgbe_fcoe_ddp_pool *ddp_pool;
585 	struct dma_pool *pool;
586 	char pool_name[32];
587 
588 	snprintf(pool_name, 32, "ixgbe_fcoe_ddp_%u", cpu);
589 
590 	pool = dma_pool_create(pool_name, dev, IXGBE_FCPTR_MAX,
591 			       IXGBE_FCPTR_ALIGN, PAGE_SIZE);
592 	if (!pool)
593 		return -ENOMEM;
594 
595 	ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
596 	ddp_pool->pool = pool;
597 	ddp_pool->noddp = 0;
598 	ddp_pool->noddp_ext_buff = 0;
599 
600 	return 0;
601 }
602 
603 /**
604  * ixgbe_configure_fcoe - configures registers for fcoe at start
605  * @adapter: ptr to ixgbe adapter
606  *
607  * This sets up FCoE related registers
608  *
609  * Returns : none
610  */
611 void ixgbe_configure_fcoe(struct ixgbe_adapter *adapter)
612 {
613 	struct ixgbe_ring_feature *fcoe = &adapter->ring_feature[RING_F_FCOE];
614 	struct ixgbe_hw *hw = &adapter->hw;
615 	int i, fcoe_q, fcoe_i;
616 	u32 etqf;
617 
618 	/* Minimal functionality for FCoE requires at least CRC offloads */
619 	if (!(adapter->netdev->features & NETIF_F_FCOE_CRC))
620 		return;
621 
622 	/* Enable L2 EtherType filter for FCoE, needed for FCoE CRC and DDP */
623 	etqf = ETH_P_FCOE | IXGBE_ETQF_FCOE | IXGBE_ETQF_FILTER_EN;
624 	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
625 		etqf |= IXGBE_ETQF_POOL_ENABLE;
626 		etqf |= VMDQ_P(0) << IXGBE_ETQF_POOL_SHIFT;
627 	}
628 	IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FCOE), etqf);
629 	IXGBE_WRITE_REG(hw, IXGBE_ETQS(IXGBE_ETQF_FILTER_FCOE), 0);
630 
631 	/* leave registers un-configured if FCoE is disabled */
632 	if (!(adapter->flags & IXGBE_FLAG_FCOE_ENABLED))
633 		return;
634 
635 	/* Use one or more Rx queues for FCoE by redirection table */
636 	for (i = 0; i < IXGBE_FCRETA_SIZE; i++) {
637 		fcoe_i = fcoe->offset + (i % fcoe->indices);
638 		fcoe_i &= IXGBE_FCRETA_ENTRY_MASK;
639 		fcoe_q = adapter->rx_ring[fcoe_i]->reg_idx;
640 		IXGBE_WRITE_REG(hw, IXGBE_FCRETA(i), fcoe_q);
641 	}
642 	IXGBE_WRITE_REG(hw, IXGBE_FCRECTL, IXGBE_FCRECTL_ENA);
643 
644 	/* Enable L2 EtherType filter for FIP */
645 	etqf = ETH_P_FIP | IXGBE_ETQF_FILTER_EN;
646 	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
647 		etqf |= IXGBE_ETQF_POOL_ENABLE;
648 		etqf |= VMDQ_P(0) << IXGBE_ETQF_POOL_SHIFT;
649 	}
650 	IXGBE_WRITE_REG(hw, IXGBE_ETQF(IXGBE_ETQF_FILTER_FIP), etqf);
651 
652 	/* Send FIP frames to the first FCoE queue */
653 	fcoe_q = adapter->rx_ring[fcoe->offset]->reg_idx;
654 	IXGBE_WRITE_REG(hw, IXGBE_ETQS(IXGBE_ETQF_FILTER_FIP),
655 			IXGBE_ETQS_QUEUE_EN |
656 			(fcoe_q << IXGBE_ETQS_RX_QUEUE_SHIFT));
657 
658 	/* Configure FCoE Rx control */
659 	IXGBE_WRITE_REG(hw, IXGBE_FCRXCTRL,
660 			IXGBE_FCRXCTRL_FCCRCBO |
661 			(FC_FCOE_VER << IXGBE_FCRXCTRL_FCOEVER_SHIFT));
662 }
663 
664 /**
665  * ixgbe_free_fcoe_ddp_resources - release all fcoe ddp context resources
666  * @adapter : ixgbe adapter
667  *
668  * Cleans up outstanding ddp context resources
669  *
670  * Returns : none
671  */
672 void ixgbe_free_fcoe_ddp_resources(struct ixgbe_adapter *adapter)
673 {
674 	struct ixgbe_fcoe *fcoe = &adapter->fcoe;
675 	int cpu, i;
676 
677 	/* do nothing if no DDP pools were allocated */
678 	if (!fcoe->ddp_pool)
679 		return;
680 
681 	for (i = 0; i < IXGBE_FCOE_DDP_MAX; i++)
682 		ixgbe_fcoe_ddp_put(adapter->netdev, i);
683 
684 	for_each_possible_cpu(cpu)
685 		ixgbe_fcoe_dma_pool_free(fcoe, cpu);
686 
687 	dma_unmap_single(&adapter->pdev->dev,
688 			 fcoe->extra_ddp_buffer_dma,
689 			 IXGBE_FCBUFF_MIN,
690 			 DMA_FROM_DEVICE);
691 	kfree(fcoe->extra_ddp_buffer);
692 
693 	fcoe->extra_ddp_buffer = NULL;
694 	fcoe->extra_ddp_buffer_dma = 0;
695 }
696 
697 /**
698  * ixgbe_setup_fcoe_ddp_resources - setup all fcoe ddp context resources
699  * @adapter: ixgbe adapter
700  *
701  * Sets up ddp context resouces
702  *
703  * Returns : 0 indicates success or -EINVAL on failure
704  */
705 int ixgbe_setup_fcoe_ddp_resources(struct ixgbe_adapter *adapter)
706 {
707 	struct ixgbe_fcoe *fcoe = &adapter->fcoe;
708 	struct device *dev = &adapter->pdev->dev;
709 	void *buffer;
710 	dma_addr_t dma;
711 	unsigned int cpu;
712 
713 	/* do nothing if no DDP pools were allocated */
714 	if (!fcoe->ddp_pool)
715 		return 0;
716 
717 	/* Extra buffer to be shared by all DDPs for HW work around */
718 	buffer = kmalloc(IXGBE_FCBUFF_MIN, GFP_ATOMIC);
719 	if (!buffer)
720 		return -ENOMEM;
721 
722 	dma = dma_map_single(dev, buffer, IXGBE_FCBUFF_MIN, DMA_FROM_DEVICE);
723 	if (dma_mapping_error(dev, dma)) {
724 		e_err(drv, "failed to map extra DDP buffer\n");
725 		kfree(buffer);
726 		return -ENOMEM;
727 	}
728 
729 	fcoe->extra_ddp_buffer = buffer;
730 	fcoe->extra_ddp_buffer_dma = dma;
731 
732 	/* allocate pci pool for each cpu */
733 	for_each_possible_cpu(cpu) {
734 		int err = ixgbe_fcoe_dma_pool_alloc(fcoe, dev, cpu);
735 		if (!err)
736 			continue;
737 
738 		e_err(drv, "failed to alloc DDP pool on cpu:%d\n", cpu);
739 		ixgbe_free_fcoe_ddp_resources(adapter);
740 		return -ENOMEM;
741 	}
742 
743 	return 0;
744 }
745 
746 static int ixgbe_fcoe_ddp_enable(struct ixgbe_adapter *adapter)
747 {
748 	struct ixgbe_fcoe *fcoe = &adapter->fcoe;
749 
750 	if (!(adapter->flags & IXGBE_FLAG_FCOE_CAPABLE))
751 		return -EINVAL;
752 
753 	fcoe->ddp_pool = alloc_percpu(struct ixgbe_fcoe_ddp_pool);
754 
755 	if (!fcoe->ddp_pool) {
756 		e_err(drv, "failed to allocate percpu DDP resources\n");
757 		return -ENOMEM;
758 	}
759 
760 	adapter->netdev->fcoe_ddp_xid = IXGBE_FCOE_DDP_MAX - 1;
761 
762 	return 0;
763 }
764 
765 static void ixgbe_fcoe_ddp_disable(struct ixgbe_adapter *adapter)
766 {
767 	struct ixgbe_fcoe *fcoe = &adapter->fcoe;
768 
769 	adapter->netdev->fcoe_ddp_xid = 0;
770 
771 	if (!fcoe->ddp_pool)
772 		return;
773 
774 	free_percpu(fcoe->ddp_pool);
775 	fcoe->ddp_pool = NULL;
776 }
777 
778 /**
779  * ixgbe_fcoe_enable - turn on FCoE offload feature
780  * @netdev: the corresponding netdev
781  *
782  * Turns on FCoE offload feature in 82599.
783  *
784  * Returns : 0 indicates success or -EINVAL on failure
785  */
786 int ixgbe_fcoe_enable(struct net_device *netdev)
787 {
788 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
789 	struct ixgbe_fcoe *fcoe = &adapter->fcoe;
790 
791 	atomic_inc(&fcoe->refcnt);
792 
793 	if (!(adapter->flags & IXGBE_FLAG_FCOE_CAPABLE))
794 		return -EINVAL;
795 
796 	if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)
797 		return -EINVAL;
798 
799 	e_info(drv, "Enabling FCoE offload features.\n");
800 
801 	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
802 		e_warn(probe, "Enabling FCoE on PF will disable legacy VFs\n");
803 
804 	if (netif_running(netdev))
805 		netdev->netdev_ops->ndo_stop(netdev);
806 
807 	/* Allocate per CPU memory to track DDP pools */
808 	ixgbe_fcoe_ddp_enable(adapter);
809 
810 	/* enable FCoE and notify stack */
811 	adapter->flags |= IXGBE_FLAG_FCOE_ENABLED;
812 	netdev->features |= NETIF_F_FCOE_MTU;
813 	netdev_features_change(netdev);
814 
815 	/* release existing queues and reallocate them */
816 	ixgbe_clear_interrupt_scheme(adapter);
817 	ixgbe_init_interrupt_scheme(adapter);
818 
819 	if (netif_running(netdev))
820 		netdev->netdev_ops->ndo_open(netdev);
821 
822 	return 0;
823 }
824 
825 /**
826  * ixgbe_fcoe_disable - turn off FCoE offload feature
827  * @netdev: the corresponding netdev
828  *
829  * Turns off FCoE offload feature in 82599.
830  *
831  * Returns : 0 indicates success or -EINVAL on failure
832  */
833 int ixgbe_fcoe_disable(struct net_device *netdev)
834 {
835 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
836 
837 	if (!atomic_dec_and_test(&adapter->fcoe.refcnt))
838 		return -EINVAL;
839 
840 	if (!(adapter->flags & IXGBE_FLAG_FCOE_ENABLED))
841 		return -EINVAL;
842 
843 	e_info(drv, "Disabling FCoE offload features.\n");
844 	if (netif_running(netdev))
845 		netdev->netdev_ops->ndo_stop(netdev);
846 
847 	/* Free per CPU memory to track DDP pools */
848 	ixgbe_fcoe_ddp_disable(adapter);
849 
850 	/* disable FCoE and notify stack */
851 	adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
852 	netdev->features &= ~NETIF_F_FCOE_MTU;
853 
854 	netdev_features_change(netdev);
855 
856 	/* release existing queues and reallocate them */
857 	ixgbe_clear_interrupt_scheme(adapter);
858 	ixgbe_init_interrupt_scheme(adapter);
859 
860 	if (netif_running(netdev))
861 		netdev->netdev_ops->ndo_open(netdev);
862 
863 	return 0;
864 }
865 
866 /**
867  * ixgbe_fcoe_get_wwn - get world wide name for the node or the port
868  * @netdev : ixgbe adapter
869  * @wwn : the world wide name
870  * @type: the type of world wide name
871  *
872  * Returns the node or port world wide name if both the prefix and the san
873  * mac address are valid, then the wwn is formed based on the NAA-2 for
874  * IEEE Extended name identifier (ref. to T10 FC-LS Spec., Sec. 15.3).
875  *
876  * Returns : 0 on success
877  */
878 int ixgbe_fcoe_get_wwn(struct net_device *netdev, u64 *wwn, int type)
879 {
880 	u16 prefix = 0xffff;
881 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
882 	struct ixgbe_mac_info *mac = &adapter->hw.mac;
883 
884 	switch (type) {
885 	case NETDEV_FCOE_WWNN:
886 		prefix = mac->wwnn_prefix;
887 		break;
888 	case NETDEV_FCOE_WWPN:
889 		prefix = mac->wwpn_prefix;
890 		break;
891 	default:
892 		break;
893 	}
894 
895 	if ((prefix != 0xffff) &&
896 	    is_valid_ether_addr(mac->san_addr)) {
897 		*wwn = ((u64) prefix << 48) |
898 		       ((u64) mac->san_addr[0] << 40) |
899 		       ((u64) mac->san_addr[1] << 32) |
900 		       ((u64) mac->san_addr[2] << 24) |
901 		       ((u64) mac->san_addr[3] << 16) |
902 		       ((u64) mac->san_addr[4] << 8)  |
903 		       ((u64) mac->san_addr[5]);
904 		return 0;
905 	}
906 	return -EINVAL;
907 }
908 
909 /**
910  * ixgbe_fcoe_get_hbainfo - get FCoE HBA information
911  * @netdev : ixgbe adapter
912  * @info : HBA information
913  *
914  * Returns ixgbe HBA information
915  *
916  * Returns : 0 on success
917  */
918 int ixgbe_fcoe_get_hbainfo(struct net_device *netdev,
919 			   struct netdev_fcoe_hbainfo *info)
920 {
921 	struct ixgbe_adapter *adapter = netdev_priv(netdev);
922 	struct ixgbe_hw *hw = &adapter->hw;
923 	int i, pos;
924 	u8 buf[8];
925 
926 	if (!info)
927 		return -EINVAL;
928 
929 	/* Don't return information on unsupported devices */
930 	if (hw->mac.type != ixgbe_mac_82599EB &&
931 	    hw->mac.type != ixgbe_mac_X540)
932 		return -EINVAL;
933 
934 	/* Manufacturer */
935 	snprintf(info->manufacturer, sizeof(info->manufacturer),
936 		 "Intel Corporation");
937 
938 	/* Serial Number */
939 
940 	/* Get the PCI-e Device Serial Number Capability */
941 	pos = pci_find_ext_capability(adapter->pdev, PCI_EXT_CAP_ID_DSN);
942 	if (pos) {
943 		pos += 4;
944 		for (i = 0; i < 8; i++)
945 			pci_read_config_byte(adapter->pdev, pos + i, &buf[i]);
946 
947 		snprintf(info->serial_number, sizeof(info->serial_number),
948 			 "%02X%02X%02X%02X%02X%02X%02X%02X",
949 			 buf[7], buf[6], buf[5], buf[4],
950 			 buf[3], buf[2], buf[1], buf[0]);
951 	} else
952 		snprintf(info->serial_number, sizeof(info->serial_number),
953 			 "Unknown");
954 
955 	/* Hardware Version */
956 	snprintf(info->hardware_version,
957 		 sizeof(info->hardware_version),
958 		 "Rev %d", hw->revision_id);
959 	/* Driver Name/Version */
960 	snprintf(info->driver_version,
961 		 sizeof(info->driver_version),
962 		 "%s v%s",
963 		 ixgbe_driver_name,
964 		 ixgbe_driver_version);
965 	/* Firmware Version */
966 	snprintf(info->firmware_version,
967 		 sizeof(info->firmware_version),
968 		 "0x%08x",
969 		 (adapter->eeprom_verh << 16) |
970 		  adapter->eeprom_verl);
971 
972 	/* Model */
973 	if (hw->mac.type == ixgbe_mac_82599EB) {
974 		snprintf(info->model,
975 			 sizeof(info->model),
976 			 "Intel 82599");
977 	} else {
978 		snprintf(info->model,
979 			 sizeof(info->model),
980 			 "Intel X540");
981 	}
982 
983 	/* Model Description */
984 	snprintf(info->model_description,
985 		 sizeof(info->model_description),
986 		 "%s",
987 		 ixgbe_default_device_descr);
988 
989 	return 0;
990 }
991 
992 /**
993  * ixgbe_fcoe_get_tc - get the current TC that fcoe is mapped to
994  * @adapter - pointer to the device adapter structure
995  *
996  * Return : TC that FCoE is mapped to
997  */
998 u8 ixgbe_fcoe_get_tc(struct ixgbe_adapter *adapter)
999 {
1000 #ifdef CONFIG_IXGBE_DCB
1001 	return netdev_get_prio_tc_map(adapter->netdev, adapter->fcoe.up);
1002 #else
1003 	return 0;
1004 #endif
1005 }
1006