drivers/scsi/bfa/bfad.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2005-2014 Brocade Communications Systems, Inc.
   4  * Copyright (c) 2014- QLogic Corporation.
   5  * All rights reserved
   6  * www.qlogic.com
   7  *
   8  * Linux driver for QLogic BR-series Fibre Channel Host Bus Adapter.
   9  */
  10
  11 /*
  12  *  bfad.c Linux driver PCI interface module.
  13  */
  14 #include <linux/module.h>
  15 #include <linux/kthread.h>
  16 #include <linux/errno.h>
  17 #include <linux/sched.h>
  18 #include <linux/init.h>
  19 #include <linux/fs.h>
  20 #include <linux/pci.h>
  21 #include <linux/firmware.h>
  22 #include <linux/uaccess.h>
  23 #include <asm/fcntl.h>
  24
  25 #include "bfad_drv.h"
  26 #include "bfad_im.h"
  27 #include "bfa_fcs.h"
  28 #include "bfa_defs.h"
  29 #include "bfa.h"
  30
  31 BFA_TRC_FILE(LDRV, BFAD);
  32 DEFINE_MUTEX(bfad_mutex);
  33 LIST_HEAD(bfad_list);
  34
  35 static int      bfad_inst;
  36 static int      num_sgpgs_parm;
  37 int             supported_fc4s;
  38 char            *host_name, *os_name, *os_patch;
  39 int             num_rports, num_ios, num_tms;
  40 int             num_fcxps, num_ufbufs;
  41 int             reqq_size, rspq_size, num_sgpgs;
  42 int             rport_del_timeout = BFA_FCS_RPORT_DEF_DEL_TIMEOUT;
  43 int             bfa_lun_queue_depth = BFAD_LUN_QUEUE_DEPTH;
  44 int             bfa_io_max_sge = BFAD_IO_MAX_SGE;
  45 int             bfa_log_level = 3; /* WARNING log level */
  46 int             ioc_auto_recover = BFA_TRUE;
  47 int             bfa_linkup_delay = -1;
  48 int             fdmi_enable = BFA_TRUE;
  49 int             pcie_max_read_reqsz;
  50 int             bfa_debugfs_enable = 1;
  51 int             msix_disable_cb = 0, msix_disable_ct = 0;
  52 int             max_xfer_size = BFAD_MAX_SECTORS >> 1;
  53 static int      max_rport_logins = BFA_FCS_MAX_RPORT_LOGINS;
  54
  55 /* Firmware releated */
  56 u32     bfi_image_cb_size, bfi_image_ct_size, bfi_image_ct2_size;
  57 u32     *bfi_image_cb, *bfi_image_ct, *bfi_image_ct2;
  58
  59 #define BFAD_FW_FILE_CB         "/*(DEBLOBBED)*/"
  60 #define BFAD_FW_FILE_CT         "/*(DEBLOBBED)*/"
  61 #define BFAD_FW_FILE_CT2        "/*(DEBLOBBED)*/"
  62
  63 static u32 *bfad_load_fwimg(struct pci_dev *pdev);
  64 static void bfad_free_fwimg(void);
  65 static void bfad_read_firmware(struct pci_dev *pdev, u32 **bfi_image,
  66                 u32 *bfi_image_size, char *fw_name);
  67
  68 static const char *msix_name_ct[] = {
  69         "ctrl",
  70         "cpe0", "cpe1", "cpe2", "cpe3",
  71         "rme0", "rme1", "rme2", "rme3" };
  72
  73 static const char *msix_name_cb[] = {
  74         "cpe0", "cpe1", "cpe2", "cpe3",
  75         "rme0", "rme1", "rme2", "rme3",
  76         "eemc", "elpu0", "elpu1", "epss", "mlpu" };
  77
  78 /*(DEBLOBBED)*/
  79
  80 module_param(os_name, charp, S_IRUGO | S_IWUSR);
  81 MODULE_PARM_DESC(os_name, "OS name of the hba host machine");
  82 module_param(os_patch, charp, S_IRUGO | S_IWUSR);
  83 MODULE_PARM_DESC(os_patch, "OS patch level of the hba host machine");
  84 module_param(host_name, charp, S_IRUGO | S_IWUSR);
  85 MODULE_PARM_DESC(host_name, "Hostname of the hba host machine");
  86 module_param(num_rports, int, S_IRUGO | S_IWUSR);
  87 MODULE_PARM_DESC(num_rports, "Max number of rports supported per port "
  88                                 "(physical/logical), default=1024");
  89 module_param(num_ios, int, S_IRUGO | S_IWUSR);
  90 MODULE_PARM_DESC(num_ios, "Max number of ioim requests, default=2000");
  91 module_param(num_tms, int, S_IRUGO | S_IWUSR);
  92 MODULE_PARM_DESC(num_tms, "Max number of task im requests, default=128");
  93 module_param(num_fcxps, int, S_IRUGO | S_IWUSR);
  94 MODULE_PARM_DESC(num_fcxps, "Max number of fcxp requests, default=64");
  95 module_param(num_ufbufs, int, S_IRUGO | S_IWUSR);
  96 MODULE_PARM_DESC(num_ufbufs, "Max number of unsolicited frame "
  97                                 "buffers, default=64");
  98 module_param(reqq_size, int, S_IRUGO | S_IWUSR);
  99 MODULE_PARM_DESC(reqq_size, "Max number of request queue elements, "
 100                                 "default=256");
 101 module_param(rspq_size, int, S_IRUGO | S_IWUSR);
 102 MODULE_PARM_DESC(rspq_size, "Max number of response queue elements, "
 103                                 "default=64");
 104 module_param(num_sgpgs, int, S_IRUGO | S_IWUSR);
 105 MODULE_PARM_DESC(num_sgpgs, "Number of scatter/gather pages, default=2048");
 106 module_param(rport_del_timeout, int, S_IRUGO | S_IWUSR);
 107 MODULE_PARM_DESC(rport_del_timeout, "Rport delete timeout, default=90 secs, "
 108                                         "Range[>0]");
 109 module_param(bfa_lun_queue_depth, int, S_IRUGO | S_IWUSR);
 110 MODULE_PARM_DESC(bfa_lun_queue_depth, "Lun queue depth, default=32, Range[>0]");
 111 module_param(bfa_io_max_sge, int, S_IRUGO | S_IWUSR);
 112 MODULE_PARM_DESC(bfa_io_max_sge, "Max io scatter/gather elements, default=255");
 113 module_param(bfa_log_level, int, S_IRUGO | S_IWUSR);
 114 MODULE_PARM_DESC(bfa_log_level, "Driver log level, default=3, "
 115                                 "Range[Critical:1|Error:2|Warning:3|Info:4]");
 116 module_param(ioc_auto_recover, int, S_IRUGO | S_IWUSR);
 117 MODULE_PARM_DESC(ioc_auto_recover, "IOC auto recovery, default=1, "
 118                                 "Range[off:0|on:1]");
 119 module_param(bfa_linkup_delay, int, S_IRUGO | S_IWUSR);
 120 MODULE_PARM_DESC(bfa_linkup_delay, "Link up delay, default=30 secs for "
 121                         "boot port. Otherwise 10 secs in RHEL4 & 0 for "
 122                         "[RHEL5, SLES10, ESX40] Range[>0]");
 123 module_param(msix_disable_cb, int, S_IRUGO | S_IWUSR);
 124 MODULE_PARM_DESC(msix_disable_cb, "Disable Message Signaled Interrupts for QLogic-415/425/815/825 cards, default=0 Range[false:0|true:1]");
 125 module_param(msix_disable_ct, int, S_IRUGO | S_IWUSR);
 126 MODULE_PARM_DESC(msix_disable_ct, "Disable Message Signaled Interrupts if possible for QLogic-1010/1020/804/1007/902/1741 cards, default=0, Range[false:0|true:1]");
 127 module_param(fdmi_enable, int, S_IRUGO | S_IWUSR);
 128 MODULE_PARM_DESC(fdmi_enable, "Enables fdmi registration, default=1, "
 129                                 "Range[false:0|true:1]");
 130 module_param(pcie_max_read_reqsz, int, S_IRUGO | S_IWUSR);
 131 MODULE_PARM_DESC(pcie_max_read_reqsz, "PCIe max read request size, default=0 "
 132                 "(use system setting), Range[128|256|512|1024|2048|4096]");
 133 module_param(bfa_debugfs_enable, int, S_IRUGO | S_IWUSR);
 134 MODULE_PARM_DESC(bfa_debugfs_enable, "Enables debugfs feature, default=1,"
 135                 " Range[false:0|true:1]");
 136 module_param(max_xfer_size, int, S_IRUGO | S_IWUSR);
 137 MODULE_PARM_DESC(max_xfer_size, "default=32MB,"
 138                 " Range[64k|128k|256k|512k|1024k|2048k]");
 139 module_param(max_rport_logins, int, S_IRUGO | S_IWUSR);
 140 MODULE_PARM_DESC(max_rport_logins, "Max number of logins to initiator and target rports on a port (physical/logical), default=1024");
 141
 142 static void
 143 bfad_sm_uninit(struct bfad_s *bfad, enum bfad_sm_event event);
 144 static void
 145 bfad_sm_created(struct bfad_s *bfad, enum bfad_sm_event event);
 146 static void
 147 bfad_sm_initializing(struct bfad_s *bfad, enum bfad_sm_event event);
 148 static void
 149 bfad_sm_operational(struct bfad_s *bfad, enum bfad_sm_event event);
 150 static void
 151 bfad_sm_stopping(struct bfad_s *bfad, enum bfad_sm_event event);
 152 static void
 153 bfad_sm_failed(struct bfad_s *bfad, enum bfad_sm_event event);
 154 static void
 155 bfad_sm_fcs_exit(struct bfad_s *bfad, enum bfad_sm_event event);
 156
 157 /*
 158  * Beginning state for the driver instance, awaiting the pci_probe event
 159  */
 160 static void
 161 bfad_sm_uninit(struct bfad_s *bfad, enum bfad_sm_event event)
 162 {
 163         bfa_trc(bfad, event);
 164
 165         switch (event) {
 166         case BFAD_E_CREATE:
 167                 bfa_sm_set_state(bfad, bfad_sm_created);
 168                 bfad->bfad_tsk = kthread_create(bfad_worker, (void *) bfad,
 169                                                 "%s", "bfad_worker");
 170                 if (IS_ERR(bfad->bfad_tsk)) {
 171                         printk(KERN_INFO "bfad[%d]: Kernel thread "
 172                                 "creation failed!\n", bfad->inst_no);
 173                         bfa_sm_send_event(bfad, BFAD_E_KTHREAD_CREATE_FAILED);
 174                 }
 175                 bfa_sm_send_event(bfad, BFAD_E_INIT);
 176                 break;
 177
 178         case BFAD_E_STOP:
 179                 /* Ignore stop; already in uninit */
 180                 break;
 181
 182         default:
 183                 bfa_sm_fault(bfad, event);
 184         }
 185 }
 186
 187 /*
 188  * Driver Instance is created, awaiting event INIT to initialize the bfad
 189  */
 190 static void
 191 bfad_sm_created(struct bfad_s *bfad, enum bfad_sm_event event)
 192 {
 193         unsigned long flags;
 194         bfa_status_t ret;
 195
 196         bfa_trc(bfad, event);
 197
 198         switch (event) {
 199         case BFAD_E_INIT:
 200                 bfa_sm_set_state(bfad, bfad_sm_initializing);
 201
 202                 init_completion(&bfad->comp);
 203
 204                 /* Enable Interrupt and wait bfa_init completion */
 205                 if (bfad_setup_intr(bfad)) {
 206                         printk(KERN_WARNING "bfad%d: bfad_setup_intr failed\n",
 207                                         bfad->inst_no);
 208                         bfa_sm_send_event(bfad, BFAD_E_INIT_FAILED);
 209                         break;
 210                 }
 211
 212                 spin_lock_irqsave(&bfad->bfad_lock, flags);
 213                 bfa_iocfc_init(&bfad->bfa);
 214                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 215
 216                 /* Set up interrupt handler for each vectors */
 217                 if ((bfad->bfad_flags & BFAD_MSIX_ON) &&
 218                         bfad_install_msix_handler(bfad)) {
 219                         printk(KERN_WARNING "%s: install_msix failed, bfad%d\n",
 220                                 __func__, bfad->inst_no);
 221                 }
 222
 223                 bfad_init_timer(bfad);
 224
 225                 wait_for_completion(&bfad->comp);
 226
 227                 if ((bfad->bfad_flags & BFAD_HAL_INIT_DONE)) {
 228                         bfa_sm_send_event(bfad, BFAD_E_INIT_SUCCESS);
 229                 } else {
 230                         printk(KERN_WARNING
 231                                 "bfa %s: bfa init failed\n",
 232                                 bfad->pci_name);
 233                         spin_lock_irqsave(&bfad->bfad_lock, flags);
 234                         bfa_fcs_init(&bfad->bfa_fcs);
 235                         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 236
 237                         ret = bfad_cfg_pport(bfad, BFA_LPORT_ROLE_FCP_IM);
 238                         if (ret != BFA_STATUS_OK) {
 239                                 init_completion(&bfad->comp);
 240
 241                                 spin_lock_irqsave(&bfad->bfad_lock, flags);
 242                                 bfad->pport.flags |= BFAD_PORT_DELETE;
 243                                 bfa_fcs_exit(&bfad->bfa_fcs);
 244                                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 245
 246                                 wait_for_completion(&bfad->comp);
 247
 248                                 bfa_sm_send_event(bfad, BFAD_E_INIT_FAILED);
 249                                 break;
 250                         }
 251                         bfad->bfad_flags |= BFAD_HAL_INIT_FAIL;
 252                         bfa_sm_send_event(bfad, BFAD_E_HAL_INIT_FAILED);
 253                 }
 254
 255                 break;
 256
 257         case BFAD_E_KTHREAD_CREATE_FAILED:
 258                 bfa_sm_set_state(bfad, bfad_sm_uninit);
 259                 break;
 260
 261         default:
 262                 bfa_sm_fault(bfad, event);
 263         }
 264 }
 265
 266 static void
 267 bfad_sm_initializing(struct bfad_s *bfad, enum bfad_sm_event event)
 268 {
 269         int     retval;
 270         unsigned long   flags;
 271
 272         bfa_trc(bfad, event);
 273
 274         switch (event) {
 275         case BFAD_E_INIT_SUCCESS:
 276                 kthread_stop(bfad->bfad_tsk);
 277                 spin_lock_irqsave(&bfad->bfad_lock, flags);
 278                 bfad->bfad_tsk = NULL;
 279                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 280
 281                 retval = bfad_start_ops(bfad);
 282                 if (retval != BFA_STATUS_OK) {
 283                         bfa_sm_set_state(bfad, bfad_sm_failed);
 284                         break;
 285                 }
 286                 bfa_sm_set_state(bfad, bfad_sm_operational);
 287                 break;
 288
 289         case BFAD_E_INIT_FAILED:
 290                 bfa_sm_set_state(bfad, bfad_sm_uninit);
 291                 kthread_stop(bfad->bfad_tsk);
 292                 spin_lock_irqsave(&bfad->bfad_lock, flags);
 293                 bfad->bfad_tsk = NULL;
 294                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 295                 break;
 296
 297         case BFAD_E_HAL_INIT_FAILED:
 298                 bfa_sm_set_state(bfad, bfad_sm_failed);
 299                 break;
 300         default:
 301                 bfa_sm_fault(bfad, event);
 302         }
 303 }
 304
 305 static void
 306 bfad_sm_failed(struct bfad_s *bfad, enum bfad_sm_event event)
 307 {
 308         int     retval;
 309
 310         bfa_trc(bfad, event);
 311
 312         switch (event) {
 313         case BFAD_E_INIT_SUCCESS:
 314                 retval = bfad_start_ops(bfad);
 315                 if (retval != BFA_STATUS_OK)
 316                         break;
 317                 bfa_sm_set_state(bfad, bfad_sm_operational);
 318                 break;
 319
 320         case BFAD_E_STOP:
 321                 bfa_sm_set_state(bfad, bfad_sm_fcs_exit);
 322                 bfa_sm_send_event(bfad, BFAD_E_FCS_EXIT_COMP);
 323                 break;
 324
 325         case BFAD_E_EXIT_COMP:
 326                 bfa_sm_set_state(bfad, bfad_sm_uninit);
 327                 bfad_remove_intr(bfad);
 328                 del_timer_sync(&bfad->hal_tmo);
 329                 break;
 330
 331         default:
 332                 bfa_sm_fault(bfad, event);
 333         }
 334 }
 335
 336 static void
 337 bfad_sm_operational(struct bfad_s *bfad, enum bfad_sm_event event)
 338 {
 339         bfa_trc(bfad, event);
 340
 341         switch (event) {
 342         case BFAD_E_STOP:
 343                 bfa_sm_set_state(bfad, bfad_sm_fcs_exit);
 344                 bfad_fcs_stop(bfad);
 345                 break;
 346
 347         default:
 348                 bfa_sm_fault(bfad, event);
 349         }
 350 }
 351
 352 static void
 353 bfad_sm_fcs_exit(struct bfad_s *bfad, enum bfad_sm_event event)
 354 {
 355         bfa_trc(bfad, event);
 356
 357         switch (event) {
 358         case BFAD_E_FCS_EXIT_COMP:
 359                 bfa_sm_set_state(bfad, bfad_sm_stopping);
 360                 bfad_stop(bfad);
 361                 break;
 362
 363         default:
 364                 bfa_sm_fault(bfad, event);
 365         }
 366 }
 367
 368 static void
 369 bfad_sm_stopping(struct bfad_s *bfad, enum bfad_sm_event event)
 370 {
 371         bfa_trc(bfad, event);
 372
 373         switch (event) {
 374         case BFAD_E_EXIT_COMP:
 375                 bfa_sm_set_state(bfad, bfad_sm_uninit);
 376                 bfad_remove_intr(bfad);
 377                 del_timer_sync(&bfad->hal_tmo);
 378                 bfad_im_probe_undo(bfad);
 379                 bfad->bfad_flags &= ~BFAD_FC4_PROBE_DONE;
 380                 bfad_uncfg_pport(bfad);
 381                 break;
 382
 383         default:
 384                 bfa_sm_fault(bfad, event);
 385                 break;
 386         }
 387 }
 388
 389 /*
 390  *  BFA callbacks
 391  */
 392 void
 393 bfad_hcb_comp(void *arg, bfa_status_t status)
 394 {
 395         struct bfad_hal_comp *fcomp = (struct bfad_hal_comp *)arg;
 396
 397         fcomp->status = status;
 398         complete(&fcomp->comp);
 399 }
 400
 401 /*
 402  * bfa_init callback
 403  */
 404 void
 405 bfa_cb_init(void *drv, bfa_status_t init_status)
 406 {
 407         struct bfad_s         *bfad = drv;
 408
 409         if (init_status == BFA_STATUS_OK) {
 410                 bfad->bfad_flags |= BFAD_HAL_INIT_DONE;
 411
 412                 /*
 413                  * If BFAD_HAL_INIT_FAIL flag is set:
 414                  * Wake up the kernel thread to start
 415                  * the bfad operations after HAL init done
 416                  */
 417                 if ((bfad->bfad_flags & BFAD_HAL_INIT_FAIL)) {
 418                         bfad->bfad_flags &= ~BFAD_HAL_INIT_FAIL;
 419                         wake_up_process(bfad->bfad_tsk);
 420                 }
 421         }
 422
 423         complete(&bfad->comp);
 424 }
 425
 426 /*
 427  *  BFA_FCS callbacks
 428  */
 429 struct bfad_port_s *
 430 bfa_fcb_lport_new(struct bfad_s *bfad, struct bfa_fcs_lport_s *port,
 431                  enum bfa_lport_role roles, struct bfad_vf_s *vf_drv,
 432                  struct bfad_vport_s *vp_drv)
 433 {
 434         bfa_status_t    rc;
 435         struct bfad_port_s    *port_drv;
 436
 437         if (!vp_drv && !vf_drv) {
 438                 port_drv = &bfad->pport;
 439                 port_drv->pvb_type = BFAD_PORT_PHYS_BASE;
 440         } else if (!vp_drv && vf_drv) {
 441                 port_drv = &vf_drv->base_port;
 442                 port_drv->pvb_type = BFAD_PORT_VF_BASE;
 443         } else if (vp_drv && !vf_drv) {
 444                 port_drv = &vp_drv->drv_port;
 445                 port_drv->pvb_type = BFAD_PORT_PHYS_VPORT;
 446         } else {
 447                 port_drv = &vp_drv->drv_port;
 448                 port_drv->pvb_type = BFAD_PORT_VF_VPORT;
 449         }
 450
 451         port_drv->fcs_port = port;
 452         port_drv->roles = roles;
 453
 454         if (roles & BFA_LPORT_ROLE_FCP_IM) {
 455                 rc = bfad_im_port_new(bfad, port_drv);
 456                 if (rc != BFA_STATUS_OK) {
 457                         bfad_im_port_delete(bfad, port_drv);
 458                         port_drv = NULL;
 459                 }
 460         }
 461
 462         return port_drv;
 463 }
 464
 465 /*
 466  * FCS RPORT alloc callback, after successful PLOGI by FCS
 467  */
 468 bfa_status_t
 469 bfa_fcb_rport_alloc(struct bfad_s *bfad, struct bfa_fcs_rport_s **rport,
 470                     struct bfad_rport_s **rport_drv)
 471 {
 472         bfa_status_t    rc = BFA_STATUS_OK;
 473
 474         *rport_drv = kzalloc(sizeof(struct bfad_rport_s), GFP_ATOMIC);
 475         if (*rport_drv == NULL) {
 476                 rc = BFA_STATUS_ENOMEM;
 477                 goto ext;
 478         }
 479
 480         *rport = &(*rport_drv)->fcs_rport;
 481
 482 ext:
 483         return rc;
 484 }
 485
 486 /*
 487  * FCS PBC VPORT Create
 488  */
 489 void
 490 bfa_fcb_pbc_vport_create(struct bfad_s *bfad, struct bfi_pbc_vport_s pbc_vport)
 491 {
 492
 493         struct bfa_lport_cfg_s port_cfg = {0};
 494         struct bfad_vport_s   *vport;
 495         int rc;
 496
 497         vport = kzalloc(sizeof(struct bfad_vport_s), GFP_ATOMIC);
 498         if (!vport) {
 499                 bfa_trc(bfad, 0);
 500                 return;
 501         }
 502
 503         vport->drv_port.bfad = bfad;
 504         port_cfg.roles = BFA_LPORT_ROLE_FCP_IM;
 505         port_cfg.pwwn = pbc_vport.vp_pwwn;
 506         port_cfg.nwwn = pbc_vport.vp_nwwn;
 507         port_cfg.preboot_vp  = BFA_TRUE;
 508
 509         rc = bfa_fcs_pbc_vport_create(&vport->fcs_vport, &bfad->bfa_fcs, 0,
 510                                   &port_cfg, vport);
 511
 512         if (rc != BFA_STATUS_OK) {
 513                 bfa_trc(bfad, 0);
 514                 return;
 515         }
 516
 517         list_add_tail(&vport->list_entry, &bfad->pbc_vport_list);
 518 }
 519
 520 void
 521 bfad_hal_mem_release(struct bfad_s *bfad)
 522 {
 523         struct bfa_meminfo_s *hal_meminfo = &bfad->meminfo;
 524         struct bfa_mem_dma_s *dma_info, *dma_elem;
 525         struct bfa_mem_kva_s *kva_info, *kva_elem;
 526         struct list_head *dm_qe, *km_qe;
 527
 528         dma_info = &hal_meminfo->dma_info;
 529         kva_info = &hal_meminfo->kva_info;
 530
 531         /* Iterate through the KVA meminfo queue */
 532         list_for_each(km_qe, &kva_info->qe) {
 533                 kva_elem = (struct bfa_mem_kva_s *) km_qe;
 534                 vfree(kva_elem->kva);
 535         }
 536
 537         /* Iterate through the DMA meminfo queue */
 538         list_for_each(dm_qe, &dma_info->qe) {
 539                 dma_elem = (struct bfa_mem_dma_s *) dm_qe;
 540                 dma_free_coherent(&bfad->pcidev->dev,
 541                                 dma_elem->mem_len, dma_elem->kva,
 542                                 (dma_addr_t) dma_elem->dma);
 543         }
 544
 545         memset(hal_meminfo, 0, sizeof(struct bfa_meminfo_s));
 546 }
 547
 548 void
 549 bfad_update_hal_cfg(struct bfa_iocfc_cfg_s *bfa_cfg)
 550 {
 551         if (num_rports > 0)
 552                 bfa_cfg->fwcfg.num_rports = num_rports;
 553         if (num_ios > 0)
 554                 bfa_cfg->fwcfg.num_ioim_reqs = num_ios;
 555         if (num_tms > 0)
 556                 bfa_cfg->fwcfg.num_tskim_reqs = num_tms;
 557         if (num_fcxps > 0 && num_fcxps <= BFA_FCXP_MAX)
 558                 bfa_cfg->fwcfg.num_fcxp_reqs = num_fcxps;
 559         if (num_ufbufs > 0 && num_ufbufs <= BFA_UF_MAX)
 560                 bfa_cfg->fwcfg.num_uf_bufs = num_ufbufs;
 561         if (reqq_size > 0)
 562                 bfa_cfg->drvcfg.num_reqq_elems = reqq_size;
 563         if (rspq_size > 0)
 564                 bfa_cfg->drvcfg.num_rspq_elems = rspq_size;
 565         if (num_sgpgs > 0 && num_sgpgs <= BFA_SGPG_MAX)
 566                 bfa_cfg->drvcfg.num_sgpgs = num_sgpgs;
 567
 568         /*
 569          * populate the hal values back to the driver for sysfs use.
 570          * otherwise, the default values will be shown as 0 in sysfs
 571          */
 572         num_rports = bfa_cfg->fwcfg.num_rports;
 573         num_ios = bfa_cfg->fwcfg.num_ioim_reqs;
 574         num_tms = bfa_cfg->fwcfg.num_tskim_reqs;
 575         num_fcxps = bfa_cfg->fwcfg.num_fcxp_reqs;
 576         num_ufbufs = bfa_cfg->fwcfg.num_uf_bufs;
 577         reqq_size = bfa_cfg->drvcfg.num_reqq_elems;
 578         rspq_size = bfa_cfg->drvcfg.num_rspq_elems;
 579         num_sgpgs = bfa_cfg->drvcfg.num_sgpgs;
 580 }
 581
 582 bfa_status_t
 583 bfad_hal_mem_alloc(struct bfad_s *bfad)
 584 {
 585         struct bfa_meminfo_s *hal_meminfo = &bfad->meminfo;
 586         struct bfa_mem_dma_s *dma_info, *dma_elem;
 587         struct bfa_mem_kva_s *kva_info, *kva_elem;
 588         struct list_head *dm_qe, *km_qe;
 589         bfa_status_t    rc = BFA_STATUS_OK;
 590         dma_addr_t      phys_addr;
 591
 592         bfa_cfg_get_default(&bfad->ioc_cfg);
 593         bfad_update_hal_cfg(&bfad->ioc_cfg);
 594         bfad->cfg_data.ioc_queue_depth = bfad->ioc_cfg.fwcfg.num_ioim_reqs;
 595         bfa_cfg_get_meminfo(&bfad->ioc_cfg, hal_meminfo, &bfad->bfa);
 596
 597         dma_info = &hal_meminfo->dma_info;
 598         kva_info = &hal_meminfo->kva_info;
 599
 600         /* Iterate through the KVA meminfo queue */
 601         list_for_each(km_qe, &kva_info->qe) {
 602                 kva_elem = (struct bfa_mem_kva_s *) km_qe;
 603                 kva_elem->kva = vzalloc(kva_elem->mem_len);
 604                 if (kva_elem->kva == NULL) {
 605                         bfad_hal_mem_release(bfad);
 606                         rc = BFA_STATUS_ENOMEM;
 607                         goto ext;
 608                 }
 609         }
 610
 611         /* Iterate through the DMA meminfo queue */
 612         list_for_each(dm_qe, &dma_info->qe) {
 613                 dma_elem = (struct bfa_mem_dma_s *) dm_qe;
 614                 dma_elem->kva = dma_alloc_coherent(&bfad->pcidev->dev,
 615                                                 dma_elem->mem_len,
 616                                                 &phys_addr, GFP_KERNEL);
 617                 if (dma_elem->kva == NULL) {
 618                         bfad_hal_mem_release(bfad);
 619                         rc = BFA_STATUS_ENOMEM;
 620                         goto ext;
 621                 }
 622                 dma_elem->dma = phys_addr;
 623                 memset(dma_elem->kva, 0, dma_elem->mem_len);
 624         }
 625 ext:
 626         return rc;
 627 }
 628
 629 /*
 630  * Create a vport under a vf.
 631  */
 632 bfa_status_t
 633 bfad_vport_create(struct bfad_s *bfad, u16 vf_id,
 634                   struct bfa_lport_cfg_s *port_cfg, struct device *dev)
 635 {
 636         struct bfad_vport_s   *vport;
 637         int             rc = BFA_STATUS_OK;
 638         unsigned long   flags;
 639         struct completion fcomp;
 640
 641         vport = kzalloc(sizeof(struct bfad_vport_s), GFP_KERNEL);
 642         if (!vport) {
 643                 rc = BFA_STATUS_ENOMEM;
 644                 goto ext;
 645         }
 646
 647         vport->drv_port.bfad = bfad;
 648         spin_lock_irqsave(&bfad->bfad_lock, flags);
 649         rc = bfa_fcs_vport_create(&vport->fcs_vport, &bfad->bfa_fcs, vf_id,
 650                                   port_cfg, vport);
 651         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 652
 653         if (rc != BFA_STATUS_OK)
 654                 goto ext_free_vport;
 655
 656         if (port_cfg->roles & BFA_LPORT_ROLE_FCP_IM) {
 657                 rc = bfad_im_scsi_host_alloc(bfad, vport->drv_port.im_port,
 658                                                         dev);
 659                 if (rc != BFA_STATUS_OK)
 660                         goto ext_free_fcs_vport;
 661         }
 662
 663         spin_lock_irqsave(&bfad->bfad_lock, flags);
 664         bfa_fcs_vport_start(&vport->fcs_vport);
 665         list_add_tail(&vport->list_entry, &bfad->vport_list);
 666         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 667
 668         return BFA_STATUS_OK;
 669
 670 ext_free_fcs_vport:
 671         spin_lock_irqsave(&bfad->bfad_lock, flags);
 672         vport->comp_del = &fcomp;
 673         init_completion(vport->comp_del);
 674         bfa_fcs_vport_delete(&vport->fcs_vport);
 675         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 676         wait_for_completion(vport->comp_del);
 677 ext_free_vport:
 678         kfree(vport);
 679 ext:
 680         return rc;
 681 }
 682
 683 void
 684 bfad_bfa_tmo(struct timer_list *t)
 685 {
 686         struct bfad_s         *bfad = from_timer(bfad, t, hal_tmo);
 687         unsigned long   flags;
 688         struct list_head               doneq;
 689
 690         spin_lock_irqsave(&bfad->bfad_lock, flags);
 691
 692         bfa_timer_beat(&bfad->bfa.timer_mod);
 693
 694         bfa_comp_deq(&bfad->bfa, &doneq);
 695         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 696
 697         if (!list_empty(&doneq)) {
 698                 bfa_comp_process(&bfad->bfa, &doneq);
 699                 spin_lock_irqsave(&bfad->bfad_lock, flags);
 700                 bfa_comp_free(&bfad->bfa, &doneq);
 701                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 702         }
 703
 704         mod_timer(&bfad->hal_tmo,
 705                   jiffies + msecs_to_jiffies(BFA_TIMER_FREQ));
 706 }
 707
 708 void
 709 bfad_init_timer(struct bfad_s *bfad)
 710 {
 711         timer_setup(&bfad->hal_tmo, bfad_bfa_tmo, 0);
 712
 713         mod_timer(&bfad->hal_tmo,
 714                   jiffies + msecs_to_jiffies(BFA_TIMER_FREQ));
 715 }
 716
 717 int
 718 bfad_pci_init(struct pci_dev *pdev, struct bfad_s *bfad)
 719 {
 720         int rc = -ENODEV;
 721
 722         if (pci_enable_device(pdev)) {
 723                 printk(KERN_ERR "pci_enable_device fail %p\n", pdev);
 724                 goto out;
 725         }
 726
 727         if (pci_request_regions(pdev, BFAD_DRIVER_NAME))
 728                 goto out_disable_device;
 729
 730         pci_set_master(pdev);
 731
 732         rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
 733         if (rc) {
 734                 rc = -ENODEV;
 735                 printk(KERN_ERR "dma_set_mask_and_coherent fail %p\n", pdev);
 736                 goto out_release_region;
 737         }
 738
 739         /* Enable PCIE Advanced Error Recovery (AER) if kernel supports */
 740         pci_enable_pcie_error_reporting(pdev);
 741
 742         bfad->pci_bar0_kva = pci_iomap(pdev, 0, pci_resource_len(pdev, 0));
 743         bfad->pci_bar2_kva = pci_iomap(pdev, 2, pci_resource_len(pdev, 2));
 744
 745         if (bfad->pci_bar0_kva == NULL) {
 746                 printk(KERN_ERR "Fail to map bar0\n");
 747                 rc = -ENODEV;
 748                 goto out_release_region;
 749         }
 750
 751         bfad->hal_pcidev.pci_slot = PCI_SLOT(pdev->devfn);
 752         bfad->hal_pcidev.pci_func = PCI_FUNC(pdev->devfn);
 753         bfad->hal_pcidev.pci_bar_kva = bfad->pci_bar0_kva;
 754         bfad->hal_pcidev.device_id = pdev->device;
 755         bfad->hal_pcidev.ssid = pdev->subsystem_device;
 756         bfad->pci_name = pci_name(pdev);
 757
 758         bfad->pci_attr.vendor_id = pdev->vendor;
 759         bfad->pci_attr.device_id = pdev->device;
 760         bfad->pci_attr.ssid = pdev->subsystem_device;
 761         bfad->pci_attr.ssvid = pdev->subsystem_vendor;
 762         bfad->pci_attr.pcifn = PCI_FUNC(pdev->devfn);
 763
 764         bfad->pcidev = pdev;
 765
 766         /* Adjust PCIe Maximum Read Request Size */
 767         if (pci_is_pcie(pdev) && pcie_max_read_reqsz) {
 768                 if (pcie_max_read_reqsz >= 128 &&
 769                     pcie_max_read_reqsz <= 4096 &&
 770                     is_power_of_2(pcie_max_read_reqsz)) {
 771                         int max_rq = pcie_get_readrq(pdev);
 772                         printk(KERN_WARNING "BFA[%s]: "
 773                                 "pcie_max_read_request_size is %d, "
 774                                 "reset to %d\n", bfad->pci_name, max_rq,
 775                                 pcie_max_read_reqsz);
 776                         pcie_set_readrq(pdev, pcie_max_read_reqsz);
 777                 } else {
 778                         printk(KERN_WARNING "BFA[%s]: invalid "
 779                                "pcie_max_read_request_size %d ignored\n",
 780                                bfad->pci_name, pcie_max_read_reqsz);
 781                 }
 782         }
 783
 784         pci_save_state(pdev);
 785
 786         return 0;
 787
 788 out_release_region:
 789         pci_release_regions(pdev);
 790 out_disable_device:
 791         pci_disable_device(pdev);
 792 out:
 793         return rc;
 794 }
 795
 796 void
 797 bfad_pci_uninit(struct pci_dev *pdev, struct bfad_s *bfad)
 798 {
 799         pci_iounmap(pdev, bfad->pci_bar0_kva);
 800         pci_iounmap(pdev, bfad->pci_bar2_kva);
 801         pci_release_regions(pdev);
 802         /* Disable PCIE Advanced Error Recovery (AER) */
 803         pci_disable_pcie_error_reporting(pdev);
 804         pci_disable_device(pdev);
 805 }
 806
 807 bfa_status_t
 808 bfad_drv_init(struct bfad_s *bfad)
 809 {
 810         bfa_status_t    rc;
 811         unsigned long   flags;
 812
 813         bfad->cfg_data.rport_del_timeout = rport_del_timeout;
 814         bfad->cfg_data.lun_queue_depth = bfa_lun_queue_depth;
 815         bfad->cfg_data.io_max_sge = bfa_io_max_sge;
 816         bfad->cfg_data.binding_method = FCP_PWWN_BINDING;
 817
 818         rc = bfad_hal_mem_alloc(bfad);
 819         if (rc != BFA_STATUS_OK) {
 820                 printk(KERN_WARNING "bfad%d bfad_hal_mem_alloc failure\n",
 821                        bfad->inst_no);
 822                 printk(KERN_WARNING
 823                         "Not enough memory to attach all QLogic BR-series HBA ports. System may need more memory.\n");
 824                 return BFA_STATUS_FAILED;
 825         }
 826
 827         bfad->bfa.trcmod = bfad->trcmod;
 828         bfad->bfa.plog = &bfad->plog_buf;
 829         bfa_plog_init(&bfad->plog_buf);
 830         bfa_plog_str(&bfad->plog_buf, BFA_PL_MID_DRVR, BFA_PL_EID_DRIVER_START,
 831                      0, "Driver Attach");
 832
 833         bfa_attach(&bfad->bfa, bfad, &bfad->ioc_cfg, &bfad->meminfo,
 834                    &bfad->hal_pcidev);
 835
 836         /* FCS INIT */
 837         spin_lock_irqsave(&bfad->bfad_lock, flags);
 838         bfad->bfa_fcs.trcmod = bfad->trcmod;
 839         bfa_fcs_attach(&bfad->bfa_fcs, &bfad->bfa, bfad, BFA_FALSE);
 840         bfad->bfa_fcs.fdmi_enabled = fdmi_enable;
 841         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 842
 843         bfad->bfad_flags |= BFAD_DRV_INIT_DONE;
 844
 845         return BFA_STATUS_OK;
 846 }
 847
 848 void
 849 bfad_drv_uninit(struct bfad_s *bfad)
 850 {
 851         unsigned long   flags;
 852
 853         spin_lock_irqsave(&bfad->bfad_lock, flags);
 854         init_completion(&bfad->comp);
 855         bfa_iocfc_stop(&bfad->bfa);
 856         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 857         wait_for_completion(&bfad->comp);
 858
 859         del_timer_sync(&bfad->hal_tmo);
 860         bfa_isr_disable(&bfad->bfa);
 861         bfa_detach(&bfad->bfa);
 862         bfad_remove_intr(bfad);
 863         bfad_hal_mem_release(bfad);
 864
 865         bfad->bfad_flags &= ~BFAD_DRV_INIT_DONE;
 866 }
 867
 868 void
 869 bfad_drv_start(struct bfad_s *bfad)
 870 {
 871         unsigned long   flags;
 872
 873         spin_lock_irqsave(&bfad->bfad_lock, flags);
 874         bfa_iocfc_start(&bfad->bfa);
 875         bfa_fcs_pbc_vport_init(&bfad->bfa_fcs);
 876         bfa_fcs_fabric_modstart(&bfad->bfa_fcs);
 877         bfad->bfad_flags |= BFAD_HAL_START_DONE;
 878         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 879
 880         if (bfad->im)
 881                 flush_workqueue(bfad->im->drv_workq);
 882 }
 883
 884 void
 885 bfad_fcs_stop(struct bfad_s *bfad)
 886 {
 887         unsigned long   flags;
 888
 889         spin_lock_irqsave(&bfad->bfad_lock, flags);
 890         init_completion(&bfad->comp);
 891         bfad->pport.flags |= BFAD_PORT_DELETE;
 892         bfa_fcs_exit(&bfad->bfa_fcs);
 893         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 894         wait_for_completion(&bfad->comp);
 895
 896         bfa_sm_send_event(bfad, BFAD_E_FCS_EXIT_COMP);
 897 }
 898
 899 void
 900 bfad_stop(struct bfad_s *bfad)
 901 {
 902         unsigned long   flags;
 903
 904         spin_lock_irqsave(&bfad->bfad_lock, flags);
 905         init_completion(&bfad->comp);
 906         bfa_iocfc_stop(&bfad->bfa);
 907         bfad->bfad_flags &= ~BFAD_HAL_START_DONE;
 908         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 909         wait_for_completion(&bfad->comp);
 910
 911         bfa_sm_send_event(bfad, BFAD_E_EXIT_COMP);
 912 }
 913
 914 bfa_status_t
 915 bfad_cfg_pport(struct bfad_s *bfad, enum bfa_lport_role role)
 916 {
 917         int             rc = BFA_STATUS_OK;
 918
 919         /* Allocate scsi_host for the physical port */
 920         if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
 921             (role & BFA_LPORT_ROLE_FCP_IM)) {
 922                 if (bfad->pport.im_port == NULL) {
 923                         rc = BFA_STATUS_FAILED;
 924                         goto out;
 925                 }
 926
 927                 rc = bfad_im_scsi_host_alloc(bfad, bfad->pport.im_port,
 928                                                 &bfad->pcidev->dev);
 929                 if (rc != BFA_STATUS_OK)
 930                         goto out;
 931
 932                 bfad->pport.roles |= BFA_LPORT_ROLE_FCP_IM;
 933         }
 934
 935         bfad->bfad_flags |= BFAD_CFG_PPORT_DONE;
 936
 937 out:
 938         return rc;
 939 }
 940
 941 void
 942 bfad_uncfg_pport(struct bfad_s *bfad)
 943 {
 944         if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
 945             (bfad->pport.roles & BFA_LPORT_ROLE_FCP_IM)) {
 946                 bfad_im_scsi_host_free(bfad, bfad->pport.im_port);
 947                 bfad_im_port_clean(bfad->pport.im_port);
 948                 kfree(bfad->pport.im_port);
 949                 bfad->pport.roles &= ~BFA_LPORT_ROLE_FCP_IM;
 950         }
 951
 952         bfad->bfad_flags &= ~BFAD_CFG_PPORT_DONE;
 953 }
 954
 955 bfa_status_t
 956 bfad_start_ops(struct bfad_s *bfad) {
 957
 958         int     retval;
 959         unsigned long   flags;
 960         struct bfad_vport_s *vport, *vport_new;
 961         struct bfa_fcs_driver_info_s driver_info;
 962
 963         /* Limit min/max. xfer size to [64k-32MB] */
 964         if (max_xfer_size < BFAD_MIN_SECTORS >> 1)
 965                 max_xfer_size = BFAD_MIN_SECTORS >> 1;
 966         if (max_xfer_size > BFAD_MAX_SECTORS >> 1)
 967                 max_xfer_size = BFAD_MAX_SECTORS >> 1;
 968
 969         /* Fill the driver_info info to fcs*/
 970         memset(&driver_info, 0, sizeof(driver_info));
 971         strlcpy(driver_info.version, BFAD_DRIVER_VERSION,
 972                 sizeof(driver_info.version));
 973         if (host_name)
 974                 strlcpy(driver_info.host_machine_name, host_name,
 975                         sizeof(driver_info.host_machine_name));
 976         if (os_name)
 977                 strlcpy(driver_info.host_os_name, os_name,
 978                         sizeof(driver_info.host_os_name));
 979         if (os_patch)
 980                 strlcpy(driver_info.host_os_patch, os_patch,
 981                         sizeof(driver_info.host_os_patch));
 982
 983         strlcpy(driver_info.os_device_name, bfad->pci_name,
 984                 sizeof(driver_info.os_device_name));
 985
 986         /* FCS driver info init */
 987         spin_lock_irqsave(&bfad->bfad_lock, flags);
 988         bfa_fcs_driver_info_init(&bfad->bfa_fcs, &driver_info);
 989
 990         if (bfad->bfad_flags & BFAD_CFG_PPORT_DONE)
 991                 bfa_fcs_update_cfg(&bfad->bfa_fcs);
 992         else
 993                 bfa_fcs_init(&bfad->bfa_fcs);
 994
 995         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 996
 997         if (!(bfad->bfad_flags & BFAD_CFG_PPORT_DONE)) {
 998                 retval = bfad_cfg_pport(bfad, BFA_LPORT_ROLE_FCP_IM);
 999                 if (retval != BFA_STATUS_OK)
1000                         return BFA_STATUS_FAILED;
1001         }
1002
1003         /* Setup fc host fixed attribute if the lk supports */
1004         bfad_fc_host_init(bfad->pport.im_port);
1005
1006         /* BFAD level FC4 IM specific resource allocation */
1007         retval = bfad_im_probe(bfad);
1008         if (retval != BFA_STATUS_OK) {
1009                 printk(KERN_WARNING "bfad_im_probe failed\n");
1010                 if (bfa_sm_cmp_state(bfad, bfad_sm_initializing))
1011                         bfa_sm_set_state(bfad, bfad_sm_failed);
1012                 return BFA_STATUS_FAILED;
1013         } else
1014                 bfad->bfad_flags |= BFAD_FC4_PROBE_DONE;
1015
1016         bfad_drv_start(bfad);
1017
1018         /* Complete pbc vport create */
1019         list_for_each_entry_safe(vport, vport_new, &bfad->pbc_vport_list,
1020                                 list_entry) {
1021                 struct fc_vport_identifiers vid;
1022                 struct fc_vport *fc_vport;
1023                 char pwwn_buf[BFA_STRING_32];
1024
1025                 memset(&vid, 0, sizeof(vid));
1026                 vid.roles = FC_PORT_ROLE_FCP_INITIATOR;
1027                 vid.vport_type = FC_PORTTYPE_NPIV;
1028                 vid.disable = false;
1029                 vid.node_name = wwn_to_u64((u8 *)
1030                                 (&((vport->fcs_vport).lport.port_cfg.nwwn)));
1031                 vid.port_name = wwn_to_u64((u8 *)
1032                                 (&((vport->fcs_vport).lport.port_cfg.pwwn)));
1033                 fc_vport = fc_vport_create(bfad->pport.im_port->shost, 0, &vid);
1034                 if (!fc_vport) {
1035                         wwn2str(pwwn_buf, vid.port_name);
1036                         printk(KERN_WARNING "bfad%d: failed to create pbc vport"
1037                                 " %s\n", bfad->inst_no, pwwn_buf);
1038                 }
1039                 list_del(&vport->list_entry);
1040                 kfree(vport);
1041         }
1042
1043         /*
1044          * If bfa_linkup_delay is set to -1 default; try to retrive the
1045          * value using the bfad_get_linkup_delay(); else use the
1046          * passed in module param value as the bfa_linkup_delay.
1047          */
1048         if (bfa_linkup_delay < 0) {
1049                 bfa_linkup_delay = bfad_get_linkup_delay(bfad);
1050                 bfad_rport_online_wait(bfad);
1051                 bfa_linkup_delay = -1;
1052         } else
1053                 bfad_rport_online_wait(bfad);
1054
1055         BFA_LOG(KERN_INFO, bfad, bfa_log_level, "bfa device claimed\n");
1056
1057         return BFA_STATUS_OK;
1058 }
1059
1060 int
1061 bfad_worker(void *ptr)
1062 {
1063         struct bfad_s *bfad = ptr;
1064         unsigned long flags;
1065
1066         if (kthread_should_stop())
1067                 return 0;
1068
1069         /* Send event BFAD_E_INIT_SUCCESS */
1070         bfa_sm_send_event(bfad, BFAD_E_INIT_SUCCESS);
1071
1072         spin_lock_irqsave(&bfad->bfad_lock, flags);
1073         bfad->bfad_tsk = NULL;
1074         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1075
1076         return 0;
1077 }
1078
1079 /*
1080  *  BFA driver interrupt functions
1081  */
1082 irqreturn_t
1083 bfad_intx(int irq, void *dev_id)
1084 {
1085         struct bfad_s   *bfad = dev_id;
1086         struct list_head        doneq;
1087         unsigned long   flags;
1088         bfa_boolean_t rc;
1089
1090         spin_lock_irqsave(&bfad->bfad_lock, flags);
1091         rc = bfa_intx(&bfad->bfa);
1092         if (!rc) {
1093                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1094                 return IRQ_NONE;
1095         }
1096
1097         bfa_comp_deq(&bfad->bfa, &doneq);
1098         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1099
1100         if (!list_empty(&doneq)) {
1101                 bfa_comp_process(&bfad->bfa, &doneq);
1102
1103                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1104                 bfa_comp_free(&bfad->bfa, &doneq);
1105                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1106         }
1107
1108         return IRQ_HANDLED;
1109
1110 }
1111
1112 static irqreturn_t
1113 bfad_msix(int irq, void *dev_id)
1114 {
1115         struct bfad_msix_s *vec = dev_id;
1116         struct bfad_s *bfad = vec->bfad;
1117         struct list_head doneq;
1118         unsigned long   flags;
1119
1120         spin_lock_irqsave(&bfad->bfad_lock, flags);
1121
1122         bfa_msix(&bfad->bfa, vec->msix.entry);
1123         bfa_comp_deq(&bfad->bfa, &doneq);
1124         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1125
1126         if (!list_empty(&doneq)) {
1127                 bfa_comp_process(&bfad->bfa, &doneq);
1128
1129                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1130                 bfa_comp_free(&bfad->bfa, &doneq);
1131                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1132         }
1133
1134         return IRQ_HANDLED;
1135 }
1136
1137 /*
1138  * Initialize the MSIX entry table.
1139  */
1140 static void
1141 bfad_init_msix_entry(struct bfad_s *bfad, struct msix_entry *msix_entries,
1142                          int mask, int max_bit)
1143 {
1144         int     i;
1145         int     match = 0x00000001;
1146
1147         for (i = 0, bfad->nvec = 0; i < MAX_MSIX_ENTRY; i++) {
1148                 if (mask & match) {
1149                         bfad->msix_tab[bfad->nvec].msix.entry = i;
1150                         bfad->msix_tab[bfad->nvec].bfad = bfad;
1151                         msix_entries[bfad->nvec].entry = i;
1152                         bfad->nvec++;
1153                 }
1154
1155                 match <<= 1;
1156         }
1157
1158 }
1159
1160 int
1161 bfad_install_msix_handler(struct bfad_s *bfad)
1162 {
1163         int i, error = 0;
1164
1165         for (i = 0; i < bfad->nvec; i++) {
1166                 sprintf(bfad->msix_tab[i].name, "bfa-%s-%s",
1167                                 bfad->pci_name,
1168                                 ((bfa_asic_id_cb(bfad->hal_pcidev.device_id)) ?
1169                                 msix_name_cb[i] : msix_name_ct[i]));
1170
1171                 error = request_irq(bfad->msix_tab[i].msix.vector,
1172                                     (irq_handler_t) bfad_msix, 0,
1173                                     bfad->msix_tab[i].name, &bfad->msix_tab[i]);
1174                 bfa_trc(bfad, i);
1175                 bfa_trc(bfad, bfad->msix_tab[i].msix.vector);
1176                 if (error) {
1177                         int     j;
1178
1179                         for (j = 0; j < i; j++)
1180                                 free_irq(bfad->msix_tab[j].msix.vector,
1181                                                 &bfad->msix_tab[j]);
1182
1183                         bfad->bfad_flags &= ~BFAD_MSIX_ON;
1184                         pci_disable_msix(bfad->pcidev);
1185
1186                         return 1;
1187                 }
1188         }
1189
1190         return 0;
1191 }
1192
1193 /*
1194  * Setup MSIX based interrupt.
1195  */
1196 int
1197 bfad_setup_intr(struct bfad_s *bfad)
1198 {
1199         int error;
1200         u32 mask = 0, i, num_bit = 0, max_bit = 0;
1201         struct msix_entry msix_entries[MAX_MSIX_ENTRY];
1202         struct pci_dev *pdev = bfad->pcidev;
1203         u16     reg;
1204
1205         /* Call BFA to get the msix map for this PCI function.  */
1206         bfa_msix_getvecs(&bfad->bfa, &mask, &num_bit, &max_bit);
1207
1208         /* Set up the msix entry table */
1209         bfad_init_msix_entry(bfad, msix_entries, mask, max_bit);
1210
1211         if ((bfa_asic_id_ctc(pdev->device) && !msix_disable_ct) ||
1212            (bfa_asic_id_cb(pdev->device) && !msix_disable_cb)) {
1213
1214                 error = pci_enable_msix_exact(bfad->pcidev,
1215                                               msix_entries, bfad->nvec);
1216                 /* In CT1 & CT2, try to allocate just one vector */
1217                 if (error == -ENOSPC && bfa_asic_id_ctc(pdev->device)) {
1218                         printk(KERN_WARNING "bfa %s: trying one msix "
1219                                "vector failed to allocate %d[%d]\n",
1220                                bfad->pci_name, bfad->nvec, error);
1221                         bfad->nvec = 1;
1222                         error = pci_enable_msix_exact(bfad->pcidev,
1223                                                       msix_entries, 1);
1224                 }
1225
1226                 if (error) {
1227                         printk(KERN_WARNING "bfad%d: "
1228                                "pci_enable_msix_exact failed (%d), "
1229                                "use line based.\n",
1230                                 bfad->inst_no, error);
1231                         goto line_based;
1232                 }
1233
1234                 /* Disable INTX in MSI-X mode */
1235                 pci_read_config_word(pdev, PCI_COMMAND, &reg);
1236
1237                 if (!(reg & PCI_COMMAND_INTX_DISABLE))
1238                         pci_write_config_word(pdev, PCI_COMMAND,
1239                                 reg | PCI_COMMAND_INTX_DISABLE);
1240
1241                 /* Save the vectors */
1242                 for (i = 0; i < bfad->nvec; i++) {
1243                         bfa_trc(bfad, msix_entries[i].vector);
1244                         bfad->msix_tab[i].msix.vector = msix_entries[i].vector;
1245                 }
1246
1247                 bfa_msix_init(&bfad->bfa, bfad->nvec);
1248
1249                 bfad->bfad_flags |= BFAD_MSIX_ON;
1250
1251                 return 0;
1252         }
1253
1254 line_based:
1255         error = request_irq(bfad->pcidev->irq, (irq_handler_t)bfad_intx,
1256                             BFAD_IRQ_FLAGS, BFAD_DRIVER_NAME, bfad);
1257         if (error)
1258                 return error;
1259
1260         bfad->bfad_flags |= BFAD_INTX_ON;
1261
1262         return 0;
1263 }
1264
1265 void
1266 bfad_remove_intr(struct bfad_s *bfad)
1267 {
1268         int     i;
1269
1270         if (bfad->bfad_flags & BFAD_MSIX_ON) {
1271                 for (i = 0; i < bfad->nvec; i++)
1272                         free_irq(bfad->msix_tab[i].msix.vector,
1273                                         &bfad->msix_tab[i]);
1274
1275                 pci_disable_msix(bfad->pcidev);
1276                 bfad->bfad_flags &= ~BFAD_MSIX_ON;
1277         } else if (bfad->bfad_flags & BFAD_INTX_ON) {
1278                 free_irq(bfad->pcidev->irq, bfad);
1279         }
1280 }
1281
1282 /*
1283  * PCI probe entry.
1284  */
1285 int
1286 bfad_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid)
1287 {
1288         struct bfad_s   *bfad;
1289         int             error = -ENODEV, retval, i;
1290
1291         /* For single port cards - only claim function 0 */
1292         if ((pdev->device == BFA_PCI_DEVICE_ID_FC_8G1P) &&
1293                 (PCI_FUNC(pdev->devfn) != 0))
1294                 return -ENODEV;
1295
1296         bfad = kzalloc(sizeof(struct bfad_s), GFP_KERNEL);
1297         if (!bfad) {
1298                 error = -ENOMEM;
1299                 goto out;
1300         }
1301
1302         bfad->trcmod = kzalloc(sizeof(struct bfa_trc_mod_s), GFP_KERNEL);
1303         if (!bfad->trcmod) {
1304                 printk(KERN_WARNING "Error alloc trace buffer!\n");
1305                 error = -ENOMEM;
1306                 goto out_alloc_trace_failure;
1307         }
1308
1309         /* TRACE INIT */
1310         bfa_trc_init(bfad->trcmod);
1311         bfa_trc(bfad, bfad_inst);
1312
1313         /* AEN INIT */
1314         INIT_LIST_HEAD(&bfad->free_aen_q);
1315         INIT_LIST_HEAD(&bfad->active_aen_q);
1316         for (i = 0; i < BFA_AEN_MAX_ENTRY; i++)
1317                 list_add_tail(&bfad->aen_list[i].qe, &bfad->free_aen_q);
1318
1319         if (!(bfad_load_fwimg(pdev))) {
1320                 kfree(bfad->trcmod);
1321                 goto out_alloc_trace_failure;
1322         }
1323
1324         retval = bfad_pci_init(pdev, bfad);
1325         if (retval) {
1326                 printk(KERN_WARNING "bfad_pci_init failure!\n");
1327                 error = retval;
1328                 goto out_pci_init_failure;
1329         }
1330
1331         mutex_lock(&bfad_mutex);
1332         bfad->inst_no = bfad_inst++;
1333         list_add_tail(&bfad->list_entry, &bfad_list);
1334         mutex_unlock(&bfad_mutex);
1335
1336         /* Initializing the state machine: State set to uninit */
1337         bfa_sm_set_state(bfad, bfad_sm_uninit);
1338
1339         spin_lock_init(&bfad->bfad_lock);
1340         spin_lock_init(&bfad->bfad_aen_spinlock);
1341
1342         pci_set_drvdata(pdev, bfad);
1343
1344         bfad->ref_count = 0;
1345         bfad->pport.bfad = bfad;
1346         INIT_LIST_HEAD(&bfad->pbc_vport_list);
1347         INIT_LIST_HEAD(&bfad->vport_list);
1348
1349         /* Setup the debugfs node for this bfad */
1350         if (bfa_debugfs_enable)
1351                 bfad_debugfs_init(&bfad->pport);
1352
1353         retval = bfad_drv_init(bfad);
1354         if (retval != BFA_STATUS_OK)
1355                 goto out_drv_init_failure;
1356
1357         bfa_sm_send_event(bfad, BFAD_E_CREATE);
1358
1359         if (bfa_sm_cmp_state(bfad, bfad_sm_uninit))
1360                 goto out_bfad_sm_failure;
1361
1362         return 0;
1363
1364 out_bfad_sm_failure:
1365         bfad_hal_mem_release(bfad);
1366 out_drv_init_failure:
1367         /* Remove the debugfs node for this bfad */
1368         kfree(bfad->regdata);
1369         bfad_debugfs_exit(&bfad->pport);
1370         mutex_lock(&bfad_mutex);
1371         bfad_inst--;
1372         list_del(&bfad->list_entry);
1373         mutex_unlock(&bfad_mutex);
1374         bfad_pci_uninit(pdev, bfad);
1375 out_pci_init_failure:
1376         kfree(bfad->trcmod);
1377 out_alloc_trace_failure:
1378         kfree(bfad);
1379 out:
1380         return error;
1381 }
1382
1383 /*
1384  * PCI remove entry.
1385  */
1386 void
1387 bfad_pci_remove(struct pci_dev *pdev)
1388 {
1389         struct bfad_s         *bfad = pci_get_drvdata(pdev);
1390         unsigned long   flags;
1391
1392         bfa_trc(bfad, bfad->inst_no);
1393
1394         spin_lock_irqsave(&bfad->bfad_lock, flags);
1395         if (bfad->bfad_tsk != NULL) {
1396                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1397                 kthread_stop(bfad->bfad_tsk);
1398         } else {
1399                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1400         }
1401
1402         /* Send Event BFAD_E_STOP */
1403         bfa_sm_send_event(bfad, BFAD_E_STOP);
1404
1405         /* Driver detach and dealloc mem */
1406         spin_lock_irqsave(&bfad->bfad_lock, flags);
1407         bfa_detach(&bfad->bfa);
1408         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1409         bfad_hal_mem_release(bfad);
1410
1411         /* Remove the debugfs node for this bfad */
1412         kfree(bfad->regdata);
1413         bfad_debugfs_exit(&bfad->pport);
1414
1415         /* Cleaning the BFAD instance */
1416         mutex_lock(&bfad_mutex);
1417         bfad_inst--;
1418         list_del(&bfad->list_entry);
1419         mutex_unlock(&bfad_mutex);
1420         bfad_pci_uninit(pdev, bfad);
1421
1422         kfree(bfad->trcmod);
1423         kfree(bfad);
1424 }
1425
1426 /*
1427  * PCI Error Recovery entry, error detected.
1428  */
1429 static pci_ers_result_t
1430 bfad_pci_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
1431 {
1432         struct bfad_s *bfad = pci_get_drvdata(pdev);
1433         unsigned long   flags;
1434         pci_ers_result_t ret = PCI_ERS_RESULT_NONE;
1435
1436         dev_printk(KERN_ERR, &pdev->dev,
1437                    "error detected state: %d - flags: 0x%x\n",
1438                    state, bfad->bfad_flags);
1439
1440         switch (state) {
1441         case pci_channel_io_normal: /* non-fatal error */
1442                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1443                 bfad->bfad_flags &= ~BFAD_EEH_BUSY;
1444                 /* Suspend/fail all bfa operations */
1445                 bfa_ioc_suspend(&bfad->bfa.ioc);
1446                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1447                 del_timer_sync(&bfad->hal_tmo);
1448                 ret = PCI_ERS_RESULT_CAN_RECOVER;
1449                 break;
1450         case pci_channel_io_frozen: /* fatal error */
1451                 init_completion(&bfad->comp);
1452                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1453                 bfad->bfad_flags |= BFAD_EEH_BUSY;
1454                 /* Suspend/fail all bfa operations */
1455                 bfa_ioc_suspend(&bfad->bfa.ioc);
1456                 bfa_fcs_stop(&bfad->bfa_fcs);
1457                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1458                 wait_for_completion(&bfad->comp);
1459
1460                 bfad_remove_intr(bfad);
1461                 del_timer_sync(&bfad->hal_tmo);
1462                 pci_disable_device(pdev);
1463                 ret = PCI_ERS_RESULT_NEED_RESET;
1464                 break;
1465         case pci_channel_io_perm_failure: /* PCI Card is DEAD */
1466                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1467                 bfad->bfad_flags |= BFAD_EEH_BUSY |
1468                                     BFAD_EEH_PCI_CHANNEL_IO_PERM_FAILURE;
1469                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1470
1471                 /* If the error_detected handler is called with the reason
1472                  * pci_channel_io_perm_failure - it will subsequently call
1473                  * pci_remove() entry point to remove the pci device from the
1474                  * system - So defer the cleanup to pci_remove(); cleaning up
1475                  * here causes inconsistent state during pci_remove().
1476                  */
1477                 ret = PCI_ERS_RESULT_DISCONNECT;
1478                 break;
1479         default:
1480                 WARN_ON(1);
1481         }
1482
1483         return ret;
1484 }
1485
1486 static int restart_bfa(struct bfad_s *bfad)
1487 {
1488         unsigned long flags;
1489         struct pci_dev *pdev = bfad->pcidev;
1490
1491         bfa_attach(&bfad->bfa, bfad, &bfad->ioc_cfg,
1492                    &bfad->meminfo, &bfad->hal_pcidev);
1493
1494         /* Enable Interrupt and wait bfa_init completion */
1495         if (bfad_setup_intr(bfad)) {
1496                 dev_printk(KERN_WARNING, &pdev->dev,
1497                            "%s: bfad_setup_intr failed\n", bfad->pci_name);
1498                 bfa_sm_send_event(bfad, BFAD_E_INIT_FAILED);
1499                 return -1;
1500         }
1501
1502         init_completion(&bfad->comp);
1503         spin_lock_irqsave(&bfad->bfad_lock, flags);
1504         bfa_iocfc_init(&bfad->bfa);
1505         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1506
1507         /* Set up interrupt handler for each vectors */
1508         if ((bfad->bfad_flags & BFAD_MSIX_ON) &&
1509             bfad_install_msix_handler(bfad))
1510                 dev_printk(KERN_WARNING, &pdev->dev,
1511                            "%s: install_msix failed.\n", bfad->pci_name);
1512
1513         bfad_init_timer(bfad);
1514         wait_for_completion(&bfad->comp);
1515         bfad_drv_start(bfad);
1516
1517         return 0;
1518 }
1519
1520 /*
1521  * PCI Error Recovery entry, re-initialize the chip.
1522  */
1523 static pci_ers_result_t
1524 bfad_pci_slot_reset(struct pci_dev *pdev)
1525 {
1526         struct bfad_s *bfad = pci_get_drvdata(pdev);
1527         u8 byte;
1528         int rc;
1529
1530         dev_printk(KERN_ERR, &pdev->dev,
1531                    "bfad_pci_slot_reset flags: 0x%x\n", bfad->bfad_flags);
1532
1533         if (pci_enable_device(pdev)) {
1534                 dev_printk(KERN_ERR, &pdev->dev, "Cannot re-enable "
1535                            "PCI device after reset.\n");
1536                 return PCI_ERS_RESULT_DISCONNECT;
1537         }
1538
1539         pci_restore_state(pdev);
1540
1541         /*
1542          * Read some byte (e.g. DMA max. payload size which can't
1543          * be 0xff any time) to make sure - we did not hit another PCI error
1544          * in the middle of recovery. If we did, then declare permanent failure.
1545          */
1546         pci_read_config_byte(pdev, 0x68, &byte);
1547         if (byte == 0xff) {
1548                 dev_printk(KERN_ERR, &pdev->dev,
1549                            "slot_reset failed ... got another PCI error !\n");
1550                 goto out_disable_device;
1551         }
1552
1553         pci_save_state(pdev);
1554         pci_set_master(pdev);
1555
1556         rc = dma_set_mask_and_coherent(&bfad->pcidev->dev, DMA_BIT_MASK(64));
1557         if (rc)
1558                 goto out_disable_device;
1559
1560         if (restart_bfa(bfad) == -1)
1561                 goto out_disable_device;
1562
1563         pci_enable_pcie_error_reporting(pdev);
1564         dev_printk(KERN_WARNING, &pdev->dev,
1565                    "slot_reset completed  flags: 0x%x!\n", bfad->bfad_flags);
1566
1567         return PCI_ERS_RESULT_RECOVERED;
1568
1569 out_disable_device:
1570         pci_disable_device(pdev);
1571         return PCI_ERS_RESULT_DISCONNECT;
1572 }
1573
1574 static pci_ers_result_t
1575 bfad_pci_mmio_enabled(struct pci_dev *pdev)
1576 {
1577         unsigned long   flags;
1578         struct bfad_s *bfad = pci_get_drvdata(pdev);
1579
1580         dev_printk(KERN_INFO, &pdev->dev, "mmio_enabled\n");
1581
1582         /* Fetch FW diagnostic information */
1583         bfa_ioc_debug_save_ftrc(&bfad->bfa.ioc);
1584
1585         /* Cancel all pending IOs */
1586         spin_lock_irqsave(&bfad->bfad_lock, flags);
1587         init_completion(&bfad->comp);
1588         bfa_fcs_stop(&bfad->bfa_fcs);
1589         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1590         wait_for_completion(&bfad->comp);
1591
1592         bfad_remove_intr(bfad);
1593         del_timer_sync(&bfad->hal_tmo);
1594         pci_disable_device(pdev);
1595
1596         return PCI_ERS_RESULT_NEED_RESET;
1597 }
1598
1599 static void
1600 bfad_pci_resume(struct pci_dev *pdev)
1601 {
1602         unsigned long   flags;
1603         struct bfad_s *bfad = pci_get_drvdata(pdev);
1604
1605         dev_printk(KERN_WARNING, &pdev->dev, "resume\n");
1606
1607         /* wait until the link is online */
1608         bfad_rport_online_wait(bfad);
1609
1610         spin_lock_irqsave(&bfad->bfad_lock, flags);
1611         bfad->bfad_flags &= ~BFAD_EEH_BUSY;
1612         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1613 }
1614
1615 struct pci_device_id bfad_id_table[] = {
1616         {
1617                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1618                 .device = BFA_PCI_DEVICE_ID_FC_8G2P,
1619                 .subvendor = PCI_ANY_ID,
1620                 .subdevice = PCI_ANY_ID,
1621         },
1622         {
1623                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1624                 .device = BFA_PCI_DEVICE_ID_FC_8G1P,
1625                 .subvendor = PCI_ANY_ID,
1626                 .subdevice = PCI_ANY_ID,
1627         },
1628         {
1629                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1630                 .device = BFA_PCI_DEVICE_ID_CT,
1631                 .subvendor = PCI_ANY_ID,
1632                 .subdevice = PCI_ANY_ID,
1633                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1634                 .class_mask = ~0,
1635         },
1636         {
1637                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1638                 .device = BFA_PCI_DEVICE_ID_CT_FC,
1639                 .subvendor = PCI_ANY_ID,
1640                 .subdevice = PCI_ANY_ID,
1641                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1642                 .class_mask = ~0,
1643         },
1644         {
1645                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1646                 .device = BFA_PCI_DEVICE_ID_CT2,
1647                 .subvendor = PCI_ANY_ID,
1648                 .subdevice = PCI_ANY_ID,
1649                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1650                 .class_mask = ~0,
1651         },
1652
1653         {
1654                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1655                 .device = BFA_PCI_DEVICE_ID_CT2_QUAD,
1656                 .subvendor = PCI_ANY_ID,
1657                 .subdevice = PCI_ANY_ID,
1658                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1659                 .class_mask = ~0,
1660         },
1661         {0, 0},
1662 };
1663
1664 MODULE_DEVICE_TABLE(pci, bfad_id_table);
1665
1666 /*
1667  * PCI error recovery handlers.
1668  */
1669 static struct pci_error_handlers bfad_err_handler = {
1670         .error_detected = bfad_pci_error_detected,
1671         .slot_reset = bfad_pci_slot_reset,
1672         .mmio_enabled = bfad_pci_mmio_enabled,
1673         .resume = bfad_pci_resume,
1674 };
1675
1676 static struct pci_driver bfad_pci_driver = {
1677         .name = BFAD_DRIVER_NAME,
1678         .id_table = bfad_id_table,
1679         .probe = bfad_pci_probe,
1680         .remove = bfad_pci_remove,
1681         .err_handler = &bfad_err_handler,
1682 };
1683
1684 /*
1685  * Driver module init.
1686  */
1687 static int __init
1688 bfad_init(void)
1689 {
1690         int             error = 0;
1691
1692         pr_info("QLogic BR-series BFA FC/FCOE SCSI driver - version: %s\n",
1693                         BFAD_DRIVER_VERSION);
1694
1695         if (num_sgpgs > 0)
1696                 num_sgpgs_parm = num_sgpgs;
1697
1698         error = bfad_im_module_init();
1699         if (error) {
1700                 error = -ENOMEM;
1701                 printk(KERN_WARNING "bfad_im_module_init failure\n");
1702                 goto ext;
1703         }
1704
1705         if (strcmp(FCPI_NAME, " fcpim") == 0)
1706                 supported_fc4s |= BFA_LPORT_ROLE_FCP_IM;
1707
1708         bfa_auto_recover = ioc_auto_recover;
1709         bfa_fcs_rport_set_del_timeout(rport_del_timeout);
1710         bfa_fcs_rport_set_max_logins(max_rport_logins);
1711
1712         error = pci_register_driver(&bfad_pci_driver);
1713         if (error) {
1714                 printk(KERN_WARNING "pci_register_driver failure\n");
1715                 goto ext;
1716         }
1717
1718         return 0;
1719
1720 ext:
1721         bfad_im_module_exit();
1722         return error;
1723 }
1724
1725 /*
1726  * Driver module exit.
1727  */
1728 static void __exit
1729 bfad_exit(void)
1730 {
1731         pci_unregister_driver(&bfad_pci_driver);
1732         bfad_im_module_exit();
1733         bfad_free_fwimg();
1734 }
1735
1736 /* Firmware handling */
1737 static void
1738 bfad_read_firmware(struct pci_dev *pdev, u32 **bfi_image,
1739                 u32 *bfi_image_size, char *fw_name)
1740 {
1741         const struct firmware *fw;
1742
1743         if (reject_firmware(&fw, fw_name, &pdev->dev)) {
1744                 printk(KERN_ALERT "Can't locate firmware %s\n", fw_name);
1745                 *bfi_image = NULL;
1746                 goto out;
1747         }
1748
1749         *bfi_image = vmalloc(fw->size);
1750         if (NULL == *bfi_image) {
1751                 printk(KERN_ALERT "Fail to allocate buffer for fw image "
1752                         "size=%x!\n", (u32) fw->size);
1753                 goto out;
1754         }
1755
1756         memcpy(*bfi_image, fw->data, fw->size);
1757         *bfi_image_size = fw->size/sizeof(u32);
1758 out:
1759         release_firmware(fw);
1760 }
1761
1762 static u32 *
1763 bfad_load_fwimg(struct pci_dev *pdev)
1764 {
1765         if (bfa_asic_id_ct2(pdev->device)) {
1766                 if (bfi_image_ct2_size == 0)
1767                         bfad_read_firmware(pdev, &bfi_image_ct2,
1768                                 &bfi_image_ct2_size, BFAD_FW_FILE_CT2);
1769                 return bfi_image_ct2;
1770         } else if (bfa_asic_id_ct(pdev->device)) {
1771                 if (bfi_image_ct_size == 0)
1772                         bfad_read_firmware(pdev, &bfi_image_ct,
1773                                 &bfi_image_ct_size, BFAD_FW_FILE_CT);
1774                 return bfi_image_ct;
1775         } else if (bfa_asic_id_cb(pdev->device)) {
1776                 if (bfi_image_cb_size == 0)
1777                         bfad_read_firmware(pdev, &bfi_image_cb,
1778                                 &bfi_image_cb_size, BFAD_FW_FILE_CB);
1779                 return bfi_image_cb;
1780         }
1781
1782         return NULL;
1783 }
1784
1785 static void
1786 bfad_free_fwimg(void)
1787 {
1788         if (bfi_image_ct2_size && bfi_image_ct2)
1789                 vfree(bfi_image_ct2);
1790         if (bfi_image_ct_size && bfi_image_ct)
1791                 vfree(bfi_image_ct);
1792         if (bfi_image_cb_size && bfi_image_cb)
1793                 vfree(bfi_image_cb);
1794 }
1795
1796 module_init(bfad_init);
1797 module_exit(bfad_exit);
1798 MODULE_LICENSE("GPL");
1799 MODULE_DESCRIPTION("QLogic BR-series Fibre Channel HBA Driver" BFAD_PROTO_NAME);
1800 MODULE_AUTHOR("QLogic Corporation");
1801 MODULE_VERSION(BFAD_DRIVER_VERSION);