linux/drivers/scsi/bnx2fc/bnx2fc_fcoe.c
<<
>>
Prefs
   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
  18static struct list_head adapter_list;
  19static struct list_head if_list;
  20static u32 adapter_count;
  21static DEFINE_MUTEX(bnx2fc_dev_lock);
  22DEFINE_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
  29static char version[] =
  30                "QLogic FCoE Driver " DRV_MODULE_NAME \
  31                " v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
  32
  33
  34MODULE_AUTHOR("Bhanu Prakash Gollapudi <bprakash@broadcom.com>");
  35MODULE_DESCRIPTION("QLogic FCoE Driver");
  36MODULE_LICENSE("GPL");
  37MODULE_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
  43static struct scsi_transport_template   *bnx2fc_transport_template;
  44static struct scsi_transport_template   *bnx2fc_vport_xport_template;
  45
  46struct 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 */
  51struct fcoe_percpu_s bnx2fc_global;
  52DEFINE_SPINLOCK(bnx2fc_global_lock);
  53
  54static struct cnic_ulp_ops bnx2fc_cnic_cb;
  55static struct libfc_function_template bnx2fc_libfc_fcn_templ;
  56static struct scsi_host_template bnx2fc_shost_template;
  57static struct fc_function_template bnx2fc_transport_function;
  58static struct fcoe_sysfs_function_template bnx2fc_fcoe_sysfs_templ;
  59static struct fc_function_template bnx2fc_vport_xport_function;
  60static int bnx2fc_create(struct net_device *netdev, enum fip_state fip_mode);
  61static void __bnx2fc_destroy(struct bnx2fc_interface *interface);
  62static int bnx2fc_destroy(struct net_device *net_device);
  63static int bnx2fc_enable(struct net_device *netdev);
  64static int bnx2fc_disable(struct net_device *netdev);
  65
  66/* fcoe_syfs control interface handlers */
  67static int bnx2fc_ctlr_alloc(struct net_device *netdev);
  68static int bnx2fc_ctlr_enabled(struct fcoe_ctlr_device *cdev);
  69
  70static void bnx2fc_recv_frame(struct sk_buff *skb);
  71
  72static void bnx2fc_start_disc(struct bnx2fc_interface *interface);
  73static int bnx2fc_shost_config(struct fc_lport *lport, struct device *dev);
  74static int bnx2fc_lport_config(struct fc_lport *lport);
  75static int bnx2fc_em_config(struct fc_lport *lport, struct bnx2fc_hba *hba);
  76static int bnx2fc_bind_adapter_devices(struct bnx2fc_hba *hba);
  77static void bnx2fc_unbind_adapter_devices(struct bnx2fc_hba *hba);
  78static int bnx2fc_bind_pcidev(struct bnx2fc_hba *hba);
  79static void bnx2fc_unbind_pcidev(struct bnx2fc_hba *hba);
  80static struct fc_lport *bnx2fc_if_create(struct bnx2fc_interface *interface,
  81                                  struct device *parent, int npiv);
  82static void bnx2fc_destroy_work(struct work_struct *work);
  83
  84static struct bnx2fc_hba *bnx2fc_hba_lookup(struct net_device *phys_dev);
  85static struct bnx2fc_interface *bnx2fc_interface_lookup(struct net_device
  86                                                        *phys_dev);
  87static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface);
  88static struct bnx2fc_hba *bnx2fc_find_hba_for_cnic(struct cnic_dev *cnic);
  89
  90static int bnx2fc_fw_init(struct bnx2fc_hba *hba);
  91static void bnx2fc_fw_destroy(struct bnx2fc_hba *hba);
  92
  93static void bnx2fc_port_shutdown(struct fc_lport *lport);
  94static void bnx2fc_stop(struct bnx2fc_interface *interface);
  95static int __init bnx2fc_mod_init(void);
  96static void __exit bnx2fc_mod_exit(void);
  97
  98unsigned int bnx2fc_debug_level;
  99module_param_named(debug_logging, bnx2fc_debug_level, int, S_IRUGO|S_IWUSR);
 100MODULE_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
 110static int bnx2fc_cpu_callback(struct notifier_block *nfb,
 111                             unsigned long action, void *hcpu);
 112/* notification function for CPU hotplug events */
 113static struct notifier_block bnx2fc_cpu_notifier = {
 114        .notifier_call = bnx2fc_cpu_callback,
 115};
 116
 117static 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
 123static 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
 133static 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
 157int 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
 167static 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
 177static 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
 204static 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 */
 252static 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 */
 415static 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;
 474err:
 475        kfree_skb(skb);
 476        return -1;
 477}
 478
 479static 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
 502static 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 */
 608int 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
 639static 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
 686static 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
 719static 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 */
 743void 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
 751static 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
 796static 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 */
 816static 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
 945static 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
 959static 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
 977static 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 */
