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