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         bfad->pci_bar0_kva = pci_iomap(pdev, 0, pci_resource_len(pdev, 0));
 740         bfad->pci_bar2_kva = pci_iomap(pdev, 2, pci_resource_len(pdev, 2));
 741
 742         if (bfad->pci_bar0_kva == NULL) {
 743                 printk(KERN_ERR "Fail to map bar0\n");
 744                 rc = -ENODEV;
 745                 goto out_release_region;
 746         }
 747
 748         bfad->hal_pcidev.pci_slot = PCI_SLOT(pdev->devfn);
 749         bfad->hal_pcidev.pci_func = PCI_FUNC(pdev->devfn);
 750         bfad->hal_pcidev.pci_bar_kva = bfad->pci_bar0_kva;
 751         bfad->hal_pcidev.device_id = pdev->device;
 752         bfad->hal_pcidev.ssid = pdev->subsystem_device;
 753         bfad->pci_name = pci_name(pdev);
 754
 755         bfad->pci_attr.vendor_id = pdev->vendor;
 756         bfad->pci_attr.device_id = pdev->device;
 757         bfad->pci_attr.ssid = pdev->subsystem_device;
 758         bfad->pci_attr.ssvid = pdev->subsystem_vendor;
 759         bfad->pci_attr.pcifn = PCI_FUNC(pdev->devfn);
 760
 761         bfad->pcidev = pdev;
 762
 763         /* Adjust PCIe Maximum Read Request Size */
 764         if (pci_is_pcie(pdev) && pcie_max_read_reqsz) {
 765                 if (pcie_max_read_reqsz >= 128 &&
 766                     pcie_max_read_reqsz <= 4096 &&
 767                     is_power_of_2(pcie_max_read_reqsz)) {
 768                         int max_rq = pcie_get_readrq(pdev);
 769                         printk(KERN_WARNING "BFA[%s]: "
 770                                 "pcie_max_read_request_size is %d, "
 771                                 "reset to %d\n", bfad->pci_name, max_rq,
 772                                 pcie_max_read_reqsz);
 773                         pcie_set_readrq(pdev, pcie_max_read_reqsz);
 774                 } else {
 775                         printk(KERN_WARNING "BFA[%s]: invalid "
 776                                "pcie_max_read_request_size %d ignored\n",
 777                                bfad->pci_name, pcie_max_read_reqsz);
 778                 }
 779         }
 780
 781         pci_save_state(pdev);
 782
 783         return 0;
 784
 785 out_release_region:
 786         pci_release_regions(pdev);
 787 out_disable_device:
 788         pci_disable_device(pdev);
 789 out:
 790         return rc;
 791 }
 792
 793 void
 794 bfad_pci_uninit(struct pci_dev *pdev, struct bfad_s *bfad)
 795 {
 796         pci_iounmap(pdev, bfad->pci_bar0_kva);
 797         pci_iounmap(pdev, bfad->pci_bar2_kva);
 798         pci_release_regions(pdev);
 799         pci_disable_device(pdev);
 800 }
 801
 802 bfa_status_t
 803 bfad_drv_init(struct bfad_s *bfad)
 804 {
 805         bfa_status_t    rc;
 806         unsigned long   flags;
 807
 808         bfad->cfg_data.rport_del_timeout = rport_del_timeout;
 809         bfad->cfg_data.lun_queue_depth = bfa_lun_queue_depth;
 810         bfad->cfg_data.io_max_sge = bfa_io_max_sge;
 811         bfad->cfg_data.binding_method = FCP_PWWN_BINDING;
 812
 813         rc = bfad_hal_mem_alloc(bfad);
 814         if (rc != BFA_STATUS_OK) {
 815                 printk(KERN_WARNING "bfad%d bfad_hal_mem_alloc failure\n",
 816                        bfad->inst_no);
 817                 printk(KERN_WARNING
 818                         "Not enough memory to attach all QLogic BR-series HBA ports. System may need more memory.\n");
 819                 return BFA_STATUS_FAILED;
 820         }
 821
 822         bfad->bfa.trcmod = bfad->trcmod;
 823         bfad->bfa.plog = &bfad->plog_buf;
 824         bfa_plog_init(&bfad->plog_buf);
 825         bfa_plog_str(&bfad->plog_buf, BFA_PL_MID_DRVR, BFA_PL_EID_DRIVER_START,
 826                      0, "Driver Attach");
 827
 828         bfa_attach(&bfad->bfa, bfad, &bfad->ioc_cfg, &bfad->meminfo,
 829                    &bfad->hal_pcidev);
 830
 831         /* FCS INIT */
 832         spin_lock_irqsave(&bfad->bfad_lock, flags);
 833         bfad->bfa_fcs.trcmod = bfad->trcmod;
 834         bfa_fcs_attach(&bfad->bfa_fcs, &bfad->bfa, bfad, BFA_FALSE);
 835         bfad->bfa_fcs.fdmi_enabled = fdmi_enable;
 836         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 837
 838         bfad->bfad_flags |= BFAD_DRV_INIT_DONE;
 839
 840         return BFA_STATUS_OK;
 841 }
 842
 843 void
 844 bfad_drv_uninit(struct bfad_s *bfad)
 845 {
 846         unsigned long   flags;
 847
 848         spin_lock_irqsave(&bfad->bfad_lock, flags);
 849         init_completion(&bfad->comp);
 850         bfa_iocfc_stop(&bfad->bfa);
 851         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 852         wait_for_completion(&bfad->comp);
 853
 854         del_timer_sync(&bfad->hal_tmo);
 855         bfa_isr_disable(&bfad->bfa);
 856         bfa_detach(&bfad->bfa);
 857         bfad_remove_intr(bfad);
 858         bfad_hal_mem_release(bfad);
 859
 860         bfad->bfad_flags &= ~BFAD_DRV_INIT_DONE;
 861 }
 862
 863 void
 864 bfad_drv_start(struct bfad_s *bfad)
 865 {
 866         unsigned long   flags;
 867
 868         spin_lock_irqsave(&bfad->bfad_lock, flags);
 869         bfa_iocfc_start(&bfad->bfa);
 870         bfa_fcs_pbc_vport_init(&bfad->bfa_fcs);
 871         bfa_fcs_fabric_modstart(&bfad->bfa_fcs);
 872         bfad->bfad_flags |= BFAD_HAL_START_DONE;
 873         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 874
 875         if (bfad->im)
 876                 flush_workqueue(bfad->im->drv_workq);
 877 }
 878
 879 void
 880 bfad_fcs_stop(struct bfad_s *bfad)
 881 {
 882         unsigned long   flags;
 883
 884         spin_lock_irqsave(&bfad->bfad_lock, flags);
 885         init_completion(&bfad->comp);
 886         bfad->pport.flags |= BFAD_PORT_DELETE;
 887         bfa_fcs_exit(&bfad->bfa_fcs);
 888         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 889         wait_for_completion(&bfad->comp);
 890
 891         bfa_sm_send_event(bfad, BFAD_E_FCS_EXIT_COMP);
 892 }
 893
 894 void
 895 bfad_stop(struct bfad_s *bfad)
 896 {
 897         unsigned long   flags;
 898
 899         spin_lock_irqsave(&bfad->bfad_lock, flags);
 900         init_completion(&bfad->comp);
 901         bfa_iocfc_stop(&bfad->bfa);
 902         bfad->bfad_flags &= ~BFAD_HAL_START_DONE;
 903         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 904         wait_for_completion(&bfad->comp);
 905
 906         bfa_sm_send_event(bfad, BFAD_E_EXIT_COMP);
 907 }
 908
 909 bfa_status_t
 910 bfad_cfg_pport(struct bfad_s *bfad, enum bfa_lport_role role)
 911 {
 912         int             rc = BFA_STATUS_OK;
 913
 914         /* Allocate scsi_host for the physical port */
 915         if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
 916             (role & BFA_LPORT_ROLE_FCP_IM)) {
 917                 if (bfad->pport.im_port == NULL) {
 918                         rc = BFA_STATUS_FAILED;
 919                         goto out;
 920                 }
 921
 922                 rc = bfad_im_scsi_host_alloc(bfad, bfad->pport.im_port,
 923                                                 &bfad->pcidev->dev);
 924                 if (rc != BFA_STATUS_OK)
 925                         goto out;
 926
 927                 bfad->pport.roles |= BFA_LPORT_ROLE_FCP_IM;
 928         }
 929
 930         bfad->bfad_flags |= BFAD_CFG_PPORT_DONE;
 931
 932 out:
 933         return rc;
 934 }
 935
 936 void
 937 bfad_uncfg_pport(struct bfad_s *bfad)
 938 {
 939         if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
 940             (bfad->pport.roles & BFA_LPORT_ROLE_FCP_IM)) {
 941                 bfad_im_scsi_host_free(bfad, bfad->pport.im_port);
 942                 bfad_im_port_clean(bfad->pport.im_port);
 943                 kfree(bfad->pport.im_port);
 944                 bfad->pport.roles &= ~BFA_LPORT_ROLE_FCP_IM;
 945         }
 946
 947         bfad->bfad_flags &= ~BFAD_CFG_PPORT_DONE;
 948 }
 949
 950 bfa_status_t
 951 bfad_start_ops(struct bfad_s *bfad) {
 952
 953         int     retval;
 954         unsigned long   flags;
 955         struct bfad_vport_s *vport, *vport_new;
 956         struct bfa_fcs_driver_info_s driver_info;
 957
 958         /* Limit min/max. xfer size to [64k-32MB] */
 959         if (max_xfer_size < BFAD_MIN_SECTORS >> 1)
 960                 max_xfer_size = BFAD_MIN_SECTORS >> 1;
 961         if (max_xfer_size > BFAD_MAX_SECTORS >> 1)
 962                 max_xfer_size = BFAD_MAX_SECTORS >> 1;
 963
 964         /* Fill the driver_info info to fcs*/
 965         memset(&driver_info, 0, sizeof(driver_info));
 966         strscpy(driver_info.version, BFAD_DRIVER_VERSION,
 967                 sizeof(driver_info.version));
 968         if (host_name)
 969                 strscpy(driver_info.host_machine_name, host_name,
 970                         sizeof(driver_info.host_machine_name));
 971         if (os_name)
 972                 strscpy(driver_info.host_os_name, os_name,
 973                         sizeof(driver_info.host_os_name));
 974         if (os_patch)
 975                 strscpy(driver_info.host_os_patch, os_patch,
 976                         sizeof(driver_info.host_os_patch));
 977
 978         strscpy(driver_info.os_device_name, bfad->pci_name,
 979                 sizeof(driver_info.os_device_name));
 980
 981         /* FCS driver info init */
 982         spin_lock_irqsave(&bfad->bfad_lock, flags);
 983         bfa_fcs_driver_info_init(&bfad->bfa_fcs, &driver_info);
 984
 985         if (bfad->bfad_flags & BFAD_CFG_PPORT_DONE)
 986                 bfa_fcs_update_cfg(&bfad->bfa_fcs);
 987         else
 988                 bfa_fcs_init(&bfad->bfa_fcs);
 989
 990         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
 991
 992         if (!(bfad->bfad_flags & BFAD_CFG_PPORT_DONE)) {
 993                 retval = bfad_cfg_pport(bfad, BFA_LPORT_ROLE_FCP_IM);
 994                 if (retval != BFA_STATUS_OK)
 995                         return BFA_STATUS_FAILED;
 996         }
 997
 998         /* Setup fc host fixed attribute if the lk supports */
 999         bfad_fc_host_init(bfad->pport.im_port);
1000
1001         /* BFAD level FC4 IM specific resource allocation */
1002         retval = bfad_im_probe(bfad);
1003         if (retval != BFA_STATUS_OK) {
1004                 printk(KERN_WARNING "bfad_im_probe failed\n");
1005                 if (bfa_sm_cmp_state(bfad, bfad_sm_initializing))
1006                         bfa_sm_set_state(bfad, bfad_sm_failed);
1007                 return BFA_STATUS_FAILED;
1008         } else
1009                 bfad->bfad_flags |= BFAD_FC4_PROBE_DONE;
1010
1011         bfad_drv_start(bfad);
1012
1013         /* Complete pbc vport create */
1014         list_for_each_entry_safe(vport, vport_new, &bfad->pbc_vport_list,
1015                                 list_entry) {
1016                 struct fc_vport_identifiers vid;
1017                 struct fc_vport *fc_vport;
1018                 char pwwn_buf[BFA_STRING_32];
1019
1020                 memset(&vid, 0, sizeof(vid));
1021                 vid.roles = FC_PORT_ROLE_FCP_INITIATOR;
1022                 vid.vport_type = FC_PORTTYPE_NPIV;
1023                 vid.disable = false;
1024                 vid.node_name = wwn_to_u64((u8 *)
1025                                 (&((vport->fcs_vport).lport.port_cfg.nwwn)));
1026                 vid.port_name = wwn_to_u64((u8 *)
1027                                 (&((vport->fcs_vport).lport.port_cfg.pwwn)));
1028                 fc_vport = fc_vport_create(bfad->pport.im_port->shost, 0, &vid);
1029                 if (!fc_vport) {
1030                         wwn2str(pwwn_buf, vid.port_name);
1031                         printk(KERN_WARNING "bfad%d: failed to create pbc vport"
1032                                 " %s\n", bfad->inst_no, pwwn_buf);
1033                 }
1034                 list_del(&vport->list_entry);
1035                 kfree(vport);
1036         }
1037
1038         /*
1039          * If bfa_linkup_delay is set to -1 default; try to retrive the
1040          * value using the bfad_get_linkup_delay(); else use the
1041          * passed in module param value as the bfa_linkup_delay.
1042          */
1043         if (bfa_linkup_delay < 0) {
1044                 bfa_linkup_delay = bfad_get_linkup_delay(bfad);
1045                 bfad_rport_online_wait(bfad);
1046                 bfa_linkup_delay = -1;
1047         } else
1048                 bfad_rport_online_wait(bfad);
1049
1050         BFA_LOG(KERN_INFO, bfad, bfa_log_level, "bfa device claimed\n");
1051
1052         return BFA_STATUS_OK;
1053 }
1054
1055 int
1056 bfad_worker(void *ptr)
1057 {
1058         struct bfad_s *bfad = ptr;
1059         unsigned long flags;
1060
1061         if (kthread_should_stop())
1062                 return 0;
1063
1064         /* Send event BFAD_E_INIT_SUCCESS */
1065         bfa_sm_send_event(bfad, BFAD_E_INIT_SUCCESS);
1066
1067         spin_lock_irqsave(&bfad->bfad_lock, flags);
1068         bfad->bfad_tsk = NULL;
1069         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1070
1071         return 0;
1072 }
1073
1074 /*
1075  *  BFA driver interrupt functions
1076  */
1077 irqreturn_t
1078 bfad_intx(int irq, void *dev_id)
1079 {
1080         struct bfad_s   *bfad = dev_id;
1081         struct list_head        doneq;
1082         unsigned long   flags;
1083         bfa_boolean_t rc;
1084
1085         spin_lock_irqsave(&bfad->bfad_lock, flags);
1086         rc = bfa_intx(&bfad->bfa);
1087         if (!rc) {
1088                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1089                 return IRQ_NONE;
1090         }
1091
1092         bfa_comp_deq(&bfad->bfa, &doneq);
1093         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1094
1095         if (!list_empty(&doneq)) {
1096                 bfa_comp_process(&bfad->bfa, &doneq);
1097
1098                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1099                 bfa_comp_free(&bfad->bfa, &doneq);
1100                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1101         }
1102
1103         return IRQ_HANDLED;
1104
1105 }
1106
1107 static irqreturn_t
1108 bfad_msix(int irq, void *dev_id)
1109 {
1110         struct bfad_msix_s *vec = dev_id;
1111         struct bfad_s *bfad = vec->bfad;
1112         struct list_head doneq;
1113         unsigned long   flags;
1114
1115         spin_lock_irqsave(&bfad->bfad_lock, flags);
1116
1117         bfa_msix(&bfad->bfa, vec->msix.entry);
1118         bfa_comp_deq(&bfad->bfa, &doneq);
1119         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1120
1121         if (!list_empty(&doneq)) {
1122                 bfa_comp_process(&bfad->bfa, &doneq);
1123
1124                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1125                 bfa_comp_free(&bfad->bfa, &doneq);
1126                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1127         }
1128
1129         return IRQ_HANDLED;
1130 }
1131
1132 /*
1133  * Initialize the MSIX entry table.
1134  */
1135 static void
1136 bfad_init_msix_entry(struct bfad_s *bfad, struct msix_entry *msix_entries,
1137                          int mask, int max_bit)
1138 {
1139         int     i;
1140         int     match = 0x00000001;
1141
1142         for (i = 0, bfad->nvec = 0; i < MAX_MSIX_ENTRY; i++) {
1143                 if (mask & match) {
1144                         bfad->msix_tab[bfad->nvec].msix.entry = i;
1145                         bfad->msix_tab[bfad->nvec].bfad = bfad;
1146                         msix_entries[bfad->nvec].entry = i;
1147                         bfad->nvec++;
1148                 }
1149
1150                 match <<= 1;
1151         }
1152
1153 }
1154
1155 int
1156 bfad_install_msix_handler(struct bfad_s *bfad)
1157 {
1158         int i, error = 0;
1159
1160         for (i = 0; i < bfad->nvec; i++) {
1161                 sprintf(bfad->msix_tab[i].name, "bfa-%s-%s",
1162                                 bfad->pci_name,
1163                                 ((bfa_asic_id_cb(bfad->hal_pcidev.device_id)) ?
1164                                 msix_name_cb[i] : msix_name_ct[i]));
1165
1166                 error = request_irq(bfad->msix_tab[i].msix.vector,
1167                                     (irq_handler_t) bfad_msix, 0,
1168                                     bfad->msix_tab[i].name, &bfad->msix_tab[i]);
1169                 bfa_trc(bfad, i);
1170                 bfa_trc(bfad, bfad->msix_tab[i].msix.vector);
1171                 if (error) {
1172                         int     j;
1173
1174                         for (j = 0; j < i; j++)
1175                                 free_irq(bfad->msix_tab[j].msix.vector,
1176                                                 &bfad->msix_tab[j]);
1177
1178                         bfad->bfad_flags &= ~BFAD_MSIX_ON;
1179                         pci_disable_msix(bfad->pcidev);
1180
1181                         return 1;
1182                 }
1183         }
1184
1185         return 0;
1186 }
1187
1188 /*
1189  * Setup MSIX based interrupt.
1190  */
1191 int
1192 bfad_setup_intr(struct bfad_s *bfad)
1193 {
1194         int error;
1195         u32 mask = 0, i, num_bit = 0, max_bit = 0;
1196         struct msix_entry msix_entries[MAX_MSIX_ENTRY];
1197         struct pci_dev *pdev = bfad->pcidev;
1198         u16     reg;
1199
1200         /* Call BFA to get the msix map for this PCI function.  */
1201         bfa_msix_getvecs(&bfad->bfa, &mask, &num_bit, &max_bit);
1202
1203         /* Set up the msix entry table */
1204         bfad_init_msix_entry(bfad, msix_entries, mask, max_bit);
1205
1206         if ((bfa_asic_id_ctc(pdev->device) && !msix_disable_ct) ||
1207            (bfa_asic_id_cb(pdev->device) && !msix_disable_cb)) {
1208
1209                 error = pci_enable_msix_exact(bfad->pcidev,
1210                                               msix_entries, bfad->nvec);
1211                 /* In CT1 & CT2, try to allocate just one vector */
1212                 if (error == -ENOSPC && bfa_asic_id_ctc(pdev->device)) {
1213                         printk(KERN_WARNING "bfa %s: trying one msix "
1214                                "vector failed to allocate %d[%d]\n",
1215                                bfad->pci_name, bfad->nvec, error);
1216                         bfad->nvec = 1;
1217                         error = pci_enable_msix_exact(bfad->pcidev,
1218                                                       msix_entries, 1);
1219                 }
1220
1221                 if (error) {
1222                         printk(KERN_WARNING "bfad%d: "
1223                                "pci_enable_msix_exact failed (%d), "
1224                                "use line based.\n",
1225                                 bfad->inst_no, error);
1226                         goto line_based;
1227                 }
1228
1229                 /* Disable INTX in MSI-X mode */
1230                 pci_read_config_word(pdev, PCI_COMMAND, &reg);
1231
1232                 if (!(reg & PCI_COMMAND_INTX_DISABLE))
1233                         pci_write_config_word(pdev, PCI_COMMAND,
1234                                 reg | PCI_COMMAND_INTX_DISABLE);
1235
1236                 /* Save the vectors */
1237                 for (i = 0; i < bfad->nvec; i++) {
1238                         bfa_trc(bfad, msix_entries[i].vector);
1239                         bfad->msix_tab[i].msix.vector = msix_entries[i].vector;
1240                 }
1241
1242                 bfa_msix_init(&bfad->bfa, bfad->nvec);
1243
1244                 bfad->bfad_flags |= BFAD_MSIX_ON;
1245
1246                 return 0;
1247         }
1248
1249 line_based:
1250         error = request_irq(bfad->pcidev->irq, (irq_handler_t)bfad_intx,
1251                             BFAD_IRQ_FLAGS, BFAD_DRIVER_NAME, bfad);
1252         if (error)
1253                 return error;
1254
1255         bfad->bfad_flags |= BFAD_INTX_ON;
1256
1257         return 0;
1258 }
1259
1260 void
1261 bfad_remove_intr(struct bfad_s *bfad)
1262 {
1263         int     i;
1264
1265         if (bfad->bfad_flags & BFAD_MSIX_ON) {
1266                 for (i = 0; i < bfad->nvec; i++)
1267                         free_irq(bfad->msix_tab[i].msix.vector,
1268                                         &bfad->msix_tab[i]);
1269
1270                 pci_disable_msix(bfad->pcidev);
1271                 bfad->bfad_flags &= ~BFAD_MSIX_ON;
1272         } else if (bfad->bfad_flags & BFAD_INTX_ON) {
1273                 free_irq(bfad->pcidev->irq, bfad);
1274         }
1275 }
1276
1277 /*
1278  * PCI probe entry.
1279  */
1280 int
1281 bfad_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid)
1282 {
1283         struct bfad_s   *bfad;
1284         int             error = -ENODEV, retval, i;
1285
1286         /* For single port cards - only claim function 0 */
1287         if ((pdev->device == BFA_PCI_DEVICE_ID_FC_8G1P) &&
1288                 (PCI_FUNC(pdev->devfn) != 0))
1289                 return -ENODEV;
1290
1291         bfad = kzalloc(sizeof(struct bfad_s), GFP_KERNEL);
1292         if (!bfad) {
1293                 error = -ENOMEM;
1294                 goto out;
1295         }
1296
1297         bfad->trcmod = kzalloc(sizeof(struct bfa_trc_mod_s), GFP_KERNEL);
1298         if (!bfad->trcmod) {
1299                 printk(KERN_WARNING "Error alloc trace buffer!\n");
1300                 error = -ENOMEM;
1301                 goto out_alloc_trace_failure;
1302         }
1303
1304         /* TRACE INIT */
1305         bfa_trc_init(bfad->trcmod);
1306         bfa_trc(bfad, bfad_inst);
1307
1308         /* AEN INIT */
1309         INIT_LIST_HEAD(&bfad->free_aen_q);
1310         INIT_LIST_HEAD(&bfad->active_aen_q);
1311         for (i = 0; i < BFA_AEN_MAX_ENTRY; i++)
1312                 list_add_tail(&bfad->aen_list[i].qe, &bfad->free_aen_q);
1313
1314         if (!(bfad_load_fwimg(pdev))) {
1315                 kfree(bfad->trcmod);
1316                 goto out_alloc_trace_failure;
1317         }
1318
1319         retval = bfad_pci_init(pdev, bfad);
1320         if (retval) {
1321                 printk(KERN_WARNING "bfad_pci_init failure!\n");
1322                 error = retval;
1323                 goto out_pci_init_failure;
1324         }
1325
1326         mutex_lock(&bfad_mutex);
1327         bfad->inst_no = bfad_inst++;
1328         list_add_tail(&bfad->list_entry, &bfad_list);
1329         mutex_unlock(&bfad_mutex);
1330
1331         /* Initializing the state machine: State set to uninit */
1332         bfa_sm_set_state(bfad, bfad_sm_uninit);
1333
1334         spin_lock_init(&bfad->bfad_lock);
1335         spin_lock_init(&bfad->bfad_aen_spinlock);
1336
1337         pci_set_drvdata(pdev, bfad);
1338
1339         bfad->ref_count = 0;
1340         bfad->pport.bfad = bfad;
1341         INIT_LIST_HEAD(&bfad->pbc_vport_list);
1342         INIT_LIST_HEAD(&bfad->vport_list);
1343
1344         /* Setup the debugfs node for this bfad */
1345         if (bfa_debugfs_enable)
1346                 bfad_debugfs_init(&bfad->pport);
1347
1348         retval = bfad_drv_init(bfad);
1349         if (retval != BFA_STATUS_OK)
1350                 goto out_drv_init_failure;
1351
1352         bfa_sm_send_event(bfad, BFAD_E_CREATE);
1353
1354         if (bfa_sm_cmp_state(bfad, bfad_sm_uninit))
1355                 goto out_bfad_sm_failure;
1356
1357         return 0;
1358
1359 out_bfad_sm_failure:
1360         bfad_hal_mem_release(bfad);
1361 out_drv_init_failure:
1362         /* Remove the debugfs node for this bfad */
1363         kfree(bfad->regdata);
1364         bfad_debugfs_exit(&bfad->pport);
1365         mutex_lock(&bfad_mutex);
1366         bfad_inst--;
1367         list_del(&bfad->list_entry);
1368         mutex_unlock(&bfad_mutex);
1369         bfad_pci_uninit(pdev, bfad);
1370 out_pci_init_failure:
1371         kfree(bfad->trcmod);
1372 out_alloc_trace_failure:
1373         kfree(bfad);
1374 out:
1375         return error;
1376 }
1377
1378 /*
1379  * PCI remove entry.
1380  */
1381 void
1382 bfad_pci_remove(struct pci_dev *pdev)
1383 {
1384         struct bfad_s         *bfad = pci_get_drvdata(pdev);
1385         unsigned long   flags;
1386
1387         bfa_trc(bfad, bfad->inst_no);
1388
1389         spin_lock_irqsave(&bfad->bfad_lock, flags);
1390         if (bfad->bfad_tsk != NULL) {
1391                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1392                 kthread_stop(bfad->bfad_tsk);
1393         } else {
1394                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1395         }
1396
1397         /* Send Event BFAD_E_STOP */
1398         bfa_sm_send_event(bfad, BFAD_E_STOP);
1399
1400         /* Driver detach and dealloc mem */
1401         spin_lock_irqsave(&bfad->bfad_lock, flags);
1402         bfa_detach(&bfad->bfa);
1403         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1404         bfad_hal_mem_release(bfad);
1405
1406         /* Remove the debugfs node for this bfad */
1407         kfree(bfad->regdata);
1408         bfad_debugfs_exit(&bfad->pport);
1409
1410         /* Cleaning the BFAD instance */
1411         mutex_lock(&bfad_mutex);
1412         bfad_inst--;
1413         list_del(&bfad->list_entry);
1414         mutex_unlock(&bfad_mutex);
1415         bfad_pci_uninit(pdev, bfad);
1416
1417         kfree(bfad->trcmod);
1418         kfree(bfad);
1419 }
1420
1421 /*
1422  * PCI Error Recovery entry, error detected.
1423  */
1424 static pci_ers_result_t
1425 bfad_pci_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
1426 {
1427         struct bfad_s *bfad = pci_get_drvdata(pdev);
1428         unsigned long   flags;
1429         pci_ers_result_t ret = PCI_ERS_RESULT_NONE;
1430
1431         dev_printk(KERN_ERR, &pdev->dev,
1432                    "error detected state: %d - flags: 0x%x\n",
1433                    state, bfad->bfad_flags);
1434
1435         switch (state) {
1436         case pci_channel_io_normal: /* non-fatal error */
1437                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1438                 bfad->bfad_flags &= ~BFAD_EEH_BUSY;
1439                 /* Suspend/fail all bfa operations */
1440                 bfa_ioc_suspend(&bfad->bfa.ioc);
1441                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1442                 del_timer_sync(&bfad->hal_tmo);
1443                 ret = PCI_ERS_RESULT_CAN_RECOVER;
1444                 break;
1445         case pci_channel_io_frozen: /* fatal error */
1446                 init_completion(&bfad->comp);
1447                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1448                 bfad->bfad_flags |= BFAD_EEH_BUSY;
1449                 /* Suspend/fail all bfa operations */
1450                 bfa_ioc_suspend(&bfad->bfa.ioc);
1451                 bfa_fcs_stop(&bfad->bfa_fcs);
1452                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1453                 wait_for_completion(&bfad->comp);
1454
1455                 bfad_remove_intr(bfad);
1456                 del_timer_sync(&bfad->hal_tmo);
1457                 pci_disable_device(pdev);
1458                 ret = PCI_ERS_RESULT_NEED_RESET;
1459                 break;
1460         case pci_channel_io_perm_failure: /* PCI Card is DEAD */
1461                 spin_lock_irqsave(&bfad->bfad_lock, flags);
1462                 bfad->bfad_flags |= BFAD_EEH_BUSY |
1463                                     BFAD_EEH_PCI_CHANNEL_IO_PERM_FAILURE;
1464                 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1465
1466                 /* If the error_detected handler is called with the reason
1467                  * pci_channel_io_perm_failure - it will subsequently call
1468                  * pci_remove() entry point to remove the pci device from the
1469                  * system - So defer the cleanup to pci_remove(); cleaning up
1470                  * here causes inconsistent state during pci_remove().
1471                  */
1472                 ret = PCI_ERS_RESULT_DISCONNECT;
1473                 break;
1474         default:
1475                 WARN_ON(1);
1476         }
1477
1478         return ret;
1479 }
1480
1481 static int restart_bfa(struct bfad_s *bfad)
1482 {
1483         unsigned long flags;
1484         struct pci_dev *pdev = bfad->pcidev;
1485
1486         bfa_attach(&bfad->bfa, bfad, &bfad->ioc_cfg,
1487                    &bfad->meminfo, &bfad->hal_pcidev);
1488
1489         /* Enable Interrupt and wait bfa_init completion */
1490         if (bfad_setup_intr(bfad)) {
1491                 dev_printk(KERN_WARNING, &pdev->dev,
1492                            "%s: bfad_setup_intr failed\n", bfad->pci_name);
1493                 bfa_sm_send_event(bfad, BFAD_E_INIT_FAILED);
1494                 return -1;
1495         }
1496
1497         init_completion(&bfad->comp);
1498         spin_lock_irqsave(&bfad->bfad_lock, flags);
1499         bfa_iocfc_init(&bfad->bfa);
1500         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1501
1502         /* Set up interrupt handler for each vectors */
1503         if ((bfad->bfad_flags & BFAD_MSIX_ON) &&
1504             bfad_install_msix_handler(bfad))
1505                 dev_printk(KERN_WARNING, &pdev->dev,
1506                            "%s: install_msix failed.\n", bfad->pci_name);
1507
1508         bfad_init_timer(bfad);
1509         wait_for_completion(&bfad->comp);
1510         bfad_drv_start(bfad);
1511
1512         return 0;
1513 }
1514
1515 /*
1516  * PCI Error Recovery entry, re-initialize the chip.
1517  */
1518 static pci_ers_result_t
1519 bfad_pci_slot_reset(struct pci_dev *pdev)
1520 {
1521         struct bfad_s *bfad = pci_get_drvdata(pdev);
1522         u8 byte;
1523         int rc;
1524
1525         dev_printk(KERN_ERR, &pdev->dev,
1526                    "bfad_pci_slot_reset flags: 0x%x\n", bfad->bfad_flags);
1527
1528         if (pci_enable_device(pdev)) {
1529                 dev_printk(KERN_ERR, &pdev->dev, "Cannot re-enable "
1530                            "PCI device after reset.\n");
1531                 return PCI_ERS_RESULT_DISCONNECT;
1532         }
1533
1534         pci_restore_state(pdev);
1535
1536         /*
1537          * Read some byte (e.g. DMA max. payload size which can't
1538          * be 0xff any time) to make sure - we did not hit another PCI error
1539          * in the middle of recovery. If we did, then declare permanent failure.
1540          */
1541         pci_read_config_byte(pdev, 0x68, &byte);
1542         if (byte == 0xff) {
1543                 dev_printk(KERN_ERR, &pdev->dev,
1544                            "slot_reset failed ... got another PCI error !\n");
1545                 goto out_disable_device;
1546         }
1547
1548         pci_save_state(pdev);
1549         pci_set_master(pdev);
1550
1551         rc = dma_set_mask_and_coherent(&bfad->pcidev->dev, DMA_BIT_MASK(64));
1552         if (rc)
1553                 goto out_disable_device;
1554
1555         if (restart_bfa(bfad) == -1)
1556                 goto out_disable_device;
1557
1558         dev_printk(KERN_WARNING, &pdev->dev,
1559                    "slot_reset completed  flags: 0x%x!\n", bfad->bfad_flags);
1560
1561         return PCI_ERS_RESULT_RECOVERED;
1562
1563 out_disable_device:
1564         pci_disable_device(pdev);
1565         return PCI_ERS_RESULT_DISCONNECT;
1566 }
1567
1568 static pci_ers_result_t
1569 bfad_pci_mmio_enabled(struct pci_dev *pdev)
1570 {
1571         unsigned long   flags;
1572         struct bfad_s *bfad = pci_get_drvdata(pdev);
1573
1574         dev_printk(KERN_INFO, &pdev->dev, "mmio_enabled\n");
1575
1576         /* Fetch FW diagnostic information */
1577         bfa_ioc_debug_save_ftrc(&bfad->bfa.ioc);
1578
1579         /* Cancel all pending IOs */
1580         spin_lock_irqsave(&bfad->bfad_lock, flags);
1581         init_completion(&bfad->comp);
1582         bfa_fcs_stop(&bfad->bfa_fcs);
1583         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1584         wait_for_completion(&bfad->comp);
1585
1586         bfad_remove_intr(bfad);
1587         del_timer_sync(&bfad->hal_tmo);
1588         pci_disable_device(pdev);
1589
1590         return PCI_ERS_RESULT_NEED_RESET;
1591 }
1592
1593 static void
1594 bfad_pci_resume(struct pci_dev *pdev)
1595 {
1596         unsigned long   flags;
1597         struct bfad_s *bfad = pci_get_drvdata(pdev);
1598
1599         dev_printk(KERN_WARNING, &pdev->dev, "resume\n");
1600
1601         /* wait until the link is online */
1602         bfad_rport_online_wait(bfad);
1603
1604         spin_lock_irqsave(&bfad->bfad_lock, flags);
1605         bfad->bfad_flags &= ~BFAD_EEH_BUSY;
1606         spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1607 }
1608
1609 struct pci_device_id bfad_id_table[] = {
1610         {
1611                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1612                 .device = BFA_PCI_DEVICE_ID_FC_8G2P,
1613                 .subvendor = PCI_ANY_ID,
1614                 .subdevice = PCI_ANY_ID,
1615         },
1616         {
1617                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1618                 .device = BFA_PCI_DEVICE_ID_FC_8G1P,
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_CT,
1625                 .subvendor = PCI_ANY_ID,
1626                 .subdevice = PCI_ANY_ID,
1627                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1628                 .class_mask = ~0,
1629         },
1630         {
1631                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1632                 .device = BFA_PCI_DEVICE_ID_CT_FC,
1633                 .subvendor = PCI_ANY_ID,
1634                 .subdevice = PCI_ANY_ID,
1635                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1636                 .class_mask = ~0,
1637         },
1638         {
1639                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1640                 .device = BFA_PCI_DEVICE_ID_CT2,
1641                 .subvendor = PCI_ANY_ID,
1642                 .subdevice = PCI_ANY_ID,
1643                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1644                 .class_mask = ~0,
1645         },
1646
1647         {
1648                 .vendor = BFA_PCI_VENDOR_ID_BROCADE,
1649                 .device = BFA_PCI_DEVICE_ID_CT2_QUAD,
1650                 .subvendor = PCI_ANY_ID,
1651                 .subdevice = PCI_ANY_ID,
1652                 .class = (PCI_CLASS_SERIAL_FIBER << 8),
1653                 .class_mask = ~0,
1654         },
1655         {0, 0},
1656 };
1657
1658 MODULE_DEVICE_TABLE(pci, bfad_id_table);
1659
1660 /*
1661  * PCI error recovery handlers.
1662  */
1663 static struct pci_error_handlers bfad_err_handler = {
1664         .error_detected = bfad_pci_error_detected,
1665         .slot_reset = bfad_pci_slot_reset,
1666         .mmio_enabled = bfad_pci_mmio_enabled,
1667         .resume = bfad_pci_resume,
1668 };
1669
1670 static struct pci_driver bfad_pci_driver = {
1671         .name = BFAD_DRIVER_NAME,
1672         .id_table = bfad_id_table,
1673         .probe = bfad_pci_probe,
1674         .remove = bfad_pci_remove,
1675         .err_handler = &bfad_err_handler,
1676 };
1677
1678 /*
1679  * Driver module init.
1680  */
1681 static int __init
1682 bfad_init(void)
1683 {
1684         int             error = 0;
1685
1686         pr_info("QLogic BR-series BFA FC/FCOE SCSI driver - version: %s\n",
1687                         BFAD_DRIVER_VERSION);
1688
1689         if (num_sgpgs > 0)
1690                 num_sgpgs_parm = num_sgpgs;
1691
1692         error = bfad_im_module_init();
1693         if (error) {
1694                 error = -ENOMEM;
1695                 printk(KERN_WARNING "bfad_im_module_init failure\n");
1696                 goto ext;
1697         }
1698
1699         if (strcmp(FCPI_NAME, " fcpim") == 0)
1700                 supported_fc4s |= BFA_LPORT_ROLE_FCP_IM;
1701
1702         bfa_auto_recover = ioc_auto_recover;
1703         bfa_fcs_rport_set_del_timeout(rport_del_timeout);
1704         bfa_fcs_rport_set_max_logins(max_rport_logins);
1705
1706         error = pci_register_driver(&bfad_pci_driver);
1707         if (error) {
1708                 printk(KERN_WARNING "pci_register_driver failure\n");
1709                 goto ext;
1710         }
1711
1712         return 0;
1713
1714 ext:
1715         bfad_im_module_exit();
1716         return error;
1717 }
1718
1719 /*
1720  * Driver module exit.
1721  */
1722 static void __exit
1723 bfad_exit(void)
1724 {
1725         pci_unregister_driver(&bfad_pci_driver);
1726         bfad_im_module_exit();
1727         bfad_free_fwimg();
1728 }
1729
1730 /* Firmware handling */
1731 static void
1732 bfad_read_firmware(struct pci_dev *pdev, u32 **bfi_image,
1733                 u32 *bfi_image_size, char *fw_name)
1734 {
1735         const struct firmware *fw;
1736
1737         if (reject_firmware(&fw, fw_name, &pdev->dev)) {
1738                 printk(KERN_ALERT "Can't locate firmware %s\n", fw_name);
1739                 *bfi_image = NULL;
1740                 goto out;
1741         }
1742
1743         *bfi_image = vmalloc(fw->size);
1744         if (NULL == *bfi_image) {
1745                 printk(KERN_ALERT "Fail to allocate buffer for fw image "
1746                         "size=%x!\n", (u32) fw->size);
1747                 goto out;
1748         }
1749
1750         memcpy(*bfi_image, fw->data, fw->size);
1751         *bfi_image_size = fw->size/sizeof(u32);
1752 out:
1753         release_firmware(fw);
1754 }
1755
1756 static u32 *
1757 bfad_load_fwimg(struct pci_dev *pdev)
1758 {
1759         if (bfa_asic_id_ct2(pdev->device)) {
1760                 if (bfi_image_ct2_size == 0)
1761                         bfad_read_firmware(pdev, &bfi_image_ct2,
1762                                 &bfi_image_ct2_size, BFAD_FW_FILE_CT2);
1763                 return bfi_image_ct2;
1764         } else if (bfa_asic_id_ct(pdev->device)) {
1765                 if (bfi_image_ct_size == 0)
1766                         bfad_read_firmware(pdev, &bfi_image_ct,
1767                                 &bfi_image_ct_size, BFAD_FW_FILE_CT);
1768                 return bfi_image_ct;
1769         } else if (bfa_asic_id_cb(pdev->device)) {
1770                 if (bfi_image_cb_size == 0)
1771                         bfad_read_firmware(pdev, &bfi_image_cb,
1772                                 &bfi_image_cb_size, BFAD_FW_FILE_CB);
1773                 return bfi_image_cb;
1774         }
1775
1776         return NULL;
1777 }
1778
1779 static void
1780 bfad_free_fwimg(void)
1781 {
1782         if (bfi_image_ct2_size && bfi_image_ct2)
1783                 vfree(bfi_image_ct2);
1784         if (bfi_image_ct_size && bfi_image_ct)
1785                 vfree(bfi_image_ct);
1786         if (bfi_image_cb_size && bfi_image_cb)
1787                 vfree(bfi_image_cb);
1788 }
1789
1790 module_init(bfad_init);
1791 module_exit(bfad_exit);
1792 MODULE_LICENSE("GPL");
1793 MODULE_DESCRIPTION("QLogic BR-series Fibre Channel HBA Driver" BFAD_PROTO_NAME);
1794 MODULE_AUTHOR("QLogic Corporation");
1795 MODULE_VERSION(BFAD_DRIVER_VERSION);