drivers/scsi/fcoe/fcoe.c

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