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