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