xref: /linux/drivers/scsi/bfa/bfad.c (revision 87c9c16317882dd6dbbc07e349bc3223e14f3244)
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		"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 		rc = -ENODEV;
753 		goto out_release_region;
754 	}
755 
756 	bfad->hal_pcidev.pci_slot = PCI_SLOT(pdev->devfn);
757 	bfad->hal_pcidev.pci_func = PCI_FUNC(pdev->devfn);
758 	bfad->hal_pcidev.pci_bar_kva = bfad->pci_bar0_kva;
759 	bfad->hal_pcidev.device_id = pdev->device;
760 	bfad->hal_pcidev.ssid = pdev->subsystem_device;
761 	bfad->pci_name = pci_name(pdev);
762 
763 	bfad->pci_attr.vendor_id = pdev->vendor;
764 	bfad->pci_attr.device_id = pdev->device;
765 	bfad->pci_attr.ssid = pdev->subsystem_device;
766 	bfad->pci_attr.ssvid = pdev->subsystem_vendor;
767 	bfad->pci_attr.pcifn = PCI_FUNC(pdev->devfn);
768 
769 	bfad->pcidev = pdev;
770 
771 	/* Adjust PCIe Maximum Read Request Size */
772 	if (pci_is_pcie(pdev) && pcie_max_read_reqsz) {
773 		if (pcie_max_read_reqsz >= 128 &&
774 		    pcie_max_read_reqsz <= 4096 &&
775 		    is_power_of_2(pcie_max_read_reqsz)) {
776 			int max_rq = pcie_get_readrq(pdev);
777 			printk(KERN_WARNING "BFA[%s]: "
778 				"pcie_max_read_request_size is %d, "
779 				"reset to %d\n", bfad->pci_name, max_rq,
780 				pcie_max_read_reqsz);
781 			pcie_set_readrq(pdev, pcie_max_read_reqsz);
782 		} else {
783 			printk(KERN_WARNING "BFA[%s]: invalid "
784 			       "pcie_max_read_request_size %d ignored\n",
785 			       bfad->pci_name, pcie_max_read_reqsz);
786 		}
787 	}
788 
789 	pci_save_state(pdev);
790 
791 	return 0;
792 
793 out_release_region:
794 	pci_release_regions(pdev);
795 out_disable_device:
796 	pci_disable_device(pdev);
797 out:
798 	return rc;
799 }
800 
801 void
802 bfad_pci_uninit(struct pci_dev *pdev, struct bfad_s *bfad)
803 {
804 	pci_iounmap(pdev, bfad->pci_bar0_kva);
805 	pci_iounmap(pdev, bfad->pci_bar2_kva);
806 	pci_release_regions(pdev);
807 	/* Disable PCIE Advanced Error Recovery (AER) */
808 	pci_disable_pcie_error_reporting(pdev);
809 	pci_disable_device(pdev);
810 }
811 
812 bfa_status_t
813 bfad_drv_init(struct bfad_s *bfad)
814 {
815 	bfa_status_t	rc;
816 	unsigned long	flags;
817 
818 	bfad->cfg_data.rport_del_timeout = rport_del_timeout;
819 	bfad->cfg_data.lun_queue_depth = bfa_lun_queue_depth;
820 	bfad->cfg_data.io_max_sge = bfa_io_max_sge;
821 	bfad->cfg_data.binding_method = FCP_PWWN_BINDING;
822 
823 	rc = bfad_hal_mem_alloc(bfad);
824 	if (rc != BFA_STATUS_OK) {
825 		printk(KERN_WARNING "bfad%d bfad_hal_mem_alloc failure\n",
826 		       bfad->inst_no);
827 		printk(KERN_WARNING
828 			"Not enough memory to attach all QLogic BR-series HBA ports. System may need more memory.\n");
829 		return BFA_STATUS_FAILED;
830 	}
831 
832 	bfad->bfa.trcmod = bfad->trcmod;
833 	bfad->bfa.plog = &bfad->plog_buf;
834 	bfa_plog_init(&bfad->plog_buf);
835 	bfa_plog_str(&bfad->plog_buf, BFA_PL_MID_DRVR, BFA_PL_EID_DRIVER_START,
836 		     0, "Driver Attach");
837 
838 	bfa_attach(&bfad->bfa, bfad, &bfad->ioc_cfg, &bfad->meminfo,
839 		   &bfad->hal_pcidev);
840 
841 	/* FCS INIT */
842 	spin_lock_irqsave(&bfad->bfad_lock, flags);
843 	bfad->bfa_fcs.trcmod = bfad->trcmod;
844 	bfa_fcs_attach(&bfad->bfa_fcs, &bfad->bfa, bfad, BFA_FALSE);
845 	bfad->bfa_fcs.fdmi_enabled = fdmi_enable;
846 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
847 
848 	bfad->bfad_flags |= BFAD_DRV_INIT_DONE;
849 
850 	return BFA_STATUS_OK;
851 }
852 
853 void
854 bfad_drv_uninit(struct bfad_s *bfad)
855 {
856 	unsigned long   flags;
857 
858 	spin_lock_irqsave(&bfad->bfad_lock, flags);
859 	init_completion(&bfad->comp);
860 	bfa_iocfc_stop(&bfad->bfa);
861 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
862 	wait_for_completion(&bfad->comp);
863 
864 	del_timer_sync(&bfad->hal_tmo);
865 	bfa_isr_disable(&bfad->bfa);
866 	bfa_detach(&bfad->bfa);
867 	bfad_remove_intr(bfad);
868 	bfad_hal_mem_release(bfad);
869 
870 	bfad->bfad_flags &= ~BFAD_DRV_INIT_DONE;
871 }
872 
873 void
874 bfad_drv_start(struct bfad_s *bfad)
875 {
876 	unsigned long	flags;
877 
878 	spin_lock_irqsave(&bfad->bfad_lock, flags);
879 	bfa_iocfc_start(&bfad->bfa);
880 	bfa_fcs_pbc_vport_init(&bfad->bfa_fcs);
881 	bfa_fcs_fabric_modstart(&bfad->bfa_fcs);
882 	bfad->bfad_flags |= BFAD_HAL_START_DONE;
883 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
884 
885 	if (bfad->im)
886 		flush_workqueue(bfad->im->drv_workq);
887 }
888 
889 void
890 bfad_fcs_stop(struct bfad_s *bfad)
891 {
892 	unsigned long	flags;
893 
894 	spin_lock_irqsave(&bfad->bfad_lock, flags);
895 	init_completion(&bfad->comp);
896 	bfad->pport.flags |= BFAD_PORT_DELETE;
897 	bfa_fcs_exit(&bfad->bfa_fcs);
898 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
899 	wait_for_completion(&bfad->comp);
900 
901 	bfa_sm_send_event(bfad, BFAD_E_FCS_EXIT_COMP);
902 }
903 
904 void
905 bfad_stop(struct bfad_s *bfad)
906 {
907 	unsigned long	flags;
908 
909 	spin_lock_irqsave(&bfad->bfad_lock, flags);
910 	init_completion(&bfad->comp);
911 	bfa_iocfc_stop(&bfad->bfa);
912 	bfad->bfad_flags &= ~BFAD_HAL_START_DONE;
913 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
914 	wait_for_completion(&bfad->comp);
915 
916 	bfa_sm_send_event(bfad, BFAD_E_EXIT_COMP);
917 }
918 
919 bfa_status_t
920 bfad_cfg_pport(struct bfad_s *bfad, enum bfa_lport_role role)
921 {
922 	int		rc = BFA_STATUS_OK;
923 
924 	/* Allocate scsi_host for the physical port */
925 	if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
926 	    (role & BFA_LPORT_ROLE_FCP_IM)) {
927 		if (bfad->pport.im_port == NULL) {
928 			rc = BFA_STATUS_FAILED;
929 			goto out;
930 		}
931 
932 		rc = bfad_im_scsi_host_alloc(bfad, bfad->pport.im_port,
933 						&bfad->pcidev->dev);
934 		if (rc != BFA_STATUS_OK)
935 			goto out;
936 
937 		bfad->pport.roles |= BFA_LPORT_ROLE_FCP_IM;
938 	}
939 
940 	bfad->bfad_flags |= BFAD_CFG_PPORT_DONE;
941 
942 out:
943 	return rc;
944 }
945 
946 void
947 bfad_uncfg_pport(struct bfad_s *bfad)
948 {
949 	if ((supported_fc4s & BFA_LPORT_ROLE_FCP_IM) &&
950 	    (bfad->pport.roles & BFA_LPORT_ROLE_FCP_IM)) {
951 		bfad_im_scsi_host_free(bfad, bfad->pport.im_port);
952 		bfad_im_port_clean(bfad->pport.im_port);
953 		kfree(bfad->pport.im_port);
954 		bfad->pport.roles &= ~BFA_LPORT_ROLE_FCP_IM;
955 	}
956 
957 	bfad->bfad_flags &= ~BFAD_CFG_PPORT_DONE;
958 }
959 
960 bfa_status_t
961 bfad_start_ops(struct bfad_s *bfad) {
962 
963 	int	retval;
964 	unsigned long	flags;
965 	struct bfad_vport_s *vport, *vport_new;
966 	struct bfa_fcs_driver_info_s driver_info;
967 
968 	/* Limit min/max. xfer size to [64k-32MB] */
969 	if (max_xfer_size < BFAD_MIN_SECTORS >> 1)
970 		max_xfer_size = BFAD_MIN_SECTORS >> 1;
971 	if (max_xfer_size > BFAD_MAX_SECTORS >> 1)
972 		max_xfer_size = BFAD_MAX_SECTORS >> 1;
973 
974 	/* Fill the driver_info info to fcs*/
975 	memset(&driver_info, 0, sizeof(driver_info));
976 	strlcpy(driver_info.version, BFAD_DRIVER_VERSION,
977 		sizeof(driver_info.version));
978 	if (host_name)
979 		strlcpy(driver_info.host_machine_name, host_name,
980 			sizeof(driver_info.host_machine_name));
981 	if (os_name)
982 		strlcpy(driver_info.host_os_name, os_name,
983 			sizeof(driver_info.host_os_name));
984 	if (os_patch)
985 		strlcpy(driver_info.host_os_patch, os_patch,
986 			sizeof(driver_info.host_os_patch));
987 
988 	strlcpy(driver_info.os_device_name, bfad->pci_name,
989 		sizeof(driver_info.os_device_name));
990 
991 	/* FCS driver info init */
992 	spin_lock_irqsave(&bfad->bfad_lock, flags);
993 	bfa_fcs_driver_info_init(&bfad->bfa_fcs, &driver_info);
994 
995 	if (bfad->bfad_flags & BFAD_CFG_PPORT_DONE)
996 		bfa_fcs_update_cfg(&bfad->bfa_fcs);
997 	else
998 		bfa_fcs_init(&bfad->bfa_fcs);
999 
1000 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1001 
1002 	if (!(bfad->bfad_flags & BFAD_CFG_PPORT_DONE)) {
1003 		retval = bfad_cfg_pport(bfad, BFA_LPORT_ROLE_FCP_IM);
1004 		if (retval != BFA_STATUS_OK)
1005 			return BFA_STATUS_FAILED;
1006 	}
1007 
1008 	/* Setup fc host fixed attribute if the lk supports */
1009 	bfad_fc_host_init(bfad->pport.im_port);
1010 
1011 	/* BFAD level FC4 IM specific resource allocation */
1012 	retval = bfad_im_probe(bfad);
1013 	if (retval != BFA_STATUS_OK) {
1014 		printk(KERN_WARNING "bfad_im_probe failed\n");
1015 		if (bfa_sm_cmp_state(bfad, bfad_sm_initializing))
1016 			bfa_sm_set_state(bfad, bfad_sm_failed);
1017 		return BFA_STATUS_FAILED;
1018 	} else
1019 		bfad->bfad_flags |= BFAD_FC4_PROBE_DONE;
1020 
1021 	bfad_drv_start(bfad);
1022 
1023 	/* Complete pbc vport create */
1024 	list_for_each_entry_safe(vport, vport_new, &bfad->pbc_vport_list,
1025 				list_entry) {
1026 		struct fc_vport_identifiers vid;
1027 		struct fc_vport *fc_vport;
1028 		char pwwn_buf[BFA_STRING_32];
1029 
1030 		memset(&vid, 0, sizeof(vid));
1031 		vid.roles = FC_PORT_ROLE_FCP_INITIATOR;
1032 		vid.vport_type = FC_PORTTYPE_NPIV;
1033 		vid.disable = false;
1034 		vid.node_name = wwn_to_u64((u8 *)
1035 				(&((vport->fcs_vport).lport.port_cfg.nwwn)));
1036 		vid.port_name = wwn_to_u64((u8 *)
1037 				(&((vport->fcs_vport).lport.port_cfg.pwwn)));
1038 		fc_vport = fc_vport_create(bfad->pport.im_port->shost, 0, &vid);
1039 		if (!fc_vport) {
1040 			wwn2str(pwwn_buf, vid.port_name);
1041 			printk(KERN_WARNING "bfad%d: failed to create pbc vport"
1042 				" %s\n", bfad->inst_no, pwwn_buf);
1043 		}
1044 		list_del(&vport->list_entry);
1045 		kfree(vport);
1046 	}
1047 
1048 	/*
1049 	 * If bfa_linkup_delay is set to -1 default; try to retrive the
1050 	 * value using the bfad_get_linkup_delay(); else use the
1051 	 * passed in module param value as the bfa_linkup_delay.
1052 	 */
1053 	if (bfa_linkup_delay < 0) {
1054 		bfa_linkup_delay = bfad_get_linkup_delay(bfad);
1055 		bfad_rport_online_wait(bfad);
1056 		bfa_linkup_delay = -1;
1057 	} else
1058 		bfad_rport_online_wait(bfad);
1059 
1060 	BFA_LOG(KERN_INFO, bfad, bfa_log_level, "bfa device claimed\n");
1061 
1062 	return BFA_STATUS_OK;
1063 }
1064 
1065 int
1066 bfad_worker(void *ptr)
1067 {
1068 	struct bfad_s *bfad = ptr;
1069 	unsigned long flags;
1070 
1071 	if (kthread_should_stop())
1072 		return 0;
1073 
1074 	/* Send event BFAD_E_INIT_SUCCESS */
1075 	bfa_sm_send_event(bfad, BFAD_E_INIT_SUCCESS);
1076 
1077 	spin_lock_irqsave(&bfad->bfad_lock, flags);
1078 	bfad->bfad_tsk = NULL;
1079 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1080 
1081 	return 0;
1082 }
1083 
1084 /*
1085  *  BFA driver interrupt functions
1086  */
1087 irqreturn_t
1088 bfad_intx(int irq, void *dev_id)
1089 {
1090 	struct bfad_s	*bfad = dev_id;
1091 	struct list_head	doneq;
1092 	unsigned long	flags;
1093 	bfa_boolean_t rc;
1094 
1095 	spin_lock_irqsave(&bfad->bfad_lock, flags);
1096 	rc = bfa_intx(&bfad->bfa);
1097 	if (!rc) {
1098 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1099 		return IRQ_NONE;
1100 	}
1101 
1102 	bfa_comp_deq(&bfad->bfa, &doneq);
1103 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1104 
1105 	if (!list_empty(&doneq)) {
1106 		bfa_comp_process(&bfad->bfa, &doneq);
1107 
1108 		spin_lock_irqsave(&bfad->bfad_lock, flags);
1109 		bfa_comp_free(&bfad->bfa, &doneq);
1110 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1111 	}
1112 
1113 	return IRQ_HANDLED;
1114 
1115 }
1116 
1117 static irqreturn_t
1118 bfad_msix(int irq, void *dev_id)
1119 {
1120 	struct bfad_msix_s *vec = dev_id;
1121 	struct bfad_s *bfad = vec->bfad;
1122 	struct list_head doneq;
1123 	unsigned long   flags;
1124 
1125 	spin_lock_irqsave(&bfad->bfad_lock, flags);
1126 
1127 	bfa_msix(&bfad->bfa, vec->msix.entry);
1128 	bfa_comp_deq(&bfad->bfa, &doneq);
1129 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1130 
1131 	if (!list_empty(&doneq)) {
1132 		bfa_comp_process(&bfad->bfa, &doneq);
1133 
1134 		spin_lock_irqsave(&bfad->bfad_lock, flags);
1135 		bfa_comp_free(&bfad->bfa, &doneq);
1136 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1137 	}
1138 
1139 	return IRQ_HANDLED;
1140 }
1141 
1142 /*
1143  * Initialize the MSIX entry table.
1144  */
1145 static void
1146 bfad_init_msix_entry(struct bfad_s *bfad, struct msix_entry *msix_entries,
1147 			 int mask, int max_bit)
1148 {
1149 	int	i;
1150 	int	match = 0x00000001;
1151 
1152 	for (i = 0, bfad->nvec = 0; i < MAX_MSIX_ENTRY; i++) {
1153 		if (mask & match) {
1154 			bfad->msix_tab[bfad->nvec].msix.entry = i;
1155 			bfad->msix_tab[bfad->nvec].bfad = bfad;
1156 			msix_entries[bfad->nvec].entry = i;
1157 			bfad->nvec++;
1158 		}
1159 
1160 		match <<= 1;
1161 	}
1162 
1163 }
1164 
1165 int
1166 bfad_install_msix_handler(struct bfad_s *bfad)
1167 {
1168 	int i, error = 0;
1169 
1170 	for (i = 0; i < bfad->nvec; i++) {
1171 		sprintf(bfad->msix_tab[i].name, "bfa-%s-%s",
1172 				bfad->pci_name,
1173 				((bfa_asic_id_cb(bfad->hal_pcidev.device_id)) ?
1174 				msix_name_cb[i] : msix_name_ct[i]));
1175 
1176 		error = request_irq(bfad->msix_tab[i].msix.vector,
1177 				    (irq_handler_t) bfad_msix, 0,
1178 				    bfad->msix_tab[i].name, &bfad->msix_tab[i]);
1179 		bfa_trc(bfad, i);
1180 		bfa_trc(bfad, bfad->msix_tab[i].msix.vector);
1181 		if (error) {
1182 			int	j;
1183 
1184 			for (j = 0; j < i; j++)
1185 				free_irq(bfad->msix_tab[j].msix.vector,
1186 						&bfad->msix_tab[j]);
1187 
1188 			bfad->bfad_flags &= ~BFAD_MSIX_ON;
1189 			pci_disable_msix(bfad->pcidev);
1190 
1191 			return 1;
1192 		}
1193 	}
1194 
1195 	return 0;
1196 }
1197 
1198 /*
1199  * Setup MSIX based interrupt.
1200  */
1201 int
1202 bfad_setup_intr(struct bfad_s *bfad)
1203 {
1204 	int error;
1205 	u32 mask = 0, i, num_bit = 0, max_bit = 0;
1206 	struct msix_entry msix_entries[MAX_MSIX_ENTRY];
1207 	struct pci_dev *pdev = bfad->pcidev;
1208 	u16	reg;
1209 
1210 	/* Call BFA to get the msix map for this PCI function.  */
1211 	bfa_msix_getvecs(&bfad->bfa, &mask, &num_bit, &max_bit);
1212 
1213 	/* Set up the msix entry table */
1214 	bfad_init_msix_entry(bfad, msix_entries, mask, max_bit);
1215 
1216 	if ((bfa_asic_id_ctc(pdev->device) && !msix_disable_ct) ||
1217 	   (bfa_asic_id_cb(pdev->device) && !msix_disable_cb)) {
1218 
1219 		error = pci_enable_msix_exact(bfad->pcidev,
1220 					      msix_entries, bfad->nvec);
1221 		/* In CT1 & CT2, try to allocate just one vector */
1222 		if (error == -ENOSPC && bfa_asic_id_ctc(pdev->device)) {
1223 			printk(KERN_WARNING "bfa %s: trying one msix "
1224 			       "vector failed to allocate %d[%d]\n",
1225 			       bfad->pci_name, bfad->nvec, error);
1226 			bfad->nvec = 1;
1227 			error = pci_enable_msix_exact(bfad->pcidev,
1228 						      msix_entries, 1);
1229 		}
1230 
1231 		if (error) {
1232 			printk(KERN_WARNING "bfad%d: "
1233 			       "pci_enable_msix_exact failed (%d), "
1234 			       "use line based.\n",
1235 				bfad->inst_no, error);
1236 			goto line_based;
1237 		}
1238 
1239 		/* Disable INTX in MSI-X mode */
1240 		pci_read_config_word(pdev, PCI_COMMAND, &reg);
1241 
1242 		if (!(reg & PCI_COMMAND_INTX_DISABLE))
1243 			pci_write_config_word(pdev, PCI_COMMAND,
1244 				reg | PCI_COMMAND_INTX_DISABLE);
1245 
1246 		/* Save the vectors */
1247 		for (i = 0; i < bfad->nvec; i++) {
1248 			bfa_trc(bfad, msix_entries[i].vector);
1249 			bfad->msix_tab[i].msix.vector = msix_entries[i].vector;
1250 		}
1251 
1252 		bfa_msix_init(&bfad->bfa, bfad->nvec);
1253 
1254 		bfad->bfad_flags |= BFAD_MSIX_ON;
1255 
1256 		return 0;
1257 	}
1258 
1259 line_based:
1260 	error = request_irq(bfad->pcidev->irq, (irq_handler_t)bfad_intx,
1261 			    BFAD_IRQ_FLAGS, BFAD_DRIVER_NAME, bfad);
1262 	if (error)
1263 		return error;
1264 
1265 	bfad->bfad_flags |= BFAD_INTX_ON;
1266 
1267 	return 0;
1268 }
1269 
1270 void
1271 bfad_remove_intr(struct bfad_s *bfad)
1272 {
1273 	int	i;
1274 
1275 	if (bfad->bfad_flags & BFAD_MSIX_ON) {
1276 		for (i = 0; i < bfad->nvec; i++)
1277 			free_irq(bfad->msix_tab[i].msix.vector,
1278 					&bfad->msix_tab[i]);
1279 
1280 		pci_disable_msix(bfad->pcidev);
1281 		bfad->bfad_flags &= ~BFAD_MSIX_ON;
1282 	} else if (bfad->bfad_flags & BFAD_INTX_ON) {
1283 		free_irq(bfad->pcidev->irq, bfad);
1284 	}
1285 }
1286 
1287 /*
1288  * PCI probe entry.
1289  */
1290 int
1291 bfad_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pid)
1292 {
1293 	struct bfad_s	*bfad;
1294 	int		error = -ENODEV, retval, i;
1295 
1296 	/* For single port cards - only claim function 0 */
1297 	if ((pdev->device == BFA_PCI_DEVICE_ID_FC_8G1P) &&
1298 		(PCI_FUNC(pdev->devfn) != 0))
1299 		return -ENODEV;
1300 
1301 	bfad = kzalloc(sizeof(struct bfad_s), GFP_KERNEL);
1302 	if (!bfad) {
1303 		error = -ENOMEM;
1304 		goto out;
1305 	}
1306 
1307 	bfad->trcmod = kzalloc(sizeof(struct bfa_trc_mod_s), GFP_KERNEL);
1308 	if (!bfad->trcmod) {
1309 		printk(KERN_WARNING "Error alloc trace buffer!\n");
1310 		error = -ENOMEM;
1311 		goto out_alloc_trace_failure;
1312 	}
1313 
1314 	/* TRACE INIT */
1315 	bfa_trc_init(bfad->trcmod);
1316 	bfa_trc(bfad, bfad_inst);
1317 
1318 	/* AEN INIT */
1319 	INIT_LIST_HEAD(&bfad->free_aen_q);
1320 	INIT_LIST_HEAD(&bfad->active_aen_q);
1321 	for (i = 0; i < BFA_AEN_MAX_ENTRY; i++)
1322 		list_add_tail(&bfad->aen_list[i].qe, &bfad->free_aen_q);
1323 
1324 	if (!(bfad_load_fwimg(pdev))) {
1325 		kfree(bfad->trcmod);
1326 		goto out_alloc_trace_failure;
1327 	}
1328 
1329 	retval = bfad_pci_init(pdev, bfad);
1330 	if (retval) {
1331 		printk(KERN_WARNING "bfad_pci_init failure!\n");
1332 		error = retval;
1333 		goto out_pci_init_failure;
1334 	}
1335 
1336 	mutex_lock(&bfad_mutex);
1337 	bfad->inst_no = bfad_inst++;
1338 	list_add_tail(&bfad->list_entry, &bfad_list);
1339 	mutex_unlock(&bfad_mutex);
1340 
1341 	/* Initializing the state machine: State set to uninit */
1342 	bfa_sm_set_state(bfad, bfad_sm_uninit);
1343 
1344 	spin_lock_init(&bfad->bfad_lock);
1345 	spin_lock_init(&bfad->bfad_aen_spinlock);
1346 
1347 	pci_set_drvdata(pdev, bfad);
1348 
1349 	bfad->ref_count = 0;
1350 	bfad->pport.bfad = bfad;
1351 	INIT_LIST_HEAD(&bfad->pbc_vport_list);
1352 	INIT_LIST_HEAD(&bfad->vport_list);
1353 
1354 	/* Setup the debugfs node for this bfad */
1355 	if (bfa_debugfs_enable)
1356 		bfad_debugfs_init(&bfad->pport);
1357 
1358 	retval = bfad_drv_init(bfad);
1359 	if (retval != BFA_STATUS_OK)
1360 		goto out_drv_init_failure;
1361 
1362 	bfa_sm_send_event(bfad, BFAD_E_CREATE);
1363 
1364 	if (bfa_sm_cmp_state(bfad, bfad_sm_uninit))
1365 		goto out_bfad_sm_failure;
1366 
1367 	return 0;
1368 
1369 out_bfad_sm_failure:
1370 	bfad_hal_mem_release(bfad);
1371 out_drv_init_failure:
1372 	/* Remove the debugfs node for this bfad */
1373 	kfree(bfad->regdata);
1374 	bfad_debugfs_exit(&bfad->pport);
1375 	mutex_lock(&bfad_mutex);
1376 	bfad_inst--;
1377 	list_del(&bfad->list_entry);
1378 	mutex_unlock(&bfad_mutex);
1379 	bfad_pci_uninit(pdev, bfad);
1380 out_pci_init_failure:
1381 	kfree(bfad->trcmod);
1382 out_alloc_trace_failure:
1383 	kfree(bfad);
1384 out:
1385 	return error;
1386 }
1387 
1388 /*
1389  * PCI remove entry.
1390  */
1391 void
1392 bfad_pci_remove(struct pci_dev *pdev)
1393 {
1394 	struct bfad_s	      *bfad = pci_get_drvdata(pdev);
1395 	unsigned long	flags;
1396 
1397 	bfa_trc(bfad, bfad->inst_no);
1398 
1399 	spin_lock_irqsave(&bfad->bfad_lock, flags);
1400 	if (bfad->bfad_tsk != NULL) {
1401 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1402 		kthread_stop(bfad->bfad_tsk);
1403 	} else {
1404 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1405 	}
1406 
1407 	/* Send Event BFAD_E_STOP */
1408 	bfa_sm_send_event(bfad, BFAD_E_STOP);
1409 
1410 	/* Driver detach and dealloc mem */
1411 	spin_lock_irqsave(&bfad->bfad_lock, flags);
1412 	bfa_detach(&bfad->bfa);
1413 	spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1414 	bfad_hal_mem_release(bfad);
1415 
1416 	/* Remove the debugfs node for this bfad */
1417 	kfree(bfad->regdata);
1418 	bfad_debugfs_exit(&bfad->pport);
1419 
1420 	/* Cleaning the BFAD instance */
1421 	mutex_lock(&bfad_mutex);
1422 	bfad_inst--;
1423 	list_del(&bfad->list_entry);
1424 	mutex_unlock(&bfad_mutex);
1425 	bfad_pci_uninit(pdev, bfad);
1426 
1427 	kfree(bfad->trcmod);
1428 	kfree(bfad);
1429 }
1430 
1431 /*
1432  * PCI Error Recovery entry, error detected.
1433  */
1434 static pci_ers_result_t
1435 bfad_pci_error_detected(struct pci_dev *pdev, pci_channel_state_t state)
1436 {
1437 	struct bfad_s *bfad = pci_get_drvdata(pdev);
1438 	unsigned long	flags;
1439 	pci_ers_result_t ret = PCI_ERS_RESULT_NONE;
1440 
1441 	dev_printk(KERN_ERR, &pdev->dev,
1442 		   "error detected state: %d - flags: 0x%x\n",
1443 		   state, bfad->bfad_flags);
1444 
1445 	switch (state) {
1446 	case pci_channel_io_normal: /* non-fatal error */
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 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1452 		del_timer_sync(&bfad->hal_tmo);
1453 		ret = PCI_ERS_RESULT_CAN_RECOVER;
1454 		break;
1455 	case pci_channel_io_frozen: /* fatal error */
1456 		init_completion(&bfad->comp);
1457 		spin_lock_irqsave(&bfad->bfad_lock, flags);
1458 		bfad->bfad_flags |= BFAD_EEH_BUSY;
1459 		/* Suspend/fail all bfa operations */
1460 		bfa_ioc_suspend(&bfad->bfa.ioc);
1461 		bfa_fcs_stop(&bfad->bfa_fcs);
1462 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1463 		wait_for_completion(&bfad->comp);
1464 
1465 		bfad_remove_intr(bfad);
1466 		del_timer_sync(&bfad->hal_tmo);
1467 		pci_disable_device(pdev);
1468 		ret = PCI_ERS_RESULT_NEED_RESET;
1469 		break;
1470 	case pci_channel_io_perm_failure: /* PCI Card is DEAD */
1471 		spin_lock_irqsave(&bfad->bfad_lock, flags);
1472 		bfad->bfad_flags |= BFAD_EEH_BUSY |
1473 				    BFAD_EEH_PCI_CHANNEL_IO_PERM_FAILURE;
1474 		spin_unlock_irqrestore(&bfad->bfad_lock, flags);
1475 
1476 		/* If the error_detected handler is called with the reason
1477 		 * pci_channel_io_perm_failure - it will subsequently call
1478 		 * pci_remove() entry point to remove the pci device from the
1479 		 * system - So defer the cleanup to pci_remove(); cleaning up
1480 		 * here causes inconsistent state during pci_remove().
1481 		 */
1482 		ret = PCI_ERS_RESULT_DISCONNECT;
1483 		break;
1484 	default:
1485 		WARN_ON(1);
1486 	}
1487 
1488 	return ret;
1489 }
1490 
1491 static int 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);
1810