1013static 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 */
1036static 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 */
1048static 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 */
1062static 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
1068static 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
1116static 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
1130static 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
1160static 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
1176static 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
1219static 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}
1240static 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
1248static 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
1272static inline void bnx2fc_interface_get(struct bnx2fc_interface *interface)
1273{
1274        kref_get(&interface->kref);
1275}
1276
1277static inline void bnx2fc_interface_put(struct bnx2fc_interface *interface)
1278{
1279        kref_put(&interface->kref, bnx2fc_interface_release);
1280}
1281static 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 */
1301static 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
1367cmgr_err:
1368        kfree(hba->tgt_ofld_list);
1369tgtofld_err:
1370        bnx2fc_unbind_pcidev(hba);
1371bind_err:
1372        kfree(hba);
1373        return NULL;
1374}
1375
1376struct 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 */
1429static 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
1521shost_err:
1522        scsi_remove_host(shost);
1523lp_config_err:
1524        scsi_host_put(lport->host);
1525free_blport:
1526        kfree(blport);
1527        return NULL;
1528}
1529
1530static 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
1538static 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
1556static 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
1579static 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 */
1602static 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
1624netdev_err:
1625        mutex_unlock(&bnx2fc_dev_lock);
1626        rtnl_unlock();
1627        return rc;
1628}
1629
1630static 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
1643static 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 */
1655static 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;
1664mem_err:
1665        bnx2fc_unbind_adapter_devices(hba);
1666        return -ENOMEM;
1667}
1668
1669static 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
1720static 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 */
1734static 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 */
1770static 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
1798static 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
1805static 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
1827static 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
1866err_unbind:
1867        bnx2fc_unbind_adapter_devices(hba);
1868err_out:
1869        return rc;
1870}
1871
1872static 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 */
1904static 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);
1929exit:
1930        mutex_unlock(&bnx2fc_dev_lock);
1931}
1932
1933static 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 */
1981static 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 */
2019static 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 */
2039static 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
2062static 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        }
2095done:
2096        return created;
2097}
2098
2099static 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);
2143done_free:
2144        kfree(npiv_tbl);
2145done:
2146        return 0;
2147}
2148
2149/**
2150 * Deprecated: Use bnx2fc_enabled()
2151 */
2152static 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 */
2185static 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
2200enum 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 */
2220static 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
2349if_create_err:
2350        destroy_workqueue(interface->timer_work_queue);
2351ifput_err:
2352        bnx2fc_net_cleanup(interface);
2353        bnx2fc_interface_put(interface);
2354        goto mod_err;
2355netdev_err:
2356        module_put(THIS_MODULE);
2357mod_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 */
2372static 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 */
2388static 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 **/
2400static 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
2412static 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
2425static 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 */
2444static 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 */
2492static 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
2500static 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
2518static 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 */
2536static 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
2554static 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 */
2593static 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 **/
2621static 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
2690free_wq:
2691        destroy_workqueue(bnx2fc_wq);
2692release_bt:
2693        bnx2fc_release_transport();
2694detach_ft:
2695        fcoe_transport_detach(&bnx2fc_transport);
2696out:
2697        return rc;
2698}
2699
2700static 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
2771module_init(bnx2fc_mod_init);
2772module_exit(bnx2fc_mod_exit);
2773
2774static 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
2787static 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
2827static 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 */
2864static 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
2882static 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 */
2895static 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};
2905