drivers/scsi/bnx2fc/bnx2fc_fcoe.c

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