drivers/scsi/bnx2fc/bnx2fc_fcoe.c

   1 /* bnx2fc_fcoe.c: Broadcom NetXtreme II Linux FCoE offload driver.
   2  * This file contains the code that interacts with libfc, libfcoe,
   3  * cnic modules to create FCoE instances, send/receive non-offloaded
   4  * FIP/FCoE packets, listen to link events etc.
   5  *
   6  * Copyright (c) 2008 - 2011 Broadcom Corporation
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation.
  11  *
  12  * Written by: Bhanu Prakash Gollapudi (bprakash@broadcom.com)
  13  */
  14
  15 #include "bnx2fc.h"
  16
  17 static struct list_head adapter_list;
  18 static struct list_head if_list;
  19 static u32 adapter_count;
  20 static DEFINE_MUTEX(bnx2fc_dev_lock);
  21 DEFINE_PER_CPU(struct bnx2fc_percpu_s, bnx2fc_percpu);
  22
  23 #define DRV_MODULE_NAME         "bnx2fc"
  24 #define DRV_MODULE_VERSION      BNX2FC_VERSION
  25 #define DRV_MODULE_RELDATE      "Dec 21, 2012"
  26
  27
  28 static char version[] =
  29                 "Broadcom NetXtreme II FCoE Driver " DRV_MODULE_NAME \
  30                 " v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
  31
  32
  33 MODULE_AUTHOR("Bhanu Prakash Gollapudi <bprakash@broadcom.com>");
  34 MODULE_DESCRIPTION("Broadcom NetXtreme II BCM57710 FCoE Driver");
  35 MODULE_LICENSE("GPL");
  36 MODULE_VERSION(DRV_MODULE_VERSION);
  37
  38 #define BNX2FC_MAX_QUEUE_DEPTH  256
  39 #define BNX2FC_MIN_QUEUE_DEPTH  32
  40 #define FCOE_WORD_TO_BYTE  4
  41
  42 static struct scsi_transport_template   *bnx2fc_transport_template;
  43 static struct scsi_transport_template   *bnx2fc_vport_xport_template;
  44
  45 struct workqueue_struct *bnx2fc_wq;
  46
  47 /* bnx2fc structure needs only one instance of the fcoe_percpu_s structure.
  48  * Here the io threads are per cpu but the l2 thread is just one
  49  */
  50 struct fcoe_percpu_s bnx2fc_global;
  51 DEFINE_SPINLOCK(bnx2fc_global_lock);
  52
  53 static struct cnic_ulp_ops bnx2fc_cnic_cb;
  54 static struct libfc_function_template bnx2fc_libfc_fcn_templ;
  55 static struct scsi_host_template bnx2fc_shost_template;
  56 static struct fc_function_template bnx2fc_transport_function;
  57 static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ;
  58 static struct fc_function_template bnx2fc_vport_xport_function;
  59 static int bnx2fc_create(struct net_device *netdev, enum fip_state fip_mode);
  60 static void __bnx2fc_destroy(struct bnx2fc_interface *interface);
  61 static int bnx2fc_destroy(struct net_device *net_device);
  62 static int bnx2fc_enable(struct net_device *netdev);
  63 static int bnx2fc_disable(struct net_device *netdev);
  64
  65 static void bnx2fc_recv_frame(struct sk_buff *skb);
  66
  67 static void bnx2fc_start_disc(struct bnx2fc_interface *interface);
  68 static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev);
  69 static int bnx2fc_lport_config(struct fc_lport *lport);
  70 static int bnx2fc_em_config(struct fc_lport *lport);
  71 static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba);
  72 static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba);
  73 static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba);
  74 static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba);
  75 static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
  76                                   struct device *parent, int npiv);
  77 static void bnx2fc_destroy_work(struct work_struct *work);
  78
  79 static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device *phys_dev);
  80 static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
  81                                                         *phys_dev);
  82 static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface);
  83 static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic);
  84
  85 static int bnx2fc_fw_init(struct bnx2fc_hba *hba);
  86 static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba);
  87
  88 static void bnx2fc_port_shutdown(struct fc_lport *lport);
  89 static void bnx2fc_stop(struct bnx2fc_interface *interface);
  90 static int __init bnx2fc_mod_init(void);
  91 static void __exit bnx2fc_mod_exit(void);
  92 static void bnx2fc_ctlr_get_lesb(struct fcoe_ctlr_device *ctlr_dev);
  93
  94 unsigned int bnx2fc_debug_level;
  95 module_param_named(debug_logging, bnx2fc_debug_level, int, S_IRUGO|S_IWUSR);
  96
  97 static int bnx2fc_cpu_callback(struct notifier_block *nfb,
  98                              unsigned long action, void *hcpu);
  99 /* notification function for CPU hotplug events */
 100 static struct notifier_block bnx2fc_cpu_notifier = {
 101         .notifier_call = bnx2fc_cpu_callback,
 102 };
 103
 104 static inline struct net_device *bnx2fc_netdev(const struct fc_lport *lport)
 105 {
 106         return ((struct bnx2fc_interface *)
 107                 ((struct fcoe_port *)lport_priv(lport))->priv)->netdev;
 108 }
 109
 110 /**
 111  * bnx2fc_get_lesb() - Fill the FCoE Link Error Status Block
 112  * @lport: the local port
 113  * @fc_lesb: the link error status block
 114  */
 115 static void bnx2fc_get_lesb(struct fc_lport *lport,
 116                             struct fc_els_lesb *fc_lesb)
 117 {
 118         struct net_device *netdev = bnx2fc_netdev(lport);
 119
 120         __fcoe_get_lesb(lport, fc_lesb, netdev);
 121 }
 122
 123 static void bnx2fc_ctlr_get_lesb(struct fcoe_ctlr_device *ctlr_dev)
 124 {
 125         struct fcoe_ctlr *fip = fcoe_ctlr_device_priv(ctlr_dev);
 126         struct net_device *netdev = bnx2fc_netdev(fip->lp);
 127         struct fcoe_fc_els_lesb *fcoe_lesb;
 128         struct fc_els_lesb fc_lesb;
 129
 130         __fcoe_get_lesb(fip->lp, &fc_lesb, netdev);
 131         fcoe_lesb = (struct fcoe_fc_els_lesb *)(&fc_lesb);
 132
 133         ctlr_dev->lesb.lesb_link_fail =
 134                 ntohl(fcoe_lesb->lesb_link_fail);
 135         ctlr_dev->lesb.lesb_vlink_fail =
 136                 ntohl(fcoe_lesb->lesb_vlink_fail);
 137         ctlr_dev->lesb.lesb_miss_fka =
 138                 ntohl(fcoe_lesb->lesb_miss_fka);
 139         ctlr_dev->lesb.lesb_symb_err =
 140                 ntohl(fcoe_lesb->lesb_symb_err);
 141         ctlr_dev->lesb.lesb_err_block =
 142                 ntohl(fcoe_lesb->lesb_err_block);
 143         ctlr_dev->lesb.lesb_fcs_error =
 144                 ntohl(fcoe_lesb->lesb_fcs_error);
 145 }
 146 EXPORT_SYMBOL(bnx2fc_ctlr_get_lesb);
 147
 148 static void bnx2fc_fcf_get_vlan_id(struct fcoe_fcf_device *fcf_dev)
 149 {
 150         struct fcoe_ctlr_device *ctlr_dev =
 151                 fcoe_fcf_dev_to_ctlr_dev(fcf_dev);
 152         struct fcoe_ctlr *ctlr = fcoe_ctlr_device_priv(ctlr_dev);
 153         struct bnx2fc_interface *fcoe = fcoe_ctlr_priv(ctlr);
 154
 155         fcf_dev->vlan_id = fcoe->vlan_id;
 156 }
 157
 158 static void bnx2fc_clean_rx_queue(struct fc_lport *lp)
 159 {
 160         struct fcoe_percpu_s *bg;
 161         struct fcoe_rcv_info *fr;
 162         struct sk_buff_head *list;
 163         struct sk_buff *skb, *next;
 164         struct sk_buff *head;
 165
 166         bg = &bnx2fc_global;
 167         spin_lock_bh(&bg->fcoe_rx_list.lock);
 168         list = &bg->fcoe_rx_list;
 169         head = list->next;
 170         for (skb = head; skb != (struct sk_buff *)list;
 171              skb = next) {
 172                 next = skb->next;
 173                 fr = fcoe_dev_from_skb(skb);
 174                 if (fr->fr_dev == lp) {
 175                         __skb_unlink(skb, list);
 176                         kfree_skb(skb);
 177                 }
 178         }
 179         spin_unlock_bh(&bg->fcoe_rx_list.lock);
 180 }
 181
 182 int bnx2fc_get_paged_crc_eof(struct sk_buff *skb, int tlen)
 183 {
 184         int rc;
 185         spin_lock(&bnx2fc_global_lock);
 186         rc = fcoe_get_paged_crc_eof(skb, tlen, &bnx2fc_global);
 187         spin_unlock(&bnx2fc_global_lock);
 188
 189         return rc;
 190 }
 191
 192 static void bnx2fc_abort_io(struct fc_lport *lport)
 193 {
 194         /*
 195          * This function is no-op for bnx2fc, but we do
 196          * not want to leave it as NULL either, as libfc
 197          * can call the default function which is
 198          * fc_fcp_abort_io.
 199          */
 200 }
 201
 202 static void bnx2fc_cleanup(struct fc_lport *lport)
 203 {
 204         struct fcoe_port *port = lport_priv(lport);
 205         struct bnx2fc_interface *interface = port->priv;
 206         struct bnx2fc_hba *hba = interface->hba;
 207         struct bnx2fc_rport *tgt;
 208         int i;
 209
 210         BNX2FC_MISC_DBG("Entered %s\n", __func__);
 211         mutex_lock(&hba->hba_mutex);
 212         spin_lock_bh(&hba->hba_lock);
 213         for (i = 0; i < BNX2FC_NUM_MAX_SESS; i++) {
 214                 tgt = hba->tgt_ofld_list[i];
 215                 if (tgt) {
 216                         /* Cleanup IOs belonging to requested vport */
 217                         if (tgt->port == port) {
 218                                 spin_unlock_bh(&hba->hba_lock);
 219                                 BNX2FC_TGT_DBG(tgt, "flush/cleanup\n");
 220                                 bnx2fc_flush_active_ios(tgt);
 221                                 spin_lock_bh(&hba->hba_lock);
 222                         }
 223                 }
 224         }
 225         spin_unlock_bh(&hba->hba_lock);
 226         mutex_unlock(&hba->hba_mutex);
 227 }
 228
 229 static int bnx2fc_xmit_l2_frame(struct bnx2fc_rport *tgt,
 230                              struct fc_frame *fp)
 231 {
 232         struct fc_rport_priv *rdata = tgt->rdata;
 233         struct fc_frame_header *fh;
 234         int rc = 0;
 235
 236         fh = fc_frame_header_get(fp);
 237         BNX2FC_TGT_DBG(tgt, "Xmit L2 frame rport = 0x%x, oxid = 0x%x, "
 238                         "r_ctl = 0x%x\n", rdata->ids.port_id,
 239                         ntohs(fh->fh_ox_id), fh->fh_r_ctl);
 240         if ((fh->fh_type == FC_TYPE_ELS) &&
 241             (fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
 242
 243                 switch (fc_frame_payload_op(fp)) {
 244                 case ELS_ADISC:
 245                         rc = bnx2fc_send_adisc(tgt, fp);
 246                         break;
 247                 case ELS_LOGO:
 248                         rc = bnx2fc_send_logo(tgt, fp);
 249                         break;
 250                 case ELS_RLS:
 251                         rc = bnx2fc_send_rls(tgt, fp);
 252                         break;
 253                 default:
 254                         break;
 255                 }
 256         } else if ((fh->fh_type ==  FC_TYPE_BLS) &&
 257             (fh->fh_r_ctl == FC_RCTL_BA_ABTS))
 258                 BNX2FC_TGT_DBG(tgt, "ABTS frame\n");
 259         else {
 260                 BNX2FC_TGT_DBG(tgt, "Send L2 frame type 0x%x "
 261                                 "rctl 0x%x thru non-offload path\n",
 262                                 fh->fh_type, fh->fh_r_ctl);
 263                 return -ENODEV;
 264         }
 265         if (rc)
 266                 return -ENOMEM;
 267         else
 268                 return 0;
 269 }
 270
 271 /**
 272  * bnx2fc_xmit - bnx2fc's FCoE frame transmit function
 273  *
 274  * @lport:      the associated local port
 275  * @fp: the fc_frame to be transmitted
 276  */
 277 static int bnx2fc_xmit(struct fc_lport *lport, struct fc_frame *fp)
 278 {
 279         struct ethhdr           *eh;
 280         struct fcoe_crc_eof     *cp;
 281         struct sk_buff          *skb;
 282         struct fc_frame_header  *fh;
 283         struct bnx2fc_interface *interface;
 284         struct fcoe_ctlr        *ctlr;
 285         struct bnx2fc_hba *hba;
 286         struct fcoe_port        *port;
 287         struct fcoe_hdr         *hp;
 288         struct bnx2fc_rport     *tgt;
 289         struct fc_stats         *stats;
 290         u8                      sof, eof;
 291         u32                     crc;
 292         unsigned int            hlen, tlen, elen;
 293         int                     wlen, rc = 0;
 294
 295         port = (struct fcoe_port *)lport_priv(lport);
 296         interface = port->priv;
 297         ctlr = bnx2fc_to_ctlr(interface);
 298         hba = interface->hba;
 299
 300         fh = fc_frame_header_get(fp);
 301
 302         skb = fp_skb(fp);
 303         if (!lport->link_up) {
 304                 BNX2FC_HBA_DBG(lport, "bnx2fc_xmit link down\n");
 305                 kfree_skb(skb);
 306                 return 0;
 307         }
 308
 309         if (unlikely(fh->fh_r_ctl == FC_RCTL_ELS_REQ)) {
 310                 if (!ctlr->sel_fcf) {
 311                         BNX2FC_HBA_DBG(lport, "FCF not selected yet!\n");
 312                         kfree_skb(skb);
 313                         return -EINVAL;
 314                 }
 315                 if (fcoe_ctlr_els_send(ctlr, lport, skb))
 316                         return 0;
 317         }
 318
 319         sof = fr_sof(fp);
 320         eof = fr_eof(fp);
 321
 322         /*
 323          * Snoop the frame header to check if the frame is for
 324          * an offloaded session
 325          */
 326         /*
 327          * tgt_ofld_list access is synchronized using
 328          * both hba mutex and hba lock. Atleast hba mutex or
 329          * hba lock needs to be held for read access.
 330          */
 331
 332         spin_lock_bh(&hba->hba_lock);
 333         tgt = bnx2fc_tgt_lookup(port, ntoh24(fh->fh_d_id));
 334         if (tgt && (test_bit(BNX2FC_FLAG_SESSION_READY, &tgt->flags))) {
 335                 /* This frame is for offloaded session */
 336                 BNX2FC_HBA_DBG(lport, "xmit: Frame is for offloaded session "
 337                                 "port_id = 0x%x\n", ntoh24(fh->fh_d_id));
 338                 spin_unlock_bh(&hba->hba_lock);
 339                 rc = bnx2fc_xmit_l2_frame(tgt, fp);
 340                 if (rc != -ENODEV) {
 341                         kfree_skb(skb);
 342                         return rc;
 343                 }
 344         } else {
 345                 spin_unlock_bh(&hba->hba_lock);
 346         }
 347
 348         elen = sizeof(struct ethhdr);
 349         hlen = sizeof(struct fcoe_hdr);
 350         tlen = sizeof(struct fcoe_crc_eof);
 351         wlen = (skb->len - tlen + sizeof(crc)) / FCOE_WORD_TO_BYTE;
 352
 353         skb->ip_summed = CHECKSUM_NONE;
 354         crc = fcoe_fc_crc(fp);
 355
 356         /* copy port crc and eof to the skb buff */
 357         if (skb_is_nonlinear(skb)) {
 358                 skb_frag_t *frag;
 359                 if (bnx2fc_get_paged_crc_eof(skb, tlen)) {
 360                         kfree_skb(skb);
 361                         return -ENOMEM;
 362                 }
 363                 frag = &skb_shinfo(skb)->frags[skb_shinfo(skb)->nr_frags - 1];
 364                 cp = kmap_atomic(skb_frag_page(frag)) + frag->page_offset;
 365         } else {
 366                 cp = (struct fcoe_crc_eof *)skb_put(skb, tlen);
 367         }
 368
 369         memset(cp, 0, sizeof(*cp));
 370         cp->fcoe_eof = eof;
 371         cp->fcoe_crc32 = cpu_to_le32(~crc);
 372         if (skb_is_nonlinear(skb)) {
 373                 kunmap_atomic(cp);
 374                 cp = NULL;
 375         }
 376
 377         /* adjust skb network/transport offsets to match mac/fcoe/port */
 378         skb_push(skb, elen + hlen);
 379         skb_reset_mac_header(skb);
 380         skb_reset_network_header(skb);
 381         skb->mac_len = elen;
 382         skb->protocol = htons(ETH_P_FCOE);
 383         skb->dev = interface->netdev;
 384
 385         /* fill up mac and fcoe headers */
 386         eh = eth_hdr(skb);
 387         eh->h_proto = htons(ETH_P_FCOE);
 388         if (ctlr->map_dest)
 389                 fc_fcoe_set_mac(eh->h_dest, fh->fh_d_id);
 390         else
 391                 /* insert GW address */
 392                 memcpy(eh->h_dest, ctlr->dest_addr, ETH_ALEN);
 393
 394         if (unlikely(ctlr->flogi_oxid != FC_XID_UNKNOWN))
 395                 memcpy(eh->h_source, ctlr->ctl_src_addr, ETH_ALEN);
 396         else
 397                 memcpy(eh->h_source, port->data_src_addr, ETH_ALEN);
 398
 399         hp = (struct fcoe_hdr *)(eh + 1);
 400         memset(hp, 0, sizeof(*hp));
 401         if (FC_FCOE_VER)
 402                 FC_FCOE_ENCAPS_VER(hp, FC_FCOE_VER);
 403         hp->fcoe_sof = sof;
 404
 405         /* fcoe lso, mss is in max_payload which is non-zero for FCP data */
 406         if (lport->seq_offload && fr_max_payload(fp)) {
 407                 skb_shinfo(skb)->gso_type = SKB_GSO_FCOE;
 408                 skb_shinfo(skb)->gso_size = fr_max_payload(fp);
 409         } else {
 410                 skb_shinfo(skb)->gso_type = 0;
 411                 skb_shinfo(skb)->gso_size = 0;
 412         }
 413
 414         /*update tx stats */
 415         stats = per_cpu_ptr(lport->stats, get_cpu());
 416         stats->TxFrames++;
 417         stats->TxWords += wlen;
 418         put_cpu();
 419
 420         /* send down to lld */
 421         fr_dev(fp) = lport;
 422         if (port->fcoe_pending_queue.qlen)
 423                 fcoe_check_wait_queue(lport, skb);
 424         else if (fcoe_start_io(skb))
 425                 fcoe_check_wait_queue(lport, skb);
 426
 427         return 0;
 428 }
 429
 430 /**
 431  * bnx2fc_rcv - This is bnx2fc's receive function called by NET_RX_SOFTIRQ
 432  *
 433  * @skb:        the receive socket buffer
 434  * @dev:        associated net device
 435  * @ptype:      context
 436  * @olddev:     last device
 437  *
 438  * This function receives the packet and builds FC frame and passes it up
 439  */
 440 static int bnx2fc_rcv(struct sk_buff *skb, struct net_device *dev,
 441                 struct packet_type *ptype, struct net_device *olddev)
 442 {
 443         struct fc_lport *lport;
 444         struct bnx2fc_interface *interface;
 445         struct fcoe_ctlr *ctlr;
 446         struct fc_frame_header *fh;
 447         struct fcoe_rcv_info *fr;
 448         struct fcoe_percpu_s *bg;
 449         unsigned short oxid;
 450
 451         interface = container_of(ptype, struct bnx2fc_interface,
 452                                  fcoe_packet_type);
 453         ctlr = bnx2fc_to_ctlr(interface);
 454         lport = ctlr->lp;
 455
 456         if (unlikely(lport == NULL)) {
 457                 printk(KERN_ERR PFX "bnx2fc_rcv: lport is NULL\n");
 458                 goto err;
 459         }
 460
 461         if (unlikely(eth_hdr(skb)->h_proto != htons(ETH_P_FCOE))) {
 462                 printk(KERN_ERR PFX "bnx2fc_rcv: Wrong FC type frame\n");
 463                 goto err;
 464         }
 465
 466         /*
 467          * Check for minimum frame length, and make sure required FCoE
 468          * and FC headers are pulled into the linear data area.
 469          */
 470         if (unlikely((skb->len < FCOE_MIN_FRAME) ||
 471             !pskb_may_pull(skb, FCOE_HEADER_LEN)))
 472                 goto err;
 473
 474         skb_set_transport_header(skb, sizeof(struct fcoe_hdr));
 475         fh = (struct fc_frame_header *) skb_transport_header(skb);
 476
 477         oxid = ntohs(fh->fh_ox_id);
 478
 479         fr = fcoe_dev_from_skb(skb);
 480         fr->fr_dev = lport;
 481
 482         bg = &bnx2fc_global;
 483         spin_lock(&bg->fcoe_rx_list.lock);
 484
 485         __skb_queue_tail(&bg->fcoe_rx_list, skb);
 486         if (bg->fcoe_rx_list.qlen == 1)
 487                 wake_up_process(bg->thread);
 488
 489         spin_unlock(&bg->fcoe_rx_list.lock);
 490
 491         return 0;
 492 err:
 493         kfree_skb(skb);
 494         return -1;
 495 }
 496
 497 static int bnx2fc_l2_rcv_thread(void *arg)
 498 {
 499         struct fcoe_percpu_s *bg = arg;
 500         struct sk_buff *skb;
 501
 502         set_user_nice(current, -20);
 503         set_current_state(TASK_INTERRUPTIBLE);
 504         while (!kthread_should_stop()) {
 505                 schedule();
 506                 spin_lock_bh(&bg->fcoe_rx_list.lock);
 507                 while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL) {
 508                         spin_unlock_bh(&bg->fcoe_rx_list.lock);
 509                         bnx2fc_recv_frame(skb);
 510                         spin_lock_bh(&bg->fcoe_rx_list.lock);
 511                 }
 512                 __set_current_state(TASK_INTERRUPTIBLE);
 513                 spin_unlock_bh(&bg->fcoe_rx_list.lock);
 514         }
 515         __set_current_state(TASK_RUNNING);
 516         return 0;
 517 }
 518
 519
 520 static void bnx2fc_recv_frame(struct sk_buff *skb)
 521 {
 522         u32 fr_len;
 523         struct fc_lport *lport;
 524         struct fcoe_rcv_info *fr;
 525         struct fc_stats *stats;
 526         struct fc_frame_header *fh;
 527         struct fcoe_crc_eof crc_eof;
 528         struct fc_frame *fp;
 529         struct fc_lport *vn_port;
 530         struct fcoe_port *port;
 531         u8 *mac = NULL;
 532         u8 *dest_mac = NULL;
 533         struct fcoe_hdr *hp;
 534
 535         fr = fcoe_dev_from_skb(skb);
 536         lport = fr->fr_dev;
 537         if (unlikely(lport == NULL)) {
 538                 printk(KERN_ERR PFX "Invalid lport struct\n");
 539                 kfree_skb(skb);
 540                 return;
 541         }
 542
 543         if (skb_is_nonlinear(skb))
 544                 skb_linearize(skb);
 545         mac = eth_hdr(skb)->h_source;
 546         dest_mac = eth_hdr(skb)->h_dest;
 547
 548         /* Pull the header */
 549         hp = (struct fcoe_hdr *) skb_network_header(skb);
 550         fh = (struct fc_frame_header *) skb_transport_header(skb);
 551         skb_pull(skb, sizeof(struct fcoe_hdr));
 552         fr_len = skb->len - sizeof(struct fcoe_crc_eof);
 553
 554         stats = per_cpu_ptr(lport->stats, get_cpu());
 555         stats->RxFrames++;
 556         stats->RxWords += fr_len / FCOE_WORD_TO_BYTE;
 557
 558         fp = (struct fc_frame *)skb;
 559         fc_frame_init(fp);
 560         fr_dev(fp) = lport;
 561         fr_sof(fp) = hp->fcoe_sof;
 562         if (skb_copy_bits(skb, fr_len, &crc_eof, sizeof(crc_eof))) {
 563                 put_cpu();
 564                 kfree_skb(skb);
 565                 return;
 566         }
 567         fr_eof(fp) = crc_eof.fcoe_eof;
 568         fr_crc(fp) = crc_eof.fcoe_crc32;
 569         if (pskb_trim(skb, fr_len)) {
 570                 put_cpu();
 571                 kfree_skb(skb);
 572                 return;
 573         }
 574
 575         fh = fc_frame_header_get(fp);
 576
 577         vn_port = fc_vport_id_lookup(lport, ntoh24(fh->fh_d_id));
 578         if (vn_port) {
 579                 port = lport_priv(vn_port);
 580                 if (compare_ether_addr(port->data_src_addr, dest_mac)
 581                     != 0) {
 582                         BNX2FC_HBA_DBG(lport, "fpma mismatch\n");
 583                         put_cpu();
 584                         kfree_skb(skb);
 585                         return;
 586                 }
 587         }
 588         if (fh->fh_r_ctl == FC_RCTL_DD_SOL_DATA &&
 589             fh->fh_type == FC_TYPE_FCP) {
 590                 /* Drop FCP data. We dont this in L2 path */
 591                 put_cpu();
 592                 kfree_skb(skb);
 593                 return;
 594         }
 595         if (fh->fh_r_ctl == FC_RCTL_ELS_REQ &&
 596             fh->fh_type == FC_TYPE_ELS) {
 597                 switch (fc_frame_payload_op(fp)) {
 598                 case ELS_LOGO:
 599                         if (ntoh24(fh->fh_s_id) == FC_FID_FLOGI) {
 600                                 /* drop non-FIP LOGO */
 601                                 put_cpu();
 602                                 kfree_skb(skb);
 603                                 return;
 604                         }
 605                         break;
 606                 }
 607         }
 608
 609         if (fh->fh_r_ctl == FC_RCTL_BA_ABTS) {
 610                 /* Drop incoming ABTS */
 611                 put_cpu();
 612                 kfree_skb(skb);
 613                 return;
 614         }
 615
 616         if (le32_to_cpu(fr_crc(fp)) !=
 617                         ~crc32(~0, skb->data, fr_len)) {
 618                 if (stats->InvalidCRCCount < 5)
 619                         printk(KERN_WARNING PFX "dropping frame with "
 620                                "CRC error\n");
 621                 stats->InvalidCRCCount++;
 622                 put_cpu();
 623                 kfree_skb(skb);
 624                 return;
 625         }
 626         put_cpu();
 627         fc_exch_recv(lport, fp);
 628 }
 629
 630 /**
 631  * bnx2fc_percpu_io_thread - thread per cpu for ios
 632  *
 633  * @arg:        ptr to bnx2fc_percpu_info structure
 634  */
 635 int bnx2fc_percpu_io_thread(void *arg)
 636 {
 637         struct bnx2fc_percpu_s *p = arg;
 638         struct bnx2fc_work *work, *tmp;
 639         LIST_HEAD(work_list);
 640
 641         set_user_nice(current, -20);
 642         set_current_state(TASK_INTERRUPTIBLE);
 643         while (!kthread_should_stop()) {
 644                 schedule();
 645                 spin_lock_bh(&p->fp_work_lock);
 646                 while (!list_empty(&p->work_list)) {
 647                         list_splice_init(&p->work_list, &work_list);
 648                         spin_unlock_bh(&p->fp_work_lock);
 649
 650                         list_for_each_entry_safe(work, tmp, &work_list, list) {
 651                                 list_del_init(&work->list);
 652                                 bnx2fc_process_cq_compl(work->tgt, work->wqe);
 653                                 kfree(work);
 654                         }
 655
 656                         spin_lock_bh(&p->fp_work_lock);
 657                 }
 658                 __set_current_state(TASK_INTERRUPTIBLE);
 659                 spin_unlock_bh(&p->fp_work_lock);
 660         }
 661         __set_current_state(TASK_RUNNING);
 662
 663         return 0;
 664 }
 665
 666 static struct fc_host_statistics *bnx2fc_get_host_stats(struct Scsi_Host *shost)
 667 {
 668         struct fc_host_statistics *bnx2fc_stats;
 669         struct fc_lport *lport = shost_priv(shost);
 670         struct fcoe_port *port = lport_priv(lport);
 671         struct bnx2fc_interface *interface = port->priv;
 672         struct bnx2fc_hba *hba = interface->hba;
 673         struct fcoe_statistics_params *fw_stats;
 674         int rc = 0;
 675
 676         fw_stats = (struct fcoe_statistics_params *)hba->stats_buffer;
 677         if (!fw_stats)
 678                 return NULL;
 679
 680         bnx2fc_stats = fc_get_host_stats(shost);
 681
 682         init_completion(&hba->stat_req_done);
 683         if (bnx2fc_send_stat_req(hba))
 684                 return bnx2fc_stats;
 685         rc = wait_for_completion_timeout(&hba->stat_req_done, (2 * HZ));
 686         if (!rc) {
 687                 BNX2FC_HBA_DBG(lport, "FW stat req timed out\n");
 688                 return bnx2fc_stats;
 689         }
 690         BNX2FC_STATS(hba, rx_stat2, fc_crc_cnt);
 691         bnx2fc_stats->invalid_crc_count += hba->bfw_stats.fc_crc_cnt;
 692         BNX2FC_STATS(hba, tx_stat, fcoe_tx_pkt_cnt);
 693         bnx2fc_stats->tx_frames += hba->bfw_stats.fcoe_tx_pkt_cnt;
 694         BNX2FC_STATS(hba, tx_stat, fcoe_tx_byte_cnt);
 695         bnx2fc_stats->tx_words += ((hba->bfw_stats.fcoe_tx_byte_cnt) / 4);
 696         BNX2FC_STATS(hba, rx_stat0, fcoe_rx_pkt_cnt);
 697         bnx2fc_stats->rx_frames += hba->bfw_stats.fcoe_rx_pkt_cnt;
 698         BNX2FC_STATS(hba, rx_stat0, fcoe_rx_byte_cnt);
 699         bnx2fc_stats->rx_words += ((hba->bfw_stats.fcoe_rx_byte_cnt) / 4);
 700
 701         bnx2fc_stats->dumped_frames = 0;
 702         bnx2fc_stats->lip_count = 0;
 703         bnx2fc_stats->nos_count = 0;
 704         bnx2fc_stats->loss_of_sync_count = 0;
 705         bnx2fc_stats->loss_of_signal_count = 0;
 706         bnx2fc_stats->prim_seq_protocol_err_count = 0;
 707
 708         memcpy(&hba->prev_stats, hba->stats_buffer,
 709                sizeof(struct fcoe_statistics_params));
 710         return bnx2fc_stats;
 711 }
 712
 713 static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev)
 714 {
 715         struct fcoe_port *port = lport_priv(lport);
 716         struct bnx2fc_interface *interface = port->priv;
 717         struct Scsi_Host *shost = lport->host;
 718         int rc = 0;
 719
 720         shost->max_cmd_len = BNX2FC_MAX_CMD_LEN;
 721         shost->max_lun = BNX2FC_MAX_LUN;
 722         shost->max_id = BNX2FC_MAX_FCP_TGT;
 723         shost->max_channel = 0;
 724         if (lport->vport)
 725                 shost->transportt = bnx2fc_vport_xport_template;
 726         else
 727                 shost->transportt = bnx2fc_transport_template;
 728
 729         /* Add the new host to SCSI-ml */
 730         rc = scsi_add_host(lport->host, dev);
 731         if (rc) {
 732                 printk(KERN_ERR PFX "Error on scsi_add_host\n");
 733                 return rc;
 734         }
 735         if (!lport->vport)
 736                 fc_host_max_npiv_vports(lport->host) = USHRT_MAX;
 737         sprintf(fc_host_symbolic_name(lport->host), "%s v%s over %s",
 738                 BNX2FC_NAME, BNX2FC_VERSION,
 739                 interface->netdev->name);
 740
 741         return 0;
 742 }
 743
 744 static void bnx2fc_link_speed_update(struct fc_lport *lport)
 745 {
 746         struct fcoe_port *port = lport_priv(lport);
 747         struct bnx2fc_interface *interface = port->priv;
 748         struct net_device *netdev = interface->netdev;
 749         struct ethtool_cmd ecmd;
 750
 751         if (!__ethtool_get_settings(netdev, &ecmd)) {
 752                 lport->link_supported_speeds &=
 753                         ~(FC_PORTSPEED_1GBIT | FC_PORTSPEED_10GBIT);
 754                 if (ecmd.supported & (SUPPORTED_1000baseT_Half |
 755                                       SUPPORTED_1000baseT_Full))
 756                         lport->link_supported_speeds |= FC_PORTSPEED_1GBIT;
 757                 if (ecmd.supported & SUPPORTED_10000baseT_Full)
 758                         lport->link_supported_speeds |= FC_PORTSPEED_10GBIT;
 759
 760                 switch (ethtool_cmd_speed(&ecmd)) {
 761                 case SPEED_1000:
 762                         lport->link_speed = FC_PORTSPEED_1GBIT;
 763                         break;
 764                 case SPEED_2500:
 765                         lport->link_speed = FC_PORTSPEED_2GBIT;
 766                         break;
 767                 case SPEED_10000:
 768                         lport->link_speed = FC_PORTSPEED_10GBIT;
 769                         break;
 770                 }
 771         }
 772 }
 773 static int bnx2fc_link_ok(struct fc_lport *lport)
 774 {
 775         struct fcoe_port *port = lport_priv(lport);
 776         struct bnx2fc_interface *interface = port->priv;
 777         struct bnx2fc_hba *hba = interface->hba;
 778         struct net_device *dev = hba->phys_dev;
 779         int rc = 0;
 780
 781         if ((dev->flags & IFF_UP) && netif_carrier_ok(dev))
 782                 clear_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
 783         else {
 784                 set_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
 785                 rc = -1;
 786         }
 787         return rc;
 788 }
 789
 790 /**
 791  * bnx2fc_get_link_state - get network link state
 792  *
 793  * @hba:        adapter instance pointer
 794  *
 795  * updates adapter structure flag based on netdev state
 796  */
 797 void bnx2fc_get_link_state(struct bnx2fc_hba *hba)
 798 {
 799         if (test_bit(__LINK_STATE_NOCARRIER, &hba->phys_dev->state))
 800                 set_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
 801         else
 802                 clear_bit(ADAPTER_STATE_LINK_DOWN, &hba->adapter_state);
 803 }
 804
 805 static int bnx2fc_net_config(struct fc_lport *lport, struct net_device *netdev)
 806 {
 807         struct bnx2fc_hba *hba;
 808         struct bnx2fc_interface *interface;
 809         struct fcoe_ctlr *ctlr;
 810         struct fcoe_port *port;
 811         u64 wwnn, wwpn;
 812
 813         port = lport_priv(lport);
 814         interface = port->priv;
 815         ctlr = bnx2fc_to_ctlr(interface);
 816         hba = interface->hba;
 817
 818         /* require support for get_pauseparam ethtool op. */
 819         if (!hba->phys_dev->ethtool_ops ||
 820             !hba->phys_dev->ethtool_ops->get_pauseparam)
 821                 return -EOPNOTSUPP;
 822
 823         if (fc_set_mfs(lport, BNX2FC_MFS))
 824                 return -EINVAL;
 825
 826         skb_queue_head_init(&port->fcoe_pending_queue);
 827         port->fcoe_pending_queue_active = 0;
 828         setup_timer(&port->timer, fcoe_queue_timer, (unsigned long) lport);
 829
 830         bnx2fc_link_speed_update(lport);
 831
 832         if (!lport->vport) {
 833                 if (fcoe_get_wwn(netdev, &wwnn, NETDEV_FCOE_WWNN))
 834                         wwnn = fcoe_wwn_from_mac(ctlr->ctl_src_addr,
 835                                                  1, 0);
 836                 BNX2FC_HBA_DBG(lport, "WWNN = 0x%llx\n", wwnn);
 837                 fc_set_wwnn(lport, wwnn);
 838
 839                 if (fcoe_get_wwn(netdev, &wwpn, NETDEV_FCOE_WWPN))
 840                         wwpn = fcoe_wwn_from_mac(ctlr->ctl_src_addr,
 841                                                  2, 0);
 842
 843                 BNX2FC_HBA_DBG(lport, "WWPN = 0x%llx\n", wwpn);
 844                 fc_set_wwpn(lport, wwpn);
 845         }
 846
 847         return 0;
 848 }
 849
 850 static void bnx2fc_destroy_timer(unsigned long data)
 851 {
 852         struct bnx2fc_hba *hba = (struct bnx2fc_hba *)data;
 853
 854         printk(KERN_ERR PFX "ERROR:bnx2fc_destroy_timer - "
 855                "Destroy compl not received!!\n");
 856         set_bit(BNX2FC_FLAG_DESTROY_CMPL, &hba->flags);
 857         wake_up_interruptible(&hba->destroy_wait);
 858 }
 859
 860 /**
 861  * bnx2fc_indicate_netevent - Generic netdev event handler
 862  *
 863  * @context:    adapter structure pointer
 864  * @event:      event type
 865  * @vlan_id:    vlan id - associated vlan id with this event
 866  *
 867  * Handles NETDEV_UP, NETDEV_DOWN, NETDEV_GOING_DOWN,NETDEV_CHANGE and
 868  * NETDEV_CHANGE_MTU events. Handle NETDEV_UNREGISTER only for vlans.
 869  */
 870 static void bnx2fc_indicate_netevent(void *context, unsigned long event,
 871                                      u16 vlan_id)
 872 {
 873         struct bnx2fc_hba *hba = (struct bnx2fc_hba *)context;
 874         struct fc_lport *lport;
 875         struct fc_lport *vport;
 876         struct bnx2fc_interface *interface, *tmp;
 877         struct fcoe_ctlr *ctlr;
 878         int wait_for_upload = 0;
 879         u32 link_possible = 1;
 880
 881         if (vlan_id != 0 && event != NETDEV_UNREGISTER)
 882                 return;
 883
 884         switch (event) {
 885         case NETDEV_UP:
 886                 if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state))
 887                         printk(KERN_ERR "indicate_netevent: "\
 888                                         "hba is not UP!!\n");
 889                 break;
 890
 891         case NETDEV_DOWN:
 892                 clear_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
 893                 clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
 894                 link_possible = 0;
 895                 break;
 896
 897         case NETDEV_GOING_DOWN:
 898                 set_bit(ADAPTER_STATE_GOING_DOWN, &hba->adapter_state);
 899                 link_possible = 0;
 900                 break;
 901
 902         case NETDEV_CHANGE:
 903                 break;
 904
 905         case NETDEV_UNREGISTER:
 906                 if (!vlan_id)
 907                         return;
 908                 mutex_lock(&bnx2fc_dev_lock);
 909                 list_for_each_entry_safe(interface, tmp, &if_list, list) {
 910                         if (interface->hba == hba &&
 911                             interface->vlan_id == (vlan_id & VLAN_VID_MASK))
 912                                 __bnx2fc_destroy(interface);
 913                 }
 914                 mutex_unlock(&bnx2fc_dev_lock);
 915                 return;
 916
 917         default:
 918                 printk(KERN_ERR PFX "Unknown netevent %ld", event);
 919                 return;
 920         }
 921
 922         mutex_lock(&bnx2fc_dev_lock);
 923         list_for_each_entry(interface, &if_list, list) {
 924
 925                 if (interface->hba != hba)
 926                         continue;
 927
 928                 ctlr = bnx2fc_to_ctlr(interface);
 929                 lport = ctlr->lp;
 930                 BNX2FC_HBA_DBG(lport, "netevent handler - event=%s %ld\n",
 931                                 interface->netdev->name, event);
 932
 933                 bnx2fc_link_speed_update(lport);
 934
 935                 if (link_possible && !bnx2fc_link_ok(lport)) {
 936                         /* Reset max recv frame size to default */
 937                         fc_set_mfs(lport, BNX2FC_MFS);
 938                         /*
 939                          * ctlr link up will only be handled during
 940                          * enable to avoid sending discovery solicitation
 941                          * on a stale vlan
 942                          */
 943                         if (interface->enabled)
 944                                 fcoe_ctlr_link_up(ctlr);
 945                 } else if (fcoe_ctlr_link_down(ctlr)) {
 946                         mutex_lock(&lport->lp_mutex);
 947                         list_for_each_entry(vport, &lport->vports, list)
 948                                 fc_host_port_type(vport->host) =
 949                                                         FC_PORTTYPE_UNKNOWN;
 950                         mutex_unlock(&lport->lp_mutex);
 951                         fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
 952                         per_cpu_ptr(lport->stats,
 953                                     get_cpu())->LinkFailureCount++;
 954                         put_cpu();
 955                         fcoe_clean_pending_queue(lport);
 956                         wait_for_upload = 1;
 957                 }
 958         }
 959         mutex_unlock(&bnx2fc_dev_lock);
 960
 961         if (wait_for_upload) {
 962                 clear_bit(ADAPTER_STATE_READY, &hba->adapter_state);
 963                 init_waitqueue_head(&hba->shutdown_wait);
 964                 BNX2FC_MISC_DBG("indicate_netevent "
 965                                 "num_ofld_sess = %d\n",
 966                                 hba->num_ofld_sess);
 967                 hba->wait_for_link_down = 1;
 968                 wait_event_interruptible(hba->shutdown_wait,
 969                                          (hba->num_ofld_sess == 0));
 970                 BNX2FC_MISC_DBG("wakeup - num_ofld_sess = %d\n",
 971                                 hba->num_ofld_sess);
 972                 hba->wait_for_link_down = 0;
 973
 974                 if (signal_pending(current))
 975                         flush_signals(current);
 976         }
 977 }
 978
 979 static int bnx2fc_libfc_config(struct fc_lport *lport)
 980 {
 981
 982         /* Set the function pointers set by bnx2fc driver */
 983         memcpy(&lport->tt, &bnx2fc_libfc_fcn_templ,
 984                 sizeof(struct libfc_function_template));
 985         fc_elsct_init(lport);
 986         fc_exch_init(lport);
 987         fc_rport_init(lport);
 988         fc_disc_init(lport);
 989         return 0;
 990 }
 991
 992 static int bnx2fc_em_config(struct fc_lport *lport)
 993 {
 994         int max_xid;
 995
 996         if (nr_cpu_ids <= 2)
 997                 max_xid = FCOE_XIDS_PER_CPU;
 998         else
 999                 max_xid = FCOE_MAX_XID;
1000         if (!fc_exch_mgr_alloc(lport, FC_CLASS_3, FCOE_MIN_XID,
1001                                 max_xid, NULL)) {
1002                 printk(KERN_ERR PFX "em_config:fc_exch_mgr_alloc failed\n");
1003                 return -ENOMEM;
1004         }
1005
1006         return 0;
1007 }
1008
1009 static int bnx2fc_lport_config(struct fc_lport *lport)
1010 {
1011         lport->link_up = 0;
1012         lport->qfull = 0;
1013         lport->max_retry_count = BNX2FC_MAX_RETRY_CNT;
1014         lport->max_rport_retry_count = BNX2FC_MAX_RPORT_RETRY_CNT;
1015         lport->e_d_tov = 2 * 1000;
1016         lport->r_a_tov = 10 * 1000;
1017
1018         lport->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS |
1019                                 FCP_SPPF_RETRY | FCP_SPPF_CONF_COMPL);
1020         lport->does_npiv = 1;
1021
1022         memset(&lport->rnid_gen, 0, sizeof(struct fc_els_rnid_gen));
1023         lport->rnid_gen.rnid_atype = BNX2FC_RNID_HBA;
1024
1025         /* alloc stats structure */
1026         if (fc_lport_init_stats(lport))
1027                 return -ENOMEM;
1028
1029         /* Finish fc_lport configuration */
1030         fc_lport_config(lport);
1031
1032         return 0;
1033 }
1034
1035 /**
1036  * bnx2fc_fip_recv - handle a received FIP frame.
1037  *
1038  * @skb: the received skb
1039  * @dev: associated &net_device
1040  * @ptype: the &packet_type structure which was used to register this handler.
1041  * @orig_dev: original receive &net_device, in case @ dev is a bond.
1042  *
1043  * Returns: 0 for success
1044  */
1045 static int bnx2fc_fip_recv(struct sk_buff *skb, struct net_device *dev,
1046                            struct packet_type *ptype,
1047                            struct net_device *orig_dev)
1048 {
1049         struct bnx2fc_interface *interface;
1050         struct fcoe_ctlr *ctlr;
1051         interface = container_of(ptype, struct bnx2fc_interface,
1052                                  fip_packet_type);
1053         ctlr = bnx2fc_to_ctlr(interface);
1054         fcoe_ctlr_recv(ctlr, skb);
1055         return 0;
1056 }
1057
1058 /**
1059  * bnx2fc_update_src_mac - Update Ethernet MAC filters.
1060  *
1061  * @fip: FCoE controller.
1062  * @old: Unicast MAC address to delete if the MAC is non-zero.
1063  * @new: Unicast MAC address to add.
1064  *
1065  * Remove any previously-set unicast MAC filter.
1066  * Add secondary FCoE MAC address filter for our OUI.
1067  */
1068 static void bnx2fc_update_src_mac(struct fc_lport *lport, u8 *addr)
1069 {
1070         struct fcoe_port *port = lport_priv(lport);
1071
1072         memcpy(port->data_src_addr, addr, ETH_ALEN);
1073 }
1074
1075 /**
1076  * bnx2fc_get_src_mac - return the ethernet source address for an lport
1077  *
1078  * @lport: libfc port
1079  */
1080 static u8 *bnx2fc_get_src_mac(struct fc_lport *lport)
1081 {
1082         struct fcoe_port *port;
1083
1084         port = (struct fcoe_port *)lport_priv(lport);
1085         return port->data_src_addr;
1086 }
1087
1088 /**
1089  * bnx2fc_fip_send - send an Ethernet-encapsulated FIP frame.
1090  *
1091  * @fip: FCoE controller.
1092  * @skb: FIP Packet.
1093  */
1094 static void bnx2fc_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb)
1095 {
1096         skb->dev = bnx2fc_from_ctlr(fip)->netdev;
1097         dev_queue_xmit(skb);
1098 }
1099
1100 static int bnx2fc_vport_create(struct fc_vport *vport, bool disabled)
1101 {
1102         struct Scsi_Host *shost = vport_to_shost(vport);
1103         struct fc_lport *n_port = shost_priv(shost);
1104         struct fcoe_port *port = lport_priv(n_port);
1105         struct bnx2fc_interface *interface = port->priv;
1106         struct net_device *netdev = interface->netdev;
1107         struct fc_lport *vn_port;
1108         int rc;
1109         char buf[32];
1110
1111         rc = fcoe_validate_vport_create(vport);
1112         if (rc) {
1113                 fcoe_wwn_to_str(vport->port_name, buf, sizeof(buf));
1114                 printk(KERN_ERR PFX "Failed to create vport, "
1115                        "WWPN (0x%s) already exists\n",
1116                        buf);
1117                 return rc;
1118         }
1119
1120         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
1121                 printk(KERN_ERR PFX "vn ports cannot be created on"
1122                         "this interface\n");
1123                 return -EIO;
1124         }
1125         rtnl_lock();
1126         mutex_lock(&bnx2fc_dev_lock);
1127         vn_port = bnx2fc_if_create(interface, &vport->dev, 1);
1128         mutex_unlock(&bnx2fc_dev_lock);
1129         rtnl_unlock();
1130
1131         if (IS_ERR(vn_port)) {
1132                 printk(KERN_ERR PFX "bnx2fc_vport_create (%s) failed\n",
1133                         netdev->name);
1134                 return -EIO;
1135         }
1136
1137         if (disabled) {
1138                 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1139         } else {
1140                 vn_port->boot_time = jiffies;
1141                 fc_lport_init(vn_port);
1142                 fc_fabric_login(vn_port);
1143                 fc_vport_setlink(vn_port);
1144         }
1145         return 0;
1146 }
1147
1148 static void bnx2fc_free_vport(struct bnx2fc_hba *hba, struct fc_lport *lport)
1149 {
1150         struct bnx2fc_lport *blport, *tmp;
1151
1152         spin_lock_bh(&hba->hba_lock);
1153         list_for_each_entry_safe(blport, tmp, &hba->vports, list) {
1154                 if (blport->lport == lport) {
1155                         list_del(&blport->list);
1156                         kfree(blport);
1157                 }
1158         }
1159         spin_unlock_bh(&hba->hba_lock);
1160 }
1161
1162 static int bnx2fc_vport_destroy(struct fc_vport *vport)
1163 {
1164         struct Scsi_Host *shost = vport_to_shost(vport);
1165         struct fc_lport *n_port = shost_priv(shost);
1166         struct fc_lport *vn_port = vport->dd_data;
1167         struct fcoe_port *port = lport_priv(vn_port);
1168         struct bnx2fc_interface *interface = port->priv;
1169         struct fc_lport *v_port;
1170         bool found = false;
1171
1172         mutex_lock(&n_port->lp_mutex);
1173         list_for_each_entry(v_port, &n_port->vports, list)
1174                 if (v_port->vport == vport) {
1175                         found = true;
1176                         break;
1177                 }
1178
1179         if (!found) {
1180                 mutex_unlock(&n_port->lp_mutex);
1181                 return -ENOENT;
1182         }
1183         list_del(&vn_port->list);
1184         mutex_unlock(&n_port->lp_mutex);
1185         bnx2fc_free_vport(interface->hba, port->lport);
1186         bnx2fc_port_shutdown(port->lport);
1187         bnx2fc_interface_put(interface);
1188         queue_work(bnx2fc_wq, &port->destroy_work);
1189         return 0;
1190 }
1191
1192 static int bnx2fc_vport_disable(struct fc_vport *vport, bool disable)
1193 {
1194         struct fc_lport *lport = vport->dd_data;
1195
1196         if (disable) {
1197                 fc_vport_set_state(vport, FC_VPORT_DISABLED);
1198                 fc_fabric_logoff(lport);
1199         } else {
1200                 lport->boot_time = jiffies;
1201                 fc_fabric_login(lport);
1202                 fc_vport_setlink(lport);
1203         }
1204         return 0;
1205 }
1206
1207
1208 static int bnx2fc_interface_setup(struct bnx2fc_interface *interface)
1209 {
1210         struct net_device *netdev = interface->netdev;
1211         struct net_device *physdev = interface->hba->phys_dev;
1212         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1213         struct netdev_hw_addr *ha;
1214         int sel_san_mac = 0;
1215
1216         /* setup Source MAC Address */
1217         rcu_read_lock();
1218         for_each_dev_addr(physdev, ha) {
1219                 BNX2FC_MISC_DBG("net_config: ha->type = %d, fip_mac = ",
1220                                 ha->type);
1221                 printk(KERN_INFO "%2x:%2x:%2x:%2x:%2x:%2x\n", ha->addr[0],
1222                                 ha->addr[1], ha->addr[2], ha->addr[3],
1223                                 ha->addr[4], ha->addr[5]);
1224
1225                 if ((ha->type == NETDEV_HW_ADDR_T_SAN) &&
1226                     (is_valid_ether_addr(ha->addr))) {
1227                         memcpy(ctlr->ctl_src_addr, ha->addr,
1228                                ETH_ALEN);
1229                         sel_san_mac = 1;
1230                         BNX2FC_MISC_DBG("Found SAN MAC\n");
1231                 }
1232         }
1233         rcu_read_unlock();
1234
1235         if (!sel_san_mac)
1236                 return -ENODEV;
1237
1238         interface->fip_packet_type.func = bnx2fc_fip_recv;
1239         interface->fip_packet_type.type = htons(ETH_P_FIP);
1240         interface->fip_packet_type.dev = netdev;
1241         dev_add_pack(&interface->fip_packet_type);
1242
1243         interface->fcoe_packet_type.func = bnx2fc_rcv;
1244         interface->fcoe_packet_type.type = __constant_htons(ETH_P_FCOE);
1245         interface->fcoe_packet_type.dev = netdev;
1246         dev_add_pack(&interface->fcoe_packet_type);
1247
1248         return 0;
1249 }
1250
1251 static int bnx2fc_attach_transport(void)
1252 {
1253         bnx2fc_transport_template =
1254                 fc_attach_transport(&bnx2fc_transport_function);
1255
1256         if (bnx2fc_transport_template == NULL) {
1257                 printk(KERN_ERR PFX "Failed to attach FC transport\n");
1258                 return -ENODEV;
1259         }
1260
1261         bnx2fc_vport_xport_template =
1262                 fc_attach_transport(&bnx2fc_vport_xport_function);
1263         if (bnx2fc_vport_xport_template == NULL) {
1264                 printk(KERN_ERR PFX
1265                        "Failed to attach FC transport for vport\n");
1266                 fc_release_transport(bnx2fc_transport_template);
1267                 bnx2fc_transport_template = NULL;
1268                 return -ENODEV;
1269         }
1270         return 0;
1271 }
1272 static void bnx2fc_release_transport(void)
1273 {
1274         fc_release_transport(bnx2fc_transport_template);
1275         fc_release_transport(bnx2fc_vport_xport_template);
1276         bnx2fc_transport_template = NULL;
1277         bnx2fc_vport_xport_template = NULL;
1278 }
1279
1280 static void bnx2fc_interface_release(struct kref *kref)
1281 {
1282         struct fcoe_ctlr_device *ctlr_dev;
1283         struct bnx2fc_interface *interface;
1284         struct fcoe_ctlr *ctlr;
1285         struct net_device *netdev;
1286
1287         interface = container_of(kref, struct bnx2fc_interface, kref);
1288         BNX2FC_MISC_DBG("Interface is being released\n");
1289
1290         ctlr = bnx2fc_to_ctlr(interface);
1291         ctlr_dev = fcoe_ctlr_to_ctlr_dev(ctlr);
1292         netdev = interface->netdev;
1293
1294         /* tear-down FIP controller */
1295         if (test_and_clear_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags))
1296                 fcoe_ctlr_destroy(ctlr);
1297
1298         fcoe_ctlr_device_delete(ctlr_dev);
1299
1300         dev_put(netdev);
1301         module_put(THIS_MODULE);
1302 }
1303
1304 static inline void bnx2fc_interface_get(struct bnx2fc_interface *interface)
1305 {
1306         kref_get(&interface->kref);
1307 }
1308
1309 static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface)
1310 {
1311         kref_put(&interface->kref, bnx2fc_interface_release);
1312 }
1313 static void bnx2fc_hba_destroy(struct bnx2fc_hba *hba)
1314 {
1315         /* Free the command manager */
1316         if (hba->cmd_mgr) {
1317                 bnx2fc_cmd_mgr_free(hba->cmd_mgr);
1318                 hba->cmd_mgr = NULL;
1319         }
1320         kfree(hba->tgt_ofld_list);
1321         bnx2fc_unbind_pcidev(hba);
1322         kfree(hba);
1323 }
1324
1325 /**
1326  * bnx2fc_hba_create - create a new bnx2fc hba
1327  *
1328  * @cnic:       pointer to cnic device
1329  *
1330  * Creates a new FCoE hba on the given device.
1331  *
1332  */
1333 static struct bnx2fc_hba *bnx2fc_hba_create(struct cnic_dev *cnic)
1334 {
1335         struct bnx2fc_hba *hba;
1336         struct fcoe_capabilities *fcoe_cap;
1337         int rc;
1338
1339         hba = kzalloc(sizeof(*hba), GFP_KERNEL);
1340         if (!hba) {
1341                 printk(KERN_ERR PFX "Unable to allocate hba structure\n");
1342                 return NULL;
1343         }
1344         spin_lock_init(&hba->hba_lock);
1345         mutex_init(&hba->hba_mutex);
1346
1347         hba->cnic = cnic;
1348         rc = bnx2fc_bind_pcidev(hba);
1349         if (rc) {
1350                 printk(KERN_ERR PFX "create_adapter:  bind error\n");
1351                 goto bind_err;
1352         }
1353         hba->phys_dev = cnic->netdev;
1354         hba->next_conn_id = 0;
1355
1356         hba->tgt_ofld_list =
1357                 kzalloc(sizeof(struct bnx2fc_rport *) * BNX2FC_NUM_MAX_SESS,
1358                         GFP_KERNEL);
1359         if (!hba->tgt_ofld_list) {
1360                 printk(KERN_ERR PFX "Unable to allocate tgt offload list\n");
1361                 goto tgtofld_err;
1362         }
1363
1364         hba->num_ofld_sess = 0;
1365
1366         hba->cmd_mgr = bnx2fc_cmd_mgr_alloc(hba, BNX2FC_MIN_XID,
1367                                                 BNX2FC_MAX_XID);
1368         if (!hba->cmd_mgr) {
1369                 printk(KERN_ERR PFX "em_config:bnx2fc_cmd_mgr_alloc failed\n");
1370                 goto cmgr_err;
1371         }
1372         fcoe_cap = &hba->fcoe_cap;
1373
1374         fcoe_cap->capability1 = BNX2FC_TM_MAX_SQES <<
1375                                         FCOE_IOS_PER_CONNECTION_SHIFT;
1376         fcoe_cap->capability1 |= BNX2FC_NUM_MAX_SESS <<
1377                                         FCOE_LOGINS_PER_PORT_SHIFT;
1378         fcoe_cap->capability2 = BNX2FC_MAX_OUTSTANDING_CMNDS <<
1379                                         FCOE_NUMBER_OF_EXCHANGES_SHIFT;
1380         fcoe_cap->capability2 |= BNX2FC_MAX_NPIV <<
1381                                         FCOE_NPIV_WWN_PER_PORT_SHIFT;
1382         fcoe_cap->capability3 = BNX2FC_NUM_MAX_SESS <<
1383                                         FCOE_TARGETS_SUPPORTED_SHIFT;
1384         fcoe_cap->capability3 |= BNX2FC_MAX_OUTSTANDING_CMNDS <<
1385                                         FCOE_OUTSTANDING_COMMANDS_SHIFT;
1386         fcoe_cap->capability4 = FCOE_CAPABILITY4_STATEFUL;
1387
1388         init_waitqueue_head(&hba->shutdown_wait);
1389         init_waitqueue_head(&hba->destroy_wait);
1390         INIT_LIST_HEAD(&hba->vports);
1391
1392         return hba;
1393
1394 cmgr_err:
1395         kfree(hba->tgt_ofld_list);
1396 tgtofld_err:
1397         bnx2fc_unbind_pcidev(hba);
1398 bind_err:
1399         kfree(hba);
1400         return NULL;
1401 }
1402
1403 struct bnx2fc_interface *bnx2fc_interface_create(struct bnx2fc_hba *hba,
1404                                       struct net_device *netdev,
1405                                       enum fip_state fip_mode)
1406 {
1407         struct fcoe_ctlr_device *ctlr_dev;
1408         struct bnx2fc_interface *interface;
1409         struct fcoe_ctlr *ctlr;
1410         int size;
1411         int rc = 0;
1412
1413         size = (sizeof(*interface) + sizeof(struct fcoe_ctlr));
1414         ctlr_dev = fcoe_ctlr_device_add(&netdev->dev, &bnx2fc_fcoe_sysfs_templ,
1415                                          size);
1416         if (!ctlr_dev) {
1417                 printk(KERN_ERR PFX "Unable to allocate interface structure\n");
1418                 return NULL;
1419         }
1420         ctlr = fcoe_ctlr_device_priv(ctlr_dev);
1421         interface = fcoe_ctlr_priv(ctlr);
1422         dev_hold(netdev);
1423         kref_init(&interface->kref);
1424         interface->hba = hba;
1425         interface->netdev = netdev;
1426
1427         /* Initialize FIP */
1428         fcoe_ctlr_init(ctlr, fip_mode);
1429         ctlr->send = bnx2fc_fip_send;
1430         ctlr->update_mac = bnx2fc_update_src_mac;
1431         ctlr->get_src_addr = bnx2fc_get_src_mac;
1432         set_bit(BNX2FC_CTLR_INIT_DONE, &interface->if_flags);
1433
1434         rc = bnx2fc_interface_setup(interface);
1435         if (!rc)
1436                 return interface;
1437
1438         fcoe_ctlr_destroy(ctlr);
1439         dev_put(netdev);
1440         fcoe_ctlr_device_delete(ctlr_dev);
1441         return NULL;
1442 }
1443
1444 /**
1445  * bnx2fc_if_create - Create FCoE instance on a given interface
1446  *
1447  * @interface:  FCoE interface to create a local port on
1448  * @parent:     Device pointer to be the parent in sysfs for the SCSI host
1449  * @npiv:       Indicates if the port is vport or not
1450  *
1451  * Creates a fc_lport instance and a Scsi_Host instance and configure them.
1452  *
1453  * Returns:     Allocated fc_lport or an error pointer
1454  */
1455 static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
1456                                   struct device *parent, int npiv)
1457 {
1458         struct fcoe_ctlr        *ctlr = bnx2fc_to_ctlr(interface);
1459         struct fc_lport         *lport, *n_port;
1460         struct fcoe_port        *port;
1461         struct Scsi_Host        *shost;
1462         struct fc_vport         *vport = dev_to_vport(parent);
1463         struct bnx2fc_lport     *blport;
1464         struct bnx2fc_hba       *hba;
1465         int                     rc = 0;
1466
1467         blport = kzalloc(sizeof(struct bnx2fc_lport), GFP_KERNEL);
1468         if (!blport) {
1469                 BNX2FC_HBA_DBG(ctlr->lp, "Unable to alloc blport\n");
1470                 return NULL;
1471         }
1472
1473         /* Allocate Scsi_Host structure */
1474         if (!npiv)
1475                 lport = libfc_host_alloc(&bnx2fc_shost_template, sizeof(*port));
1476         else
1477                 lport = libfc_vport_create(vport, sizeof(*port));
1478
1479         if (!lport) {
1480                 printk(KERN_ERR PFX "could not allocate scsi host structure\n");
1481                 goto free_blport;
1482         }
1483         shost = lport->host;
1484         port = lport_priv(lport);
1485         port->lport = lport;
1486         port->priv = interface;
1487         INIT_WORK(&port->destroy_work, bnx2fc_destroy_work);
1488
1489         /* Configure fcoe_port */
1490         rc = bnx2fc_lport_config(lport);
1491         if (rc)
1492                 goto lp_config_err;
1493
1494         if (npiv) {
1495                 printk(KERN_ERR PFX "Setting vport names, 0x%llX 0x%llX\n",
1496                         vport->node_name, vport->port_name);
1497                 fc_set_wwnn(lport, vport->node_name);
1498                 fc_set_wwpn(lport, vport->port_name);
1499         }
1500         /* Configure netdev and networking properties of the lport */
1501         rc = bnx2fc_net_config(lport, interface->netdev);
1502         if (rc) {
1503                 printk(KERN_ERR PFX "Error on bnx2fc_net_config\n");
1504                 goto lp_config_err;
1505         }
1506
1507         rc = bnx2fc_shost_config(lport, parent);
1508         if (rc) {
1509                 printk(KERN_ERR PFX "Couldnt configure shost for %s\n",
1510                         interface->netdev->name);
1511                 goto lp_config_err;
1512         }
1513
1514         /* Initialize the libfc library */
1515         rc = bnx2fc_libfc_config(lport);
1516         if (rc) {
1517                 printk(KERN_ERR PFX "Couldnt configure libfc\n");
1518                 goto shost_err;
1519         }
1520         fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1521
1522         /* Allocate exchange manager */
1523         if (!npiv)
1524                 rc = bnx2fc_em_config(lport);
1525         else {
1526                 shost = vport_to_shost(vport);
1527                 n_port = shost_priv(shost);
1528                 rc = fc_exch_mgr_list_clone(n_port, lport);
1529         }
1530
1531         if (rc) {
1532                 printk(KERN_ERR PFX "Error on bnx2fc_em_config\n");
1533                 goto shost_err;
1534         }
1535
1536         bnx2fc_interface_get(interface);
1537
1538         hba = interface->hba;
1539         spin_lock_bh(&hba->hba_lock);
1540         blport->lport = lport;
1541         list_add_tail(&blport->list, &hba->vports);
1542         spin_unlock_bh(&hba->hba_lock);
1543
1544         return lport;
1545
1546 shost_err:
1547         scsi_remove_host(shost);
1548 lp_config_err:
1549         scsi_host_put(lport->host);
1550 free_blport:
1551         kfree(blport);
1552         return NULL;
1553 }
1554
1555 static void bnx2fc_net_cleanup(struct bnx2fc_interface *interface)
1556 {
1557         /* Dont listen for Ethernet packets anymore */
1558         __dev_remove_pack(&interface->fcoe_packet_type);
1559         __dev_remove_pack(&interface->fip_packet_type);
1560         synchronize_net();
1561 }
1562
1563 static void bnx2fc_interface_cleanup(struct bnx2fc_interface *interface)
1564 {
1565         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1566         struct fc_lport *lport = ctlr->lp;
1567         struct fcoe_port *port = lport_priv(lport);
1568         struct bnx2fc_hba *hba = interface->hba;
1569
1570         /* Stop the transmit retry timer */
1571         del_timer_sync(&port->timer);
1572
1573         /* Free existing transmit skbs */
1574         fcoe_clean_pending_queue(lport);
1575
1576         bnx2fc_net_cleanup(interface);
1577
1578         bnx2fc_free_vport(hba, lport);
1579 }
1580
1581 static void bnx2fc_if_destroy(struct fc_lport *lport)
1582 {
1583
1584         /* Free queued packets for the receive thread */
1585         bnx2fc_clean_rx_queue(lport);
1586
1587         /* Detach from scsi-ml */
1588         fc_remove_host(lport->host);
1589         scsi_remove_host(lport->host);
1590
1591         /*
1592          * Note that only the physical lport will have the exchange manager.
1593          * for vports, this function is NOP
1594          */
1595         fc_exch_mgr_free(lport);
1596
1597         /* Free memory used by statistical counters */
1598         fc_lport_free_stats(lport);
1599
1600         /* Release Scsi_Host */
1601         scsi_host_put(lport->host);
1602 }
1603
1604 static void __bnx2fc_destroy(struct bnx2fc_interface *interface)
1605 {
1606         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1607         struct fc_lport *lport = ctlr->lp;
1608         struct fcoe_port *port = lport_priv(lport);
1609
1610         bnx2fc_interface_cleanup(interface);
1611         bnx2fc_stop(interface);
1612         list_del(&interface->list);
1613         bnx2fc_interface_put(interface);
1614         queue_work(bnx2fc_wq, &port->destroy_work);
1615 }
1616
1617 /**
1618  * bnx2fc_destroy - Destroy a bnx2fc FCoE interface
1619  *
1620  * @buffer: The name of the Ethernet interface to be destroyed
1621  * @kp:     The associated kernel parameter
1622  *
1623  * Called from sysfs.
1624  *
1625  * Returns: 0 for success
1626  */
1627 static int bnx2fc_destroy(struct net_device *netdev)
1628 {
1629         struct bnx2fc_interface *interface = NULL;
1630         struct workqueue_struct *timer_work_queue;
1631         struct fcoe_ctlr *ctlr;
1632         int rc = 0;
1633
1634         rtnl_lock();
1635         mutex_lock(&bnx2fc_dev_lock);
1636
1637         interface = bnx2fc_interface_lookup(netdev);
1638         ctlr = bnx2fc_to_ctlr(interface);
1639         if (!interface || !ctlr->lp) {
1640                 rc = -ENODEV;
1641                 printk(KERN_ERR PFX "bnx2fc_destroy: interface or lport not found\n");
1642                 goto netdev_err;
1643         }
1644
1645         timer_work_queue = interface->timer_work_queue;
1646         __bnx2fc_destroy(interface);
1647         destroy_workqueue(timer_work_queue);
1648
1649 netdev_err:
1650         mutex_unlock(&bnx2fc_dev_lock);
1651         rtnl_unlock();
1652         return rc;
1653 }
1654
1655 static void bnx2fc_destroy_work(struct work_struct *work)
1656 {
1657         struct fcoe_port *port;
1658         struct fc_lport *lport;
1659
1660         port = container_of(work, struct fcoe_port, destroy_work);
1661         lport = port->lport;
1662
1663         BNX2FC_HBA_DBG(lport, "Entered bnx2fc_destroy_work\n");
1664
1665         bnx2fc_if_destroy(lport);
1666 }
1667
1668 static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba)
1669 {
1670         bnx2fc_free_fw_resc(hba);
1671         bnx2fc_free_task_ctx(hba);
1672 }
1673
1674 /**
1675  * bnx2fc_bind_adapter_devices - binds bnx2fc adapter with the associated
1676  *                      pci structure
1677  *
1678  * @hba:                Adapter instance
1679  */
1680 static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba)
1681 {
1682         if (bnx2fc_setup_task_ctx(hba))
1683                 goto mem_err;
1684
1685         if (bnx2fc_setup_fw_resc(hba))
1686                 goto mem_err;
1687
1688         return 0;
1689 mem_err:
1690         bnx2fc_unbind_adapter_devices(hba);
1691         return -ENOMEM;
1692 }
1693
1694 static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba)
1695 {
1696         struct cnic_dev *cnic;
1697
1698         if (!hba->cnic) {
1699                 printk(KERN_ERR PFX "cnic is NULL\n");
1700                 return -ENODEV;
1701         }
1702         cnic = hba->cnic;
1703         hba->pcidev = cnic->pcidev;
1704         if (hba->pcidev)
1705                 pci_dev_get(hba->pcidev);
1706
1707         return 0;
1708 }
1709
1710 static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba)
1711 {
1712         if (hba->pcidev)
1713                 pci_dev_put(hba->pcidev);
1714         hba->pcidev = NULL;
1715 }
1716
1717 /**
1718  * bnx2fc_ulp_get_stats - cnic callback to populate FCoE stats
1719  *
1720  * @handle:    transport handle pointing to adapter struture
1721  */
1722 static int bnx2fc_ulp_get_stats(void *handle)
1723 {
1724         struct bnx2fc_hba *hba = handle;
1725         struct cnic_dev *cnic;
1726         struct fcoe_stats_info *stats_addr;
1727
1728         if (!hba)
1729                 return -EINVAL;
1730
1731         cnic = hba->cnic;
1732         stats_addr = &cnic->stats_addr->fcoe_stat;
1733         if (!stats_addr)
1734                 return -EINVAL;
1735
1736         strncpy(stats_addr->version, BNX2FC_VERSION,
1737                 sizeof(stats_addr->version));
1738         stats_addr->txq_size = BNX2FC_SQ_WQES_MAX;
1739         stats_addr->rxq_size = BNX2FC_CQ_WQES_MAX;
1740
1741         return 0;
1742 }
1743
1744
1745 /**
1746  * bnx2fc_ulp_start - cnic callback to initialize & start adapter instance
1747  *
1748  * @handle:     transport handle pointing to adapter structure
1749  *
1750  * This function maps adapter structure to pcidev structure and initiates
1751  *      firmware handshake to enable/initialize on-chip FCoE components.
1752  *      This bnx2fc - cnic interface api callback is used after following
1753  *      conditions are met -
1754  *      a) underlying network interface is up (marked by event NETDEV_UP
1755  *              from netdev
1756  *      b) bnx2fc adatper structure is registered.
1757  */
1758 static void bnx2fc_ulp_start(void *handle)
1759 {
1760         struct bnx2fc_hba *hba = handle;
1761         struct bnx2fc_interface *interface;
1762         struct fcoe_ctlr *ctlr;
1763         struct fc_lport *lport;
1764
1765         mutex_lock(&bnx2fc_dev_lock);
1766
1767         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1768                 bnx2fc_fw_init(hba);
1769
1770         BNX2FC_MISC_DBG("bnx2fc started.\n");
1771
1772         list_for_each_entry(interface, &if_list, list) {
1773                 if (interface->hba == hba) {
1774                         ctlr = bnx2fc_to_ctlr(interface);
1775                         lport = ctlr->lp;
1776                         /* Kick off Fabric discovery*/
1777                         printk(KERN_ERR PFX "ulp_init: start discovery\n");
1778                         lport->tt.frame_send = bnx2fc_xmit;
1779                         bnx2fc_start_disc(interface);
1780                 }
1781         }
1782
1783         mutex_unlock(&bnx2fc_dev_lock);
1784 }
1785
1786 static void bnx2fc_port_shutdown(struct fc_lport *lport)
1787 {
1788         BNX2FC_MISC_DBG("Entered %s\n", __func__);
1789         fc_fabric_logoff(lport);
1790         fc_lport_destroy(lport);
1791 }
1792
1793 static void bnx2fc_stop(struct bnx2fc_interface *interface)
1794 {
1795         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1796         struct fc_lport *lport;
1797         struct fc_lport *vport;
1798
1799         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags))
1800                 return;
1801
1802         lport = ctlr->lp;
1803         bnx2fc_port_shutdown(lport);
1804
1805         mutex_lock(&lport->lp_mutex);
1806         list_for_each_entry(vport, &lport->vports, list)
1807                 fc_host_port_type(vport->host) =
1808                                         FC_PORTTYPE_UNKNOWN;
1809         mutex_unlock(&lport->lp_mutex);
1810         fc_host_port_type(lport->host) = FC_PORTTYPE_UNKNOWN;
1811         fcoe_ctlr_link_down(ctlr);
1812         fcoe_clean_pending_queue(lport);
1813 }
1814
1815 static int bnx2fc_fw_init(struct bnx2fc_hba *hba)
1816 {
1817 #define BNX2FC_INIT_POLL_TIME           (1000 / HZ)
1818         int rc = -1;
1819         int i = HZ;
1820
1821         rc = bnx2fc_bind_adapter_devices(hba);
1822         if (rc) {
1823                 printk(KERN_ALERT PFX
1824                         "bnx2fc_bind_adapter_devices failed - rc = %d\n", rc);
1825                 goto err_out;
1826         }
1827
1828         rc = bnx2fc_send_fw_fcoe_init_msg(hba);
1829         if (rc) {
1830                 printk(KERN_ALERT PFX
1831                         "bnx2fc_send_fw_fcoe_init_msg failed - rc = %d\n", rc);
1832                 goto err_unbind;
1833         }
1834
1835         /*
1836          * Wait until the adapter init message is complete, and adapter
1837          * state is UP.
1838          */
1839         while (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state) && i--)
1840                 msleep(BNX2FC_INIT_POLL_TIME);
1841
1842         if (!test_bit(ADAPTER_STATE_UP, &hba->adapter_state)) {
1843                 printk(KERN_ERR PFX "bnx2fc_start: %s failed to initialize.  "
1844                                 "Ignoring...\n",
1845                                 hba->cnic->netdev->name);
1846                 rc = -1;
1847                 goto err_unbind;
1848         }
1849
1850
1851         set_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags);
1852         return 0;
1853
1854 err_unbind:
1855         bnx2fc_unbind_adapter_devices(hba);
1856 err_out:
1857         return rc;
1858 }
1859
1860 static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba)
1861 {
1862         if (test_and_clear_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags)) {
1863                 if (bnx2fc_send_fw_fcoe_destroy_msg(hba) == 0) {
1864                         init_timer(&hba->destroy_timer);
1865                         hba->destroy_timer.expires = BNX2FC_FW_TIMEOUT +
1866                                                                 jiffies;
1867                         hba->destroy_timer.function = bnx2fc_destroy_timer;
1868                         hba->destroy_timer.data = (unsigned long)hba;
1869                         add_timer(&hba->destroy_timer);
1870                         wait_event_interruptible(hba->destroy_wait,
1871                                         test_bit(BNX2FC_FLAG_DESTROY_CMPL,
1872                                                  &hba->flags));
1873                         clear_bit(BNX2FC_FLAG_DESTROY_CMPL, &hba->flags);
1874                         /* This should never happen */
1875                         if (signal_pending(current))
1876                                 flush_signals(current);
1877
1878                         del_timer_sync(&hba->destroy_timer);
1879                 }
1880                 bnx2fc_unbind_adapter_devices(hba);
1881         }
1882 }
1883
1884 /**
1885  * bnx2fc_ulp_stop - cnic callback to shutdown adapter instance
1886  *
1887  * @handle:     transport handle pointing to adapter structure
1888  *
1889  * Driver checks if adapter is already in shutdown mode, if not start
1890  *      the shutdown process.
1891  */
1892 static void bnx2fc_ulp_stop(void *handle)
1893 {
1894         struct bnx2fc_hba *hba = handle;
1895         struct bnx2fc_interface *interface;
1896
1897         printk(KERN_ERR "ULP_STOP\n");
1898
1899         mutex_lock(&bnx2fc_dev_lock);
1900         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &hba->flags))
1901                 goto exit;
1902         list_for_each_entry(interface, &if_list, list) {
1903                 if (interface->hba == hba)
1904                         bnx2fc_stop(interface);
1905         }
1906         BUG_ON(hba->num_ofld_sess != 0);
1907
1908         mutex_lock(&hba->hba_mutex);
1909         clear_bit(ADAPTER_STATE_UP, &hba->adapter_state);
1910         clear_bit(ADAPTER_STATE_GOING_DOWN,
1911                   &hba->adapter_state);
1912
1913         clear_bit(ADAPTER_STATE_READY, &hba->adapter_state);
1914         mutex_unlock(&hba->hba_mutex);
1915
1916         bnx2fc_fw_destroy(hba);
1917 exit:
1918         mutex_unlock(&bnx2fc_dev_lock);
1919 }
1920
1921 static void bnx2fc_start_disc(struct bnx2fc_interface *interface)
1922 {
1923         struct fcoe_ctlr *ctlr = bnx2fc_to_ctlr(interface);
1924         struct fc_lport *lport;
1925         int wait_cnt = 0;
1926
1927         BNX2FC_MISC_DBG("Entered %s\n", __func__);
1928         /* Kick off FIP/FLOGI */
1929         if (!test_bit(BNX2FC_FLAG_FW_INIT_DONE, &interface->hba->flags)) {
1930                 printk(KERN_ERR PFX "Init not done yet\n");
1931                 return;
1932         }
1933
1934         lport = ctlr->lp;
1935         BNX2FC_HBA_DBG(lport, "calling fc_fabric_login\n");
1936
1937         if (!bnx2fc_link_ok(lport) && interface->enabled) {
1938                 BNX2FC_HBA_DBG(lport, "ctlr_link_up\n");
1939                 fcoe_ctlr_link_up(ctlr);
1940                 fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
1941                 set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
1942         }
1943
1944         /* wait for the FCF to be selected before issuing FLOGI */
1945         while (!ctlr->sel_fcf) {
1946                 msleep(250);
1947                 /* give up after 3 secs */
1948                 if (++wait_cnt > 12)
1949                         break;
1950         }
1951
1952         /* Reset max receive frame size to default */
1953         if (fc_set_mfs(lport, BNX2FC_MFS))
1954                 return;
1955
1956         fc_lport_init(lport);
1957         fc_fabric_login(lport);
1958 }
1959
1960
1961 /**
1962  * bnx2fc_ulp_init - Initialize an adapter instance
1963  *
1964  * @dev :       cnic device handle
1965  * Called from cnic_register_driver() context to initialize all
1966  *      enumerated cnic devices. This routine allocates adapter structure
1967  *      and other device specific resources.
1968  */
1969 static void bnx2fc_ulp_init(struct cnic_dev *dev)
1970 {
1971         struct bnx2fc_hba *hba;
1972         int rc = 0;
1973
1974         BNX2FC_MISC_DBG("Entered %s\n", __func__);
1975         /* bnx2fc works only when bnx2x is loaded */
1976         if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags) ||
1977             (dev->max_fcoe_conn == 0)) {
1978                 printk(KERN_ERR PFX "bnx2fc FCoE not supported on %s,"
1979                                     " flags: %lx fcoe_conn: %d\n",
1980                         dev->netdev->name, dev->flags, dev->max_fcoe_conn);
1981                 return;
1982         }
1983
1984         hba = bnx2fc_hba_create(dev);
1985         if (!hba) {
1986                 printk(KERN_ERR PFX "hba initialization failed\n");
1987                 return;
1988         }
1989
1990         /* Add HBA to the adapter list */
1991         mutex_lock(&bnx2fc_dev_lock);
1992         list_add_tail(&hba->list, &adapter_list);
1993         adapter_count++;
1994         mutex_unlock(&bnx2fc_dev_lock);
1995
1996         dev->fcoe_cap = &hba->fcoe_cap;
1997         clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
1998         rc = dev->register_device(dev, CNIC_ULP_FCOE,
1999                                                 (void *) hba);
2000         if (rc)
2001                 printk(KERN_ERR PFX "register_device failed, rc = %d\n", rc);
2002         else
2003                 set_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic);
2004 }
2005
2006
2007 static int bnx2fc_disable(struct net_device *netdev)
2008 {
2009         struct bnx2fc_interface *interface;
2010         struct fcoe_ctlr *ctlr;
2011         int rc = 0;
2012
2013         rtnl_lock();
2014         mutex_lock(&bnx2fc_dev_lock);
2015
2016         interface = bnx2fc_interface_lookup(netdev);
2017         ctlr = bnx2fc_to_ctlr(interface);
2018         if (!interface || !ctlr->lp) {
2019                 rc = -ENODEV;
2020                 printk(KERN_ERR PFX "bnx2fc_disable: interface or lport not found\n");
2021         } else {
2022                 interface->enabled = false;
2023                 fcoe_ctlr_link_down(ctlr);
2024                 fcoe_clean_pending_queue(ctlr->lp);
2025         }
2026
2027         mutex_unlock(&bnx2fc_dev_lock);
2028         rtnl_unlock();
2029         return rc;
2030 }
2031
2032
2033 static int bnx2fc_enable(struct net_device *netdev)
2034 {
2035         struct bnx2fc_interface *interface;
2036         struct fcoe_ctlr *ctlr;
2037         int rc = 0;
2038
2039         rtnl_lock();
2040         mutex_lock(&bnx2fc_dev_lock);
2041
2042         interface = bnx2fc_interface_lookup(netdev);
2043         ctlr = bnx2fc_to_ctlr(interface);
2044         if (!interface || !ctlr->lp) {
2045                 rc = -ENODEV;
2046                 printk(KERN_ERR PFX "bnx2fc_enable: interface or lport not found\n");
2047         } else if (!bnx2fc_link_ok(ctlr->lp)) {
2048                 fcoe_ctlr_link_up(ctlr);
2049                 interface->enabled = true;
2050         }
2051
2052         mutex_unlock(&bnx2fc_dev_lock);
2053         rtnl_unlock();
2054         return rc;
2055 }
2056
2057 /**
2058  * bnx2fc_create - Create bnx2fc FCoE interface
2059  *
2060  * @buffer: The name of Ethernet interface to create on
2061  * @kp:     The associated kernel param
2062  *
2063  * Called from sysfs.
2064  *
2065  * Returns: 0 for success
2066  */
2067 static int bnx2fc_create(struct net_device *netdev, enum fip_state fip_mode)
2068 {
2069         struct fcoe_ctlr *ctlr;
2070         struct bnx2fc_interface *interface;
2071         struct bnx2fc_hba *hba;
2072         struct net_device *phys_dev = netdev;
2073         struct fc_lport *lport;
2074         struct ethtool_drvinfo drvinfo;
2075         int rc = 0;
2076         int vlan_id = 0;
2077
2078         BNX2FC_MISC_DBG("Entered bnx2fc_create\n");
2079         if (fip_mode != FIP_MODE_FABRIC) {
2080                 printk(KERN_ERR "fip mode not FABRIC\n");
2081                 return -EIO;
2082         }
2083
2084         rtnl_lock();
2085
2086         mutex_lock(&bnx2fc_dev_lock);
2087
2088         if (!try_module_get(THIS_MODULE)) {
2089                 rc = -EINVAL;
2090                 goto mod_err;
2091         }
2092
2093         /* obtain physical netdev */
2094         if (netdev->priv_flags & IFF_802_1Q_VLAN)
2095                 phys_dev = vlan_dev_real_dev(netdev);
2096
2097         /* verify if the physical device is a netxtreme2 device */
2098         if (phys_dev->ethtool_ops && phys_dev->ethtool_ops->get_drvinfo) {
2099                 memset(&drvinfo, 0, sizeof(drvinfo));
2100                 phys_dev->ethtool_ops->get_drvinfo(phys_dev, &drvinfo);
2101                 if (strncmp(drvinfo.driver, "bnx2x", strlen("bnx2x"))) {
2102                         printk(KERN_ERR PFX "Not a netxtreme2 device\n");
2103                         rc = -EINVAL;
2104                         goto netdev_err;
2105                 }
2106         } else {
2107                 printk(KERN_ERR PFX "unable to obtain drv_info\n");
2108                 rc = -EINVAL;
2109                 goto netdev_err;
2110         }
2111
2112         /* obtain interface and initialize rest of the structure */
2113         hba = bnx2fc_hba_lookup(phys_dev);
2114         if (!hba) {
2115                 rc = -ENODEV;
2116                 printk(KERN_ERR PFX "bnx2fc_create: hba not found\n");
2117                 goto netdev_err;
2118         }
2119
2120         if (bnx2fc_interface_lookup(netdev)) {
2121                 rc = -EEXIST;
2122                 goto netdev_err;
2123         }
2124
2125         interface = bnx2fc_interface_create(hba, netdev, fip_mode);
2126         if (!interface) {
2127                 printk(KERN_ERR PFX "bnx2fc_interface_create failed\n");
2128                 goto ifput_err;
2129         }
2130
2131         if (netdev->priv_flags & IFF_802_1Q_VLAN) {
2132                 vlan_id = vlan_dev_vlan_id(netdev);
2133                 interface->vlan_enabled = 1;
2134         }
2135
2136         ctlr = bnx2fc_to_ctlr(interface);
2137         interface->vlan_id = vlan_id;
2138
2139         interface->timer_work_queue =
2140                         create_singlethread_workqueue("bnx2fc_timer_wq");
2141         if (!interface->timer_work_queue) {
2142                 printk(KERN_ERR PFX "ulp_init could not create timer_wq\n");
2143                 rc = -EINVAL;
2144                 goto ifput_err;
2145         }
2146
2147         lport = bnx2fc_if_create(interface, &interface->hba->pcidev->dev, 0);
2148         if (!lport) {
2149                 printk(KERN_ERR PFX "Failed to create interface (%s)\n",
2150                         netdev->name);
2151                 rc = -EINVAL;
2152                 goto if_create_err;
2153         }
2154
2155         /* Add interface to if_list */
2156         list_add_tail(&interface->list, &if_list);
2157
2158         lport->boot_time = jiffies;
2159
2160         /* Make this master N_port */
2161         ctlr->lp = lport;
2162
2163         if (!bnx2fc_link_ok(lport)) {
2164                 fcoe_ctlr_link_up(ctlr);
2165                 fc_host_port_type(lport->host) = FC_PORTTYPE_NPORT;
2166                 set_bit(ADAPTER_STATE_READY, &interface->hba->adapter_state);
2167         }
2168
2169         BNX2FC_HBA_DBG(lport, "create: START DISC\n");
2170         bnx2fc_start_disc(interface);
2171         interface->enabled = true;
2172         /*
2173          * Release from kref_init in bnx2fc_interface_setup, on success
2174          * lport should be holding a reference taken in bnx2fc_if_create
2175          */
2176         bnx2fc_interface_put(interface);
2177         /* put netdev that was held while calling dev_get_by_name */
2178         mutex_unlock(&bnx2fc_dev_lock);
2179         rtnl_unlock();
2180         return 0;
2181
2182 if_create_err:
2183         destroy_workqueue(interface->timer_work_queue);
2184 ifput_err:
2185         bnx2fc_net_cleanup(interface);
2186         bnx2fc_interface_put(interface);
2187         goto mod_err;
2188 netdev_err:
2189         module_put(THIS_MODULE);
2190 mod_err:
2191         mutex_unlock(&bnx2fc_dev_lock);
2192         rtnl_unlock();
2193         return rc;
2194 }
2195
2196 /**
2197  * bnx2fc_find_hba_for_cnic - maps cnic instance to bnx2fc hba instance
2198  *
2199  * @cnic:       Pointer to cnic device instance
2200  *
2201  **/
2202 static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic)
2203 {
2204         struct bnx2fc_hba *hba;
2205
2206         /* Called with bnx2fc_dev_lock held */
2207         list_for_each_entry(hba, &adapter_list, list) {
2208                 if (hba->cnic == cnic)
2209                         return hba;
2210         }
2211         return NULL;
2212 }
2213
2214 static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
2215                                                         *netdev)
2216 {
2217         struct bnx2fc_interface *interface;
2218
2219         /* Called with bnx2fc_dev_lock held */
2220         list_for_each_entry(interface, &if_list, list) {
2221                 if (interface->netdev == netdev)
2222                         return interface;
2223         }
2224         return NULL;
2225 }
2226
2227 static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device
2228                                                       *phys_dev)
2229 {
2230         struct bnx2fc_hba *hba;
2231
2232         /* Called with bnx2fc_dev_lock held */
2233         list_for_each_entry(hba, &adapter_list, list) {
2234                 if (hba->phys_dev == phys_dev)
2235                         return hba;
2236         }
2237         printk(KERN_ERR PFX "adapter_lookup: hba NULL\n");
2238         return NULL;
2239 }
2240
2241 /**
2242  * bnx2fc_ulp_exit - shuts down adapter instance and frees all resources
2243  *
2244  * @dev         cnic device handle
2245  */
2246 static void bnx2fc_ulp_exit(struct cnic_dev *dev)
2247 {
2248         struct bnx2fc_hba *hba;
2249         struct bnx2fc_interface *interface, *tmp;
2250
2251         BNX2FC_MISC_DBG("Entered bnx2fc_ulp_exit\n");
2252
2253         if (!test_bit(CNIC_F_BNX2X_CLASS, &dev->flags)) {
2254                 printk(KERN_ERR PFX "bnx2fc port check: %s, flags: %lx\n",
2255                         dev->netdev->name, dev->flags);
2256                 return;
2257         }
2258
2259         mutex_lock(&bnx2fc_dev_lock);
2260         hba = bnx2fc_find_hba_for_cnic(dev);
2261         if (!hba) {
2262                 printk(KERN_ERR PFX "bnx2fc_ulp_exit: hba not found, dev 0%p\n",
2263                        dev);
2264                 mutex_unlock(&bnx2fc_dev_lock);
2265                 return;
2266         }
2267
2268         list_del_init(&hba->list);
2269         adapter_count--;
2270
2271         list_for_each_entry_safe(interface, tmp, &if_list, list)
2272                 /* destroy not called yet, move to quiesced list */
2273                 if (interface->hba == hba)
2274                         __bnx2fc_destroy(interface);
2275         mutex_unlock(&bnx2fc_dev_lock);
2276
2277         bnx2fc_ulp_stop(hba);
2278         /* unregister cnic device */
2279         if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED, &hba->reg_with_cnic))
2280                 hba->cnic->unregister_device(hba->cnic, CNIC_ULP_FCOE);
2281         bnx2fc_hba_destroy(hba);
2282 }
2283
2284 /**
2285  * bnx2fc_fcoe_reset - Resets the fcoe
2286  *
2287  * @shost: shost the reset is from
2288  *
2289  * Returns: always 0
2290  */
2291 static int bnx2fc_fcoe_reset(struct Scsi_Host *shost)
2292 {
2293         struct fc_lport *lport = shost_priv(shost);
2294         fc_lport_reset(lport);
2295         return 0;
2296 }
2297
2298
2299 static bool bnx2fc_match(struct net_device *netdev)
2300 {
2301         struct net_device *phys_dev = netdev;
2302
2303         mutex_lock(&bnx2fc_dev_lock);
2304         if (netdev->priv_flags & IFF_802_1Q_VLAN)
2305                 phys_dev = vlan_dev_real_dev(netdev);
2306
2307         if (bnx2fc_hba_lookup(phys_dev)) {
2308                 mutex_unlock(&bnx2fc_dev_lock);
2309                 return true;
2310         }
2311
2312         mutex_unlock(&bnx2fc_dev_lock);
2313         return false;
2314 }
2315
2316
2317 static struct fcoe_transport bnx2fc_transport = {
2318         .name = {"bnx2fc"},
2319         .attached = false,
2320         .list = LIST_HEAD_INIT(bnx2fc_transport.list),
2321         .match = bnx2fc_match,
2322         .create = bnx2fc_create,
2323         .destroy = bnx2fc_destroy,
2324         .enable = bnx2fc_enable,
2325         .disable = bnx2fc_disable,
2326 };
2327
2328 /**
2329  * bnx2fc_percpu_thread_create - Create a receive thread for an
2330  *                               online CPU
2331  *
2332  * @cpu: cpu index for the online cpu
2333  */
2334 static void bnx2fc_percpu_thread_create(unsigned int cpu)
2335 {
2336         struct bnx2fc_percpu_s *p;
2337         struct task_struct *thread;
2338
2339         p = &per_cpu(bnx2fc_percpu, cpu);
2340
2341         thread = kthread_create_on_node(bnx2fc_percpu_io_thread,
2342                                         (void *)p, cpu_to_node(cpu),
2343                                         "bnx2fc_thread/%d", cpu);
2344         /* bind thread to the cpu */
2345         if (likely(!IS_ERR(thread))) {
2346                 kthread_bind(thread, cpu);
2347                 p->iothread = thread;
2348                 wake_up_process(thread);
2349         }
2350 }
2351
2352 static void bnx2fc_percpu_thread_destroy(unsigned int cpu)
2353 {
2354         struct bnx2fc_percpu_s *p;
2355         struct task_struct *thread;
2356         struct bnx2fc_work *work, *tmp;
2357
2358         BNX2FC_MISC_DBG("destroying io thread for CPU %d\n", cpu);
2359
2360         /* Prevent any new work from being queued for this CPU */
2361         p = &per_cpu(bnx2fc_percpu, cpu);
2362         spin_lock_bh(&p->fp_work_lock);
2363         thread = p->iothread;
2364         p->iothread = NULL;
2365
2366
2367         /* Free all work in the list */
2368         list_for_each_entry_safe(work, tmp, &p->work_list, list) {
2369                 list_del_init(&work->list);
2370                 bnx2fc_process_cq_compl(work->tgt, work->wqe);
2371                 kfree(work);
2372         }
2373
2374         spin_unlock_bh(&p->fp_work_lock);
2375
2376         if (thread)
2377                 kthread_stop(thread);
2378 }
2379
2380 /**
2381  * bnx2fc_cpu_callback - Handler for CPU hotplug events
2382  *
2383  * @nfb:    The callback data block
2384  * @action: The event triggering the callback
2385  * @hcpu:   The index of the CPU that the event is for
2386  *
2387  * This creates or destroys per-CPU data for fcoe
2388  *
2389  * Returns NOTIFY_OK always.
2390  */
2391 static int bnx2fc_cpu_callback(struct notifier_block *nfb,
2392                              unsigned long action, void *hcpu)
2393 {
2394         unsigned cpu = (unsigned long)hcpu;
2395
2396         switch (action) {
2397         case CPU_ONLINE:
2398         case CPU_ONLINE_FROZEN:
2399                 printk(PFX "CPU %x online: Create Rx thread\n", cpu);
2400                 bnx2fc_percpu_thread_create(cpu);
2401                 break;
2402         case CPU_DEAD:
2403         case CPU_DEAD_FROZEN:
2404                 printk(PFX "CPU %x offline: Remove Rx thread\n", cpu);
2405                 bnx2fc_percpu_thread_destroy(cpu);
2406                 break;
2407         default:
2408                 break;
2409         }
2410         return NOTIFY_OK;
2411 }
2412
2413 /**
2414  * bnx2fc_mod_init - module init entry point
2415  *
2416  * Initialize driver wide global data structures, and register
2417  * with cnic module
2418  **/
2419 static int __init bnx2fc_mod_init(void)
2420 {
2421         struct fcoe_percpu_s *bg;
2422         struct task_struct *l2_thread;
2423         int rc = 0;
2424         unsigned int cpu = 0;
2425         struct bnx2fc_percpu_s *p;
2426
2427         printk(KERN_INFO PFX "%s", version);
2428
2429         /* register as a fcoe transport */
2430         rc = fcoe_transport_attach(&bnx2fc_transport);
2431         if (rc) {
2432                 printk(KERN_ERR "failed to register an fcoe transport, check "
2433                         "if libfcoe is loaded\n");
2434                 goto out;
2435         }
2436
2437         INIT_LIST_HEAD(&adapter_list);
2438         INIT_LIST_HEAD(&if_list);
2439         mutex_init(&bnx2fc_dev_lock);
2440         adapter_count = 0;
2441
2442         /* Attach FC transport template */
2443         rc = bnx2fc_attach_transport();
2444         if (rc)
2445                 goto detach_ft;
2446
2447         bnx2fc_wq = alloc_workqueue("bnx2fc", 0, 0);
2448         if (!bnx2fc_wq) {
2449                 rc = -ENOMEM;
2450                 goto release_bt;
2451         }
2452
2453         bg = &bnx2fc_global;
2454         skb_queue_head_init(&bg->fcoe_rx_list);
2455         l2_thread = kthread_create(bnx2fc_l2_rcv_thread,
2456                                    (void *)bg,
2457                                    "bnx2fc_l2_thread");
2458         if (IS_ERR(l2_thread)) {
2459                 rc = PTR_ERR(l2_thread);
2460                 goto free_wq;
2461         }
2462         wake_up_process(l2_thread);
2463         spin_lock_bh(&bg->fcoe_rx_list.lock);
2464         bg->thread = l2_thread;
2465         spin_unlock_bh(&bg->fcoe_rx_list.lock);
2466
2467         for_each_possible_cpu(cpu) {
2468                 p = &per_cpu(bnx2fc_percpu, cpu);
2469                 INIT_LIST_HEAD(&p->work_list);
2470                 spin_lock_init(&p->fp_work_lock);
2471         }
2472
2473         for_each_online_cpu(cpu) {
2474                 bnx2fc_percpu_thread_create(cpu);
2475         }
2476
2477         /* Initialize per CPU interrupt thread */
2478         register_hotcpu_notifier(&bnx2fc_cpu_notifier);
2479
2480         cnic_register_driver(CNIC_ULP_FCOE, &bnx2fc_cnic_cb);
2481
2482         return 0;
2483
2484 free_wq:
2485         destroy_workqueue(bnx2fc_wq);
2486 release_bt:
2487         bnx2fc_release_transport();
2488 detach_ft:
2489         fcoe_transport_detach(&bnx2fc_transport);
2490 out:
2491         return rc;
2492 }
2493
2494 static void __exit bnx2fc_mod_exit(void)
2495 {
2496         LIST_HEAD(to_be_deleted);
2497         struct bnx2fc_hba *hba, *next;
2498         struct fcoe_percpu_s *bg;
2499         struct task_struct *l2_thread;
2500         struct sk_buff *skb;
2501         unsigned int cpu = 0;
2502
2503         /*
2504          * NOTE: Since cnic calls register_driver routine rtnl_lock,
2505          * it will have higher precedence than bnx2fc_dev_lock.
2506          * unregister_device() cannot be called with bnx2fc_dev_lock
2507          * held.
2508          */
2509         mutex_lock(&bnx2fc_dev_lock);
2510         list_splice(&adapter_list, &to_be_deleted);
2511         INIT_LIST_HEAD(&adapter_list);
2512         adapter_count = 0;
2513         mutex_unlock(&bnx2fc_dev_lock);
2514
2515         /* Unregister with cnic */
2516         list_for_each_entry_safe(hba, next, &to_be_deleted, list) {
2517                 list_del_init(&hba->list);
2518                 printk(KERN_ERR PFX "MOD_EXIT:destroy hba = 0x%p\n",
2519                        hba);
2520                 bnx2fc_ulp_stop(hba);
2521                 /* unregister cnic device */
2522                 if (test_and_clear_bit(BNX2FC_CNIC_REGISTERED,
2523                                        &hba->reg_with_cnic))
2524                         hba->cnic->unregister_device(hba->cnic,
2525                                                          CNIC_ULP_FCOE);
2526                 bnx2fc_hba_destroy(hba);
2527         }
2528         cnic_unregister_driver(CNIC_ULP_FCOE);
2529
2530         /* Destroy global thread */
2531         bg = &bnx2fc_global;
2532         spin_lock_bh(&bg->fcoe_rx_list.lock);
2533         l2_thread = bg->thread;
2534         bg->thread = NULL;
2535         while ((skb = __skb_dequeue(&bg->fcoe_rx_list)) != NULL)
2536                 kfree_skb(skb);
2537
2538         spin_unlock_bh(&bg->fcoe_rx_list.lock);
2539
2540         if (l2_thread)
2541                 kthread_stop(l2_thread);
2542
2543         unregister_hotcpu_notifier(&bnx2fc_cpu_notifier);
2544
2545         /* Destroy per cpu threads */
2546         for_each_online_cpu(cpu) {
2547                 bnx2fc_percpu_thread_destroy(cpu);
2548         }
2549
2550         destroy_workqueue(bnx2fc_wq);
2551         /*
2552          * detach from scsi transport
2553          * must happen after all destroys are done
2554          */
2555         bnx2fc_release_transport();
2556
2557         /* detach from fcoe transport */
2558         fcoe_transport_detach(&bnx2fc_transport);
2559 }
2560
2561 module_init(bnx2fc_mod_init);
2562 module_exit(bnx2fc_mod_exit);
2563
2564 static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ = {
2565         .get_fcoe_ctlr_mode = fcoe_ctlr_get_fip_mode,
2566         .get_fcoe_ctlr_link_fail = bnx2fc_ctlr_get_lesb,
2567         .get_fcoe_ctlr_vlink_fail = bnx2fc_ctlr_get_lesb,
2568         .get_fcoe_ctlr_miss_fka = bnx2fc_ctlr_get_lesb,
2569         .get_fcoe_ctlr_symb_err = bnx2fc_ctlr_get_lesb,
2570         .get_fcoe_ctlr_err_block = bnx2fc_ctlr_get_lesb,
2571         .get_fcoe_ctlr_fcs_error = bnx2fc_ctlr_get_lesb,
2572
2573         .get_fcoe_fcf_selected = fcoe_fcf_get_selected,
2574         .get_fcoe_fcf_vlan_id = bnx2fc_fcf_get_vlan_id,
2575 };
2576
2577 static struct fc_function_template bnx2fc_transport_function = {
2578         .show_host_node_name = 1,
2579         .show_host_port_name = 1,
2580         .show_host_supported_classes = 1,
2581         .show_host_supported_fc4s = 1,
2582         .show_host_active_fc4s = 1,
2583         .show_host_maxframe_size = 1,
2584
2585         .show_host_port_id = 1,
2586         .show_host_supported_speeds = 1,
2587         .get_host_speed = fc_get_host_speed,
2588         .show_host_speed = 1,
2589         .show_host_port_type = 1,
2590         .get_host_port_state = fc_get_host_port_state,
2591         .show_host_port_state = 1,
2592         .show_host_symbolic_name = 1,
2593
2594         .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2595                                 sizeof(struct bnx2fc_rport)),
2596         .show_rport_maxframe_size = 1,
2597         .show_rport_supported_classes = 1,
2598
2599         .show_host_fabric_name = 1,
2600         .show_starget_node_name = 1,
2601         .show_starget_port_name = 1,
2602         .show_starget_port_id = 1,
2603         .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2604         .show_rport_dev_loss_tmo = 1,
2605         .get_fc_host_stats = bnx2fc_get_host_stats,
2606
2607         .issue_fc_host_lip = bnx2fc_fcoe_reset,
2608
2609         .terminate_rport_io = fc_rport_terminate_io,
2610
2611         .vport_create = bnx2fc_vport_create,
2612         .vport_delete = bnx2fc_vport_destroy,
2613         .vport_disable = bnx2fc_vport_disable,
2614         .bsg_request = fc_lport_bsg_request,
2615 };
2616
2617 static struct fc_function_template bnx2fc_vport_xport_function = {
2618         .show_host_node_name = 1,
2619         .show_host_port_name = 1,
2620         .show_host_supported_classes = 1,
2621         .show_host_supported_fc4s = 1,
2622         .show_host_active_fc4s = 1,
2623         .show_host_maxframe_size = 1,
2624
2625         .show_host_port_id = 1,
2626         .show_host_supported_speeds = 1,
2627         .get_host_speed = fc_get_host_speed,
2628         .show_host_speed = 1,
2629         .show_host_port_type = 1,
2630         .get_host_port_state = fc_get_host_port_state,
2631         .show_host_port_state = 1,
2632         .show_host_symbolic_name = 1,
2633
2634         .dd_fcrport_size = (sizeof(struct fc_rport_libfc_priv) +
2635                                 sizeof(struct bnx2fc_rport)),
2636         .show_rport_maxframe_size = 1,
2637         .show_rport_supported_classes = 1,
2638
2639         .show_host_fabric_name = 1,
2640         .show_starget_node_name = 1,
2641         .show_starget_port_name = 1,
2642         .show_starget_port_id = 1,
2643         .set_rport_dev_loss_tmo = fc_set_rport_loss_tmo,
2644         .show_rport_dev_loss_tmo = 1,
2645         .get_fc_host_stats = fc_get_host_stats,
2646         .issue_fc_host_lip = bnx2fc_fcoe_reset,
2647         .terminate_rport_io = fc_rport_terminate_io,
2648         .bsg_request = fc_lport_bsg_request,
2649 };
2650
2651 /**
2652  * scsi_host_template structure used while registering with SCSI-ml
2653  */
2654 static struct scsi_host_template bnx2fc_shost_template = {
2655         .module                 = THIS_MODULE,
2656         .name                   = "Broadcom Offload FCoE Initiator",
2657         .queuecommand           = bnx2fc_queuecommand,
2658         .eh_abort_handler       = bnx2fc_eh_abort,        /* abts */
2659         .eh_device_reset_handler = bnx2fc_eh_device_reset, /* lun reset */
2660         .eh_target_reset_handler = bnx2fc_eh_target_reset, /* tgt reset */
2661         .eh_host_reset_handler  = fc_eh_host_reset,
2662         .slave_alloc            = fc_slave_alloc,
2663         .change_queue_depth     = fc_change_queue_depth,
2664         .change_queue_type      = fc_change_queue_type,
2665         .this_id                = -1,
2666         .cmd_per_lun            = 3,
2667         .can_queue              = BNX2FC_CAN_QUEUE,
2668         .use_clustering         = ENABLE_CLUSTERING,
2669         .sg_tablesize           = BNX2FC_MAX_BDS_PER_CMD,
2670         .max_sectors            = 1024,
2671 };
2672
2673 static struct libfc_function_template bnx2fc_libfc_fcn_templ = {
2674         .frame_send             = bnx2fc_xmit,
2675         .elsct_send             = bnx2fc_elsct_send,
2676         .fcp_abort_io           = bnx2fc_abort_io,
2677         .fcp_cleanup            = bnx2fc_cleanup,
2678         .get_lesb               = bnx2fc_get_lesb,
2679         .rport_event_callback   = bnx2fc_rport_event_handler,
2680 };
2681
2682 /**
2683  * bnx2fc_cnic_cb - global template of bnx2fc - cnic driver interface
2684  *                      structure carrying callback function pointers
2685  */
2686 static struct cnic_ulp_ops bnx2fc_cnic_cb = {
2687         .owner                  = THIS_MODULE,
2688         .cnic_init              = bnx2fc_ulp_init,
2689         .cnic_exit              = bnx2fc_ulp_exit,
2690         .cnic_start             = bnx2fc_ulp_start,
2691         .cnic_stop              = bnx2fc_ulp_stop,
2692         .indicate_kcqes         = bnx2fc_indicate_kcqe,
2693         .indicate_netevent      = bnx2fc_indicate_netevent,
2694         .cnic_get_stats         = bnx2fc_ulp_get_stats,
2695 };