xref: /openbmc/linux/drivers/scsi/fcoe/fcoe.c (revision 7fe2f6399a84760a9af8896ac152728250f82adb)
1 /*
2  * Copyright(c) 2007 - 2009 Intel Corporation. All rights reserved.
3  *
4  * This program is free software; you can redistribute it and/or modify it
5  * under the terms and conditions of the GNU General Public License,
6  * version 2, as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope it will be useful, but WITHOUT
9  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
11  * more details.
12  *
13  * You should have received a copy of the GNU General Public License along with
14  * this program; if not, write to the Free Software Foundation, Inc.,
15  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
16  *
17  * Maintained at www.Open-FCoE.org
18  */
19 
20 #include <linux/module.h>
21 #include <linux/version.h>
22 #include <linux/spinlock.h>
23 #include <linux/netdevice.h>
24 #include <linux/etherdevice.h>
25 #include <linux/ethtool.h>
26 #include <linux/if_ether.h>
27 #include <linux/if_vlan.h>
28 #include <linux/crc32.h>
29 #include <linux/slab.h>
30 #include <linux/cpu.h>
31 #include <linux/fs.h>
32 #include <linux/sysfs.h>
33 #include <linux/ctype.h>
34 #include <linux/workqueue.h>
35 #include <scsi/scsi_tcq.h>
36 #include <scsi/scsicam.h>
37 #include <scsi/scsi_transport.h>
38 #include <scsi/scsi_transport_fc.h>
39 #include <net/rtnetlink.h>
40 
41 #include <scsi/fc/fc_encaps.h>
42 #include <scsi/fc/fc_fip.h>
43 
44 #include <scsi/libfc.h>
45 #include <scsi/fc_frame.h>
46 #include <scsi/libfcoe.h>
47 
48 #include "fcoe.h"
49 
50 MODULE_AUTHOR("Open-FCoE.org");
51 MODULE_DESCRIPTION("FCoE");
52 MODULE_LICENSE("GPL v2");
53 
54 /* Performance tuning parameters for fcoe */
55 static unsigned int fcoe_ddp_min;
56 module_param_named(ddp_min, fcoe_ddp_min, uint, S_IRUGO | S_IWUSR);
57 MODULE_PARM_DESC(ddp_min, "Minimum I/O size in bytes for "	\
58 		 "Direct Data Placement (DDP).");
59 
60 DEFINE_MUTEX(fcoe_config_mutex);
61 
62 static struct workqueue_struct *fcoe_wq;
63 
64 /* fcoe_percpu_clean completion.  Waiter protected by fcoe_create_mutex */
65 static DECLARE_COMPLETION(fcoe_flush_completion);
66 
67 /* fcoe host list */
68 /* must only by accessed under the RTNL mutex */
69 LIST_HEAD(fcoe_hostlist);
70 DEFINE_PER_CPU(struct fcoe_percpu_s, fcoe_percpu);
71 
72 /* Function Prototypes */
73 static int fcoe_reset(struct Scsi_Host *);
74 static int fcoe_xmit(struct fc_lport *, struct fc_frame *);
75 static int fcoe_rcv(struct sk_buff *, struct net_device *,
76 		    struct packet_type *, struct net_device *);
77 static int fcoe_percpu_receive_thread(void *);
78 static void fcoe_percpu_clean(struct fc_lport *);
79 static int fcoe_link_speed_update(struct fc_lport *);
80 static int fcoe_link_ok(struct fc_lport *);
81 
82 static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *);
83 static int fcoe_hostlist_add(const struct fc_lport *);
84 
85 static int fcoe_device_notification(struct notifier_block *, ulong, void *);
86 static void fcoe_dev_setup(void);
87 static void fcoe_dev_cleanup(void);
88 static struct fcoe_interface
89 *fcoe_hostlist_lookup_port(const struct net_device *);
90 
91 static int fcoe_fip_recv(struct sk_buff *, struct net_device *,
92 			 struct packet_type *, struct net_device *);
93 
94 static void fcoe_fip_send(struct fcoe_ctlr *, struct sk_buff *);
95 static void fcoe_update_src_mac(struct fc_lport *, u8 *);
96 static u8 *fcoe_get_src_mac(struct fc_lport *);
97 static void fcoe_destroy_work(struct work_struct *);
98 
99 static int fcoe_ddp_setup(struct fc_lport *, u16, struct scatterlist *,
100 			  unsigned int);
101 static int fcoe_ddp_done(struct fc_lport *, u16);
102 
103 static int fcoe_cpu_callback(struct notifier_block *, unsigned long, void *);
104 
105 static bool fcoe_match(struct net_device *netdev);
106 static int fcoe_create(struct net_device *netdev, enum fip_state fip_mode);
107 static int fcoe_destroy(struct net_device *netdev);
108 static int fcoe_enable(struct net_device *netdev);
109 static int fcoe_disable(struct net_device *netdev);
110 
111 static struct fc_seq *fcoe_elsct_send(struct fc_lport *,
112 				      u32 did, struct fc_frame *,
113 				      unsigned int op,
114 				      void (*resp)(struct fc_seq *,
115 						   struct fc_frame *,
116 						   void *),
117 				      void *, u32 timeout);
118 static void fcoe_recv_frame(struct sk_buff *skb);
119 
120 static void fcoe_get_lesb(struct fc_lport *, struct fc_els_lesb *);
121 
122 /* notification function for packets from net device */
123 static struct notifier_block fcoe_notifier = {
124 	.notifier_call = fcoe_device_notification,
125 };
126 
127 /* notification function for CPU hotplug events */
128 static struct notifier_block fcoe_cpu_notifier = {
129 	.notifier_call = fcoe_cpu_callback,
130 };
131 
132 static struct scsi_transport_template *fcoe_nport_scsi_transport;
133 static struct scsi_transport_template *fcoe_vport_scsi_transport;
134 
135 static int fcoe_vport_destroy(struct fc_vport *);
136 static int fcoe_vport_create(struct fc_vport *, bool disabled);
137 static int fcoe_vport_disable(struct fc_vport *, bool disable);
138 static void fcoe_set_vport_symbolic_name(struct fc_vport *);
139 static void fcoe_set_port_id(struct fc_lport *, u32, struct fc_frame *);
140 static int fcoe_validate_vport_create(struct fc_vport *);
141 
142 static struct libfc_function_template fcoe_libfc_fcn_templ = {
143 	.frame_send = fcoe_xmit,
144 	.ddp_setup = fcoe_ddp_setup,
145 	.ddp_done = fcoe_ddp_done,
146 	.elsct_send = fcoe_elsct_send,
147 	.get_lesb = fcoe_get_lesb,
148 	.lport_set_port_id = fcoe_set_port_id,
149 };
150 
151 struct fc_function_template fcoe_nport_fc_functions = {
152 	.show_host_node_name = 1,
153 	.show_host_port_name = 1,
154 	.show_host_supported_classes = 1,
155 	.show_host_supported_fc4s = 1,
156 	.show_host_active_fc4s = 1,
157 	.show_host_maxframe_size = 1,
158 
159 	.show_host_port_id = 1,
160 	.show_host_supported_speeds = 1,
161 	.get_host_speed = fc_get_host_speed,
162 	.show_host_speed = 1,
163 	.show_host_port_type = 1,
164 	.get_host_port_state = fc_get_host_port_state,
165 	.show_host_port_state = 1,
166 	.show_host_symbolic_name = 1,
167 
168 	.dd_fcrport_size = sizeof(struct fc_rport_libfc_priv),
169 	.show_rport_maxframe_size = 1,
170 	.show_rport_supported_classes = 1,
171 
172 	.show_host_fabric_name = 1,
173 	.show_starget_node_name = 1,
174 	.show_starget_port_name = 1,
175 	.show_starget_port_id = 1,
176 	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
177 	.show_rport_dev_loss_tmo = 1,
178 	.get_fc_host_stats = fc_get_host_stats,
179 	.issue_fc_host_lip = fcoe_reset,
180 
181 	.terminate_rport_io = fc_rport_terminate_io,
182 
183 	.vport_create = fcoe_vport_create,
184 	.vport_delete = fcoe_vport_destroy,
185 	.vport_disable = fcoe_vport_disable,
186 	.set_vport_symbolic_name = fcoe_set_vport_symbolic_name,
187 
188 	.bsg_request = fc_lport_bsg_request,
189 };
190 
191 struct fc_function_template fcoe_vport_fc_functions = {
192 	.show_host_node_name = 1,
193 	.show_host_port_name = 1,
194 	.show_host_supported_classes = 1,
195 	.show_host_supported_fc4s = 1,
196 	.show_host_active_fc4s = 1,
197 	.show_host_maxframe_size = 1,
198 
199 	.show_host_port_id = 1,
200 	.show_host_supported_speeds = 1,
201 	.get_host_speed = fc_get_host_speed,
202 	.show_host_speed = 1,
203 	.show_host_port_type = 1,
204 	.get_host_port_state = fc_get_host_port_state,
205 	.show_host_port_state = 1,
206 	.show_host_symbolic_name = 1,
207 
208 	.dd_fcrport_size = sizeof(struct fc_rport_libfc_priv),
209 	.show_rport_maxframe_size = 1,
210 	.show_rport_supported_classes = 1,
211 
212 	.show_host_fabric_name = 1,
213 	.show_starget_node_name = 1,
214 	.show_starget_port_name = 1,
215 	.show_starget_port_id = 1,
216 	.set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
217 	.show_rport_dev_loss_tmo = 1,
218 	.get_fc_host_stats = fc_get_host_stats,
219 	.issue_fc_host_lip = fcoe_reset,
220 
221 	.terminate_rport_io = fc_rport_terminate_io,
222 
223 	.bsg_request = fc_lport_bsg_request,
224 };
225 
226 static struct scsi_host_template fcoe_shost_template = {
227 	.module = THIS_MODULE,
228 	.name = "FCoE Driver",
229 	.proc_name = FCOE_NAME,
230 	.queuecommand = fc_queuecommand,
231 	.eh_abort_handler = fc_eh_abort,
232 	.eh_device_reset_handler = fc_eh_device_reset,
233 	.eh_host_reset_handler = fc_eh_host_reset,
234 	.slave_alloc = fc_slave_alloc,
235 	.change_queue_depth = fc_change_queue_depth,
236 	.change_queue_type = fc_change_queue_type,
237 	.this_id = -1,
238 	.cmd_per_lun = 3,
239 	.can_queue = FCOE_MAX_OUTSTANDING_COMMANDS,
240 	.use_clustering = ENABLE_CLUSTERING,
241 	.sg_tablesize = SG_ALL,
242 	.max_sectors = 0xffff,
243 };
244 
245 /**
246  * fcoe_interface_setup() - Setup a FCoE interface
247  * @fcoe:   The new FCoE interface
248  * @netdev: The net device that the fcoe interface is on
249  *
250  * Returns : 0 for success
251  * Locking: must be called with the RTNL mutex held
252  */
253 static int fcoe_interface_setup(struct fcoe_interface *fcoe,
254 				struct net_device *netdev)
255 {
256 	struct fcoe_ctlr *fip = &fcoe->ctlr;
257 	struct netdev_hw_addr *ha;
258 	struct net_device *real_dev;
259 	u8 flogi_maddr[ETH_ALEN];
260 	const struct net_device_ops *ops;
261 
262 	fcoe->netdev = netdev;
263 
264 	/* Let LLD initialize for FCoE */
265 	ops = netdev->netdev_ops;
266 	if (ops->ndo_fcoe_enable) {
267 		if (ops->ndo_fcoe_enable(netdev))
268 			FCOE_NETDEV_DBG(netdev, "Failed to enable FCoE"
269 					" specific feature for LLD.\n");
270 	}
271 
272 	/* Do not support for bonding device */
273 	if (netdev->priv_flags & IFF_BONDING && netdev->flags & IFF_MASTER) {
274 		FCOE_NETDEV_DBG(netdev, "Bonded interfaces not supported\n");
275 		return -EOPNOTSUPP;
276 	}
277 
278 	/* look for SAN MAC address, if multiple SAN MACs exist, only
279 	 * use the first one for SPMA */
280 	real_dev = (netdev->priv_flags & IFF_802_1Q_VLAN) ?
281 		vlan_dev_real_dev(netdev) : netdev;
282 	rcu_read_lock();
283 	for_each_dev_addr(real_dev, ha) {
284 		if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
285 		    (is_valid_ether_addr(ha->addr))) {
286 			memcpy(fip->ctl_src_addr, ha->addr, ETH_ALEN);
287 			fip->spma = 1;
288 			break;
289 		}
290 	}
291 	rcu_read_unlock();
292 
293 	/* setup Source Mac Address */
294 	if (!fip->spma)
295 		memcpy(fip->ctl_src_addr, netdev->dev_addr, netdev->addr_len);
296 
297 	/*
298 	 * Add FCoE MAC address as second unicast MAC address
299 	 * or enter promiscuous mode if not capable of listening
300 	 * for multiple unicast MACs.
301 	 */
302 	memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
303 	dev_uc_add(netdev, flogi_maddr);
304 	if (fip->spma)
305 		dev_uc_add(netdev, fip->ctl_src_addr);
306 	if (fip->mode == FIP_MODE_VN2VN) {
307 		dev_mc_add(netdev, FIP_ALL_VN2VN_MACS);
308 		dev_mc_add(netdev, FIP_ALL_P2P_MACS);
309 	} else
310 		dev_mc_add(netdev, FIP_ALL_ENODE_MACS);
311 
312 	/*
313 	 * setup the receive function from ethernet driver
314 	 * on the ethertype for the given device
315 	 */
316 	fcoe->fcoe_packet_type.func = fcoe_rcv;
317 	fcoe->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
318 	fcoe->fcoe_packet_type.dev = netdev;
319 	dev_add_pack(&fcoe->fcoe_packet_type);
320 
321 	fcoe->fip_packet_type.func = fcoe_fip_recv;
322 	fcoe->fip_packet_type.type = htons(ETH_P_FIP);
323 	fcoe->fip_packet_type.dev = netdev;
324 	dev_add_pack(&fcoe->fip_packet_type);
325 
326 	return 0;
327 }
328 
329 /**
330  * fcoe_interface_create() - Create a FCoE interface on a net device
331  * @netdev: The net device to create the FCoE interface on
332  * @fip_mode: The mode to use for FIP
333  *
334  * Returns: pointer to a struct fcoe_interface or NULL on error
335  */
336 static struct fcoe_interface *fcoe_interface_create(struct net_device *netdev,
337 						    enum fip_state fip_mode)
338 {
339 	struct fcoe_interface *fcoe;
340 	int err;
341 
342 	if (!try_module_get(THIS_MODULE)) {
343 		FCOE_NETDEV_DBG(netdev,
344 				"Could not get a reference to the module\n");
345 		fcoe = ERR_PTR(-EBUSY);
346 		goto out;
347 	}
348 
349 	fcoe = kzalloc(sizeof(*fcoe), GFP_KERNEL);
350 	if (!fcoe) {
351 		FCOE_NETDEV_DBG(netdev, "Could not allocate fcoe structure\n");
352 		fcoe = ERR_PTR(-ENOMEM);
353 		goto out_nomod;
354 	}
355 
356 	dev_hold(netdev);
357 	kref_init(&fcoe->kref);
358 
359 	/*
360 	 * Initialize FIP.
361 	 */
362 	fcoe_ctlr_init(&fcoe->ctlr, fip_mode);
363 	fcoe->ctlr.send = fcoe_fip_send;
364 	fcoe->ctlr.update_mac = fcoe_update_src_mac;
365 	fcoe->ctlr.get_src_addr = fcoe_get_src_mac;
366 
367 	err = fcoe_interface_setup(fcoe, netdev);
368 	if (err) {
369 		fcoe_ctlr_destroy(&fcoe->ctlr);
370 		kfree(fcoe);
371 		dev_put(netdev);
372 		fcoe = ERR_PTR(err);
373 		goto out_nomod;
374 	}
375 
376 	goto out;
377 
378 out_nomod:
379 	module_put(THIS_MODULE);
380 out:
381 	return fcoe;
382 }
383 
384 /**
385  * fcoe_interface_release() - fcoe_port kref release function
386  * @kref: Embedded reference count in an fcoe_interface struct
387  */
388 static void fcoe_interface_release(struct kref *kref)
389 {
390 	struct fcoe_interface *fcoe;
391 	struct net_device *netdev;
392 
393 	fcoe = container_of(kref, struct fcoe_interface, kref);
394 	netdev = fcoe->netdev;
395 	/* tear-down the FCoE controller */
396 	fcoe_ctlr_destroy(&fcoe->ctlr);
397 	kfree(fcoe);
398 	dev_put(netdev);
399 	module_put(THIS_MODULE);
400 }
401 
402 /**
403  * fcoe_interface_get() - Get a reference to a FCoE interface
404  * @fcoe: The FCoE interface to be held
405  */
406 static inline void fcoe_interface_get(struct fcoe_interface *fcoe)
407 {
408 	kref_get(&fcoe->kref);
409 }
410 
411 /**
412  * fcoe_interface_put() - Put a reference to a FCoE interface
413  * @fcoe: The FCoE interface to be released
414  */
415 static inline void fcoe_interface_put(struct fcoe_interface *fcoe)
416 {
417 	kref_put(&fcoe->kref, fcoe_interface_release);
418 }
419 
420 /**
421  * fcoe_interface_cleanup() - Clean up a FCoE interface
422  * @fcoe: The FCoE interface to be cleaned up
423  *
424  * Caller must be holding the RTNL mutex
425  */
426 void fcoe_interface_cleanup(struct fcoe_interface *fcoe)
427 {
428 	struct net_device *netdev = fcoe->netdev;
429 	struct fcoe_ctlr *fip = &fcoe->ctlr;
430 	u8 flogi_maddr[ETH_ALEN];
431 	const struct net_device_ops *ops;
432 	struct fcoe_port *port = lport_priv(fcoe->ctlr.lp);
433 
434 	FCOE_NETDEV_DBG(netdev, "Destroying interface\n");
435 
436 	/* Logout of the fabric */
437 	fc_fabric_logoff(fcoe->ctlr.lp);
438 
439 	/* Cleanup the fc_lport */
440 	fc_lport_destroy(fcoe->ctlr.lp);
441 
442 	/* Stop the transmit retry timer */
443 	del_timer_sync(&port->timer);
444 
445 	/* Free existing transmit skbs */
446 	fcoe_clean_pending_queue(fcoe->ctlr.lp);
447 
448 	/*
449 	 * Don't listen for Ethernet packets anymore.
450 	 * synchronize_net() ensures that the packet handlers are not running
451 	 * on another CPU. dev_remove_pack() would do that, this calls the
452 	 * unsyncronized version __dev_remove_pack() to avoid multiple delays.
453 	 */
454 	__dev_remove_pack(&fcoe->fcoe_packet_type);
455 	__dev_remove_pack(&fcoe->fip_packet_type);
456 	synchronize_net();
457 
458 	/* Delete secondary MAC addresses */
459 	memcpy(flogi_maddr, (u8[6]) FC_FCOE_FLOGI_MAC, ETH_ALEN);
460 	dev_uc_del(netdev, flogi_maddr);
461 	if (fip->spma)
462 		dev_uc_del(netdev, fip->ctl_src_addr);
463 	if (fip->mode == FIP_MODE_VN2VN) {
464 		dev_mc_del(netdev, FIP_ALL_VN2VN_MACS);
465 		dev_mc_del(netdev, FIP_ALL_P2P_MACS);
466 	} else
467 		dev_mc_del(netdev, FIP_ALL_ENODE_MACS);
468 
469 	if (!is_zero_ether_addr(port->data_src_addr))
470 		dev_uc_del(netdev, port->data_src_addr);
471 
472 	/* Tell the LLD we are done w/ FCoE */
473 	ops = netdev->netdev_ops;
474 	if (ops->ndo_fcoe_disable) {
475 		if (ops->ndo_fcoe_disable(netdev))
476 			FCOE_NETDEV_DBG(netdev, "Failed to disable FCoE"
477 					" specific feature for LLD.\n");
478 	}
479 	fcoe_interface_put(fcoe);
480 }
481 
482 /**
483  * fcoe_fip_recv() - Handler for received FIP frames
484  * @skb:      The receive skb
485  * @netdev:   The associated net device
486  * @ptype:    The packet_type structure which was used to register this handler
487  * @orig_dev: The original net_device the the skb was received on.
488  *	      (in case dev is a bond)
489  *
490  * Returns: 0 for success
491  */
492 static int fcoe_fip_recv(struct sk_buff *skb, struct net_device *netdev,
493 			 struct packet_type *ptype,
494 			 struct net_device *orig_dev)
495 {
496 	struct fcoe_interface *fcoe;
497 
498 	fcoe = container_of(ptype, struct fcoe_interface, fip_packet_type);
499 	fcoe_ctlr_recv(&fcoe->ctlr, skb);
500 	return 0;
501 }
502 
503 /**
504  * fcoe_fip_send() - Send an Ethernet-encapsulated FIP frame
505  * @fip: The FCoE controller
506  * @skb: The FIP packet to be sent
507  */
508 static void fcoe_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
509 {
510 	skb->dev = fcoe_from_ctlr(fip)->netdev;
511 	dev_queue_xmit(skb);
512 }
513 
514 /**
515  * fcoe_update_src_mac() - Update the Ethernet MAC filters
516  * @lport: The local port to update the source MAC on
517  * @addr:  Unicast MAC address to add
518  *
519  * Remove any previously-set unicast MAC filter.
520  * Add secondary FCoE MAC address filter for our OUI.
521  */
522 static void fcoe_update_src_mac(struct fc_lport *lport, u8 *addr)
523 {
524 	struct fcoe_port *port = lport_priv(lport);
525 	struct fcoe_interface *fcoe = port->priv;
526 
527 	rtnl_lock();
528 	if (!is_zero_ether_addr(port->data_src_addr))
529 		dev_uc_del(fcoe->netdev, port->data_src_addr);
530 	if (!is_zero_ether_addr(addr))
531 		dev_uc_add(fcoe->netdev, addr);
532 	memcpy(port->data_src_addr, addr, ETH_ALEN);
533 	rtnl_unlock();
534 }
535 
536 /**
537  * fcoe_get_src_mac() - return the Ethernet source address for an lport
538  * @lport: libfc lport
539  */
540 static u8 *fcoe_get_src_mac(struct fc_lport *lport)
541 {
542 	struct fcoe_port *port = lport_priv(lport);
543 
544 	return port->data_src_addr;
545 }
546 
547 /**
548  * fcoe_lport_config() - Set up a local port
549  * @lport: The local port to be setup
550  *
551  * Returns: 0 for success
552  */
553 static int fcoe_lport_config(struct fc_lport *lport)
554 {
555 	lport->link_up = 0;
556 	lport->qfull = 0;
557 	lport->max_retry_count = 3;
558 	lport->max_rport_retry_count = 3;
559 	lport->e_d_tov = 2 * 1000;	/* FC-FS default */
560 	lport->r_a_tov = 2 * 2 * 1000;
561 	lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
562 				 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
563 	lport->does_npiv = 1;
564 
565 	fc_lport_init_stats(lport);
566 
567 	/* lport fc_lport related configuration */
568 	fc_lport_config(lport);
569 
570 	/* offload related configuration */
571 	lport->crc_offload = 0;
572 	lport->seq_offload = 0;
573 	lport->lro_enabled = 0;
574 	lport->lro_xid = 0;
575 	lport->lso_max = 0;
576 
577 	return 0;
578 }
579 
580 /**
581  * fcoe_get_wwn() - Get the world wide name from LLD if it supports it
582  * @netdev: the associated net device
583  * @wwn: the output WWN
584  * @type: the type of WWN (WWPN or WWNN)
585  *
586  * Returns: 0 for success
587  */
588 static int fcoe_get_wwn(struct net_device *netdev, u64 *wwn, int type)
589 {
590 	const struct net_device_ops *ops = netdev->netdev_ops;
591 
592 	if (ops->ndo_fcoe_get_wwn)
593 		return ops->ndo_fcoe_get_wwn(netdev, wwn, type);
594 	return -EINVAL;
595 }
596 
597 /**
598  * fcoe_netdev_features_change - Updates the lport's offload flags based
599  * on the LLD netdev's FCoE feature flags
600  */
601 static void fcoe_netdev_features_change(struct fc_lport *lport,
602 					struct net_device *netdev)
603 {
604 	mutex_lock(&lport->lp_mutex);
605 
606 	if (netdev->features & NETIF_F_SG)
607 		lport->sg_supp = 1;
608 	else
609 		lport->sg_supp = 0;
610 
611 	if (netdev->features & NETIF_F_FCOE_CRC) {
612 		lport->crc_offload = 1;
613 		FCOE_NETDEV_DBG(netdev, "Supports FCCRC offload\n");
614 	} else {
615 		lport->crc_offload = 0;
616 	}
617 
618 	if (netdev->features & NETIF_F_FSO) {
619 		lport->seq_offload = 1;
620 		lport->lso_max = netdev->gso_max_size;
621 		FCOE_NETDEV_DBG(netdev, "Supports LSO for max len 0x%x\n",
622 				lport->lso_max);
623 	} else {
624 		lport->seq_offload = 0;
625 		lport->lso_max = 0;
626 	}
627 
628 	if (netdev->fcoe_ddp_xid) {
629 		lport->lro_enabled = 1;
630 		lport->lro_xid = netdev->fcoe_ddp_xid;
631 		FCOE_NETDEV_DBG(netdev, "Supports LRO for max xid 0x%x\n",
632 				lport->lro_xid);
633 	} else {
634 		lport->lro_enabled = 0;
635 		lport->lro_xid = 0;
636 	}
637 
638 	mutex_unlock(&lport->lp_mutex);
639 }
640 
641 /**
642  * fcoe_netdev_config() - Set up net devive for SW FCoE
643  * @lport:  The local port that is associated with the net device
644  * @netdev: The associated net device
645  *
646  * Must be called after fcoe_lport_config() as it will use local port mutex
647  *
648  * Returns: 0 for success
649  */
650 static int fcoe_netdev_config(struct fc_lport *lport, struct net_device *netdev)
651 {
652 	u32 mfs;
653 	u64 wwnn, wwpn;
654 	struct fcoe_interface *fcoe;
655 	struct fcoe_port *port;
656 
657 	/* Setup lport private data to point to fcoe softc */
658 	port = lport_priv(lport);
659 	fcoe = port->priv;
660 
661 	/*
662 	 * Determine max frame size based on underlying device and optional
663 	 * user-configured limit.  If the MFS is too low, fcoe_link_ok()
664 	 * will return 0, so do this first.
665 	 */
666 	mfs = netdev->mtu;
667 	if (netdev->features & NETIF_F_FCOE_MTU) {
668 		mfs = FCOE_MTU;
669 		FCOE_NETDEV_DBG(netdev, "Supports FCOE_MTU of %d bytes\n", mfs);
670 	}
671 	mfs -= (sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof));
672 	if (fc_set_mfs(lport, mfs))
673 		return -EINVAL;
674 
675 	/* offload features support */
676 	fcoe_netdev_features_change(lport, netdev);
677 
678 	skb_queue_head_init(&port->fcoe_pending_queue);
679 	port->fcoe_pending_queue_active = 0;
680 	setup_timer(&port->timer, fcoe_queue_timer, (unsigned long)lport);
681 
682 	fcoe_link_speed_update(lport);
683 
684 	if (!lport->vport) {
685 		if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN))
686 			wwnn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr, 1, 0);
687 		fc_set_wwnn(lport, wwnn);
688 		if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN))
689 			wwpn = fcoe_wwn_from_mac(fcoe->ctlr.ctl_src_addr,
690 						 2, 0);
691 		fc_set_wwpn(lport, wwpn);
692 	}
693 
694 	return 0;
695 }
696 
697 /**
698  * fcoe_shost_config() - Set up the SCSI host associated with a local port
699  * @lport: The local port
700  * @dev:   The device associated with the SCSI host
701  *
702  * Must be called after fcoe_lport_config() and fcoe_netdev_config()
703  *
704  * Returns: 0 for success
705  */
706 static int fcoe_shost_config(struct fc_lport *lport, struct device *dev)
707 {
708 	int rc = 0;
709 
710 	/* lport scsi host config */
711 	lport->host->max_lun = FCOE_MAX_LUN;
712 	lport->host->max_id = FCOE_MAX_FCP_TARGET;
713 	lport->host->max_channel = 0;
714 	lport->host->max_cmd_len = FCOE_MAX_CMD_LEN;
715 
716 	if (lport->vport)
717 		lport->host->transportt = fcoe_vport_scsi_transport;
718 	else
719 		lport->host->transportt = fcoe_nport_scsi_transport;
720 
721 	/* add the new host to the SCSI-ml */
722 	rc = scsi_add_host(lport->host, dev);
723 	if (rc) {
724 		FCOE_NETDEV_DBG(fcoe_netdev(lport), "fcoe_shost_config: "
725 				"error on scsi_add_host\n");
726 		return rc;
727 	}
728 
729 	if (!lport->vport)
730 		fc_host_max_npiv_vports(lport->host) = USHRT_MAX;
731 
732 	snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE,
733 		 "%s v%s over %s", FCOE_NAME, FCOE_VERSION,
734 		 fcoe_netdev(lport)->name);
735 
736 	return 0;
737 }
738 
739 /**
740  * fcoe_oem_match() - The match routine for the offloaded exchange manager
741  * @fp: The I/O frame
742  *
743  * This routine will be associated with an exchange manager (EM). When
744  * the libfc exchange handling code is looking for an EM to use it will
745  * call this routine and pass it the frame that it wishes to send. This
746  * routine will return True if the associated EM is to be used and False
747  * if the echange code should continue looking for an EM.
748  *
749  * The offload EM that this routine is associated with will handle any
750  * packets that are for SCSI read requests.
751  *
752  * Returns: True for read types I/O, otherwise returns false.
753  */
754 bool fcoe_oem_match(struct fc_frame *fp)
755 {
756 	return fc_fcp_is_read(fr_fsp(fp)) &&
757 		(fr_fsp(fp)->data_len > fcoe_ddp_min);
758 }
759 
760 /**
761  * fcoe_em_config() - Allocate and configure an exchange manager
762  * @lport: The local port that the new EM will be associated with
763  *
764  * Returns: 0 on success
765  */
766 static inline int fcoe_em_config(struct fc_lport *lport)
767 {
768 	struct fcoe_port *port = lport_priv(lport);
769 	struct fcoe_interface *fcoe = port->priv;
770 	struct fcoe_interface *oldfcoe = NULL;
771 	struct net_device *old_real_dev, *cur_real_dev;
772 	u16 min_xid = FCOE_MIN_XID;
773 	u16 max_xid = FCOE_MAX_XID;
774 
775 	/*
776 	 * Check if need to allocate an em instance for
777 	 * offload exchange ids to be shared across all VN_PORTs/lport.
778 	 */
779 	if (!lport->lro_enabled || !lport->lro_xid ||
780 	    (lport->lro_xid >= max_xid)) {
781 		lport->lro_xid = 0;
782 		goto skip_oem;
783 	}
784 
785 	/*
786 	 * Reuse existing offload em instance in case
787 	 * it is already allocated on real eth device
788 	 */
789 	if (fcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
790 		cur_real_dev = vlan_dev_real_dev(fcoe->netdev);
791 	else
792 		cur_real_dev = fcoe->netdev;
793 
794 	list_for_each_entry(oldfcoe, &fcoe_hostlist, list) {
795 		if (oldfcoe->netdev->priv_flags & IFF_802_1Q_VLAN)
796 			old_real_dev = vlan_dev_real_dev(oldfcoe->netdev);
797 		else
798 			old_real_dev = oldfcoe->netdev;
799 
800 		if (cur_real_dev == old_real_dev) {
801 			fcoe->oem = oldfcoe->oem;
802 			break;
803 		}
804 	}
805 
806 	if (fcoe->oem) {
807 		if (!fc_exch_mgr_add(lport, fcoe->oem, fcoe_oem_match)) {
808 			printk(KERN_ERR "fcoe_em_config: failed to add "
809 			       "offload em:%p on interface:%s\n",
810 			       fcoe->oem, fcoe->netdev->name);
811 			return -ENOMEM;
812 		}
813 	} else {
814 		fcoe->oem = fc_exch_mgr_alloc(lport, FC_CLASS_3,
815 					      FCOE_MIN_XID, lport->lro_xid,
816 					      fcoe_oem_match);
817 		if (!fcoe->oem) {
818 			printk(KERN_ERR "fcoe_em_config: failed to allocate "
819 			       "em for offload exches on interface:%s\n",
820 			       fcoe->netdev->name);
821 			return -ENOMEM;
822 		}
823 	}
824 
825 	/*
826 	 * Exclude offload EM xid range from next EM xid range.
827 	 */
828 	min_xid += lport->lro_xid + 1;
829 
830 skip_oem:
831 	if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, min_xid, max_xid, NULL)) {
832 		printk(KERN_ERR "fcoe_em_config: failed to "
833 		       "allocate em on interface %s\n", fcoe->netdev->name);
834 		return -ENOMEM;
835 	}
836 
837 	return 0;
838 }
839 
840 /**
841  * fcoe_if_destroy() - Tear down a SW FCoE instance
842  * @lport: The local port to be destroyed
843  *
844  */
845 static void fcoe_if_destroy(struct fc_lport *lport)
846 {
847 	/* Free queued packets for the per-CPU receive threads */
848 	fcoe_percpu_clean(lport);
849 
850 	/* Detach from the scsi-ml */
851 	fc_remove_host(lport->host);
852 	scsi_remove_host(lport->host);
853 
854 	/* Destroy lport scsi_priv */
855 	fc_fcp_destroy(lport);
856 
857 	/* There are no more rports or I/O, free the EM */
858 	fc_exch_mgr_free(lport);
859 
860 	/* Free memory used by statistical counters */
861 	fc_lport_free_stats(lport);
862 
863 	/* Release the Scsi_Host */
864 	scsi_host_put(lport->host);
865 }
866 
867 /**
868  * fcoe_ddp_setup() - Call a LLD's ddp_setup through the net device
869  * @lport: The local port to setup DDP for
870  * @xid:   The exchange ID for this DDP transfer
871  * @sgl:   The scatterlist describing this transfer
872  * @sgc:   The number of sg items
873  *
874  * Returns: 0 if the DDP context was not configured
875  */
876 static int fcoe_ddp_setup(struct fc_lport *lport, u16 xid,
877 			  struct scatterlist *sgl, unsigned int sgc)
878 {
879 	struct net_device *netdev = fcoe_netdev(lport);
880 
881 	if (netdev->netdev_ops->ndo_fcoe_ddp_setup)
882 		return netdev->netdev_ops->ndo_fcoe_ddp_setup(netdev,
883 							      xid, sgl,
884 							      sgc);
885 
886 	return 0;
887 }
888 
889 /**
890  * fcoe_ddp_done() - Call a LLD's ddp_done through the net device
891  * @lport: The local port to complete DDP on
892  * @xid:   The exchange ID for this DDP transfer
893  *
894  * Returns: the length of data that have been completed by DDP
895  */
896 static int fcoe_ddp_done(struct fc_lport *lport, u16 xid)
897 {
898 	struct net_device *netdev = fcoe_netdev(lport);
899 
900 	if (netdev->netdev_ops->ndo_fcoe_ddp_done)
901 		return netdev->netdev_ops->ndo_fcoe_ddp_done(netdev, xid);
902 	return 0;
903 }
904 
905 /**
906  * fcoe_if_create() - Create a FCoE instance on an interface
907  * @fcoe:   The FCoE interface to create a local port on
908  * @parent: The device pointer to be the parent in sysfs for the SCSI host
909  * @npiv:   Indicates if the port is a vport or not
910  *
911  * Creates a fc_lport instance and a Scsi_Host instance and configure them.
912  *
913  * Returns: The allocated fc_lport or an error pointer
914  */
915 static struct fc_lport *fcoe_if_create(struct fcoe_interface *fcoe,
916 				       struct device *parent, int npiv)
917 {
918 	struct net_device *netdev = fcoe->netdev;
919 	struct fc_lport *lport, *n_port;
920 	struct fcoe_port *port;
921 	struct Scsi_Host *shost;
922 	int rc;
923 	/*
924 	 * parent is only a vport if npiv is 1,
925 	 * but we'll only use vport in that case so go ahead and set it
926 	 */
927 	struct fc_vport *vport = dev_to_vport(parent);
928 
929 	FCOE_NETDEV_DBG(netdev, "Create Interface\n");
930 
931 	if (!npiv)
932 		lport = libfc_host_alloc(&fcoe_shost_template, sizeof(*port));
933 	else
934 		lport = libfc_vport_create(vport, sizeof(*port));
935 
936 	if (!lport) {
937 		FCOE_NETDEV_DBG(netdev, "Could not allocate host structure\n");
938 		rc = -ENOMEM;
939 		goto out;
940 	}
941 	port = lport_priv(lport);
942 	port->lport = lport;
943 	port->priv = fcoe;
944 	port->max_queue_depth = FCOE_MAX_QUEUE_DEPTH;
945 	port->min_queue_depth = FCOE_MIN_QUEUE_DEPTH;
946 	INIT_WORK(&port->destroy_work, fcoe_destroy_work);
947 
948 	/* configure a fc_lport including the exchange manager */
949 	rc = fcoe_lport_config(lport);
950 	if (rc) {
951 		FCOE_NETDEV_DBG(netdev, "Could not configure lport for the "
952 				"interface\n");
953 		goto out_host_put;
954 	}
955 
956 	if (npiv) {
957 		FCOE_NETDEV_DBG(netdev, "Setting vport names, "
958 				"%16.16llx %16.16llx\n",
959 				vport->node_name, vport->port_name);
960 		fc_set_wwnn(lport, vport->node_name);
961 		fc_set_wwpn(lport, vport->port_name);
962 	}
963 
964 	/* configure lport network properties */
965 	rc = fcoe_netdev_config(lport, netdev);
966 	if (rc) {
967 		FCOE_NETDEV_DBG(netdev, "Could not configure netdev for the "
968 				"interface\n");
969 		goto out_lp_destroy;
970 	}
971 
972 	/* configure lport scsi host properties */
973 	rc = fcoe_shost_config(lport, parent);
974 	if (rc) {
975 		FCOE_NETDEV_DBG(netdev, "Could not configure shost for the "
976 				"interface\n");
977 		goto out_lp_destroy;
978 	}
979 
980 	/* Initialize the library */
981 	rc = fcoe_libfc_config(lport, &fcoe->ctlr, &fcoe_libfc_fcn_templ, 1);
982 	if (rc) {
983 		FCOE_NETDEV_DBG(netdev, "Could not configure libfc for the "
984 				"interface\n");
985 		goto out_lp_destroy;
986 	}
987 
988 	/*
989 	 * fcoe_em_alloc() and fcoe_hostlist_add() both
990 	 * need to be atomic with respect to other changes to the
991 	 * hostlist since fcoe_em_alloc() looks for an existing EM
992 	 * instance on host list updated by fcoe_hostlist_add().
993 	 *
994 	 * This is currently handled through the fcoe_config_mutex
995 	 * begin held.
996 	 */
997 	if (!npiv)
998 		/* lport exch manager allocation */
999 		rc = fcoe_em_config(lport);
1000 	else {
1001 		shost = vport_to_shost(vport);
1002 		n_port = shost_priv(shost);
1003 		rc = fc_exch_mgr_list_clone(n_port, lport);
1004 	}
1005 
1006 	if (rc) {
1007 		FCOE_NETDEV_DBG(netdev, "Could not configure the EM\n");
1008 		goto out_lp_destroy;
1009 	}
1010 
1011 	fcoe_interface_get(fcoe);
1012 	return lport;
1013 
1014 out_lp_destroy:
1015 	fc_exch_mgr_free(lport);
1016 out_host_put:
1017 	scsi_host_put(lport->host);
1018 out:
1019 	return ERR_PTR(rc);
1020 }
1021 
1022 /**
1023  * fcoe_if_init() - Initialization routine for fcoe.ko
1024  *
1025  * Attaches the SW FCoE transport to the FC transport
1026  *
1027  * Returns: 0 on success
1028  */
1029 static int __init fcoe_if_init(void)
1030 {
1031 	/* attach to scsi transport */
1032 	fcoe_nport_scsi_transport =
1033 		fc_attach_transport(&fcoe_nport_fc_functions);
1034 	fcoe_vport_scsi_transport =
1035 		fc_attach_transport(&fcoe_vport_fc_functions);
1036 
1037 	if (!fcoe_nport_scsi_transport) {
1038 		printk(KERN_ERR "fcoe: Failed to attach to the FC transport\n");
1039 		return -ENODEV;
1040 	}
1041 
1042 	return 0;
1043 }
1044 
1045 /**
1046  * fcoe_if_exit() - Tear down fcoe.ko
1047  *
1048  * Detaches the SW FCoE transport from the FC transport
1049  *
1050  * Returns: 0 on success
1051  */
1052 int __exit fcoe_if_exit(void)
1053 {
1054 	fc_release_transport(fcoe_nport_scsi_transport);
1055 	fc_release_transport(fcoe_vport_scsi_transport);
1056 	fcoe_nport_scsi_transport = NULL;
1057 	fcoe_vport_scsi_transport = NULL;
1058 	return 0;
1059 }
1060 
1061 /**
1062  * fcoe_percpu_thread_create() - Create a receive thread for an online CPU
1063  * @cpu: The CPU index of the CPU to create a receive thread for
1064  */
1065 static void fcoe_percpu_thread_create(unsigned int cpu)
1066 {
1067 	struct fcoe_percpu_s *p;
1068 	struct task_struct *thread;
1069 
1070 	p = &per_cpu(fcoe_percpu, cpu);
1071 
1072 	thread = kthread_create(fcoe_percpu_receive_thread,
1073 				(void *)p, "fcoethread/%d", cpu);
1074 
1075 	if (likely(!IS_ERR(thread))) {
1076 		kthread_bind(thread, cpu);
1077 		wake_up_process(thread);
1078 
1079 		spin_lock_bh(&p->fcoe_rx_list.lock);
1080 		p->thread = thread;
1081 		spin_unlock_bh(&p->fcoe_rx_list.lock);
1082 	}
1083 }
1084 
1085 /**
1086  * fcoe_percpu_thread_destroy() - Remove the receive thread of a CPU
1087  * @cpu: The CPU index of the CPU whose receive thread is to be destroyed
1088  *
1089  * Destroys a per-CPU Rx thread. Any pending skbs are moved to the
1090  * current CPU's Rx thread. If the thread being destroyed is bound to
1091  * the CPU processing this context the skbs will be freed.
1092  */
1093 static void fcoe_percpu_thread_destroy(unsigned int cpu)
1094 {
1095 	struct fcoe_percpu_s *p;
1096 	struct task_struct *thread;
1097 	struct page *crc_eof;
1098 	struct sk_buff *skb;
1099 #ifdef CONFIG_SMP
1100 	struct fcoe_percpu_s *p0;
1101 	unsigned targ_cpu = get_cpu();
1102 #endif /* CONFIG_SMP */
1103 
1104 	FCOE_DBG("Destroying receive thread for CPU %d\n", cpu);
1105 
1106 	/* Prevent any new skbs from being queued for this CPU. */
1107 	p = &per_cpu(fcoe_percpu, cpu);
1108 	spin_lock_bh(&p->fcoe_rx_list.lock);
1109 	thread = p->thread;
1110 	p->thread = NULL;
1111 	crc_eof = p->crc_eof_page;
1112 	p->crc_eof_page = NULL;
1113 	p->crc_eof_offset = 0;
1114 	spin_unlock_bh(&p->fcoe_rx_list.lock);
1115 
1116 #ifdef CONFIG_SMP
1117 	/*
1118 	 * Don't bother moving the skb's if this context is running
1119 	 * on the same CPU that is having its thread destroyed. This
1120 	 * can easily happen when the module is removed.
1121 	 */
1122 	if (cpu != targ_cpu) {
1123 		p0 = &per_cpu(fcoe_percpu, targ_cpu);
1124 		spin_lock_bh(&p0->fcoe_rx_list.lock);
1125 		if (p0->thread) {
1126 			FCOE_DBG("Moving frames from CPU %d to CPU %d\n",
1127 				 cpu, targ_cpu);
1128 
1129 			while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
1130 				__skb_queue_tail(&p0->fcoe_rx_list, skb);
1131 			spin_unlock_bh(&p0->fcoe_rx_list.lock);
1132 		} else {
1133 			/*
1134 			 * The targeted CPU is not initialized and cannot accept
1135 			 * new	skbs. Unlock the targeted CPU and drop the skbs
1136 			 * on the CPU that is going offline.
1137 			 */
1138 			while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
1139 				kfree_skb(skb);
1140 			spin_unlock_bh(&p0->fcoe_rx_list.lock);
1141 		}
1142 	} else {
1143 		/*
1144 		 * This scenario occurs when the module is being removed
1145 		 * and all threads are being destroyed. skbs will continue
1146 		 * to be shifted from the CPU thread that is being removed
1147 		 * to the CPU thread associated with the CPU that is processing
1148 		 * the module removal. Once there is only one CPU Rx thread it
1149 		 * will reach this case and we will drop all skbs and later
1150 		 * stop the thread.
1151 		 */
1152 		spin_lock_bh(&p->fcoe_rx_list.lock);
1153 		while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
1154 			kfree_skb(skb);
1155 		spin_unlock_bh(&p->fcoe_rx_list.lock);
1156 	}
1157 	put_cpu();
1158 #else
1159 	/*
1160 	 * This a non-SMP scenario where the singular Rx thread is
1161 	 * being removed. Free all skbs and stop the thread.
1162 	 */
1163 	spin_lock_bh(&p->fcoe_rx_list.lock);
1164 	while ((skb = __skb_dequeue(&p->fcoe_rx_list)) != NULL)
1165 		kfree_skb(skb);
1166 	spin_unlock_bh(&p->fcoe_rx_list.lock);
1167 #endif
1168 
1169 	if (thread)
1170 		kthread_stop(thread);
1171 
1172 	if (crc_eof)
1173 		put_page(crc_eof);
1174 }
1175 
1176 /**
1177  * fcoe_cpu_callback() - Handler for CPU hotplug events
1178  * @nfb:    The callback data block
1179  * @action: The event triggering the callback
1180  * @hcpu:   The index of the CPU that the event is for
1181  *
1182  * This creates or destroys per-CPU data for fcoe
1183  *
1184  * Returns NOTIFY_OK always.
1185  */
1186 static int fcoe_cpu_callback(struct notifier_block *nfb,
1187 			     unsigned long action, void *hcpu)
1188 {
1189 	unsigned cpu = (unsigned long)hcpu;
1190 
1191 	switch (action) {
1192 	case CPU_ONLINE:
1193 	case CPU_ONLINE_FROZEN:
1194 		FCOE_DBG("CPU %x online: Create Rx thread\n", cpu);
1195 		fcoe_percpu_thread_create(cpu);
1196 		break;
1197 	case CPU_DEAD:
1198 	case CPU_DEAD_FROZEN:
1199 		FCOE_DBG("CPU %x offline: Remove Rx thread\n", cpu);
1200 		fcoe_percpu_thread_destroy(cpu);
1201 		break;
1202 	default:
1203 		break;
1204 	}
1205 	return NOTIFY_OK;
1206 }
1207 
1208 /**
1209  * fcoe_rcv() - Receive packets from a net device
1210  * @skb:    The received packet
1211  * @netdev: The net device that the packet was received on
1212  * @ptype:  The packet type context
1213  * @olddev: The last device net device
1214  *
1215  * This routine is called by NET_RX_SOFTIRQ. It receives a packet, builds a
1216  * FC frame and passes the frame to libfc.
1217  *
1218  * Returns: 0 for success
1219  */
1220 int fcoe_rcv(struct sk_buff *skb, struct net_device *netdev,
1221 	     struct packet_type *ptype, struct net_device *olddev)
1222 {
1223 	struct fc_lport *lport;
1224 	struct fcoe_rcv_info *fr;
1225 	struct fcoe_interface *fcoe;
1226 	struct fc_frame_header *fh;
1227 	struct fcoe_percpu_s *fps;
1228 	struct ethhdr *eh;
1229 	unsigned int cpu;
1230 
1231 	fcoe = container_of(ptype, struct fcoe_interface, fcoe_packet_type);
1232 	lport = fcoe->ctlr.lp;
1233 	if (unlikely(!lport)) {
1234 		FCOE_NETDEV_DBG(netdev, "Cannot find hba structure");
1235 		goto err2;
1236 	}
1237 	if (!lport->link_up)
1238 		goto err2;
1239 
1240 	FCOE_NETDEV_DBG(netdev, "skb_info: len:%d data_len:%d head:%p "
1241 			"data:%p tail:%p end:%p sum:%d dev:%s",
1242 			skb->len, skb->data_len, skb->head, skb->data,
1243 			skb_tail_pointer(skb), skb_end_pointer(skb),
1244 			skb->csum, skb->dev ? skb->dev->name : "<NULL>");
1245 
1246 	eh = eth_hdr(skb);
1247 
1248 	if (is_fip_mode(&fcoe->ctlr) &&
1249 	    compare_ether_addr(eh->h_source, fcoe->ctlr.dest_addr)) {
1250 		FCOE_NETDEV_DBG(netdev, "wrong source mac address:%pM\n",
1251 				eh->h_source);
1252 		goto err;
1253 	}
1254 
1255 	/*
1256 	 * Check for minimum frame length, and make sure required FCoE
1257 	 * and FC headers are pulled into the linear data area.
1258 	 */
1259 	if (unlikely((skb->len < FCOE_MIN_FRAME) ||
1260 		     !pskb_may_pull(skb, FCOE_HEADER_LEN)))
1261 		goto err;
1262 
1263 	skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
1264 	fh = (struct fc_frame_header *) skb_transport_header(skb);
1265 
1266 	if (ntoh24(&eh->h_dest[3]) != ntoh24(fh->fh_d_id)) {
1267 		FCOE_NETDEV_DBG(netdev, "FC frame d_id mismatch with MAC:%pM\n",
1268 				eh->h_dest);
1269 		goto err;
1270 	}
1271 
1272 	fr = fcoe_dev_from_skb(skb);
1273 	fr->fr_dev = lport;
1274 	fr->ptype = ptype;
1275 
1276 	/*
1277 	 * In case the incoming frame's exchange is originated from
1278 	 * the initiator, then received frame's exchange id is ANDed
1279 	 * with fc_cpu_mask bits to get the same cpu on which exchange
1280 	 * was originated, otherwise just use the current cpu.
1281 	 */
1282 	if (ntoh24(fh->fh_f_ctl) & FC_FC_EX_CTX)
1283 		cpu = ntohs(fh->fh_ox_id) & fc_cpu_mask;
1284 	else
1285 		cpu = smp_processor_id();
1286 
1287 	fps = &per_cpu(fcoe_percpu, cpu);
1288 	spin_lock_bh(&fps->fcoe_rx_list.lock);
1289 	if (unlikely(!fps->thread)) {
1290 		/*
1291 		 * The targeted CPU is not ready, let's target
1292 		 * the first CPU now. For non-SMP systems this
1293 		 * will check the same CPU twice.
1294 		 */
1295 		FCOE_NETDEV_DBG(netdev, "CPU is online, but no receive thread "
1296 				"ready for incoming skb- using first online "
1297 				"CPU.\n");
1298 
1299 		spin_unlock_bh(&fps->fcoe_rx_list.lock);
1300 		cpu = cpumask_first(cpu_online_mask);
1301 		fps = &per_cpu(fcoe_percpu, cpu);
1302 		spin_lock_bh(&fps->fcoe_rx_list.lock);
1303 		if (!fps->thread) {
1304 			spin_unlock_bh(&fps->fcoe_rx_list.lock);
1305 			goto err;
1306 		}
1307 	}
1308 
1309 	/*
1310 	 * We now have a valid CPU that we're targeting for
1311 	 * this skb. We also have this receive thread locked,
1312 	 * so we're free to queue skbs into it's queue.
1313 	 */
1314 
1315 	/* If this is a SCSI-FCP frame, and this is already executing on the
1316 	 * correct CPU, and the queue for this CPU is empty, then go ahead
1317 	 * and process the frame directly in the softirq context.
1318 	 * This lets us process completions without context switching from the
1319 	 * NET_RX softirq, to our receive processing thread, and then back to
1320 	 * BLOCK softirq context.
1321 	 */
1322 	if (fh->fh_type == FC_TYPE_FCP &&
1323 	    cpu == smp_processor_id() &&
1324 	    skb_queue_empty(&fps->fcoe_rx_list)) {
1325 		spin_unlock_bh(&fps->fcoe_rx_list.lock);
1326 		fcoe_recv_frame(skb);
1327 	} else {
1328 		__skb_queue_tail(&fps->fcoe_rx_list, skb);
1329 		if (fps->fcoe_rx_list.qlen == 1)
1330 			wake_up_process(fps->thread);
1331 		spin_unlock_bh(&fps->fcoe_rx_list.lock);
1332 	}
1333 
1334 	return 0;
1335 err:
1336 	per_cpu_ptr(lport->dev_stats, get_cpu())->ErrorFrames++;
1337 	put_cpu();
1338 err2:
1339 	kfree_skb(skb);
1340 	return -1;
1341 }
1342 
1343 /**
1344  * fcoe_alloc_paged_crc_eof() - Allocate a page to be used for the trailer CRC
1345  * @skb:  The packet to be transmitted
1346  * @tlen: The total length of the trailer
1347  *
1348  * Returns: 0 for success
1349  */
1350 static int fcoe_alloc_paged_crc_eof(struct sk_buff *skb, int tlen)
1351 {
1352 	struct fcoe_percpu_s *fps;
1353 	int rc;
1354 
1355 	fps = &get_cpu_var(fcoe_percpu);
1356 	rc = fcoe_get_paged_crc_eof(skb, tlen, fps);
1357 	put_cpu_var(fcoe_percpu);
1358 
1359 	return rc;
1360 }
1361 
1362 /**
1363  * fcoe_xmit() - Transmit a FCoE frame
1364  * @lport: The local port that the frame is to be transmitted for
1365  * @fp:	   The frame to be transmitted
1366  *
1367  * Return: 0 for success
1368  */
1369 int fcoe_xmit(struct fc_lport *lport, struct fc_frame *fp)
1370 {
1371 	int wlen;
1372 	u32 crc;
1373 	struct ethhdr *eh;
1374 	struct fcoe_crc_eof *cp;
1375 	struct sk_buff *skb;
1376 	struct fcoe_dev_stats *stats;
1377 	struct fc_frame_header *fh;
1378 	unsigned int hlen;		/* header length implies the version */
1379 	unsigned int tlen;		/* trailer length */
1380 	unsigned int elen;		/* eth header, may include vlan */
1381 	struct fcoe_port *port = lport_priv(lport);
1382 	struct fcoe_interface *fcoe = port->priv;
1383 	u8 sof, eof;
1384 	struct fcoe_hdr *hp;
1385 
1386 	WARN_ON((fr_len(fp) % sizeof(u32)) != 0);
1387 
1388 	fh = fc_frame_header_get(fp);
1389 	skb = fp_skb(fp);
1390 	wlen = skb->len / FCOE_WORD_TO_BYTE;
1391 
1392 	if (!lport->link_up) {
1393 		kfree_skb(skb);
1394 		return 0;
1395 	}
1396 
1397 	if (unlikely(fh->fh_type == FC_TYPE_ELS) &&
1398 	    fcoe_ctlr_els_send(&fcoe->ctlr, lport, skb))
1399 		return 0;
1400 
1401 	sof = fr_sof(fp);
1402 	eof = fr_eof(fp);
1403 
1404 	elen = sizeof(struct ethhdr);
1405 	hlen = sizeof(struct fcoe_hdr);
1406 	tlen = sizeof(struct fcoe_crc_eof);
1407 	wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
1408 
1409 	/* crc offload */
1410 	if (likely(lport->crc_offload)) {
1411 		skb->ip_summed = CHECKSUM_PARTIAL;
1412 		skb->csum_start = skb_headroom(skb);
1413 		skb->csum_offset = skb->len;
1414 		crc = 0;
1415 	} else {
1416 		skb->ip_summed = CHECKSUM_NONE;
1417 		crc = fcoe_fc_crc(fp);
1418 	}
1419 
1420 	/* copy port crc and eof to the skb buff */
1421 	if (skb_is_nonlinear(skb)) {
1422 		skb_frag_t *frag;
1423 		if (fcoe_alloc_paged_crc_eof(skb, tlen)) {
1424 			kfree_skb(skb);
1425 			return -ENOMEM;
1426 		}
1427 		frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
1428 		cp = kmap_atomic(frag->page, KM_SKB_DATA_SOFTIRQ)
1429 			+ frag->page_offset;
1430 	} else {
1431 		cp = (struct fcoe_crc_eof *)skb_put(skb, tlen);
1432 	}
1433 
1434 	memset(cp, 0, sizeof(*cp));
1435 	cp->fcoe_eof = eof;
1436 	cp->fcoe_crc32 = cpu_to_le32(~crc);
1437 
1438 	if (skb_is_nonlinear(skb)) {
1439 		kunmap_atomic(cp, KM_SKB_DATA_SOFTIRQ);
1440 		cp = NULL;
1441 	}
1442 
1443 	/* adjust skb network/transport offsets to match mac/fcoe/port */
1444 	skb_push(skb, elen + hlen);
1445 	skb_reset_mac_header(skb);
1446 	skb_reset_network_header(skb);
1447 	skb->mac_len = elen;
1448 	skb->protocol = htons(ETH_P_FCOE);
1449 	skb->dev = fcoe->netdev;
1450 
1451 	/* fill up mac and fcoe headers */
1452 	eh = eth_hdr(skb);
1453 	eh->h_proto = htons(ETH_P_FCOE);
1454 	memcpy(eh->h_dest, fcoe->ctlr.dest_addr, ETH_ALEN);
1455 	if (fcoe->ctlr.map_dest)
1456 		memcpy(eh->h_dest + 3, fh->fh_d_id, 3);
1457 
1458 	if (unlikely(fcoe->ctlr.flogi_oxid != FC_XID_UNKNOWN))
1459 		memcpy(eh->h_source, fcoe->ctlr.ctl_src_addr, ETH_ALEN);
1460 	else
1461 		memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
1462 
1463 	hp = (struct fcoe_hdr *)(eh + 1);
1464 	memset(hp, 0, sizeof(*hp));
1465 	if (FC_FCOE_VER)
1466 		FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
1467 	hp->fcoe_sof = sof;
1468 
1469 	/* fcoe lso, mss is in max_payload which is non-zero for FCP data */
1470 	if (lport->seq_offload && fr_max_payload(fp)) {
1471 		skb_shinfo(skb)->gso_type = SKB_GSO_FCOE;
1472 		skb_shinfo(skb)->gso_size = fr_max_payload(fp);
1473 	} else {
1474 		skb_shinfo(skb)->gso_type = 0;
1475 		skb_shinfo(skb)->gso_size = 0;
1476 	}
1477 	/* update tx stats: regardless if LLD fails */
1478 	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1479 	stats->TxFrames++;
1480 	stats->TxWords += wlen;
1481 	put_cpu();
1482 
1483 	/* send down to lld */
1484 	fr_dev(fp) = lport;
1485 	if (port->fcoe_pending_queue.qlen)
1486 		fcoe_check_wait_queue(lport, skb);
1487 	else if (fcoe_start_io(skb))
1488 		fcoe_check_wait_queue(lport, skb);
1489 
1490 	return 0;
1491 }
1492 
1493 /**
1494  * fcoe_percpu_flush_done() - Indicate per-CPU queue flush completion
1495  * @skb: The completed skb (argument required by destructor)
1496  */
1497 static void fcoe_percpu_flush_done(struct sk_buff *skb)
1498 {
1499 	complete(&fcoe_flush_completion);
1500 }
1501 
1502 /**
1503  * fcoe_filter_frames() - filter out bad fcoe frames, i.e. bad CRC
1504  * @lport: The local port the frame was received on
1505  * @fp:	   The received frame
1506  *
1507  * Return: 0 on passing filtering checks
1508  */
1509 static inline int fcoe_filter_frames(struct fc_lport *lport,
1510 				     struct fc_frame *fp)
1511 {
1512 	struct fcoe_interface *fcoe;
1513 	struct fc_frame_header *fh;
1514 	struct sk_buff *skb = (struct sk_buff *)fp;
1515 	struct fcoe_dev_stats *stats;
1516 
1517 	/*
1518 	 * We only check CRC if no offload is available and if it is
1519 	 * it's solicited data, in which case, the FCP layer would
1520 	 * check it during the copy.
1521 	 */
1522 	if (lport->crc_offload && skb->ip_summed == CHECKSUM_UNNECESSARY)
1523 		fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
1524 	else
1525 		fr_flags(fp) |= FCPHF_CRC_UNCHECKED;
1526 
1527 	fh = (struct fc_frame_header *) skb_transport_header(skb);
1528 	fh = fc_frame_header_get(fp);
1529 	if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA && fh->fh_type == FC_TYPE_FCP)
1530 		return 0;
1531 
1532 	fcoe = ((struct fcoe_port *)lport_priv(lport))->priv;
1533 	if (is_fip_mode(&fcoe->ctlr) && fc_frame_payload_op(fp) == ELS_LOGO &&
1534 	    ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
1535 		FCOE_DBG("fcoe: dropping FCoE lport LOGO in fip mode\n");
1536 		return -EINVAL;
1537 	}
1538 
1539 	if (!(fr_flags(fp) & FCPHF_CRC_UNCHECKED) ||
1540 	    le32_to_cpu(fr_crc(fp)) == ~crc32(~0, skb->data, skb->len)) {
1541 		fr_flags(fp) &= ~FCPHF_CRC_UNCHECKED;
1542 		return 0;
1543 	}
1544 
1545 	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1546 	stats->InvalidCRCCount++;
1547 	if (stats->InvalidCRCCount < 5)
1548 		printk(KERN_WARNING "fcoe: dropping frame with CRC error\n");
1549 	return -EINVAL;
1550 }
1551 
1552 /**
1553  * fcoe_recv_frame() - process a single received frame
1554  * @skb: frame to process
1555  */
1556 static void fcoe_recv_frame(struct sk_buff *skb)
1557 {
1558 	u32 fr_len;
1559 	struct fc_lport *lport;
1560 	struct fcoe_rcv_info *fr;
1561 	struct fcoe_dev_stats *stats;
1562 	struct fcoe_crc_eof crc_eof;
1563 	struct fc_frame *fp;
1564 	struct fcoe_port *port;
1565 	struct fcoe_hdr *hp;
1566 
1567 	fr = fcoe_dev_from_skb(skb);
1568 	lport = fr->fr_dev;
1569 	if (unlikely(!lport)) {
1570 		if (skb->destructor != fcoe_percpu_flush_done)
1571 			FCOE_NETDEV_DBG(skb->dev, "NULL lport in skb");
1572 		kfree_skb(skb);
1573 		return;
1574 	}
1575 
1576 	FCOE_NETDEV_DBG(skb->dev, "skb_info: len:%d data_len:%d "
1577 			"head:%p data:%p tail:%p end:%p sum:%d dev:%s",
1578 			skb->len, skb->data_len,
1579 			skb->head, skb->data, skb_tail_pointer(skb),
1580 			skb_end_pointer(skb), skb->csum,
1581 			skb->dev ? skb->dev->name : "<NULL>");
1582 
1583 	port = lport_priv(lport);
1584 	if (skb_is_nonlinear(skb))
1585 		skb_linearize(skb);	/* not ideal */
1586 
1587 	/*
1588 	 * Frame length checks and setting up the header pointers
1589 	 * was done in fcoe_rcv already.
1590 	 */
1591 	hp = (struct fcoe_hdr *) skb_network_header(skb);
1592 
1593 	stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1594 	if (unlikely(FC_FCOE_DECAPS_VER(hp) != FC_FCOE_VER)) {
1595 		if (stats->ErrorFrames < 5)
1596 			printk(KERN_WARNING "fcoe: FCoE version "
1597 			       "mismatch: The frame has "
1598 			       "version %x, but the "
1599 			       "initiator supports version "
1600 			       "%x\n", FC_FCOE_DECAPS_VER(hp),
1601 			       FC_FCOE_VER);
1602 		goto drop;
1603 	}
1604 
1605 	skb_pull(skb, sizeof(struct fcoe_hdr));
1606 	fr_len = skb->len - sizeof(struct fcoe_crc_eof);
1607 
1608 	stats->RxFrames++;
1609 	stats->RxWords += fr_len / FCOE_WORD_TO_BYTE;
1610 
1611 	fp = (struct fc_frame *)skb;
1612 	fc_frame_init(fp);
1613 	fr_dev(fp) = lport;
1614 	fr_sof(fp) = hp->fcoe_sof;
1615 
1616 	/* Copy out the CRC and EOF trailer for access */
1617 	if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof)))
1618 		goto drop;
1619 	fr_eof(fp) = crc_eof.fcoe_eof;
1620 	fr_crc(fp) = crc_eof.fcoe_crc32;
1621 	if (pskb_trim(skb, fr_len))
1622 		goto drop;
1623 
1624 	if (!fcoe_filter_frames(lport, fp)) {
1625 		put_cpu();
1626 		fc_exch_recv(lport, fp);
1627 		return;
1628 	}
1629 drop:
1630 	stats->ErrorFrames++;
1631 	put_cpu();
1632 	kfree_skb(skb);
1633 }
1634 
1635 /**
1636  * fcoe_percpu_receive_thread() - The per-CPU packet receive thread
1637  * @arg: The per-CPU context
1638  *
1639  * Return: 0 for success
1640  */
1641 int fcoe_percpu_receive_thread(void *arg)
1642 {
1643 	struct fcoe_percpu_s *p = arg;
1644 	struct sk_buff *skb;
1645 
1646 	set_user_nice(current, -20);
1647 
1648 	while (!kthread_should_stop()) {
1649 
1650 		spin_lock_bh(&p->fcoe_rx_list.lock);
1651 		while ((skb = __skb_dequeue(&p->fcoe_rx_list)) == NULL) {
1652 			set_current_state(TASK_INTERRUPTIBLE);
1653 			spin_unlock_bh(&p->fcoe_rx_list.lock);
1654 			schedule();
1655 			set_current_state(TASK_RUNNING);
1656 			if (kthread_should_stop())
1657 				return 0;
1658 			spin_lock_bh(&p->fcoe_rx_list.lock);
1659 		}
1660 		spin_unlock_bh(&p->fcoe_rx_list.lock);
1661 		fcoe_recv_frame(skb);
1662 	}
1663 	return 0;
1664 }
1665 
1666 /**
1667  * fcoe_dev_setup() - Setup the link change notification interface
1668  */
1669 static void fcoe_dev_setup(void)
1670 {
1671 	register_netdevice_notifier(&fcoe_notifier);
1672 }
1673 
1674 /**
1675  * fcoe_dev_cleanup() - Cleanup the link change notification interface
1676  */
1677 static void fcoe_dev_cleanup(void)
1678 {
1679 	unregister_netdevice_notifier(&fcoe_notifier);
1680 }
1681 
1682 /**
1683  * fcoe_device_notification() - Handler for net device events
1684  * @notifier: The context of the notification
1685  * @event:    The type of event
1686  * @ptr:      The net device that the event was on
1687  *
1688  * This function is called by the Ethernet driver in case of link change event.
1689  *
1690  * Returns: 0 for success
1691  */
1692 static int fcoe_device_notification(struct notifier_block *notifier,
1693 				    ulong event, void *ptr)
1694 {
1695 	struct fc_lport *lport = NULL;
1696 	struct net_device *netdev = ptr;
1697 	struct fcoe_interface *fcoe;
1698 	struct fcoe_port *port;
1699 	struct fcoe_dev_stats *stats;
1700 	u32 link_possible = 1;
1701 	u32 mfs;
1702 	int rc = NOTIFY_OK;
1703 
1704 	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
1705 		if (fcoe->netdev == netdev) {
1706 			lport = fcoe->ctlr.lp;
1707 			break;
1708 		}
1709 	}
1710 	if (!lport) {
1711 		rc = NOTIFY_DONE;
1712 		goto out;
1713 	}
1714 
1715 	switch (event) {
1716 	case NETDEV_DOWN:
1717 	case NETDEV_GOING_DOWN:
1718 		link_possible = 0;
1719 		break;
1720 	case NETDEV_UP:
1721 	case NETDEV_CHANGE:
1722 		break;
1723 	case NETDEV_CHANGEMTU:
1724 		if (netdev->features & NETIF_F_FCOE_MTU)
1725 			break;
1726 		mfs = netdev->mtu - (sizeof(struct fcoe_hdr) +
1727 				     sizeof(struct fcoe_crc_eof));
1728 		if (mfs >= FC_MIN_MAX_FRAME)
1729 			fc_set_mfs(lport, mfs);
1730 		break;
1731 	case NETDEV_REGISTER:
1732 		break;
1733 	case NETDEV_UNREGISTER:
1734 		list_del(&fcoe->list);
1735 		port = lport_priv(fcoe->ctlr.lp);
1736 		fcoe_interface_cleanup(fcoe);
1737 		queue_work(fcoe_wq, &port->destroy_work);
1738 		goto out;
1739 		break;
1740 	case NETDEV_FEAT_CHANGE:
1741 		fcoe_netdev_features_change(lport, netdev);
1742 		break;
1743 	default:
1744 		FCOE_NETDEV_DBG(netdev, "Unknown event %ld "
1745 				"from netdev netlink\n", event);
1746 	}
1747 
1748 	fcoe_link_speed_update(lport);
1749 
1750 	if (link_possible && !fcoe_link_ok(lport))
1751 		fcoe_ctlr_link_up(&fcoe->ctlr);
1752 	else if (fcoe_ctlr_link_down(&fcoe->ctlr)) {
1753 		stats = per_cpu_ptr(lport->dev_stats, get_cpu());
1754 		stats->LinkFailureCount++;
1755 		put_cpu();
1756 		fcoe_clean_pending_queue(lport);
1757 	}
1758 out:
1759 	return rc;
1760 }
1761 
1762 /**
1763  * fcoe_disable() - Disables a FCoE interface
1764  * @netdev  : The net_device object the Ethernet interface to create on
1765  *
1766  * Called from fcoe transport.
1767  *
1768  * Returns: 0 for success
1769  */
1770 static int fcoe_disable(struct net_device *netdev)
1771 {
1772 	struct fcoe_interface *fcoe;
1773 	int rc = 0;
1774 
1775 	mutex_lock(&fcoe_config_mutex);
1776 
1777 	rtnl_lock();
1778 	fcoe = fcoe_hostlist_lookup_port(netdev);
1779 	rtnl_unlock();
1780 
1781 	if (fcoe) {
1782 		fcoe_ctlr_link_down(&fcoe->ctlr);
1783 		fcoe_clean_pending_queue(fcoe->ctlr.lp);
1784 	} else
1785 		rc = -ENODEV;
1786 
1787 	mutex_unlock(&fcoe_config_mutex);
1788 	return rc;
1789 }
1790 
1791 /**
1792  * fcoe_enable() - Enables a FCoE interface
1793  * @netdev  : The net_device object the Ethernet interface to create on
1794  *
1795  * Called from fcoe transport.
1796  *
1797  * Returns: 0 for success
1798  */
1799 static int fcoe_enable(struct net_device *netdev)
1800 {
1801 	struct fcoe_interface *fcoe;
1802 	int rc = 0;
1803 
1804 	mutex_lock(&fcoe_config_mutex);
1805 	rtnl_lock();
1806 	fcoe = fcoe_hostlist_lookup_port(netdev);
1807 	rtnl_unlock();
1808 
1809 	if (!fcoe)
1810 		rc = -ENODEV;
1811 	else if (!fcoe_link_ok(fcoe->ctlr.lp))
1812 		fcoe_ctlr_link_up(&fcoe->ctlr);
1813 
1814 	mutex_unlock(&fcoe_config_mutex);
1815 	return rc;
1816 }
1817 
1818 /**
1819  * fcoe_destroy() - Destroy a FCoE interface
1820  * @netdev  : The net_device object the Ethernet interface to create on
1821  *
1822  * Called from fcoe transport
1823  *
1824  * Returns: 0 for success
1825  */
1826 static int fcoe_destroy(struct net_device *netdev)
1827 {
1828 	struct fcoe_interface *fcoe;
1829 	struct fc_lport *lport;
1830 	int rc = 0;
1831 
1832 	mutex_lock(&fcoe_config_mutex);
1833 	rtnl_lock();
1834 	fcoe = fcoe_hostlist_lookup_port(netdev);
1835 	if (!fcoe) {
1836 		rtnl_unlock();
1837 		rc = -ENODEV;
1838 		goto out_nodev;
1839 	}
1840 	lport = fcoe->ctlr.lp;
1841 	list_del(&fcoe->list);
1842 	fcoe_interface_cleanup(fcoe);
1843 	rtnl_unlock();
1844 	fcoe_if_destroy(lport);
1845 out_nodev:
1846 	mutex_unlock(&fcoe_config_mutex);
1847 	return rc;
1848 }
1849 
1850 /**
1851  * fcoe_destroy_work() - Destroy a FCoE port in a deferred work context
1852  * @work: Handle to the FCoE port to be destroyed
1853  */
1854 static void fcoe_destroy_work(struct work_struct *work)
1855 {
1856 	struct fcoe_port *port;
1857 
1858 	port = container_of(work, struct fcoe_port, destroy_work);
1859 	mutex_lock(&fcoe_config_mutex);
1860 	fcoe_if_destroy(port->lport);
1861 	mutex_unlock(&fcoe_config_mutex);
1862 }
1863 
1864 /**
1865  * fcoe_match() - Check if the FCoE is supported on the given netdevice
1866  * @netdev  : The net_device object the Ethernet interface to create on
1867  *
1868  * Called from fcoe transport.
1869  *
1870  * Returns: always returns true as this is the default FCoE transport,
1871  * i.e., support all netdevs.
1872  */
1873 static bool fcoe_match(struct net_device *netdev)
1874 {
1875 	return true;
1876 }
1877 
1878 /**
1879  * fcoe_create() - Create a fcoe interface
1880  * @netdev  : The net_device object the Ethernet interface to create on
1881  * @fip_mode: The FIP mode for this creation
1882  *
1883  * Called from fcoe transport
1884  *
1885  * Returns: 0 for success
1886  */
1887 static int fcoe_create(struct net_device *netdev, enum fip_state fip_mode)
1888 {
1889 	int rc;
1890 	struct fcoe_interface *fcoe;
1891 	struct fc_lport *lport;
1892 
1893 	mutex_lock(&fcoe_config_mutex);
1894 	rtnl_lock();
1895 
1896 	/* look for existing lport */
1897 	if (fcoe_hostlist_lookup(netdev)) {
1898 		rc = -EEXIST;
1899 		goto out_nodev;
1900 	}
1901 
1902 	fcoe = fcoe_interface_create(netdev, fip_mode);
1903 	if (IS_ERR(fcoe)) {
1904 		rc = PTR_ERR(fcoe);
1905 		goto out_nodev;
1906 	}
1907 
1908 	lport = fcoe_if_create(fcoe, &netdev->dev, 0);
1909 	if (IS_ERR(lport)) {
1910 		printk(KERN_ERR "fcoe: Failed to create interface (%s)\n",
1911 		       netdev->name);
1912 		rc = -EIO;
1913 		fcoe_interface_cleanup(fcoe);
1914 		goto out_free;
1915 	}
1916 
1917 	/* Make this the "master" N_Port */
1918 	fcoe->ctlr.lp = lport;
1919 
1920 	/* add to lports list */
1921 	fcoe_hostlist_add(lport);
1922 
1923 	/* start FIP Discovery and FLOGI */
1924 	lport->boot_time = jiffies;
1925 	fc_fabric_login(lport);
1926 	if (!fcoe_link_ok(lport))
1927 		fcoe_ctlr_link_up(&fcoe->ctlr);
1928 
1929 	/*
1930 	 * Release from init in fcoe_interface_create(), on success lport
1931 	 * should be holding a reference taken in fcoe_if_create().
1932 	 */
1933 	fcoe_interface_put(fcoe);
1934 	rtnl_unlock();
1935 	mutex_unlock(&fcoe_config_mutex);
1936 
1937 	return 0;
1938 out_free:
1939 	fcoe_interface_put(fcoe);
1940 out_nodev:
1941 	rtnl_unlock();
1942 	mutex_unlock(&fcoe_config_mutex);
1943 	return rc;
1944 }
1945 
1946 /**
1947  * fcoe_link_speed_update() - Update the supported and actual link speeds
1948  * @lport: The local port to update speeds for
1949  *
1950  * Returns: 0 if the ethtool query was successful
1951  *          -1 if the ethtool query failed
1952  */
1953 int fcoe_link_speed_update(struct fc_lport *lport)
1954 {
1955 	struct net_device *netdev = fcoe_netdev(lport);
1956 	struct ethtool_cmd ecmd;
1957 
1958 	if (!dev_ethtool_get_settings(netdev, &ecmd)) {
1959 		lport->link_supported_speeds &=
1960 			~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
1961 		if (ecmd.supported & (SUPPORTED_1000baseT_Half |
1962 				      SUPPORTED_1000baseT_Full))
1963 			lport->link_supported_speeds |= FC_PORTSPEED_1GBIT;
1964 		if (ecmd.supported & SUPPORTED_10000baseT_Full)
1965 			lport->link_supported_speeds |=
1966 				FC_PORTSPEED_10GBIT;
1967 		switch (ethtool_cmd_speed(&ecmd)) {
1968 		case SPEED_1000:
1969 			lport->link_speed = FC_PORTSPEED_1GBIT;
1970 			break;
1971 		case SPEED_10000:
1972 			lport->link_speed = FC_PORTSPEED_10GBIT;
1973 			break;
1974 		}
1975 		return 0;
1976 	}
1977 	return -1;
1978 }
1979 
1980 /**
1981  * fcoe_link_ok() - Check if the link is OK for a local port
1982  * @lport: The local port to check link on
1983  *
1984  * Returns: 0 if link is UP and OK, -1 if not
1985  *
1986  */
1987 int fcoe_link_ok(struct fc_lport *lport)
1988 {
1989 	struct net_device *netdev = fcoe_netdev(lport);
1990 
1991 	if (netif_oper_up(netdev))
1992 		return 0;
1993 	return -1;
1994 }
1995 
1996 /**
1997  * fcoe_percpu_clean() - Clear all pending skbs for an local port
1998  * @lport: The local port whose skbs are to be cleared
1999  *
2000  * Must be called with fcoe_create_mutex held to single-thread completion.
2001  *
2002  * This flushes the pending skbs by adding a new skb to each queue and
2003  * waiting until they are all freed.  This assures us that not only are
2004  * there no packets that will be handled by the lport, but also that any
2005  * threads already handling packet have returned.
2006  */
2007 void fcoe_percpu_clean(struct fc_lport *lport)
2008 {
2009 	struct fcoe_percpu_s *pp;
2010 	struct fcoe_rcv_info *fr;
2011 	struct sk_buff_head *list;
2012 	struct sk_buff *skb, *next;
2013 	struct sk_buff *head;
2014 	unsigned int cpu;
2015 
2016 	for_each_possible_cpu(cpu) {
2017 		pp = &per_cpu(fcoe_percpu, cpu);
2018 		spin_lock_bh(&pp->fcoe_rx_list.lock);
2019 		list = &pp->fcoe_rx_list;
2020 		head = list->next;
2021 		for (skb = head; skb != (struct sk_buff *)list;
2022 		     skb = next) {
2023 			next = skb->next;
2024 			fr = fcoe_dev_from_skb(skb);
2025 			if (fr->fr_dev == lport) {
2026 				__skb_unlink(skb, list);
2027 				kfree_skb(skb);
2028 			}
2029 		}
2030 
2031 		if (!pp->thread || !cpu_online(cpu)) {
2032 			spin_unlock_bh(&pp->fcoe_rx_list.lock);
2033 			continue;
2034 		}
2035 
2036 		skb = dev_alloc_skb(0);
2037 		if (!skb) {
2038 			spin_unlock_bh(&pp->fcoe_rx_list.lock);
2039 			continue;
2040 		}
2041 		skb->destructor = fcoe_percpu_flush_done;
2042 
2043 		__skb_queue_tail(&pp->fcoe_rx_list, skb);
2044 		if (pp->fcoe_rx_list.qlen == 1)
2045 			wake_up_process(pp->thread);
2046 		spin_unlock_bh(&pp->fcoe_rx_list.lock);
2047 
2048 		wait_for_completion(&fcoe_flush_completion);
2049 	}
2050 }
2051 
2052 /**
2053  * fcoe_reset() - Reset a local port
2054  * @shost: The SCSI host associated with the local port to be reset
2055  *
2056  * Returns: Always 0 (return value required by FC transport template)
2057  */
2058 int fcoe_reset(struct Scsi_Host *shost)
2059 {
2060 	struct fc_lport *lport = shost_priv(shost);
2061 	struct fcoe_port *port = lport_priv(lport);
2062 	struct fcoe_interface *fcoe = port->priv;
2063 
2064 	fcoe_ctlr_link_down(&fcoe->ctlr);
2065 	fcoe_clean_pending_queue(fcoe->ctlr.lp);
2066 	if (!fcoe_link_ok(fcoe->ctlr.lp))
2067 		fcoe_ctlr_link_up(&fcoe->ctlr);
2068 	return 0;
2069 }
2070 
2071 /**
2072  * fcoe_hostlist_lookup_port() - Find the FCoE interface associated with a net device
2073  * @netdev: The net device used as a key
2074  *
2075  * Locking: Must be called with the RNL mutex held.
2076  *
2077  * Returns: NULL or the FCoE interface
2078  */
2079 static struct fcoe_interface *
2080 fcoe_hostlist_lookup_port(const struct net_device *netdev)
2081 {
2082 	struct fcoe_interface *fcoe;
2083 
2084 	list_for_each_entry(fcoe, &fcoe_hostlist, list) {
2085 		if (fcoe->netdev == netdev)
2086 			return fcoe;
2087 	}
2088 	return NULL;
2089 }
2090 
2091 /**
2092  * fcoe_hostlist_lookup() - Find the local port associated with a
2093  *			    given net device
2094  * @netdev: The netdevice used as a key
2095  *
2096  * Locking: Must be called with the RTNL mutex held
2097  *
2098  * Returns: NULL or the local port
2099  */
2100 static struct fc_lport *fcoe_hostlist_lookup(const struct net_device *netdev)
2101 {
2102 	struct fcoe_interface *fcoe;
2103 
2104 	fcoe = fcoe_hostlist_lookup_port(netdev);
2105 	return (fcoe) ? fcoe->ctlr.lp : NULL;
2106 }
2107 
2108 /**
2109  * fcoe_hostlist_add() - Add the FCoE interface identified by a local
2110  *			 port to the hostlist
2111  * @lport: The local port that identifies the FCoE interface to be added
2112  *
2113  * Locking: must be called with the RTNL mutex held
2114  *
2115  * Returns: 0 for success
2116  */
2117 static int fcoe_hostlist_add(const struct fc_lport *lport)
2118 {
2119 	struct fcoe_interface *fcoe;
2120 	struct fcoe_port *port;
2121 
2122 	fcoe = fcoe_hostlist_lookup_port(fcoe_netdev(lport));
2123 	if (!fcoe) {
2124 		port = lport_priv(lport);
2125 		fcoe = port->priv;
2126 		list_add_tail(&fcoe->list, &fcoe_hostlist);
2127 	}
2128 	return 0;
2129 }
2130 
2131 
2132 static struct fcoe_transport fcoe_sw_transport = {
2133 	.name = {FCOE_TRANSPORT_DEFAULT},
2134 	.attached = false,
2135 	.list = LIST_HEAD_INIT(fcoe_sw_transport.list),
2136 	.match = fcoe_match,
2137 	.create = fcoe_create,
2138 	.destroy = fcoe_destroy,
2139 	.enable = fcoe_enable,
2140 	.disable = fcoe_disable,
2141 };
2142 
2143 /**
2144  * fcoe_init() - Initialize fcoe.ko
2145  *
2146  * Returns: 0 on success, or a negative value on failure
2147  */
2148 static int __init fcoe_init(void)
2149 {
2150 	struct fcoe_percpu_s *p;
2151 	unsigned int cpu;
2152 	int rc = 0;
2153 
2154 	fcoe_wq = alloc_workqueue("fcoe", 0, 0);
2155 	if (!fcoe_wq)
2156 		return -ENOMEM;
2157 
2158 	/* register as a fcoe transport */
2159 	rc = fcoe_transport_attach(&fcoe_sw_transport);
2160 	if (rc) {
2161 		printk(KERN_ERR "failed to register an fcoe transport, check "
2162 			"if libfcoe is loaded\n");
2163 		return rc;
2164 	}
2165 
2166 	mutex_lock(&fcoe_config_mutex);
2167 
2168 	for_each_possible_cpu(cpu) {
2169 		p = &per_cpu(fcoe_percpu, cpu);
2170 		skb_queue_head_init(&p->fcoe_rx_list);
2171 	}
2172 
2173 	for_each_online_cpu(cpu)
2174 		fcoe_percpu_thread_create(cpu);
2175 
2176 	/* Initialize per CPU interrupt thread */
2177 	rc = register_hotcpu_notifier(&fcoe_cpu_notifier);
2178 	if (rc)
2179 		goto out_free;
2180 
2181 	/* Setup link change notification */
2182 	fcoe_dev_setup();
2183 
2184 	rc = fcoe_if_init();
2185 	if (rc)
2186 		goto out_free;
2187 
2188 	mutex_unlock(&fcoe_config_mutex);
2189 	return 0;
2190 
2191 out_free:
2192 	for_each_online_cpu(cpu) {
2193 		fcoe_percpu_thread_destroy(cpu);
2194 	}
2195 	mutex_unlock(&fcoe_config_mutex);
2196 	destroy_workqueue(fcoe_wq);
2197 	return rc;
2198 }
2199 module_init(fcoe_init);
2200 
2201 /**
2202  * fcoe_exit() - Clean up fcoe.ko
2203  *
2204  * Returns: 0 on success or a  negative value on failure
2205  */
2206 static void __exit fcoe_exit(void)
2207 {
2208 	struct fcoe_interface *fcoe, *tmp;
2209 	struct fcoe_port *port;
2210 	unsigned int cpu;
2211 
2212 	mutex_lock(&fcoe_config_mutex);
2213 
2214 	fcoe_dev_cleanup();
2215 
2216 	/* releases the associated fcoe hosts */
2217 	rtnl_lock();
2218 	list_for_each_entry_safe(fcoe, tmp, &fcoe_hostlist, list) {
2219 		list_del(&fcoe->list);
2220 		port = lport_priv(fcoe->ctlr.lp);
2221 		fcoe_interface_cleanup(fcoe);
2222 		queue_work(fcoe_wq, &port->destroy_work);
2223 	}
2224 	rtnl_unlock();
2225 
2226 	unregister_hotcpu_notifier(&fcoe_cpu_notifier);
2227 
2228 	for_each_online_cpu(cpu)
2229 		fcoe_percpu_thread_destroy(cpu);
2230 
2231 	mutex_unlock(&fcoe_config_mutex);
2232 
2233 	/*
2234 	 * destroy_work's may be chained but destroy_workqueue()
2235 	 * can take care of them. Just kill the fcoe_wq.
2236 	 */
2237 	destroy_workqueue(fcoe_wq);
2238 
2239 	/*
2240 	 * Detaching from the scsi transport must happen after all
2241 	 * destroys are done on the fcoe_wq. destroy_workqueue will
2242 	 * enusre the fcoe_wq is flushed.
2243 	 */
2244 	fcoe_if_exit();
2245 
2246 	/* detach from fcoe transport */
2247 	fcoe_transport_detach(&fcoe_sw_transport);
2248 }
2249 module_exit(fcoe_exit);
2250 
2251 /**
2252  * fcoe_flogi_resp() - FCoE specific FLOGI and FDISC response handler
2253  * @seq: active sequence in the FLOGI or FDISC exchange
2254  * @fp: response frame, or error encoded in a pointer (timeout)
2255  * @arg: pointer the the fcoe_ctlr structure
2256  *
2257  * This handles MAC address management for FCoE, then passes control on to
2258  * the libfc FLOGI response handler.
2259  */
2260 static void fcoe_flogi_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
2261 {
2262 	struct fcoe_ctlr *fip = arg;
2263 	struct fc_exch *exch = fc_seq_exch(seq);
2264 	struct fc_lport *lport = exch->lp;
2265 	u8 *mac;
2266 
2267 	if (IS_ERR(fp))
2268 		goto done;
2269 
2270 	mac = fr_cb(fp)->granted_mac;
2271 	if (is_zero_ether_addr(mac)) {
2272 		/* pre-FIP */
2273 		if (fcoe_ctlr_recv_flogi(fip, lport, fp)) {
2274 			fc_frame_free(fp);
2275 			return;
2276 		}
2277 	}
2278 	fcoe_update_src_mac(lport, mac);
2279 done:
2280 	fc_lport_flogi_resp(seq, fp, lport);
2281 }
2282 
2283 /**
2284  * fcoe_logo_resp() - FCoE specific LOGO response handler
2285  * @seq: active sequence in the LOGO exchange
2286  * @fp: response frame, or error encoded in a pointer (timeout)
2287  * @arg: pointer the the fcoe_ctlr structure
2288  *
2289  * This handles MAC address management for FCoE, then passes control on to
2290  * the libfc LOGO response handler.
2291  */
2292 static void fcoe_logo_resp(struct fc_seq *seq, struct fc_frame *fp, void *arg)
2293 {
2294 	struct fc_lport *lport = arg;
2295 	static u8 zero_mac[ETH_ALEN] = { 0 };
2296 
2297 	if (!IS_ERR(fp))
2298 		fcoe_update_src_mac(lport, zero_mac);
2299 	fc_lport_logo_resp(seq, fp, lport);
2300 }
2301 
2302 /**
2303  * fcoe_elsct_send - FCoE specific ELS handler
2304  *
2305  * This does special case handling of FIP encapsualted ELS exchanges for FCoE,
2306  * using FCoE specific response handlers and passing the FIP controller as
2307  * the argument (the lport is still available from the exchange).
2308  *
2309  * Most of the work here is just handed off to the libfc routine.
2310  */
2311 static struct fc_seq *fcoe_elsct_send(struct fc_lport *lport, u32 did,
2312 				      struct fc_frame *fp, unsigned int op,
2313 				      void (*resp)(struct fc_seq *,
2314 						   struct fc_frame *,
2315 						   void *),
2316 				      void *arg, u32 timeout)
2317 {
2318 	struct fcoe_port *port = lport_priv(lport);
2319 	struct fcoe_interface *fcoe = port->priv;
2320 	struct fcoe_ctlr *fip = &fcoe->ctlr;
2321 	struct fc_frame_header *fh = fc_frame_header_get(fp);
2322 
2323 	switch (op) {
2324 	case ELS_FLOGI:
2325 	case ELS_FDISC:
2326 		if (lport->point_to_multipoint)
2327 			break;
2328 		return fc_elsct_send(lport, did, fp, op, fcoe_flogi_resp,
2329 				     fip, timeout);
2330 	case ELS_LOGO:
2331 		/* only hook onto fabric logouts, not port logouts */
2332 		if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI)
2333 			break;
2334 		return fc_elsct_send(lport, did, fp, op, fcoe_logo_resp,
2335 				     lport, timeout);
2336 	}
2337 	return fc_elsct_send(lport, did, fp, op, resp, arg, timeout);
2338 }
2339 
2340 /**
2341  * fcoe_vport_create() - create an fc_host/scsi_host for a vport
2342  * @vport: fc_vport object to create a new fc_host for
2343  * @disabled: start the new fc_host in a disabled state by default?
2344  *
2345  * Returns: 0 for success
2346  */
2347 static int fcoe_vport_create(struct fc_vport *vport, bool disabled)
2348 {
2349 	struct Scsi_Host *shost = vport_to_shost(vport);
2350 	struct fc_lport *n_port = shost_priv(shost);
2351 	struct fcoe_port *port = lport_priv(n_port);
2352 	struct fcoe_interface *fcoe = port->priv;
2353 	struct net_device *netdev = fcoe->netdev;
2354 	struct fc_lport *vn_port;
2355 	int rc;
2356 	char buf[32];
2357 
2358 	rc = fcoe_validate_vport_create(vport);
2359 	if (rc) {
2360 		wwn_to_str(vport->port_name, buf, sizeof(buf));
2361 		printk(KERN_ERR "fcoe: Failed to create vport, "
2362 			"WWPN (0x%s) already exists\n",
2363 			buf);
2364 		return rc;
2365 	}
2366 
2367 	mutex_lock(&fcoe_config_mutex);
2368 	vn_port = fcoe_if_create(fcoe, &vport->dev, 1);
2369 	mutex_unlock(&fcoe_config_mutex);
2370 
2371 	if (IS_ERR(vn_port)) {
2372 		printk(KERN_ERR "fcoe: fcoe_vport_create(%s) failed\n",
2373 		       netdev->name);
2374 		return -EIO;
2375 	}
2376 
2377 	if (disabled) {
2378 		fc_vport_set_state(vport, FC_VPORT_DISABLED);
2379 	} else {
2380 		vn_port->boot_time = jiffies;
2381 		fc_fabric_login(vn_port);
2382 		fc_vport_setlink(vn_port);
2383 	}
2384 	return 0;
2385 }
2386 
2387 /**
2388  * fcoe_vport_destroy() - destroy the fc_host/scsi_host for a vport
2389  * @vport: fc_vport object that is being destroyed
2390  *
2391  * Returns: 0 for success
2392  */
2393 static int fcoe_vport_destroy(struct fc_vport *vport)
2394 {
2395 	struct Scsi_Host *shost = vport_to_shost(vport);
2396 	struct fc_lport *n_port = shost_priv(shost);
2397 	struct fc_lport *vn_port = vport->dd_data;
2398 	struct fcoe_port *port = lport_priv(vn_port);
2399 
2400 	mutex_lock(&n_port->lp_mutex);
2401 	list_del(&vn_port->list);
2402 	mutex_unlock(&n_port->lp_mutex);
2403 	queue_work(fcoe_wq, &port->destroy_work);
2404 	return 0;
2405 }
2406 
2407 /**
2408  * fcoe_vport_disable() - change vport state
2409  * @vport: vport to bring online/offline
2410  * @disable: should the vport be disabled?
2411  */
2412 static int fcoe_vport_disable(struct fc_vport *vport, bool disable)
2413 {
2414 	struct fc_lport *lport = vport->dd_data;
2415 
2416 	if (disable) {
2417 		fc_vport_set_state(vport, FC_VPORT_DISABLED);
2418 		fc_fabric_logoff(lport);
2419 	} else {
2420 		lport->boot_time = jiffies;
2421 		fc_fabric_login(lport);
2422 		fc_vport_setlink(lport);
2423 	}
2424 
2425 	return 0;
2426 }
2427 
2428 /**
2429  * fcoe_vport_set_symbolic_name() - append vport string to symbolic name
2430  * @vport: fc_vport with a new symbolic name string
2431  *
2432  * After generating a new symbolic name string, a new RSPN_ID request is
2433  * sent to the name server.  There is no response handler, so if it fails
2434  * for some reason it will not be retried.
2435  */
2436 static void fcoe_set_vport_symbolic_name(struct fc_vport *vport)
2437 {
2438 	struct fc_lport *lport = vport->dd_data;
2439 	struct fc_frame *fp;
2440 	size_t len;
2441 
2442 	snprintf(fc_host_symbolic_name(lport->host), FC_SYMBOLIC_NAME_SIZE,
2443 		 "%s v%s over %s : %s", FCOE_NAME, FCOE_VERSION,
2444 		 fcoe_netdev(lport)->name, vport->symbolic_name);
2445 
2446 	if (lport->state != LPORT_ST_READY)
2447 		return;
2448 
2449 	len = strnlen(fc_host_symbolic_name(lport->host), 255);
2450 	fp = fc_frame_alloc(lport,
2451 			    sizeof(struct fc_ct_hdr) +
2452 			    sizeof(struct fc_ns_rspn) + len);
2453 	if (!fp)
2454 		return;
2455 	lport->tt.elsct_send(lport, FC_FID_DIR_SERV, fp, FC_NS_RSPN_ID,
2456 			     NULL, NULL, 3 * lport->r_a_tov);
2457 }
2458 
2459 /**
2460  * fcoe_get_lesb() - Fill the FCoE Link Error Status Block
2461  * @lport: the local port
2462  * @fc_lesb: the link error status block
2463  */
2464 static void fcoe_get_lesb(struct fc_lport *lport,
2465 			 struct fc_els_lesb *fc_lesb)
2466 {
2467 	unsigned int cpu;
2468 	u32 lfc, vlfc, mdac;
2469 	struct fcoe_dev_stats *devst;
2470 	struct fcoe_fc_els_lesb *lesb;
2471 	struct rtnl_link_stats64 temp;
2472 	struct net_device *netdev = fcoe_netdev(lport);
2473 
2474 	lfc = 0;
2475 	vlfc = 0;
2476 	mdac = 0;
2477 	lesb = (struct fcoe_fc_els_lesb *)fc_lesb;
2478 	memset(lesb, 0, sizeof(*lesb));
2479 	for_each_possible_cpu(cpu) {
2480 		devst = per_cpu_ptr(lport->dev_stats, cpu);
2481 		lfc += devst->LinkFailureCount;
2482 		vlfc += devst->VLinkFailureCount;
2483 		mdac += devst->MissDiscAdvCount;
2484 	}
2485 	lesb->lesb_link_fail = htonl(lfc);
2486 	lesb->lesb_vlink_fail = htonl(vlfc);
2487 	lesb->lesb_miss_fka = htonl(mdac);
2488 	lesb->lesb_fcs_error = htonl(dev_get_stats(netdev, &temp)->rx_crc_errors);
2489 }
2490 
2491 /**
2492  * fcoe_set_port_id() - Callback from libfc when Port_ID is set.
2493  * @lport: the local port
2494  * @port_id: the port ID
2495  * @fp: the received frame, if any, that caused the port_id to be set.
2496  *
2497  * This routine handles the case where we received a FLOGI and are
2498  * entering point-to-point mode.  We need to call fcoe_ctlr_recv_flogi()
2499  * so it can set the non-mapped mode and gateway address.
2500  *
2501  * The FLOGI LS_ACC is handled by fcoe_flogi_resp().
2502  */
2503 static void fcoe_set_port_id(struct fc_lport *lport,
2504 			     u32 port_id, struct fc_frame *fp)
2505 {
2506 	struct fcoe_port *port = lport_priv(lport);
2507 	struct fcoe_interface *fcoe = port->priv;
2508 
2509 	if (fp && fc_frame_payload_op(fp) == ELS_FLOGI)
2510 		fcoe_ctlr_recv_flogi(&fcoe->ctlr, lport, fp);
2511 }
2512 
2513 /**
2514  * fcoe_validate_vport_create() - Validate a vport before creating it
2515  * @vport: NPIV port to be created
2516  *
2517  * This routine is meant to add validation for a vport before creating it
2518  * via fcoe_vport_create().
2519  * Current validations are:
2520  *      - WWPN supplied is unique for given lport
2521  *
2522  *
2523 */
2524 static int fcoe_validate_vport_create(struct fc_vport *vport)
2525 {
2526 	struct Scsi_Host *shost = vport_to_shost(vport);
2527 	struct fc_lport *n_port = shost_priv(shost);
2528 	struct fc_lport *vn_port;
2529 	int rc = 0;
2530 	char buf[32];
2531 
2532 	mutex_lock(&n_port->lp_mutex);
2533 
2534 	wwn_to_str(vport->port_name, buf, sizeof(buf));
2535 	/* Check if the wwpn is not same as that of the lport */
2536 	if (!memcmp(&n_port->wwpn, &vport->port_name, sizeof(u64))) {
2537 		FCOE_DBG("vport WWPN 0x%s is same as that of the "
2538 			"base port WWPN\n", buf);
2539 		rc = -EINVAL;
2540 		goto out;
2541 	}
2542 
2543 	/* Check if there is any existing vport with same wwpn */
2544 	list_for_each_entry(vn_port, &n_port->vports, list) {
2545 		if (!memcmp(&vn_port->wwpn, &vport->port_name, sizeof(u64))) {
2546 			FCOE_DBG("vport with given WWPN 0x%s already "
2547 			"exists\n", buf);
2548 			rc = -EINVAL;
2549 			break;
2550 		}
2551 	}
2552 
2553 out:
2554 	mutex_unlock(&n_port->lp_mutex);
2555 
2556 	return rc;
2557 }
2558