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