xref: /linux/drivers/scsi/qla2xxx/qla_init.c (revision 2b8232ce512105e28453f301d1510de8363bccd1)
1 /*
2  * QLogic Fibre Channel HBA Driver
3  * Copyright (c)  2003-2005 QLogic Corporation
4  *
5  * See LICENSE.qla2xxx for copyright and licensing details.
6  */
7 #include "qla_def.h"
8 
9 #include <linux/delay.h>
10 #include <linux/vmalloc.h>
11 
12 #include "qla_devtbl.h"
13 
14 #ifdef CONFIG_SPARC
15 #include <asm/prom.h>
16 #endif
17 
18 /* XXX(hch): this is ugly, but we don't want to pull in exioctl.h */
19 #ifndef EXT_IS_LUN_BIT_SET
20 #define EXT_IS_LUN_BIT_SET(P,L) \
21     (((P)->mask[L/8] & (0x80 >> (L%8)))?1:0)
22 #define EXT_SET_LUN_BIT(P,L) \
23     ((P)->mask[L/8] |= (0x80 >> (L%8)))
24 #endif
25 
26 /*
27 *  QLogic ISP2x00 Hardware Support Function Prototypes.
28 */
29 static int qla2x00_isp_firmware(scsi_qla_host_t *);
30 static void qla2x00_resize_request_q(scsi_qla_host_t *);
31 static int qla2x00_setup_chip(scsi_qla_host_t *);
32 static void qla2x00_init_response_q_entries(scsi_qla_host_t *);
33 static int qla2x00_init_rings(scsi_qla_host_t *);
34 static int qla2x00_fw_ready(scsi_qla_host_t *);
35 static int qla2x00_configure_hba(scsi_qla_host_t *);
36 static int qla2x00_configure_loop(scsi_qla_host_t *);
37 static int qla2x00_configure_local_loop(scsi_qla_host_t *);
38 static int qla2x00_configure_fabric(scsi_qla_host_t *);
39 static int qla2x00_find_all_fabric_devs(scsi_qla_host_t *, struct list_head *);
40 static int qla2x00_device_resync(scsi_qla_host_t *);
41 static int qla2x00_fabric_dev_login(scsi_qla_host_t *, fc_port_t *,
42     uint16_t *);
43 
44 static int qla2x00_restart_isp(scsi_qla_host_t *);
45 
46 static int qla2x00_find_new_loop_id(scsi_qla_host_t *ha, fc_port_t *dev);
47 
48 /****************************************************************************/
49 /*                QLogic ISP2x00 Hardware Support Functions.                */
50 /****************************************************************************/
51 
52 /*
53 * qla2x00_initialize_adapter
54 *      Initialize board.
55 *
56 * Input:
57 *      ha = adapter block pointer.
58 *
59 * Returns:
60 *      0 = success
61 */
62 int
63 qla2x00_initialize_adapter(scsi_qla_host_t *ha)
64 {
65 	int	rval;
66 
67 	/* Clear adapter flags. */
68 	ha->flags.online = 0;
69 	ha->flags.reset_active = 0;
70 	atomic_set(&ha->loop_down_timer, LOOP_DOWN_TIME);
71 	atomic_set(&ha->loop_state, LOOP_DOWN);
72 	ha->device_flags = DFLG_NO_CABLE;
73 	ha->dpc_flags = 0;
74 	ha->flags.management_server_logged_in = 0;
75 	ha->marker_needed = 0;
76 	ha->mbx_flags = 0;
77 	ha->isp_abort_cnt = 0;
78 	ha->beacon_blink_led = 0;
79 	set_bit(REGISTER_FDMI_NEEDED, &ha->dpc_flags);
80 
81 	qla_printk(KERN_INFO, ha, "Configuring PCI space...\n");
82 	rval = ha->isp_ops->pci_config(ha);
83 	if (rval) {
84 		DEBUG2(printk("scsi(%ld): Unable to configure PCI space.\n",
85 		    ha->host_no));
86 		return (rval);
87 	}
88 
89 	ha->isp_ops->reset_chip(ha);
90 
91 	ha->isp_ops->get_flash_version(ha, ha->request_ring);
92 
93 	qla_printk(KERN_INFO, ha, "Configure NVRAM parameters...\n");
94 
95 	ha->isp_ops->nvram_config(ha);
96 
97 	if (ha->flags.disable_serdes) {
98 		/* Mask HBA via NVRAM settings? */
99 		qla_printk(KERN_INFO, ha, "Masking HBA WWPN "
100 		    "%02x%02x%02x%02x%02x%02x%02x%02x (via NVRAM).\n",
101 		    ha->port_name[0], ha->port_name[1],
102 		    ha->port_name[2], ha->port_name[3],
103 		    ha->port_name[4], ha->port_name[5],
104 		    ha->port_name[6], ha->port_name[7]);
105 		return QLA_FUNCTION_FAILED;
106 	}
107 
108 	qla_printk(KERN_INFO, ha, "Verifying loaded RISC code...\n");
109 
110 	if (qla2x00_isp_firmware(ha) != QLA_SUCCESS) {
111 		rval = ha->isp_ops->chip_diag(ha);
112 		if (rval)
113 			return (rval);
114 		rval = qla2x00_setup_chip(ha);
115 		if (rval)
116 			return (rval);
117 	}
118 	rval = qla2x00_init_rings(ha);
119 
120 	return (rval);
121 }
122 
123 /**
124  * qla2100_pci_config() - Setup ISP21xx PCI configuration registers.
125  * @ha: HA context
126  *
127  * Returns 0 on success.
128  */
129 int
130 qla2100_pci_config(scsi_qla_host_t *ha)
131 {
132 	uint16_t w;
133 	uint32_t d;
134 	unsigned long flags;
135 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
136 
137 	pci_set_master(ha->pdev);
138 	pci_try_set_mwi(ha->pdev);
139 
140 	pci_read_config_word(ha->pdev, PCI_COMMAND, &w);
141 	w |= (PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
142 	pci_write_config_word(ha->pdev, PCI_COMMAND, w);
143 
144 	/* Reset expansion ROM address decode enable */
145 	pci_read_config_dword(ha->pdev, PCI_ROM_ADDRESS, &d);
146 	d &= ~PCI_ROM_ADDRESS_ENABLE;
147 	pci_write_config_dword(ha->pdev, PCI_ROM_ADDRESS, d);
148 
149 	/* Get PCI bus information. */
150 	spin_lock_irqsave(&ha->hardware_lock, flags);
151 	ha->pci_attr = RD_REG_WORD(&reg->ctrl_status);
152 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
153 
154 	return QLA_SUCCESS;
155 }
156 
157 /**
158  * qla2300_pci_config() - Setup ISP23xx PCI configuration registers.
159  * @ha: HA context
160  *
161  * Returns 0 on success.
162  */
163 int
164 qla2300_pci_config(scsi_qla_host_t *ha)
165 {
166 	uint16_t	w;
167 	uint32_t	d;
168 	unsigned long   flags = 0;
169 	uint32_t	cnt;
170 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
171 
172 	pci_set_master(ha->pdev);
173 	pci_try_set_mwi(ha->pdev);
174 
175 	pci_read_config_word(ha->pdev, PCI_COMMAND, &w);
176 	w |= (PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
177 
178 	if (IS_QLA2322(ha) || IS_QLA6322(ha))
179 		w &= ~PCI_COMMAND_INTX_DISABLE;
180 	pci_write_config_word(ha->pdev, PCI_COMMAND, w);
181 
182 	/*
183 	 * If this is a 2300 card and not 2312, reset the
184 	 * COMMAND_INVALIDATE due to a bug in the 2300. Unfortunately,
185 	 * the 2310 also reports itself as a 2300 so we need to get the
186 	 * fb revision level -- a 6 indicates it really is a 2300 and
187 	 * not a 2310.
188 	 */
189 	if (IS_QLA2300(ha)) {
190 		spin_lock_irqsave(&ha->hardware_lock, flags);
191 
192 		/* Pause RISC. */
193 		WRT_REG_WORD(&reg->hccr, HCCR_PAUSE_RISC);
194 		for (cnt = 0; cnt < 30000; cnt++) {
195 			if ((RD_REG_WORD(&reg->hccr) & HCCR_RISC_PAUSE) != 0)
196 				break;
197 
198 			udelay(10);
199 		}
200 
201 		/* Select FPM registers. */
202 		WRT_REG_WORD(&reg->ctrl_status, 0x20);
203 		RD_REG_WORD(&reg->ctrl_status);
204 
205 		/* Get the fb rev level */
206 		ha->fb_rev = RD_FB_CMD_REG(ha, reg);
207 
208 		if (ha->fb_rev == FPM_2300)
209 			pci_clear_mwi(ha->pdev);
210 
211 		/* Deselect FPM registers. */
212 		WRT_REG_WORD(&reg->ctrl_status, 0x0);
213 		RD_REG_WORD(&reg->ctrl_status);
214 
215 		/* Release RISC module. */
216 		WRT_REG_WORD(&reg->hccr, HCCR_RELEASE_RISC);
217 		for (cnt = 0; cnt < 30000; cnt++) {
218 			if ((RD_REG_WORD(&reg->hccr) & HCCR_RISC_PAUSE) == 0)
219 				break;
220 
221 			udelay(10);
222 		}
223 
224 		spin_unlock_irqrestore(&ha->hardware_lock, flags);
225 	}
226 
227 	pci_write_config_byte(ha->pdev, PCI_LATENCY_TIMER, 0x80);
228 
229 	/* Reset expansion ROM address decode enable */
230 	pci_read_config_dword(ha->pdev, PCI_ROM_ADDRESS, &d);
231 	d &= ~PCI_ROM_ADDRESS_ENABLE;
232 	pci_write_config_dword(ha->pdev, PCI_ROM_ADDRESS, d);
233 
234 	/* Get PCI bus information. */
235 	spin_lock_irqsave(&ha->hardware_lock, flags);
236 	ha->pci_attr = RD_REG_WORD(&reg->ctrl_status);
237 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
238 
239 	return QLA_SUCCESS;
240 }
241 
242 /**
243  * qla24xx_pci_config() - Setup ISP24xx PCI configuration registers.
244  * @ha: HA context
245  *
246  * Returns 0 on success.
247  */
248 int
249 qla24xx_pci_config(scsi_qla_host_t *ha)
250 {
251 	uint16_t w;
252 	uint32_t d;
253 	unsigned long flags = 0;
254 	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
255 
256 	pci_set_master(ha->pdev);
257 	pci_try_set_mwi(ha->pdev);
258 
259 	pci_read_config_word(ha->pdev, PCI_COMMAND, &w);
260 	w |= (PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
261 	w &= ~PCI_COMMAND_INTX_DISABLE;
262 	pci_write_config_word(ha->pdev, PCI_COMMAND, w);
263 
264 	pci_write_config_byte(ha->pdev, PCI_LATENCY_TIMER, 0x80);
265 
266 	/* PCI-X -- adjust Maximum Memory Read Byte Count (2048). */
267 	if (pci_find_capability(ha->pdev, PCI_CAP_ID_PCIX))
268 		pcix_set_mmrbc(ha->pdev, 2048);
269 
270 	/* PCIe -- adjust Maximum Read Request Size (2048). */
271 	if (pci_find_capability(ha->pdev, PCI_CAP_ID_EXP))
272 		pcie_set_readrq(ha->pdev, 2048);
273 
274 	/* Reset expansion ROM address decode enable */
275 	pci_read_config_dword(ha->pdev, PCI_ROM_ADDRESS, &d);
276 	d &= ~PCI_ROM_ADDRESS_ENABLE;
277 	pci_write_config_dword(ha->pdev, PCI_ROM_ADDRESS, d);
278 
279 	ha->chip_revision = ha->pdev->revision;
280 
281 	/* Get PCI bus information. */
282 	spin_lock_irqsave(&ha->hardware_lock, flags);
283 	ha->pci_attr = RD_REG_DWORD(&reg->ctrl_status);
284 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
285 
286 	return QLA_SUCCESS;
287 }
288 
289 /**
290  * qla25xx_pci_config() - Setup ISP25xx PCI configuration registers.
291  * @ha: HA context
292  *
293  * Returns 0 on success.
294  */
295 int
296 qla25xx_pci_config(scsi_qla_host_t *ha)
297 {
298 	uint16_t w;
299 	uint32_t d;
300 
301 	pci_set_master(ha->pdev);
302 	pci_try_set_mwi(ha->pdev);
303 
304 	pci_read_config_word(ha->pdev, PCI_COMMAND, &w);
305 	w |= (PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
306 	w &= ~PCI_COMMAND_INTX_DISABLE;
307 	pci_write_config_word(ha->pdev, PCI_COMMAND, w);
308 
309 	/* PCIe -- adjust Maximum Read Request Size (2048). */
310 	if (pci_find_capability(ha->pdev, PCI_CAP_ID_EXP))
311 		pcie_set_readrq(ha->pdev, 2048);
312 
313 	/* Reset expansion ROM address decode enable */
314 	pci_read_config_dword(ha->pdev, PCI_ROM_ADDRESS, &d);
315 	d &= ~PCI_ROM_ADDRESS_ENABLE;
316 	pci_write_config_dword(ha->pdev, PCI_ROM_ADDRESS, d);
317 
318 	ha->chip_revision = ha->pdev->revision;
319 
320 	return QLA_SUCCESS;
321 }
322 
323 /**
324  * qla2x00_isp_firmware() - Choose firmware image.
325  * @ha: HA context
326  *
327  * Returns 0 on success.
328  */
329 static int
330 qla2x00_isp_firmware(scsi_qla_host_t *ha)
331 {
332 	int  rval;
333 
334 	/* Assume loading risc code */
335 	rval = QLA_FUNCTION_FAILED;
336 
337 	if (ha->flags.disable_risc_code_load) {
338 		DEBUG2(printk("scsi(%ld): RISC CODE NOT loaded\n",
339 		    ha->host_no));
340 		qla_printk(KERN_INFO, ha, "RISC CODE NOT loaded\n");
341 
342 		/* Verify checksum of loaded RISC code. */
343 		rval = qla2x00_verify_checksum(ha, ha->fw_srisc_address);
344 	}
345 
346 	if (rval) {
347 		DEBUG2_3(printk("scsi(%ld): **** Load RISC code ****\n",
348 		    ha->host_no));
349 	}
350 
351 	return (rval);
352 }
353 
354 /**
355  * qla2x00_reset_chip() - Reset ISP chip.
356  * @ha: HA context
357  *
358  * Returns 0 on success.
359  */
360 void
361 qla2x00_reset_chip(scsi_qla_host_t *ha)
362 {
363 	unsigned long   flags = 0;
364 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
365 	uint32_t	cnt;
366 	uint16_t	cmd;
367 
368 	ha->isp_ops->disable_intrs(ha);
369 
370 	spin_lock_irqsave(&ha->hardware_lock, flags);
371 
372 	/* Turn off master enable */
373 	cmd = 0;
374 	pci_read_config_word(ha->pdev, PCI_COMMAND, &cmd);
375 	cmd &= ~PCI_COMMAND_MASTER;
376 	pci_write_config_word(ha->pdev, PCI_COMMAND, cmd);
377 
378 	if (!IS_QLA2100(ha)) {
379 		/* Pause RISC. */
380 		WRT_REG_WORD(&reg->hccr, HCCR_PAUSE_RISC);
381 		if (IS_QLA2200(ha) || IS_QLA2300(ha)) {
382 			for (cnt = 0; cnt < 30000; cnt++) {
383 				if ((RD_REG_WORD(&reg->hccr) &
384 				    HCCR_RISC_PAUSE) != 0)
385 					break;
386 				udelay(100);
387 			}
388 		} else {
389 			RD_REG_WORD(&reg->hccr);	/* PCI Posting. */
390 			udelay(10);
391 		}
392 
393 		/* Select FPM registers. */
394 		WRT_REG_WORD(&reg->ctrl_status, 0x20);
395 		RD_REG_WORD(&reg->ctrl_status);		/* PCI Posting. */
396 
397 		/* FPM Soft Reset. */
398 		WRT_REG_WORD(&reg->fpm_diag_config, 0x100);
399 		RD_REG_WORD(&reg->fpm_diag_config);	/* PCI Posting. */
400 
401 		/* Toggle Fpm Reset. */
402 		if (!IS_QLA2200(ha)) {
403 			WRT_REG_WORD(&reg->fpm_diag_config, 0x0);
404 			RD_REG_WORD(&reg->fpm_diag_config); /* PCI Posting. */
405 		}
406 
407 		/* Select frame buffer registers. */
408 		WRT_REG_WORD(&reg->ctrl_status, 0x10);
409 		RD_REG_WORD(&reg->ctrl_status);		/* PCI Posting. */
410 
411 		/* Reset frame buffer FIFOs. */
412 		if (IS_QLA2200(ha)) {
413 			WRT_FB_CMD_REG(ha, reg, 0xa000);
414 			RD_FB_CMD_REG(ha, reg);		/* PCI Posting. */
415 		} else {
416 			WRT_FB_CMD_REG(ha, reg, 0x00fc);
417 
418 			/* Read back fb_cmd until zero or 3 seconds max */
419 			for (cnt = 0; cnt < 3000; cnt++) {
420 				if ((RD_FB_CMD_REG(ha, reg) & 0xff) == 0)
421 					break;
422 				udelay(100);
423 			}
424 		}
425 
426 		/* Select RISC module registers. */
427 		WRT_REG_WORD(&reg->ctrl_status, 0);
428 		RD_REG_WORD(&reg->ctrl_status);		/* PCI Posting. */
429 
430 		/* Reset RISC processor. */
431 		WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
432 		RD_REG_WORD(&reg->hccr);		/* PCI Posting. */
433 
434 		/* Release RISC processor. */
435 		WRT_REG_WORD(&reg->hccr, HCCR_RELEASE_RISC);
436 		RD_REG_WORD(&reg->hccr);		/* PCI Posting. */
437 	}
438 
439 	WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
440 	WRT_REG_WORD(&reg->hccr, HCCR_CLR_HOST_INT);
441 
442 	/* Reset ISP chip. */
443 	WRT_REG_WORD(&reg->ctrl_status, CSR_ISP_SOFT_RESET);
444 
445 	/* Wait for RISC to recover from reset. */
446 	if (IS_QLA2100(ha) || IS_QLA2200(ha) || IS_QLA2300(ha)) {
447 		/*
448 		 * It is necessary to for a delay here since the card doesn't
449 		 * respond to PCI reads during a reset. On some architectures
450 		 * this will result in an MCA.
451 		 */
452 		udelay(20);
453 		for (cnt = 30000; cnt; cnt--) {
454 			if ((RD_REG_WORD(&reg->ctrl_status) &
455 			    CSR_ISP_SOFT_RESET) == 0)
456 				break;
457 			udelay(100);
458 		}
459 	} else
460 		udelay(10);
461 
462 	/* Reset RISC processor. */
463 	WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
464 
465 	WRT_REG_WORD(&reg->semaphore, 0);
466 
467 	/* Release RISC processor. */
468 	WRT_REG_WORD(&reg->hccr, HCCR_RELEASE_RISC);
469 	RD_REG_WORD(&reg->hccr);			/* PCI Posting. */
470 
471 	if (IS_QLA2100(ha) || IS_QLA2200(ha) || IS_QLA2300(ha)) {
472 		for (cnt = 0; cnt < 30000; cnt++) {
473 			if (RD_MAILBOX_REG(ha, reg, 0) != MBS_BUSY)
474 				break;
475 
476 			udelay(100);
477 		}
478 	} else
479 		udelay(100);
480 
481 	/* Turn on master enable */
482 	cmd |= PCI_COMMAND_MASTER;
483 	pci_write_config_word(ha->pdev, PCI_COMMAND, cmd);
484 
485 	/* Disable RISC pause on FPM parity error. */
486 	if (!IS_QLA2100(ha)) {
487 		WRT_REG_WORD(&reg->hccr, HCCR_DISABLE_PARITY_PAUSE);
488 		RD_REG_WORD(&reg->hccr);		/* PCI Posting. */
489 	}
490 
491 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
492 }
493 
494 /**
495  * qla24xx_reset_risc() - Perform full reset of ISP24xx RISC.
496  * @ha: HA context
497  *
498  * Returns 0 on success.
499  */
500 static inline void
501 qla24xx_reset_risc(scsi_qla_host_t *ha)
502 {
503 	unsigned long flags = 0;
504 	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
505 	uint32_t cnt, d2;
506 	uint16_t wd;
507 
508 	spin_lock_irqsave(&ha->hardware_lock, flags);
509 
510 	/* Reset RISC. */
511 	WRT_REG_DWORD(&reg->ctrl_status, CSRX_DMA_SHUTDOWN|MWB_4096_BYTES);
512 	for (cnt = 0; cnt < 30000; cnt++) {
513 		if ((RD_REG_DWORD(&reg->ctrl_status) & CSRX_DMA_ACTIVE) == 0)
514 			break;
515 
516 		udelay(10);
517 	}
518 
519 	WRT_REG_DWORD(&reg->ctrl_status,
520 	    CSRX_ISP_SOFT_RESET|CSRX_DMA_SHUTDOWN|MWB_4096_BYTES);
521 	pci_read_config_word(ha->pdev, PCI_COMMAND, &wd);
522 
523 	udelay(100);
524 	/* Wait for firmware to complete NVRAM accesses. */
525 	d2 = (uint32_t) RD_REG_WORD(&reg->mailbox0);
526 	for (cnt = 10000 ; cnt && d2; cnt--) {
527 		udelay(5);
528 		d2 = (uint32_t) RD_REG_WORD(&reg->mailbox0);
529 		barrier();
530 	}
531 
532 	/* Wait for soft-reset to complete. */
533 	d2 = RD_REG_DWORD(&reg->ctrl_status);
534 	for (cnt = 6000000 ; cnt && (d2 & CSRX_ISP_SOFT_RESET); cnt--) {
535 		udelay(5);
536 		d2 = RD_REG_DWORD(&reg->ctrl_status);
537 		barrier();
538 	}
539 
540 	WRT_REG_DWORD(&reg->hccr, HCCRX_SET_RISC_RESET);
541 	RD_REG_DWORD(&reg->hccr);
542 
543 	WRT_REG_DWORD(&reg->hccr, HCCRX_REL_RISC_PAUSE);
544 	RD_REG_DWORD(&reg->hccr);
545 
546 	WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_RESET);
547 	RD_REG_DWORD(&reg->hccr);
548 
549 	d2 = (uint32_t) RD_REG_WORD(&reg->mailbox0);
550 	for (cnt = 6000000 ; cnt && d2; cnt--) {
551 		udelay(5);
552 		d2 = (uint32_t) RD_REG_WORD(&reg->mailbox0);
553 		barrier();
554 	}
555 
556 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
557 }
558 
559 /**
560  * qla24xx_reset_chip() - Reset ISP24xx chip.
561  * @ha: HA context
562  *
563  * Returns 0 on success.
564  */
565 void
566 qla24xx_reset_chip(scsi_qla_host_t *ha)
567 {
568 	ha->isp_ops->disable_intrs(ha);
569 
570 	/* Perform RISC reset. */
571 	qla24xx_reset_risc(ha);
572 }
573 
574 /**
575  * qla2x00_chip_diag() - Test chip for proper operation.
576  * @ha: HA context
577  *
578  * Returns 0 on success.
579  */
580 int
581 qla2x00_chip_diag(scsi_qla_host_t *ha)
582 {
583 	int		rval;
584 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
585 	unsigned long	flags = 0;
586 	uint16_t	data;
587 	uint32_t	cnt;
588 	uint16_t	mb[5];
589 
590 	/* Assume a failed state */
591 	rval = QLA_FUNCTION_FAILED;
592 
593 	DEBUG3(printk("scsi(%ld): Testing device at %lx.\n",
594 	    ha->host_no, (u_long)&reg->flash_address));
595 
596 	spin_lock_irqsave(&ha->hardware_lock, flags);
597 
598 	/* Reset ISP chip. */
599 	WRT_REG_WORD(&reg->ctrl_status, CSR_ISP_SOFT_RESET);
600 
601 	/*
602 	 * We need to have a delay here since the card will not respond while
603 	 * in reset causing an MCA on some architectures.
604 	 */
605 	udelay(20);
606 	data = qla2x00_debounce_register(&reg->ctrl_status);
607 	for (cnt = 6000000 ; cnt && (data & CSR_ISP_SOFT_RESET); cnt--) {
608 		udelay(5);
609 		data = RD_REG_WORD(&reg->ctrl_status);
610 		barrier();
611 	}
612 
613 	if (!cnt)
614 		goto chip_diag_failed;
615 
616 	DEBUG3(printk("scsi(%ld): Reset register cleared by chip reset\n",
617 	    ha->host_no));
618 
619 	/* Reset RISC processor. */
620 	WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
621 	WRT_REG_WORD(&reg->hccr, HCCR_RELEASE_RISC);
622 
623 	/* Workaround for QLA2312 PCI parity error */
624 	if (IS_QLA2100(ha) || IS_QLA2200(ha) || IS_QLA2300(ha)) {
625 		data = qla2x00_debounce_register(MAILBOX_REG(ha, reg, 0));
626 		for (cnt = 6000000; cnt && (data == MBS_BUSY); cnt--) {
627 			udelay(5);
628 			data = RD_MAILBOX_REG(ha, reg, 0);
629 			barrier();
630 		}
631 	} else
632 		udelay(10);
633 
634 	if (!cnt)
635 		goto chip_diag_failed;
636 
637 	/* Check product ID of chip */
638 	DEBUG3(printk("scsi(%ld): Checking product ID of chip\n", ha->host_no));
639 
640 	mb[1] = RD_MAILBOX_REG(ha, reg, 1);
641 	mb[2] = RD_MAILBOX_REG(ha, reg, 2);
642 	mb[3] = RD_MAILBOX_REG(ha, reg, 3);
643 	mb[4] = qla2x00_debounce_register(MAILBOX_REG(ha, reg, 4));
644 	if (mb[1] != PROD_ID_1 || (mb[2] != PROD_ID_2 && mb[2] != PROD_ID_2a) ||
645 	    mb[3] != PROD_ID_3) {
646 		qla_printk(KERN_WARNING, ha,
647 		    "Wrong product ID = 0x%x,0x%x,0x%x\n", mb[1], mb[2], mb[3]);
648 
649 		goto chip_diag_failed;
650 	}
651 	ha->product_id[0] = mb[1];
652 	ha->product_id[1] = mb[2];
653 	ha->product_id[2] = mb[3];
654 	ha->product_id[3] = mb[4];
655 
656 	/* Adjust fw RISC transfer size */
657 	if (ha->request_q_length > 1024)
658 		ha->fw_transfer_size = REQUEST_ENTRY_SIZE * 1024;
659 	else
660 		ha->fw_transfer_size = REQUEST_ENTRY_SIZE *
661 		    ha->request_q_length;
662 
663 	if (IS_QLA2200(ha) &&
664 	    RD_MAILBOX_REG(ha, reg, 7) == QLA2200A_RISC_ROM_VER) {
665 		/* Limit firmware transfer size with a 2200A */
666 		DEBUG3(printk("scsi(%ld): Found QLA2200A chip.\n",
667 		    ha->host_no));
668 
669 		ha->device_type |= DT_ISP2200A;
670 		ha->fw_transfer_size = 128;
671 	}
672 
673 	/* Wrap Incoming Mailboxes Test. */
674 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
675 
676 	DEBUG3(printk("scsi(%ld): Checking mailboxes.\n", ha->host_no));
677 	rval = qla2x00_mbx_reg_test(ha);
678 	if (rval) {
679 		DEBUG(printk("scsi(%ld): Failed mailbox send register test\n",
680 		    ha->host_no));
681 		qla_printk(KERN_WARNING, ha,
682 		    "Failed mailbox send register test\n");
683 	}
684 	else {
685 		/* Flag a successful rval */
686 		rval = QLA_SUCCESS;
687 	}
688 	spin_lock_irqsave(&ha->hardware_lock, flags);
689 
690 chip_diag_failed:
691 	if (rval)
692 		DEBUG2_3(printk("scsi(%ld): Chip diagnostics **** FAILED "
693 		    "****\n", ha->host_no));
694 
695 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
696 
697 	return (rval);
698 }
699 
700 /**
701  * qla24xx_chip_diag() - Test ISP24xx for proper operation.
702  * @ha: HA context
703  *
704  * Returns 0 on success.
705  */
706 int
707 qla24xx_chip_diag(scsi_qla_host_t *ha)
708 {
709 	int rval;
710 
711 	/* Perform RISC reset. */
712 	qla24xx_reset_risc(ha);
713 
714 	ha->fw_transfer_size = REQUEST_ENTRY_SIZE * 1024;
715 
716 	rval = qla2x00_mbx_reg_test(ha);
717 	if (rval) {
718 		DEBUG(printk("scsi(%ld): Failed mailbox send register test\n",
719 		    ha->host_no));
720 		qla_printk(KERN_WARNING, ha,
721 		    "Failed mailbox send register test\n");
722 	} else {
723 		/* Flag a successful rval */
724 		rval = QLA_SUCCESS;
725 	}
726 
727 	return rval;
728 }
729 
730 void
731 qla2x00_alloc_fw_dump(scsi_qla_host_t *ha)
732 {
733 	int rval;
734 	uint32_t dump_size, fixed_size, mem_size, req_q_size, rsp_q_size,
735 	    eft_size;
736 	dma_addr_t eft_dma;
737 	void *eft;
738 
739 	if (ha->fw_dump) {
740 		qla_printk(KERN_WARNING, ha,
741 		    "Firmware dump previously allocated.\n");
742 		return;
743 	}
744 
745 	ha->fw_dumped = 0;
746 	fixed_size = mem_size = eft_size = 0;
747 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
748 		fixed_size = sizeof(struct qla2100_fw_dump);
749 	} else if (IS_QLA23XX(ha)) {
750 		fixed_size = offsetof(struct qla2300_fw_dump, data_ram);
751 		mem_size = (ha->fw_memory_size - 0x11000 + 1) *
752 		    sizeof(uint16_t);
753 	} else if (IS_FWI2_CAPABLE(ha)) {
754 		fixed_size = IS_QLA25XX(ha) ?
755 		    offsetof(struct qla25xx_fw_dump, ext_mem):
756 		    offsetof(struct qla24xx_fw_dump, ext_mem);
757 		mem_size = (ha->fw_memory_size - 0x100000 + 1) *
758 		    sizeof(uint32_t);
759 
760 		/* Allocate memory for Extended Trace Buffer. */
761 		eft = dma_alloc_coherent(&ha->pdev->dev, EFT_SIZE, &eft_dma,
762 		    GFP_KERNEL);
763 		if (!eft) {
764 			qla_printk(KERN_WARNING, ha, "Unable to allocate "
765 			    "(%d KB) for EFT.\n", EFT_SIZE / 1024);
766 			goto cont_alloc;
767 		}
768 
769 		rval = qla2x00_trace_control(ha, TC_ENABLE, eft_dma,
770 		    EFT_NUM_BUFFERS);
771 		if (rval) {
772 			qla_printk(KERN_WARNING, ha, "Unable to initialize "
773 			    "EFT (%d).\n", rval);
774 			dma_free_coherent(&ha->pdev->dev, EFT_SIZE, eft,
775 			    eft_dma);
776 			goto cont_alloc;
777 		}
778 
779 		qla_printk(KERN_INFO, ha, "Allocated (%d KB) for EFT...\n",
780 		    EFT_SIZE / 1024);
781 
782 		eft_size = EFT_SIZE;
783 		memset(eft, 0, eft_size);
784 		ha->eft_dma = eft_dma;
785 		ha->eft = eft;
786 	}
787 cont_alloc:
788 	req_q_size = ha->request_q_length * sizeof(request_t);
789 	rsp_q_size = ha->response_q_length * sizeof(response_t);
790 
791 	dump_size = offsetof(struct qla2xxx_fw_dump, isp);
792 	dump_size += fixed_size + mem_size + req_q_size + rsp_q_size +
793 	    eft_size;
794 
795 	ha->fw_dump = vmalloc(dump_size);
796 	if (!ha->fw_dump) {
797 		qla_printk(KERN_WARNING, ha, "Unable to allocate (%d KB) for "
798 		    "firmware dump!!!\n", dump_size / 1024);
799 
800 		if (ha->eft) {
801 			dma_free_coherent(&ha->pdev->dev, eft_size, ha->eft,
802 			    ha->eft_dma);
803 			ha->eft = NULL;
804 			ha->eft_dma = 0;
805 		}
806 		return;
807 	}
808 
809 	qla_printk(KERN_INFO, ha, "Allocated (%d KB) for firmware dump...\n",
810 	    dump_size / 1024);
811 
812 	ha->fw_dump_len = dump_size;
813 	ha->fw_dump->signature[0] = 'Q';
814 	ha->fw_dump->signature[1] = 'L';
815 	ha->fw_dump->signature[2] = 'G';
816 	ha->fw_dump->signature[3] = 'C';
817 	ha->fw_dump->version = __constant_htonl(1);
818 
819 	ha->fw_dump->fixed_size = htonl(fixed_size);
820 	ha->fw_dump->mem_size = htonl(mem_size);
821 	ha->fw_dump->req_q_size = htonl(req_q_size);
822 	ha->fw_dump->rsp_q_size = htonl(rsp_q_size);
823 
824 	ha->fw_dump->eft_size = htonl(eft_size);
825 	ha->fw_dump->eft_addr_l = htonl(LSD(ha->eft_dma));
826 	ha->fw_dump->eft_addr_h = htonl(MSD(ha->eft_dma));
827 
828 	ha->fw_dump->header_size =
829 	    htonl(offsetof(struct qla2xxx_fw_dump, isp));
830 }
831 
832 /**
833  * qla2x00_resize_request_q() - Resize request queue given available ISP memory.
834  * @ha: HA context
835  *
836  * Returns 0 on success.
837  */
838 static void
839 qla2x00_resize_request_q(scsi_qla_host_t *ha)
840 {
841 	int rval;
842 	uint16_t fw_iocb_cnt = 0;
843 	uint16_t request_q_length = REQUEST_ENTRY_CNT_2XXX_EXT_MEM;
844 	dma_addr_t request_dma;
845 	request_t *request_ring;
846 
847 	/* Valid only on recent ISPs. */
848 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
849 		return;
850 
851 	/* Retrieve IOCB counts available to the firmware. */
852 	rval = qla2x00_get_resource_cnts(ha, NULL, NULL, NULL, &fw_iocb_cnt);
853 	if (rval)
854 		return;
855 	/* No point in continuing if current settings are sufficient. */
856 	if (fw_iocb_cnt < 1024)
857 		return;
858 	if (ha->request_q_length >= request_q_length)
859 		return;
860 
861 	/* Attempt to claim larger area for request queue. */
862 	request_ring = dma_alloc_coherent(&ha->pdev->dev,
863 	    (request_q_length + 1) * sizeof(request_t), &request_dma,
864 	    GFP_KERNEL);
865 	if (request_ring == NULL)
866 		return;
867 
868 	/* Resize successful, report extensions. */
869 	qla_printk(KERN_INFO, ha, "Extended memory detected (%d KB)...\n",
870 	    (ha->fw_memory_size + 1) / 1024);
871 	qla_printk(KERN_INFO, ha, "Resizing request queue depth "
872 	    "(%d -> %d)...\n", ha->request_q_length, request_q_length);
873 
874 	/* Clear old allocations. */
875 	dma_free_coherent(&ha->pdev->dev,
876 	    (ha->request_q_length + 1) * sizeof(request_t), ha->request_ring,
877 	    ha->request_dma);
878 
879 	/* Begin using larger queue. */
880 	ha->request_q_length = request_q_length;
881 	ha->request_ring = request_ring;
882 	ha->request_dma = request_dma;
883 }
884 
885 /**
886  * qla2x00_setup_chip() - Load and start RISC firmware.
887  * @ha: HA context
888  *
889  * Returns 0 on success.
890  */
891 static int
892 qla2x00_setup_chip(scsi_qla_host_t *ha)
893 {
894 	int rval;
895 	uint32_t srisc_address = 0;
896 
897 	/* Load firmware sequences */
898 	rval = ha->isp_ops->load_risc(ha, &srisc_address);
899 	if (rval == QLA_SUCCESS) {
900 		DEBUG(printk("scsi(%ld): Verifying Checksum of loaded RISC "
901 		    "code.\n", ha->host_no));
902 
903 		rval = qla2x00_verify_checksum(ha, srisc_address);
904 		if (rval == QLA_SUCCESS) {
905 			/* Start firmware execution. */
906 			DEBUG(printk("scsi(%ld): Checksum OK, start "
907 			    "firmware.\n", ha->host_no));
908 
909 			rval = qla2x00_execute_fw(ha, srisc_address);
910 			/* Retrieve firmware information. */
911 			if (rval == QLA_SUCCESS && ha->fw_major_version == 0) {
912 				qla2x00_get_fw_version(ha,
913 				    &ha->fw_major_version,
914 				    &ha->fw_minor_version,
915 				    &ha->fw_subminor_version,
916 				    &ha->fw_attributes, &ha->fw_memory_size);
917 				qla2x00_resize_request_q(ha);
918 				ha->flags.npiv_supported = 0;
919 				if (IS_QLA24XX(ha) &&
920 				    (ha->fw_attributes & BIT_2))
921 					ha->flags.npiv_supported = 1;
922 
923 				if (ql2xallocfwdump)
924 					qla2x00_alloc_fw_dump(ha);
925 			}
926 		} else {
927 			DEBUG2(printk(KERN_INFO
928 			    "scsi(%ld): ISP Firmware failed checksum.\n",
929 			    ha->host_no));
930 		}
931 	}
932 
933 	if (rval) {
934 		DEBUG2_3(printk("scsi(%ld): Setup chip **** FAILED ****.\n",
935 		    ha->host_no));
936 	}
937 
938 	return (rval);
939 }
940 
941 /**
942  * qla2x00_init_response_q_entries() - Initializes response queue entries.
943  * @ha: HA context
944  *
945  * Beginning of request ring has initialization control block already built
946  * by nvram config routine.
947  *
948  * Returns 0 on success.
949  */
950 static void
951 qla2x00_init_response_q_entries(scsi_qla_host_t *ha)
952 {
953 	uint16_t cnt;
954 	response_t *pkt;
955 
956 	pkt = ha->response_ring_ptr;
957 	for (cnt = 0; cnt < ha->response_q_length; cnt++) {
958 		pkt->signature = RESPONSE_PROCESSED;
959 		pkt++;
960 	}
961 
962 }
963 
964 /**
965  * qla2x00_update_fw_options() - Read and process firmware options.
966  * @ha: HA context
967  *
968  * Returns 0 on success.
969  */
970 void
971 qla2x00_update_fw_options(scsi_qla_host_t *ha)
972 {
973 	uint16_t swing, emphasis, tx_sens, rx_sens;
974 
975 	memset(ha->fw_options, 0, sizeof(ha->fw_options));
976 	qla2x00_get_fw_options(ha, ha->fw_options);
977 
978 	if (IS_QLA2100(ha) || IS_QLA2200(ha))
979 		return;
980 
981 	/* Serial Link options. */
982 	DEBUG3(printk("scsi(%ld): Serial link options:\n",
983 	    ha->host_no));
984 	DEBUG3(qla2x00_dump_buffer((uint8_t *)&ha->fw_seriallink_options,
985 	    sizeof(ha->fw_seriallink_options)));
986 
987 	ha->fw_options[1] &= ~FO1_SET_EMPHASIS_SWING;
988 	if (ha->fw_seriallink_options[3] & BIT_2) {
989 		ha->fw_options[1] |= FO1_SET_EMPHASIS_SWING;
990 
991 		/*  1G settings */
992 		swing = ha->fw_seriallink_options[2] & (BIT_2 | BIT_1 | BIT_0);
993 		emphasis = (ha->fw_seriallink_options[2] &
994 		    (BIT_4 | BIT_3)) >> 3;
995 		tx_sens = ha->fw_seriallink_options[0] &
996 		    (BIT_3 | BIT_2 | BIT_1 | BIT_0);
997 		rx_sens = (ha->fw_seriallink_options[0] &
998 		    (BIT_7 | BIT_6 | BIT_5 | BIT_4)) >> 4;
999 		ha->fw_options[10] = (emphasis << 14) | (swing << 8);
1000 		if (IS_QLA2300(ha) || IS_QLA2312(ha) || IS_QLA6312(ha)) {
1001 			if (rx_sens == 0x0)
1002 				rx_sens = 0x3;
1003 			ha->fw_options[10] |= (tx_sens << 4) | rx_sens;
1004 		} else if (IS_QLA2322(ha) || IS_QLA6322(ha))
1005 			ha->fw_options[10] |= BIT_5 |
1006 			    ((rx_sens & (BIT_1 | BIT_0)) << 2) |
1007 			    (tx_sens & (BIT_1 | BIT_0));
1008 
1009 		/*  2G settings */
1010 		swing = (ha->fw_seriallink_options[2] &
1011 		    (BIT_7 | BIT_6 | BIT_5)) >> 5;
1012 		emphasis = ha->fw_seriallink_options[3] & (BIT_1 | BIT_0);
1013 		tx_sens = ha->fw_seriallink_options[1] &
1014 		    (BIT_3 | BIT_2 | BIT_1 | BIT_0);
1015 		rx_sens = (ha->fw_seriallink_options[1] &
1016 		    (BIT_7 | BIT_6 | BIT_5 | BIT_4)) >> 4;
1017 		ha->fw_options[11] = (emphasis << 14) | (swing << 8);
1018 		if (IS_QLA2300(ha) || IS_QLA2312(ha) || IS_QLA6312(ha)) {
1019 			if (rx_sens == 0x0)
1020 				rx_sens = 0x3;
1021 			ha->fw_options[11] |= (tx_sens << 4) | rx_sens;
1022 		} else if (IS_QLA2322(ha) || IS_QLA6322(ha))
1023 			ha->fw_options[11] |= BIT_5 |
1024 			    ((rx_sens & (BIT_1 | BIT_0)) << 2) |
1025 			    (tx_sens & (BIT_1 | BIT_0));
1026 	}
1027 
1028 	/* FCP2 options. */
1029 	/*  Return command IOCBs without waiting for an ABTS to complete. */
1030 	ha->fw_options[3] |= BIT_13;
1031 
1032 	/* LED scheme. */
1033 	if (ha->flags.enable_led_scheme)
1034 		ha->fw_options[2] |= BIT_12;
1035 
1036 	/* Detect ISP6312. */
1037 	if (IS_QLA6312(ha))
1038 		ha->fw_options[2] |= BIT_13;
1039 
1040 	/* Update firmware options. */
1041 	qla2x00_set_fw_options(ha, ha->fw_options);
1042 }
1043 
1044 void
1045 qla24xx_update_fw_options(scsi_qla_host_t *ha)
1046 {
1047 	int rval;
1048 
1049 	/* Update Serial Link options. */
1050 	if ((le16_to_cpu(ha->fw_seriallink_options24[0]) & BIT_0) == 0)
1051 		return;
1052 
1053 	rval = qla2x00_set_serdes_params(ha,
1054 	    le16_to_cpu(ha->fw_seriallink_options24[1]),
1055 	    le16_to_cpu(ha->fw_seriallink_options24[2]),
1056 	    le16_to_cpu(ha->fw_seriallink_options24[3]));
1057 	if (rval != QLA_SUCCESS) {
1058 		qla_printk(KERN_WARNING, ha,
1059 		    "Unable to update Serial Link options (%x).\n", rval);
1060 	}
1061 }
1062 
1063 void
1064 qla2x00_config_rings(struct scsi_qla_host *ha)
1065 {
1066 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
1067 
1068 	/* Setup ring parameters in initialization control block. */
1069 	ha->init_cb->request_q_outpointer = __constant_cpu_to_le16(0);
1070 	ha->init_cb->response_q_inpointer = __constant_cpu_to_le16(0);
1071 	ha->init_cb->request_q_length = cpu_to_le16(ha->request_q_length);
1072 	ha->init_cb->response_q_length = cpu_to_le16(ha->response_q_length);
1073 	ha->init_cb->request_q_address[0] = cpu_to_le32(LSD(ha->request_dma));
1074 	ha->init_cb->request_q_address[1] = cpu_to_le32(MSD(ha->request_dma));
1075 	ha->init_cb->response_q_address[0] = cpu_to_le32(LSD(ha->response_dma));
1076 	ha->init_cb->response_q_address[1] = cpu_to_le32(MSD(ha->response_dma));
1077 
1078 	WRT_REG_WORD(ISP_REQ_Q_IN(ha, reg), 0);
1079 	WRT_REG_WORD(ISP_REQ_Q_OUT(ha, reg), 0);
1080 	WRT_REG_WORD(ISP_RSP_Q_IN(ha, reg), 0);
1081 	WRT_REG_WORD(ISP_RSP_Q_OUT(ha, reg), 0);
1082 	RD_REG_WORD(ISP_RSP_Q_OUT(ha, reg));		/* PCI Posting. */
1083 }
1084 
1085 void
1086 qla24xx_config_rings(struct scsi_qla_host *ha)
1087 {
1088 	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1089 	struct init_cb_24xx *icb;
1090 
1091 	/* Setup ring parameters in initialization control block. */
1092 	icb = (struct init_cb_24xx *)ha->init_cb;
1093 	icb->request_q_outpointer = __constant_cpu_to_le16(0);
1094 	icb->response_q_inpointer = __constant_cpu_to_le16(0);
1095 	icb->request_q_length = cpu_to_le16(ha->request_q_length);
1096 	icb->response_q_length = cpu_to_le16(ha->response_q_length);
1097 	icb->request_q_address[0] = cpu_to_le32(LSD(ha->request_dma));
1098 	icb->request_q_address[1] = cpu_to_le32(MSD(ha->request_dma));
1099 	icb->response_q_address[0] = cpu_to_le32(LSD(ha->response_dma));
1100 	icb->response_q_address[1] = cpu_to_le32(MSD(ha->response_dma));
1101 
1102 	WRT_REG_DWORD(&reg->req_q_in, 0);
1103 	WRT_REG_DWORD(&reg->req_q_out, 0);
1104 	WRT_REG_DWORD(&reg->rsp_q_in, 0);
1105 	WRT_REG_DWORD(&reg->rsp_q_out, 0);
1106 	RD_REG_DWORD(&reg->rsp_q_out);
1107 }
1108 
1109 /**
1110  * qla2x00_init_rings() - Initializes firmware.
1111  * @ha: HA context
1112  *
1113  * Beginning of request ring has initialization control block already built
1114  * by nvram config routine.
1115  *
1116  * Returns 0 on success.
1117  */
1118 static int
1119 qla2x00_init_rings(scsi_qla_host_t *ha)
1120 {
1121 	int	rval;
1122 	unsigned long flags = 0;
1123 	int cnt;
1124 	struct mid_init_cb_24xx *mid_init_cb =
1125 	    (struct mid_init_cb_24xx *) ha->init_cb;
1126 
1127 	spin_lock_irqsave(&ha->hardware_lock, flags);
1128 
1129 	/* Clear outstanding commands array. */
1130 	for (cnt = 0; cnt < MAX_OUTSTANDING_COMMANDS; cnt++)
1131 		ha->outstanding_cmds[cnt] = NULL;
1132 
1133 	ha->current_outstanding_cmd = 0;
1134 
1135 	/* Clear RSCN queue. */
1136 	ha->rscn_in_ptr = 0;
1137 	ha->rscn_out_ptr = 0;
1138 
1139 	/* Initialize firmware. */
1140 	ha->request_ring_ptr  = ha->request_ring;
1141 	ha->req_ring_index    = 0;
1142 	ha->req_q_cnt         = ha->request_q_length;
1143 	ha->response_ring_ptr = ha->response_ring;
1144 	ha->rsp_ring_index    = 0;
1145 
1146 	/* Initialize response queue entries */
1147 	qla2x00_init_response_q_entries(ha);
1148 
1149 	ha->isp_ops->config_rings(ha);
1150 
1151 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
1152 
1153 	/* Update any ISP specific firmware options before initialization. */
1154 	ha->isp_ops->update_fw_options(ha);
1155 
1156 	DEBUG(printk("scsi(%ld): Issue init firmware.\n", ha->host_no));
1157 
1158 	mid_init_cb->count = MAX_NUM_VPORT_FABRIC;
1159 	ha->max_npiv_vports = MAX_NUM_VPORT_FABRIC;
1160 
1161 	rval = qla2x00_init_firmware(ha, ha->init_cb_size);
1162 	if (rval) {
1163 		DEBUG2_3(printk("scsi(%ld): Init firmware **** FAILED ****.\n",
1164 		    ha->host_no));
1165 	} else {
1166 		DEBUG3(printk("scsi(%ld): Init firmware -- success.\n",
1167 		    ha->host_no));
1168 	}
1169 
1170 	return (rval);
1171 }
1172 
1173 /**
1174  * qla2x00_fw_ready() - Waits for firmware ready.
1175  * @ha: HA context
1176  *
1177  * Returns 0 on success.
1178  */
1179 static int
1180 qla2x00_fw_ready(scsi_qla_host_t *ha)
1181 {
1182 	int		rval;
1183 	unsigned long	wtime, mtime;
1184 	uint16_t	min_wait;	/* Minimum wait time if loop is down */
1185 	uint16_t	wait_time;	/* Wait time if loop is coming ready */
1186 	uint16_t	fw_state;
1187 
1188 	rval = QLA_SUCCESS;
1189 
1190 	/* 20 seconds for loop down. */
1191 	min_wait = 20;
1192 
1193 	/*
1194 	 * Firmware should take at most one RATOV to login, plus 5 seconds for
1195 	 * our own processing.
1196 	 */
1197 	if ((wait_time = (ha->retry_count*ha->login_timeout) + 5) < min_wait) {
1198 		wait_time = min_wait;
1199 	}
1200 
1201 	/* Min wait time if loop down */
1202 	mtime = jiffies + (min_wait * HZ);
1203 
1204 	/* wait time before firmware ready */
1205 	wtime = jiffies + (wait_time * HZ);
1206 
1207 	/* Wait for ISP to finish LIP */
1208 	if (!ha->flags.init_done)
1209  		qla_printk(KERN_INFO, ha, "Waiting for LIP to complete...\n");
1210 
1211 	DEBUG3(printk("scsi(%ld): Waiting for LIP to complete...\n",
1212 	    ha->host_no));
1213 
1214 	do {
1215 		rval = qla2x00_get_firmware_state(ha, &fw_state);
1216 		if (rval == QLA_SUCCESS) {
1217 			if (fw_state < FSTATE_LOSS_OF_SYNC) {
1218 				ha->device_flags &= ~DFLG_NO_CABLE;
1219 			}
1220 			if (fw_state == FSTATE_READY) {
1221 				DEBUG(printk("scsi(%ld): F/W Ready - OK \n",
1222 				    ha->host_no));
1223 
1224 				qla2x00_get_retry_cnt(ha, &ha->retry_count,
1225 				    &ha->login_timeout, &ha->r_a_tov);
1226 
1227 				rval = QLA_SUCCESS;
1228 				break;
1229 			}
1230 
1231 			rval = QLA_FUNCTION_FAILED;
1232 
1233 			if (atomic_read(&ha->loop_down_timer) &&
1234 			    fw_state != FSTATE_READY) {
1235 				/* Loop down. Timeout on min_wait for states
1236 				 * other than Wait for Login.
1237 				 */
1238 				if (time_after_eq(jiffies, mtime)) {
1239 					qla_printk(KERN_INFO, ha,
1240 					    "Cable is unplugged...\n");
1241 
1242 					ha->device_flags |= DFLG_NO_CABLE;
1243 					break;
1244 				}
1245 			}
1246 		} else {
1247 			/* Mailbox cmd failed. Timeout on min_wait. */
1248 			if (time_after_eq(jiffies, mtime))
1249 				break;
1250 		}
1251 
1252 		if (time_after_eq(jiffies, wtime))
1253 			break;
1254 
1255 		/* Delay for a while */
1256 		msleep(500);
1257 
1258 		DEBUG3(printk("scsi(%ld): fw_state=%x curr time=%lx.\n",
1259 		    ha->host_no, fw_state, jiffies));
1260 	} while (1);
1261 
1262 	DEBUG(printk("scsi(%ld): fw_state=%x curr time=%lx.\n",
1263 	    ha->host_no, fw_state, jiffies));
1264 
1265 	if (rval) {
1266 		DEBUG2_3(printk("scsi(%ld): Firmware ready **** FAILED ****.\n",
1267 		    ha->host_no));
1268 	}
1269 
1270 	return (rval);
1271 }
1272 
1273 /*
1274 *  qla2x00_configure_hba
1275 *      Setup adapter context.
1276 *
1277 * Input:
1278 *      ha = adapter state pointer.
1279 *
1280 * Returns:
1281 *      0 = success
1282 *
1283 * Context:
1284 *      Kernel context.
1285 */
1286 static int
1287 qla2x00_configure_hba(scsi_qla_host_t *ha)
1288 {
1289 	int       rval;
1290 	uint16_t      loop_id;
1291 	uint16_t      topo;
1292 	uint16_t      sw_cap;
1293 	uint8_t       al_pa;
1294 	uint8_t       area;
1295 	uint8_t       domain;
1296 	char		connect_type[22];
1297 
1298 	/* Get host addresses. */
1299 	rval = qla2x00_get_adapter_id(ha,
1300 	    &loop_id, &al_pa, &area, &domain, &topo, &sw_cap);
1301 	if (rval != QLA_SUCCESS) {
1302 		if (LOOP_TRANSITION(ha) || atomic_read(&ha->loop_down_timer) ||
1303 		    (rval == QLA_COMMAND_ERROR && loop_id == 0x7)) {
1304 			DEBUG2(printk("%s(%ld) Loop is in a transition state\n",
1305 			    __func__, ha->host_no));
1306 		} else {
1307 			qla_printk(KERN_WARNING, ha,
1308 			    "ERROR -- Unable to get host loop ID.\n");
1309 			set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1310 		}
1311 		return (rval);
1312 	}
1313 
1314 	if (topo == 4) {
1315 		qla_printk(KERN_INFO, ha,
1316 			"Cannot get topology - retrying.\n");
1317 		return (QLA_FUNCTION_FAILED);
1318 	}
1319 
1320 	ha->loop_id = loop_id;
1321 
1322 	/* initialize */
1323 	ha->min_external_loopid = SNS_FIRST_LOOP_ID;
1324 	ha->operating_mode = LOOP;
1325 	ha->switch_cap = 0;
1326 
1327 	switch (topo) {
1328 	case 0:
1329 		DEBUG3(printk("scsi(%ld): HBA in NL topology.\n",
1330 		    ha->host_no));
1331 		ha->current_topology = ISP_CFG_NL;
1332 		strcpy(connect_type, "(Loop)");
1333 		break;
1334 
1335 	case 1:
1336 		DEBUG3(printk("scsi(%ld): HBA in FL topology.\n",
1337 		    ha->host_no));
1338 		ha->switch_cap = sw_cap;
1339 		ha->current_topology = ISP_CFG_FL;
1340 		strcpy(connect_type, "(FL_Port)");
1341 		break;
1342 
1343 	case 2:
1344 		DEBUG3(printk("scsi(%ld): HBA in N P2P topology.\n",
1345 		    ha->host_no));
1346 		ha->operating_mode = P2P;
1347 		ha->current_topology = ISP_CFG_N;
1348 		strcpy(connect_type, "(N_Port-to-N_Port)");
1349 		break;
1350 
1351 	case 3:
1352 		DEBUG3(printk("scsi(%ld): HBA in F P2P topology.\n",
1353 		    ha->host_no));
1354 		ha->switch_cap = sw_cap;
1355 		ha->operating_mode = P2P;
1356 		ha->current_topology = ISP_CFG_F;
1357 		strcpy(connect_type, "(F_Port)");
1358 		break;
1359 
1360 	default:
1361 		DEBUG3(printk("scsi(%ld): HBA in unknown topology %x. "
1362 		    "Using NL.\n",
1363 		    ha->host_no, topo));
1364 		ha->current_topology = ISP_CFG_NL;
1365 		strcpy(connect_type, "(Loop)");
1366 		break;
1367 	}
1368 
1369 	/* Save Host port and loop ID. */
1370 	/* byte order - Big Endian */
1371 	ha->d_id.b.domain = domain;
1372 	ha->d_id.b.area = area;
1373 	ha->d_id.b.al_pa = al_pa;
1374 
1375 	if (!ha->flags.init_done)
1376  		qla_printk(KERN_INFO, ha,
1377 		    "Topology - %s, Host Loop address 0x%x\n",
1378  		    connect_type, ha->loop_id);
1379 
1380 	if (rval) {
1381 		DEBUG2_3(printk("scsi(%ld): FAILED.\n", ha->host_no));
1382 	} else {
1383 		DEBUG3(printk("scsi(%ld): exiting normally.\n", ha->host_no));
1384 	}
1385 
1386 	return(rval);
1387 }
1388 
1389 static inline void
1390 qla2x00_set_model_info(scsi_qla_host_t *ha, uint8_t *model, size_t len, char *def)
1391 {
1392 	char *st, *en;
1393 	uint16_t index;
1394 
1395 	if (memcmp(model, BINZERO, len) != 0) {
1396 		strncpy(ha->model_number, model, len);
1397 		st = en = ha->model_number;
1398 		en += len - 1;
1399 		while (en > st) {
1400 			if (*en != 0x20 && *en != 0x00)
1401 				break;
1402 			*en-- = '\0';
1403 		}
1404 
1405 		index = (ha->pdev->subsystem_device & 0xff);
1406 		if (ha->pdev->subsystem_vendor == PCI_VENDOR_ID_QLOGIC &&
1407 		    index < QLA_MODEL_NAMES)
1408 			ha->model_desc = qla2x00_model_name[index * 2 + 1];
1409 	} else {
1410 		index = (ha->pdev->subsystem_device & 0xff);
1411 		if (ha->pdev->subsystem_vendor == PCI_VENDOR_ID_QLOGIC &&
1412 		    index < QLA_MODEL_NAMES) {
1413 			strcpy(ha->model_number,
1414 			    qla2x00_model_name[index * 2]);
1415 			ha->model_desc = qla2x00_model_name[index * 2 + 1];
1416 		} else {
1417 			strcpy(ha->model_number, def);
1418 		}
1419 	}
1420 }
1421 
1422 /* On sparc systems, obtain port and node WWN from firmware
1423  * properties.
1424  */
1425 static void qla2xxx_nvram_wwn_from_ofw(scsi_qla_host_t *ha, nvram_t *nv)
1426 {
1427 #ifdef CONFIG_SPARC
1428 	struct pci_dev *pdev = ha->pdev;
1429 	struct device_node *dp = pci_device_to_OF_node(pdev);
1430 	const u8 *val;
1431 	int len;
1432 
1433 	val = of_get_property(dp, "port-wwn", &len);
1434 	if (val && len >= WWN_SIZE)
1435 		memcpy(nv->port_name, val, WWN_SIZE);
1436 
1437 	val = of_get_property(dp, "node-wwn", &len);
1438 	if (val && len >= WWN_SIZE)
1439 		memcpy(nv->node_name, val, WWN_SIZE);
1440 #endif
1441 }
1442 
1443 /*
1444 * NVRAM configuration for ISP 2xxx
1445 *
1446 * Input:
1447 *      ha                = adapter block pointer.
1448 *
1449 * Output:
1450 *      initialization control block in response_ring
1451 *      host adapters parameters in host adapter block
1452 *
1453 * Returns:
1454 *      0 = success.
1455 */
1456 int
1457 qla2x00_nvram_config(scsi_qla_host_t *ha)
1458 {
1459 	int             rval;
1460 	uint8_t         chksum = 0;
1461 	uint16_t        cnt;
1462 	uint8_t         *dptr1, *dptr2;
1463 	init_cb_t       *icb = ha->init_cb;
1464 	nvram_t         *nv = ha->nvram;
1465 	uint8_t         *ptr = ha->nvram;
1466 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
1467 
1468 	rval = QLA_SUCCESS;
1469 
1470 	/* Determine NVRAM starting address. */
1471 	ha->nvram_size = sizeof(nvram_t);
1472 	ha->nvram_base = 0;
1473 	if (!IS_QLA2100(ha) && !IS_QLA2200(ha) && !IS_QLA2300(ha))
1474 		if ((RD_REG_WORD(&reg->ctrl_status) >> 14) == 1)
1475 			ha->nvram_base = 0x80;
1476 
1477 	/* Get NVRAM data and calculate checksum. */
1478 	ha->isp_ops->read_nvram(ha, ptr, ha->nvram_base, ha->nvram_size);
1479 	for (cnt = 0, chksum = 0; cnt < ha->nvram_size; cnt++)
1480 		chksum += *ptr++;
1481 
1482 	DEBUG5(printk("scsi(%ld): Contents of NVRAM\n", ha->host_no));
1483 	DEBUG5(qla2x00_dump_buffer((uint8_t *)nv, ha->nvram_size));
1484 
1485 	/* Bad NVRAM data, set defaults parameters. */
1486 	if (chksum || nv->id[0] != 'I' || nv->id[1] != 'S' ||
1487 	    nv->id[2] != 'P' || nv->id[3] != ' ' || nv->nvram_version < 1) {
1488 		/* Reset NVRAM data. */
1489 		qla_printk(KERN_WARNING, ha, "Inconsistent NVRAM detected: "
1490 		    "checksum=0x%x id=%c version=0x%x.\n", chksum, nv->id[0],
1491 		    nv->nvram_version);
1492 		qla_printk(KERN_WARNING, ha, "Falling back to functioning (yet "
1493 		    "invalid -- WWPN) defaults.\n");
1494 
1495 		/*
1496 		 * Set default initialization control block.
1497 		 */
1498 		memset(nv, 0, ha->nvram_size);
1499 		nv->parameter_block_version = ICB_VERSION;
1500 
1501 		if (IS_QLA23XX(ha)) {
1502 			nv->firmware_options[0] = BIT_2 | BIT_1;
1503 			nv->firmware_options[1] = BIT_7 | BIT_5;
1504 			nv->add_firmware_options[0] = BIT_5;
1505 			nv->add_firmware_options[1] = BIT_5 | BIT_4;
1506 			nv->frame_payload_size = __constant_cpu_to_le16(2048);
1507 			nv->special_options[1] = BIT_7;
1508 		} else if (IS_QLA2200(ha)) {
1509 			nv->firmware_options[0] = BIT_2 | BIT_1;
1510 			nv->firmware_options[1] = BIT_7 | BIT_5;
1511 			nv->add_firmware_options[0] = BIT_5;
1512 			nv->add_firmware_options[1] = BIT_5 | BIT_4;
1513 			nv->frame_payload_size = __constant_cpu_to_le16(1024);
1514 		} else if (IS_QLA2100(ha)) {
1515 			nv->firmware_options[0] = BIT_3 | BIT_1;
1516 			nv->firmware_options[1] = BIT_5;
1517 			nv->frame_payload_size = __constant_cpu_to_le16(1024);
1518 		}
1519 
1520 		nv->max_iocb_allocation = __constant_cpu_to_le16(256);
1521 		nv->execution_throttle = __constant_cpu_to_le16(16);
1522 		nv->retry_count = 8;
1523 		nv->retry_delay = 1;
1524 
1525 		nv->port_name[0] = 33;
1526 		nv->port_name[3] = 224;
1527 		nv->port_name[4] = 139;
1528 
1529 		qla2xxx_nvram_wwn_from_ofw(ha, nv);
1530 
1531 		nv->login_timeout = 4;
1532 
1533 		/*
1534 		 * Set default host adapter parameters
1535 		 */
1536 		nv->host_p[1] = BIT_2;
1537 		nv->reset_delay = 5;
1538 		nv->port_down_retry_count = 8;
1539 		nv->max_luns_per_target = __constant_cpu_to_le16(8);
1540 		nv->link_down_timeout = 60;
1541 
1542 		rval = 1;
1543 	}
1544 
1545 #if defined(CONFIG_IA64_GENERIC) || defined(CONFIG_IA64_SGI_SN2)
1546 	/*
1547 	 * The SN2 does not provide BIOS emulation which means you can't change
1548 	 * potentially bogus BIOS settings. Force the use of default settings
1549 	 * for link rate and frame size.  Hope that the rest of the settings
1550 	 * are valid.
1551 	 */
1552 	if (ia64_platform_is("sn2")) {
1553 		nv->frame_payload_size = __constant_cpu_to_le16(2048);
1554 		if (IS_QLA23XX(ha))
1555 			nv->special_options[1] = BIT_7;
1556 	}
1557 #endif
1558 
1559 	/* Reset Initialization control block */
1560 	memset(icb, 0, ha->init_cb_size);
1561 
1562 	/*
1563 	 * Setup driver NVRAM options.
1564 	 */
1565 	nv->firmware_options[0] |= (BIT_6 | BIT_1);
1566 	nv->firmware_options[0] &= ~(BIT_5 | BIT_4);
1567 	nv->firmware_options[1] |= (BIT_5 | BIT_0);
1568 	nv->firmware_options[1] &= ~BIT_4;
1569 
1570 	if (IS_QLA23XX(ha)) {
1571 		nv->firmware_options[0] |= BIT_2;
1572 		nv->firmware_options[0] &= ~BIT_3;
1573 		nv->add_firmware_options[1] |= BIT_5 | BIT_4;
1574 
1575 		if (IS_QLA2300(ha)) {
1576 			if (ha->fb_rev == FPM_2310) {
1577 				strcpy(ha->model_number, "QLA2310");
1578 			} else {
1579 				strcpy(ha->model_number, "QLA2300");
1580 			}
1581 		} else {
1582 			qla2x00_set_model_info(ha, nv->model_number,
1583 			    sizeof(nv->model_number), "QLA23xx");
1584 		}
1585 	} else if (IS_QLA2200(ha)) {
1586 		nv->firmware_options[0] |= BIT_2;
1587 		/*
1588 		 * 'Point-to-point preferred, else loop' is not a safe
1589 		 * connection mode setting.
1590 		 */
1591 		if ((nv->add_firmware_options[0] & (BIT_6 | BIT_5 | BIT_4)) ==
1592 		    (BIT_5 | BIT_4)) {
1593 			/* Force 'loop preferred, else point-to-point'. */
1594 			nv->add_firmware_options[0] &= ~(BIT_6 | BIT_5 | BIT_4);
1595 			nv->add_firmware_options[0] |= BIT_5;
1596 		}
1597 		strcpy(ha->model_number, "QLA22xx");
1598 	} else /*if (IS_QLA2100(ha))*/ {
1599 		strcpy(ha->model_number, "QLA2100");
1600 	}
1601 
1602 	/*
1603 	 * Copy over NVRAM RISC parameter block to initialization control block.
1604 	 */
1605 	dptr1 = (uint8_t *)icb;
1606 	dptr2 = (uint8_t *)&nv->parameter_block_version;
1607 	cnt = (uint8_t *)&icb->request_q_outpointer - (uint8_t *)&icb->version;
1608 	while (cnt--)
1609 		*dptr1++ = *dptr2++;
1610 
1611 	/* Copy 2nd half. */
1612 	dptr1 = (uint8_t *)icb->add_firmware_options;
1613 	cnt = (uint8_t *)icb->reserved_3 - (uint8_t *)icb->add_firmware_options;
1614 	while (cnt--)
1615 		*dptr1++ = *dptr2++;
1616 
1617 	/* Use alternate WWN? */
1618 	if (nv->host_p[1] & BIT_7) {
1619 		memcpy(icb->node_name, nv->alternate_node_name, WWN_SIZE);
1620 		memcpy(icb->port_name, nv->alternate_port_name, WWN_SIZE);
1621 	}
1622 
1623 	/* Prepare nodename */
1624 	if ((icb->firmware_options[1] & BIT_6) == 0) {
1625 		/*
1626 		 * Firmware will apply the following mask if the nodename was
1627 		 * not provided.
1628 		 */
1629 		memcpy(icb->node_name, icb->port_name, WWN_SIZE);
1630 		icb->node_name[0] &= 0xF0;
1631 	}
1632 
1633 	/*
1634 	 * Set host adapter parameters.
1635 	 */
1636 	if (nv->host_p[0] & BIT_7)
1637 		ql2xextended_error_logging = 1;
1638 	ha->flags.disable_risc_code_load = ((nv->host_p[0] & BIT_4) ? 1 : 0);
1639 	/* Always load RISC code on non ISP2[12]00 chips. */
1640 	if (!IS_QLA2100(ha) && !IS_QLA2200(ha))
1641 		ha->flags.disable_risc_code_load = 0;
1642 	ha->flags.enable_lip_reset = ((nv->host_p[1] & BIT_1) ? 1 : 0);
1643 	ha->flags.enable_lip_full_login = ((nv->host_p[1] & BIT_2) ? 1 : 0);
1644 	ha->flags.enable_target_reset = ((nv->host_p[1] & BIT_3) ? 1 : 0);
1645 	ha->flags.enable_led_scheme = (nv->special_options[1] & BIT_4) ? 1 : 0;
1646 	ha->flags.disable_serdes = 0;
1647 
1648 	ha->operating_mode =
1649 	    (icb->add_firmware_options[0] & (BIT_6 | BIT_5 | BIT_4)) >> 4;
1650 
1651 	memcpy(ha->fw_seriallink_options, nv->seriallink_options,
1652 	    sizeof(ha->fw_seriallink_options));
1653 
1654 	/* save HBA serial number */
1655 	ha->serial0 = icb->port_name[5];
1656 	ha->serial1 = icb->port_name[6];
1657 	ha->serial2 = icb->port_name[7];
1658 	ha->node_name = icb->node_name;
1659 	ha->port_name = icb->port_name;
1660 
1661 	icb->execution_throttle = __constant_cpu_to_le16(0xFFFF);
1662 
1663 	ha->retry_count = nv->retry_count;
1664 
1665 	/* Set minimum login_timeout to 4 seconds. */
1666 	if (nv->login_timeout < ql2xlogintimeout)
1667 		nv->login_timeout = ql2xlogintimeout;
1668 	if (nv->login_timeout < 4)
1669 		nv->login_timeout = 4;
1670 	ha->login_timeout = nv->login_timeout;
1671 	icb->login_timeout = nv->login_timeout;
1672 
1673 	/* Set minimum RATOV to 200 tenths of a second. */
1674 	ha->r_a_tov = 200;
1675 
1676 	ha->loop_reset_delay = nv->reset_delay;
1677 
1678 	/* Link Down Timeout = 0:
1679 	 *
1680 	 * 	When Port Down timer expires we will start returning
1681 	 *	I/O's to OS with "DID_NO_CONNECT".
1682 	 *
1683 	 * Link Down Timeout != 0:
1684 	 *
1685 	 *	 The driver waits for the link to come up after link down
1686 	 *	 before returning I/Os to OS with "DID_NO_CONNECT".
1687 	 */
1688 	if (nv->link_down_timeout == 0) {
1689 		ha->loop_down_abort_time =
1690 		    (LOOP_DOWN_TIME - LOOP_DOWN_TIMEOUT);
1691 	} else {
1692 		ha->link_down_timeout =	 nv->link_down_timeout;
1693 		ha->loop_down_abort_time =
1694 		    (LOOP_DOWN_TIME - ha->link_down_timeout);
1695 	}
1696 
1697 	/*
1698 	 * Need enough time to try and get the port back.
1699 	 */
1700 	ha->port_down_retry_count = nv->port_down_retry_count;
1701 	if (qlport_down_retry)
1702 		ha->port_down_retry_count = qlport_down_retry;
1703 	/* Set login_retry_count */
1704 	ha->login_retry_count  = nv->retry_count;
1705 	if (ha->port_down_retry_count == nv->port_down_retry_count &&
1706 	    ha->port_down_retry_count > 3)
1707 		ha->login_retry_count = ha->port_down_retry_count;
1708 	else if (ha->port_down_retry_count > (int)ha->login_retry_count)
1709 		ha->login_retry_count = ha->port_down_retry_count;
1710 	if (ql2xloginretrycount)
1711 		ha->login_retry_count = ql2xloginretrycount;
1712 
1713 	icb->lun_enables = __constant_cpu_to_le16(0);
1714 	icb->command_resource_count = 0;
1715 	icb->immediate_notify_resource_count = 0;
1716 	icb->timeout = __constant_cpu_to_le16(0);
1717 
1718 	if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
1719 		/* Enable RIO */
1720 		icb->firmware_options[0] &= ~BIT_3;
1721 		icb->add_firmware_options[0] &=
1722 		    ~(BIT_3 | BIT_2 | BIT_1 | BIT_0);
1723 		icb->add_firmware_options[0] |= BIT_2;
1724 		icb->response_accumulation_timer = 3;
1725 		icb->interrupt_delay_timer = 5;
1726 
1727 		ha->flags.process_response_queue = 1;
1728 	} else {
1729 		/* Enable ZIO. */
1730 		if (!ha->flags.init_done) {
1731 			ha->zio_mode = icb->add_firmware_options[0] &
1732 			    (BIT_3 | BIT_2 | BIT_1 | BIT_0);
1733 			ha->zio_timer = icb->interrupt_delay_timer ?
1734 			    icb->interrupt_delay_timer: 2;
1735 		}
1736 		icb->add_firmware_options[0] &=
1737 		    ~(BIT_3 | BIT_2 | BIT_1 | BIT_0);
1738 		ha->flags.process_response_queue = 0;
1739 		if (ha->zio_mode != QLA_ZIO_DISABLED) {
1740 			ha->zio_mode = QLA_ZIO_MODE_6;
1741 
1742 			DEBUG2(printk("scsi(%ld): ZIO mode %d enabled; timer "
1743 			    "delay (%d us).\n", ha->host_no, ha->zio_mode,
1744 			    ha->zio_timer * 100));
1745 			qla_printk(KERN_INFO, ha,
1746 			    "ZIO mode %d enabled; timer delay (%d us).\n",
1747 			    ha->zio_mode, ha->zio_timer * 100);
1748 
1749 			icb->add_firmware_options[0] |= (uint8_t)ha->zio_mode;
1750 			icb->interrupt_delay_timer = (uint8_t)ha->zio_timer;
1751 			ha->flags.process_response_queue = 1;
1752 		}
1753 	}
1754 
1755 	if (rval) {
1756 		DEBUG2_3(printk(KERN_WARNING
1757 		    "scsi(%ld): NVRAM configuration failed!\n", ha->host_no));
1758 	}
1759 	return (rval);
1760 }
1761 
1762 static void
1763 qla2x00_rport_del(void *data)
1764 {
1765 	fc_port_t *fcport = data;
1766 	struct fc_rport *rport;
1767 	unsigned long flags;
1768 
1769 	spin_lock_irqsave(&fcport->rport_lock, flags);
1770 	rport = fcport->drport;
1771 	fcport->drport = NULL;
1772 	spin_unlock_irqrestore(&fcport->rport_lock, flags);
1773 	if (rport)
1774 		fc_remote_port_delete(rport);
1775 }
1776 
1777 /**
1778  * qla2x00_alloc_fcport() - Allocate a generic fcport.
1779  * @ha: HA context
1780  * @flags: allocation flags
1781  *
1782  * Returns a pointer to the allocated fcport, or NULL, if none available.
1783  */
1784 static fc_port_t *
1785 qla2x00_alloc_fcport(scsi_qla_host_t *ha, gfp_t flags)
1786 {
1787 	fc_port_t *fcport;
1788 
1789 	fcport = kmalloc(sizeof(fc_port_t), flags);
1790 	if (fcport == NULL)
1791 		return (fcport);
1792 
1793 	/* Setup fcport template structure. */
1794 	memset(fcport, 0, sizeof (fc_port_t));
1795 	fcport->ha = ha;
1796 	fcport->vp_idx = ha->vp_idx;
1797 	fcport->port_type = FCT_UNKNOWN;
1798 	fcport->loop_id = FC_NO_LOOP_ID;
1799 	atomic_set(&fcport->state, FCS_UNCONFIGURED);
1800 	fcport->flags = FCF_RLC_SUPPORT;
1801 	fcport->supported_classes = FC_COS_UNSPECIFIED;
1802 	spin_lock_init(&fcport->rport_lock);
1803 
1804 	return (fcport);
1805 }
1806 
1807 /*
1808  * qla2x00_configure_loop
1809  *      Updates Fibre Channel Device Database with what is actually on loop.
1810  *
1811  * Input:
1812  *      ha                = adapter block pointer.
1813  *
1814  * Returns:
1815  *      0 = success.
1816  *      1 = error.
1817  *      2 = database was full and device was not configured.
1818  */
1819 static int
1820 qla2x00_configure_loop(scsi_qla_host_t *ha)
1821 {
1822 	int  rval;
1823 	unsigned long flags, save_flags;
1824 
1825 	rval = QLA_SUCCESS;
1826 
1827 	/* Get Initiator ID */
1828 	if (test_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags)) {
1829 		rval = qla2x00_configure_hba(ha);
1830 		if (rval != QLA_SUCCESS) {
1831 			DEBUG(printk("scsi(%ld): Unable to configure HBA.\n",
1832 			    ha->host_no));
1833 			return (rval);
1834 		}
1835 	}
1836 
1837 	save_flags = flags = ha->dpc_flags;
1838 	DEBUG(printk("scsi(%ld): Configure loop -- dpc flags =0x%lx\n",
1839 	    ha->host_no, flags));
1840 
1841 	/*
1842 	 * If we have both an RSCN and PORT UPDATE pending then handle them
1843 	 * both at the same time.
1844 	 */
1845 	clear_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags);
1846 	clear_bit(RSCN_UPDATE, &ha->dpc_flags);
1847 
1848 	/* Determine what we need to do */
1849 	if (ha->current_topology == ISP_CFG_FL &&
1850 	    (test_bit(LOCAL_LOOP_UPDATE, &flags))) {
1851 
1852 		ha->flags.rscn_queue_overflow = 1;
1853 		set_bit(RSCN_UPDATE, &flags);
1854 
1855 	} else if (ha->current_topology == ISP_CFG_F &&
1856 	    (test_bit(LOCAL_LOOP_UPDATE, &flags))) {
1857 
1858 		ha->flags.rscn_queue_overflow = 1;
1859 		set_bit(RSCN_UPDATE, &flags);
1860 		clear_bit(LOCAL_LOOP_UPDATE, &flags);
1861 
1862 	} else if (ha->current_topology == ISP_CFG_N) {
1863 		clear_bit(RSCN_UPDATE, &flags);
1864 
1865 	} else if (!ha->flags.online ||
1866 	    (test_bit(ABORT_ISP_ACTIVE, &flags))) {
1867 
1868 		ha->flags.rscn_queue_overflow = 1;
1869 		set_bit(RSCN_UPDATE, &flags);
1870 		set_bit(LOCAL_LOOP_UPDATE, &flags);
1871 	}
1872 
1873 	if (test_bit(LOCAL_LOOP_UPDATE, &flags)) {
1874 		if (test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags)) {
1875 			rval = QLA_FUNCTION_FAILED;
1876 		} else {
1877 			rval = qla2x00_configure_local_loop(ha);
1878 		}
1879 	}
1880 
1881 	if (rval == QLA_SUCCESS && test_bit(RSCN_UPDATE, &flags)) {
1882 		if (LOOP_TRANSITION(ha)) {
1883 			rval = QLA_FUNCTION_FAILED;
1884 		} else {
1885 			rval = qla2x00_configure_fabric(ha);
1886 		}
1887 	}
1888 
1889 	if (rval == QLA_SUCCESS) {
1890 		if (atomic_read(&ha->loop_down_timer) ||
1891 		    test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags)) {
1892 			rval = QLA_FUNCTION_FAILED;
1893 		} else {
1894 			atomic_set(&ha->loop_state, LOOP_READY);
1895 
1896 			DEBUG(printk("scsi(%ld): LOOP READY\n", ha->host_no));
1897 		}
1898 	}
1899 
1900 	if (rval) {
1901 		DEBUG2_3(printk("%s(%ld): *** FAILED ***\n",
1902 		    __func__, ha->host_no));
1903 	} else {
1904 		DEBUG3(printk("%s: exiting normally\n", __func__));
1905 	}
1906 
1907 	/* Restore state if a resync event occured during processing */
1908 	if (test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags)) {
1909 		if (test_bit(LOCAL_LOOP_UPDATE, &save_flags))
1910 			set_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags);
1911 		if (test_bit(RSCN_UPDATE, &save_flags))
1912 			set_bit(RSCN_UPDATE, &ha->dpc_flags);
1913 	}
1914 
1915 	return (rval);
1916 }
1917 
1918 
1919 
1920 /*
1921  * qla2x00_configure_local_loop
1922  *	Updates Fibre Channel Device Database with local loop devices.
1923  *
1924  * Input:
1925  *	ha = adapter block pointer.
1926  *
1927  * Returns:
1928  *	0 = success.
1929  */
1930 static int
1931 qla2x00_configure_local_loop(scsi_qla_host_t *ha)
1932 {
1933 	int		rval, rval2;
1934 	int		found_devs;
1935 	int		found;
1936 	fc_port_t	*fcport, *new_fcport;
1937 
1938 	uint16_t	index;
1939 	uint16_t	entries;
1940 	char		*id_iter;
1941 	uint16_t	loop_id;
1942 	uint8_t		domain, area, al_pa;
1943 	scsi_qla_host_t *pha = to_qla_parent(ha);
1944 
1945 	found_devs = 0;
1946 	new_fcport = NULL;
1947 	entries = MAX_FIBRE_DEVICES;
1948 
1949 	DEBUG3(printk("scsi(%ld): Getting FCAL position map\n", ha->host_no));
1950 	DEBUG3(qla2x00_get_fcal_position_map(ha, NULL));
1951 
1952 	/* Get list of logged in devices. */
1953 	memset(ha->gid_list, 0, GID_LIST_SIZE);
1954 	rval = qla2x00_get_id_list(ha, ha->gid_list, ha->gid_list_dma,
1955 	    &entries);
1956 	if (rval != QLA_SUCCESS)
1957 		goto cleanup_allocation;
1958 
1959 	DEBUG3(printk("scsi(%ld): Entries in ID list (%d)\n",
1960 	    ha->host_no, entries));
1961 	DEBUG3(qla2x00_dump_buffer((uint8_t *)ha->gid_list,
1962 	    entries * sizeof(struct gid_list_info)));
1963 
1964 	/* Allocate temporary fcport for any new fcports discovered. */
1965 	new_fcport = qla2x00_alloc_fcport(ha, GFP_KERNEL);
1966 	if (new_fcport == NULL) {
1967 		rval = QLA_MEMORY_ALLOC_FAILED;
1968 		goto cleanup_allocation;
1969 	}
1970 	new_fcport->flags &= ~FCF_FABRIC_DEVICE;
1971 
1972 	/*
1973 	 * Mark local devices that were present with FCF_DEVICE_LOST for now.
1974 	 */
1975 	list_for_each_entry(fcport, &pha->fcports, list) {
1976 		if (fcport->vp_idx != ha->vp_idx)
1977 			continue;
1978 
1979 		if (atomic_read(&fcport->state) == FCS_ONLINE &&
1980 		    fcport->port_type != FCT_BROADCAST &&
1981 		    (fcport->flags & FCF_FABRIC_DEVICE) == 0) {
1982 
1983 			DEBUG(printk("scsi(%ld): Marking port lost, "
1984 			    "loop_id=0x%04x\n",
1985 			    ha->host_no, fcport->loop_id));
1986 
1987 			atomic_set(&fcport->state, FCS_DEVICE_LOST);
1988 			fcport->flags &= ~FCF_FARP_DONE;
1989 		}
1990 	}
1991 
1992 	/* Add devices to port list. */
1993 	id_iter = (char *)ha->gid_list;
1994 	for (index = 0; index < entries; index++) {
1995 		domain = ((struct gid_list_info *)id_iter)->domain;
1996 		area = ((struct gid_list_info *)id_iter)->area;
1997 		al_pa = ((struct gid_list_info *)id_iter)->al_pa;
1998 		if (IS_QLA2100(ha) || IS_QLA2200(ha))
1999 			loop_id = (uint16_t)
2000 			    ((struct gid_list_info *)id_iter)->loop_id_2100;
2001 		else
2002 			loop_id = le16_to_cpu(
2003 			    ((struct gid_list_info *)id_iter)->loop_id);
2004 		id_iter += ha->gid_list_info_size;
2005 
2006 		/* Bypass reserved domain fields. */
2007 		if ((domain & 0xf0) == 0xf0)
2008 			continue;
2009 
2010 		/* Bypass if not same domain and area of adapter. */
2011 		if (area && domain &&
2012 		    (area != ha->d_id.b.area || domain != ha->d_id.b.domain))
2013 			continue;
2014 
2015 		/* Bypass invalid local loop ID. */
2016 		if (loop_id > LAST_LOCAL_LOOP_ID)
2017 			continue;
2018 
2019 		/* Fill in member data. */
2020 		new_fcport->d_id.b.domain = domain;
2021 		new_fcport->d_id.b.area = area;
2022 		new_fcport->d_id.b.al_pa = al_pa;
2023 		new_fcport->loop_id = loop_id;
2024 		new_fcport->vp_idx = ha->vp_idx;
2025 		rval2 = qla2x00_get_port_database(ha, new_fcport, 0);
2026 		if (rval2 != QLA_SUCCESS) {
2027 			DEBUG2(printk("scsi(%ld): Failed to retrieve fcport "
2028 			    "information -- get_port_database=%x, "
2029 			    "loop_id=0x%04x\n",
2030 			    ha->host_no, rval2, new_fcport->loop_id));
2031 			DEBUG2(printk("scsi(%ld): Scheduling resync...\n",
2032 			    ha->host_no));
2033 			set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
2034 			continue;
2035 		}
2036 
2037 		/* Check for matching device in port list. */
2038 		found = 0;
2039 		fcport = NULL;
2040 		list_for_each_entry(fcport, &pha->fcports, list) {
2041 			if (fcport->vp_idx != ha->vp_idx)
2042 				continue;
2043 
2044 			if (memcmp(new_fcport->port_name, fcport->port_name,
2045 			    WWN_SIZE))
2046 				continue;
2047 
2048 			fcport->flags &= ~(FCF_FABRIC_DEVICE |
2049 			    FCF_PERSISTENT_BOUND);
2050 			fcport->loop_id = new_fcport->loop_id;
2051 			fcport->port_type = new_fcport->port_type;
2052 			fcport->d_id.b24 = new_fcport->d_id.b24;
2053 			memcpy(fcport->node_name, new_fcport->node_name,
2054 			    WWN_SIZE);
2055 
2056 			found++;
2057 			break;
2058 		}
2059 
2060 		if (!found) {
2061 			/* New device, add to fcports list. */
2062 			new_fcport->flags &= ~FCF_PERSISTENT_BOUND;
2063 			if (ha->parent) {
2064 				new_fcport->ha = ha;
2065 				new_fcport->vp_idx = ha->vp_idx;
2066 				list_add_tail(&new_fcport->vp_fcport,
2067 				    &ha->vp_fcports);
2068 			}
2069 			list_add_tail(&new_fcport->list, &pha->fcports);
2070 
2071 			/* Allocate a new replacement fcport. */
2072 			fcport = new_fcport;
2073 			new_fcport = qla2x00_alloc_fcport(ha, GFP_KERNEL);
2074 			if (new_fcport == NULL) {
2075 				rval = QLA_MEMORY_ALLOC_FAILED;
2076 				goto cleanup_allocation;
2077 			}
2078 			new_fcport->flags &= ~FCF_FABRIC_DEVICE;
2079 		}
2080 
2081 		/* Base iIDMA settings on HBA port speed. */
2082 		fcport->fp_speed = ha->link_data_rate;
2083 
2084 		qla2x00_update_fcport(ha, fcport);
2085 
2086 		found_devs++;
2087 	}
2088 
2089 cleanup_allocation:
2090 	kfree(new_fcport);
2091 
2092 	if (rval != QLA_SUCCESS) {
2093 		DEBUG2(printk("scsi(%ld): Configure local loop error exit: "
2094 		    "rval=%x\n", ha->host_no, rval));
2095 	}
2096 
2097 	if (found_devs) {
2098 		ha->device_flags |= DFLG_LOCAL_DEVICES;
2099 		ha->device_flags &= ~DFLG_RETRY_LOCAL_DEVICES;
2100 	}
2101 
2102 	return (rval);
2103 }
2104 
2105 static void
2106 qla2x00_probe_for_all_luns(scsi_qla_host_t *ha)
2107 {
2108 	fc_port_t	*fcport;
2109 
2110 	qla2x00_mark_all_devices_lost(ha, 0);
2111  	list_for_each_entry(fcport, &ha->fcports, list) {
2112 		if (fcport->port_type != FCT_TARGET)
2113 			continue;
2114 
2115 		qla2x00_update_fcport(ha, fcport);
2116 	}
2117 }
2118 
2119 static void
2120 qla2x00_iidma_fcport(scsi_qla_host_t *ha, fc_port_t *fcport)
2121 {
2122 #define LS_UNKNOWN      2
2123 	static char *link_speeds[5] = { "1", "2", "?", "4", "8" };
2124 	int rval;
2125 	uint16_t mb[6];
2126 
2127 	if (!IS_IIDMA_CAPABLE(ha))
2128 		return;
2129 
2130 	if (fcport->fp_speed == PORT_SPEED_UNKNOWN) {
2131 		DEBUG2(printk("scsi(%ld): %02x%02x%02x%02x%02x%02x%02x%02x -- "
2132 		    "unsupported FM port operating speed.\n",
2133 		    ha->host_no, fcport->port_name[0], fcport->port_name[1],
2134 		    fcport->port_name[2], fcport->port_name[3],
2135 		    fcport->port_name[4], fcport->port_name[5],
2136 		    fcport->port_name[6], fcport->port_name[7]));
2137 		return;
2138 	}
2139 
2140 	rval = qla2x00_set_idma_speed(ha, fcport->loop_id, fcport->fp_speed,
2141 	    mb);
2142 	if (rval != QLA_SUCCESS) {
2143 		DEBUG2(printk("scsi(%ld): Unable to adjust iIDMA "
2144 		    "%02x%02x%02x%02x%02x%02x%02x%02x -- %04x %x %04x %04x.\n",
2145 		    ha->host_no, fcport->port_name[0], fcport->port_name[1],
2146 		    fcport->port_name[2], fcport->port_name[3],
2147 		    fcport->port_name[4], fcport->port_name[5],
2148 		    fcport->port_name[6], fcport->port_name[7], rval,
2149 		    fcport->fp_speed, mb[0], mb[1]));
2150 	} else {
2151 		DEBUG2(qla_printk(KERN_INFO, ha,
2152 		    "iIDMA adjusted to %s GB/s on "
2153 		    "%02x%02x%02x%02x%02x%02x%02x%02x.\n",
2154 		    link_speeds[fcport->fp_speed], fcport->port_name[0],
2155 		    fcport->port_name[1], fcport->port_name[2],
2156 		    fcport->port_name[3], fcport->port_name[4],
2157 		    fcport->port_name[5], fcport->port_name[6],
2158 		    fcport->port_name[7]));
2159 	}
2160 }
2161 
2162 static void
2163 qla2x00_reg_remote_port(scsi_qla_host_t *ha, fc_port_t *fcport)
2164 {
2165 	struct fc_rport_identifiers rport_ids;
2166 	struct fc_rport *rport;
2167 	unsigned long flags;
2168 
2169 	if (fcport->drport)
2170 		qla2x00_rport_del(fcport);
2171 	if (fcport->rport)
2172 		return;
2173 
2174 	rport_ids.node_name = wwn_to_u64(fcport->node_name);
2175 	rport_ids.port_name = wwn_to_u64(fcport->port_name);
2176 	rport_ids.port_id = fcport->d_id.b.domain << 16 |
2177 	    fcport->d_id.b.area << 8 | fcport->d_id.b.al_pa;
2178 	rport_ids.roles = FC_RPORT_ROLE_UNKNOWN;
2179 	rport = fc_remote_port_add(ha->host, 0, &rport_ids);
2180 	if (!rport) {
2181 		qla_printk(KERN_WARNING, ha,
2182 		    "Unable to allocate fc remote port!\n");
2183 		return;
2184 	}
2185 	spin_lock_irqsave(&fcport->rport_lock, flags);
2186 	fcport->rport = rport;
2187 	*((fc_port_t **)rport->dd_data) = fcport;
2188 	spin_unlock_irqrestore(&fcport->rport_lock, flags);
2189 
2190 	rport->supported_classes = fcport->supported_classes;
2191 
2192 	rport_ids.roles = FC_RPORT_ROLE_UNKNOWN;
2193 	if (fcport->port_type == FCT_INITIATOR)
2194 		rport_ids.roles |= FC_RPORT_ROLE_FCP_INITIATOR;
2195 	if (fcport->port_type == FCT_TARGET)
2196 		rport_ids.roles |= FC_RPORT_ROLE_FCP_TARGET;
2197 	fc_remote_port_rolechg(rport, rport_ids.roles);
2198 
2199 	if (rport->scsi_target_id != -1 &&
2200 	    rport->scsi_target_id < ha->host->max_id)
2201 		fcport->os_target_id = rport->scsi_target_id;
2202 }
2203 
2204 /*
2205  * qla2x00_update_fcport
2206  *	Updates device on list.
2207  *
2208  * Input:
2209  *	ha = adapter block pointer.
2210  *	fcport = port structure pointer.
2211  *
2212  * Return:
2213  *	0  - Success
2214  *  BIT_0 - error
2215  *
2216  * Context:
2217  *	Kernel context.
2218  */
2219 void
2220 qla2x00_update_fcport(scsi_qla_host_t *ha, fc_port_t *fcport)
2221 {
2222 	scsi_qla_host_t *pha = to_qla_parent(ha);
2223 
2224 	fcport->ha = ha;
2225 	fcport->login_retry = 0;
2226 	fcport->port_login_retry_count = pha->port_down_retry_count *
2227 	    PORT_RETRY_TIME;
2228 	atomic_set(&fcport->port_down_timer, pha->port_down_retry_count *
2229 	    PORT_RETRY_TIME);
2230 	fcport->flags &= ~FCF_LOGIN_NEEDED;
2231 
2232 	qla2x00_iidma_fcport(ha, fcport);
2233 
2234 	atomic_set(&fcport->state, FCS_ONLINE);
2235 
2236 	qla2x00_reg_remote_port(ha, fcport);
2237 }
2238 
2239 /*
2240  * qla2x00_configure_fabric
2241  *      Setup SNS devices with loop ID's.
2242  *
2243  * Input:
2244  *      ha = adapter block pointer.
2245  *
2246  * Returns:
2247  *      0 = success.
2248  *      BIT_0 = error
2249  */
2250 static int
2251 qla2x00_configure_fabric(scsi_qla_host_t *ha)
2252 {
2253 	int	rval, rval2;
2254 	fc_port_t	*fcport, *fcptemp;
2255 	uint16_t	next_loopid;
2256 	uint16_t	mb[MAILBOX_REGISTER_COUNT];
2257 	uint16_t	loop_id;
2258 	LIST_HEAD(new_fcports);
2259 	scsi_qla_host_t *pha = to_qla_parent(ha);
2260 
2261 	/* If FL port exists, then SNS is present */
2262 	if (IS_FWI2_CAPABLE(ha))
2263 		loop_id = NPH_F_PORT;
2264 	else
2265 		loop_id = SNS_FL_PORT;
2266 	rval = qla2x00_get_port_name(ha, loop_id, ha->fabric_node_name, 1);
2267 	if (rval != QLA_SUCCESS) {
2268 		DEBUG2(printk("scsi(%ld): MBC_GET_PORT_NAME Failed, No FL "
2269 		    "Port\n", ha->host_no));
2270 
2271 		ha->device_flags &= ~SWITCH_FOUND;
2272 		return (QLA_SUCCESS);
2273 	}
2274 	ha->device_flags |= SWITCH_FOUND;
2275 
2276 	/* Mark devices that need re-synchronization. */
2277 	rval2 = qla2x00_device_resync(ha);
2278 	if (rval2 == QLA_RSCNS_HANDLED) {
2279 		/* No point doing the scan, just continue. */
2280 		return (QLA_SUCCESS);
2281 	}
2282 	do {
2283 		/* FDMI support. */
2284 		if (ql2xfdmienable &&
2285 		    test_and_clear_bit(REGISTER_FDMI_NEEDED, &ha->dpc_flags))
2286 			qla2x00_fdmi_register(ha);
2287 
2288 		/* Ensure we are logged into the SNS. */
2289 		if (IS_FWI2_CAPABLE(ha))
2290 			loop_id = NPH_SNS;
2291 		else
2292 			loop_id = SIMPLE_NAME_SERVER;
2293 		ha->isp_ops->fabric_login(ha, loop_id, 0xff, 0xff,
2294 		    0xfc, mb, BIT_1 | BIT_0);
2295 		if (mb[0] != MBS_COMMAND_COMPLETE) {
2296 			DEBUG2(qla_printk(KERN_INFO, ha,
2297 			    "Failed SNS login: loop_id=%x mb[0]=%x mb[1]=%x "
2298 			    "mb[2]=%x mb[6]=%x mb[7]=%x\n", loop_id,
2299 			    mb[0], mb[1], mb[2], mb[6], mb[7]));
2300 			return (QLA_SUCCESS);
2301 		}
2302 
2303 		if (test_and_clear_bit(REGISTER_FC4_NEEDED, &ha->dpc_flags)) {
2304 			if (qla2x00_rft_id(ha)) {
2305 				/* EMPTY */
2306 				DEBUG2(printk("scsi(%ld): Register FC-4 "
2307 				    "TYPE failed.\n", ha->host_no));
2308 			}
2309 			if (qla2x00_rff_id(ha)) {
2310 				/* EMPTY */
2311 				DEBUG2(printk("scsi(%ld): Register FC-4 "
2312 				    "Features failed.\n", ha->host_no));
2313 			}
2314 			if (qla2x00_rnn_id(ha)) {
2315 				/* EMPTY */
2316 				DEBUG2(printk("scsi(%ld): Register Node Name "
2317 				    "failed.\n", ha->host_no));
2318 			} else if (qla2x00_rsnn_nn(ha)) {
2319 				/* EMPTY */
2320 				DEBUG2(printk("scsi(%ld): Register Symbolic "
2321 				    "Node Name failed.\n", ha->host_no));
2322 			}
2323 		}
2324 
2325 		rval = qla2x00_find_all_fabric_devs(ha, &new_fcports);
2326 		if (rval != QLA_SUCCESS)
2327 			break;
2328 
2329 		/*
2330 		 * Logout all previous fabric devices marked lost, except
2331 		 * tape devices.
2332 		 */
2333 		list_for_each_entry(fcport, &pha->fcports, list) {
2334 			if (fcport->vp_idx !=ha->vp_idx)
2335 				continue;
2336 
2337 			if (test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags))
2338 				break;
2339 
2340 			if ((fcport->flags & FCF_FABRIC_DEVICE) == 0)
2341 				continue;
2342 
2343 			if (atomic_read(&fcport->state) == FCS_DEVICE_LOST) {
2344 				qla2x00_mark_device_lost(ha, fcport,
2345 				    ql2xplogiabsentdevice, 0);
2346 				if (fcport->loop_id != FC_NO_LOOP_ID &&
2347 				    (fcport->flags & FCF_TAPE_PRESENT) == 0 &&
2348 				    fcport->port_type != FCT_INITIATOR &&
2349 				    fcport->port_type != FCT_BROADCAST) {
2350 					ha->isp_ops->fabric_logout(ha,
2351 					    fcport->loop_id,
2352 					    fcport->d_id.b.domain,
2353 					    fcport->d_id.b.area,
2354 					    fcport->d_id.b.al_pa);
2355 					fcport->loop_id = FC_NO_LOOP_ID;
2356 				}
2357 			}
2358 		}
2359 
2360 		/* Starting free loop ID. */
2361 		next_loopid = pha->min_external_loopid;
2362 
2363 		/*
2364 		 * Scan through our port list and login entries that need to be
2365 		 * logged in.
2366 		 */
2367 		list_for_each_entry(fcport, &pha->fcports, list) {
2368 			if (fcport->vp_idx != ha->vp_idx)
2369 				continue;
2370 
2371 			if (atomic_read(&ha->loop_down_timer) ||
2372 			    test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags))
2373 				break;
2374 
2375 			if ((fcport->flags & FCF_FABRIC_DEVICE) == 0 ||
2376 			    (fcport->flags & FCF_LOGIN_NEEDED) == 0)
2377 				continue;
2378 
2379 			if (fcport->loop_id == FC_NO_LOOP_ID) {
2380 				fcport->loop_id = next_loopid;
2381 				rval = qla2x00_find_new_loop_id(ha, fcport);
2382 				if (rval != QLA_SUCCESS) {
2383 					/* Ran out of IDs to use */
2384 					break;
2385 				}
2386 			}
2387 			/* Login and update database */
2388 			qla2x00_fabric_dev_login(ha, fcport, &next_loopid);
2389 		}
2390 
2391 		/* Exit if out of loop IDs. */
2392 		if (rval != QLA_SUCCESS) {
2393 			break;
2394 		}
2395 
2396 		/*
2397 		 * Login and add the new devices to our port list.
2398 		 */
2399 		list_for_each_entry_safe(fcport, fcptemp, &new_fcports, list) {
2400 			if (atomic_read(&ha->loop_down_timer) ||
2401 			    test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags))
2402 				break;
2403 
2404 			/* Find a new loop ID to use. */
2405 			fcport->loop_id = next_loopid;
2406 			rval = qla2x00_find_new_loop_id(ha, fcport);
2407 			if (rval != QLA_SUCCESS) {
2408 				/* Ran out of IDs to use */
2409 				break;
2410 			}
2411 
2412 			/* Login and update database */
2413 			qla2x00_fabric_dev_login(ha, fcport, &next_loopid);
2414 
2415 			if (ha->parent) {
2416 				fcport->ha = ha;
2417 				fcport->vp_idx = ha->vp_idx;
2418 				list_add_tail(&fcport->vp_fcport,
2419 				    &ha->vp_fcports);
2420 				list_move_tail(&fcport->list,
2421 				    &ha->parent->fcports);
2422 			} else
2423 				list_move_tail(&fcport->list, &ha->fcports);
2424 		}
2425 	} while (0);
2426 
2427 	/* Free all new device structures not processed. */
2428 	list_for_each_entry_safe(fcport, fcptemp, &new_fcports, list) {
2429 		list_del(&fcport->list);
2430 		kfree(fcport);
2431 	}
2432 
2433 	if (rval) {
2434 		DEBUG2(printk("scsi(%ld): Configure fabric error exit: "
2435 		    "rval=%d\n", ha->host_no, rval));
2436 	}
2437 
2438 	return (rval);
2439 }
2440 
2441 
2442 /*
2443  * qla2x00_find_all_fabric_devs
2444  *
2445  * Input:
2446  *	ha = adapter block pointer.
2447  *	dev = database device entry pointer.
2448  *
2449  * Returns:
2450  *	0 = success.
2451  *
2452  * Context:
2453  *	Kernel context.
2454  */
2455 static int
2456 qla2x00_find_all_fabric_devs(scsi_qla_host_t *ha, struct list_head *new_fcports)
2457 {
2458 	int		rval;
2459 	uint16_t	loop_id;
2460 	fc_port_t	*fcport, *new_fcport, *fcptemp;
2461 	int		found;
2462 
2463 	sw_info_t	*swl;
2464 	int		swl_idx;
2465 	int		first_dev, last_dev;
2466 	port_id_t	wrap, nxt_d_id;
2467 	int 		vp_index;
2468 	int		empty_vp_index;
2469 	int		found_vp;
2470 	scsi_qla_host_t *vha;
2471 	scsi_qla_host_t *pha = to_qla_parent(ha);
2472 
2473 	rval = QLA_SUCCESS;
2474 
2475 	/* Try GID_PT to get device list, else GAN. */
2476 	swl = kmalloc(sizeof(sw_info_t) * MAX_FIBRE_DEVICES, GFP_ATOMIC);
2477 	if (swl == NULL) {
2478 		/*EMPTY*/
2479 		DEBUG2(printk("scsi(%ld): GID_PT allocations failed, fallback "
2480 		    "on GA_NXT\n", ha->host_no));
2481 	} else {
2482 		memset(swl, 0, sizeof(sw_info_t) * MAX_FIBRE_DEVICES);
2483 		if (qla2x00_gid_pt(ha, swl) != QLA_SUCCESS) {
2484 			kfree(swl);
2485 			swl = NULL;
2486 		} else if (qla2x00_gpn_id(ha, swl) != QLA_SUCCESS) {
2487 			kfree(swl);
2488 			swl = NULL;
2489 		} else if (qla2x00_gnn_id(ha, swl) != QLA_SUCCESS) {
2490 			kfree(swl);
2491 			swl = NULL;
2492 		} else if (qla2x00_gfpn_id(ha, swl) == QLA_SUCCESS) {
2493 			qla2x00_gpsc(ha, swl);
2494 		}
2495 	}
2496 	swl_idx = 0;
2497 
2498 	/* Allocate temporary fcport for any new fcports discovered. */
2499 	new_fcport = qla2x00_alloc_fcport(ha, GFP_KERNEL);
2500 	if (new_fcport == NULL) {
2501 		kfree(swl);
2502 		return (QLA_MEMORY_ALLOC_FAILED);
2503 	}
2504 	new_fcport->flags |= (FCF_FABRIC_DEVICE | FCF_LOGIN_NEEDED);
2505 	new_fcport->vp_idx = ha->vp_idx;
2506 	/* Set start port ID scan at adapter ID. */
2507 	first_dev = 1;
2508 	last_dev = 0;
2509 
2510 	/* Starting free loop ID. */
2511 	loop_id = pha->min_external_loopid;
2512 	for (; loop_id <= ha->last_loop_id; loop_id++) {
2513 		if (qla2x00_is_reserved_id(ha, loop_id))
2514 			continue;
2515 
2516 		if (atomic_read(&ha->loop_down_timer) || LOOP_TRANSITION(ha))
2517 			break;
2518 
2519 		if (swl != NULL) {
2520 			if (last_dev) {
2521 				wrap.b24 = new_fcport->d_id.b24;
2522 			} else {
2523 				new_fcport->d_id.b24 = swl[swl_idx].d_id.b24;
2524 				memcpy(new_fcport->node_name,
2525 				    swl[swl_idx].node_name, WWN_SIZE);
2526 				memcpy(new_fcport->port_name,
2527 				    swl[swl_idx].port_name, WWN_SIZE);
2528 				memcpy(new_fcport->fabric_port_name,
2529 				    swl[swl_idx].fabric_port_name, WWN_SIZE);
2530 				new_fcport->fp_speed = swl[swl_idx].fp_speed;
2531 
2532 				if (swl[swl_idx].d_id.b.rsvd_1 != 0) {
2533 					last_dev = 1;
2534 				}
2535 				swl_idx++;
2536 			}
2537 		} else {
2538 			/* Send GA_NXT to the switch */
2539 			rval = qla2x00_ga_nxt(ha, new_fcport);
2540 			if (rval != QLA_SUCCESS) {
2541 				qla_printk(KERN_WARNING, ha,
2542 				    "SNS scan failed -- assuming zero-entry "
2543 				    "result...\n");
2544 				list_for_each_entry_safe(fcport, fcptemp,
2545 				    new_fcports, list) {
2546 					list_del(&fcport->list);
2547 					kfree(fcport);
2548 				}
2549 				rval = QLA_SUCCESS;
2550 				break;
2551 			}
2552 		}
2553 
2554 		/* If wrap on switch device list, exit. */
2555 		if (first_dev) {
2556 			wrap.b24 = new_fcport->d_id.b24;
2557 			first_dev = 0;
2558 		} else if (new_fcport->d_id.b24 == wrap.b24) {
2559 			DEBUG2(printk("scsi(%ld): device wrap (%02x%02x%02x)\n",
2560 			    ha->host_no, new_fcport->d_id.b.domain,
2561 			    new_fcport->d_id.b.area, new_fcport->d_id.b.al_pa));
2562 			break;
2563 		}
2564 
2565 		/* Bypass if same physical adapter. */
2566 		if (new_fcport->d_id.b24 == pha->d_id.b24)
2567 			continue;
2568 
2569 		/* Bypass virtual ports of the same host. */
2570 		if (pha->num_vhosts) {
2571 			vp_index = find_next_bit(
2572 			    (unsigned long *)pha->vp_idx_map,
2573 			    MAX_MULTI_ID_FABRIC + 1, 1);
2574 
2575 			for (;vp_index <= MAX_MULTI_ID_FABRIC;
2576 			    vp_index = find_next_bit(
2577 			    (unsigned long *)pha->vp_idx_map,
2578 			    MAX_MULTI_ID_FABRIC + 1, vp_index + 1)) {
2579 				empty_vp_index = 1;
2580 				found_vp = 0;
2581 				list_for_each_entry(vha, &pha->vp_list,
2582 				    vp_list) {
2583 					if (vp_index == vha->vp_idx) {
2584 						empty_vp_index = 0;
2585 						found_vp = 1;
2586 						break;
2587 					}
2588 				}
2589 
2590 				if (empty_vp_index)
2591 					continue;
2592 
2593 				if (found_vp &&
2594 				    new_fcport->d_id.b24 == vha->d_id.b24)
2595 					break;
2596 			}
2597 			if (vp_index <= MAX_MULTI_ID_FABRIC)
2598 				continue;
2599 		}
2600 
2601 		/* Bypass if same domain and area of adapter. */
2602 		if (((new_fcport->d_id.b24 & 0xffff00) ==
2603 		    (ha->d_id.b24 & 0xffff00)) && ha->current_topology ==
2604 			ISP_CFG_FL)
2605 			    continue;
2606 
2607 		/* Bypass reserved domain fields. */
2608 		if ((new_fcport->d_id.b.domain & 0xf0) == 0xf0)
2609 			continue;
2610 
2611 		/* Locate matching device in database. */
2612 		found = 0;
2613 		list_for_each_entry(fcport, &pha->fcports, list) {
2614 			if (new_fcport->vp_idx != fcport->vp_idx)
2615 				continue;
2616 			if (memcmp(new_fcport->port_name, fcport->port_name,
2617 			    WWN_SIZE))
2618 				continue;
2619 
2620 			found++;
2621 
2622 			/* Update port state. */
2623 			memcpy(fcport->fabric_port_name,
2624 			    new_fcport->fabric_port_name, WWN_SIZE);
2625 			fcport->fp_speed = new_fcport->fp_speed;
2626 
2627 			/*
2628 			 * If address the same and state FCS_ONLINE, nothing
2629 			 * changed.
2630 			 */
2631 			if (fcport->d_id.b24 == new_fcport->d_id.b24 &&
2632 			    atomic_read(&fcport->state) == FCS_ONLINE) {
2633 				break;
2634 			}
2635 
2636 			/*
2637 			 * If device was not a fabric device before.
2638 			 */
2639 			if ((fcport->flags & FCF_FABRIC_DEVICE) == 0) {
2640 				fcport->d_id.b24 = new_fcport->d_id.b24;
2641 				fcport->loop_id = FC_NO_LOOP_ID;
2642 				fcport->flags |= (FCF_FABRIC_DEVICE |
2643 				    FCF_LOGIN_NEEDED);
2644 				fcport->flags &= ~FCF_PERSISTENT_BOUND;
2645 				break;
2646 			}
2647 
2648 			/*
2649 			 * Port ID changed or device was marked to be updated;
2650 			 * Log it out if still logged in and mark it for
2651 			 * relogin later.
2652 			 */
2653 			fcport->d_id.b24 = new_fcport->d_id.b24;
2654 			fcport->flags |= FCF_LOGIN_NEEDED;
2655 			if (fcport->loop_id != FC_NO_LOOP_ID &&
2656 			    (fcport->flags & FCF_TAPE_PRESENT) == 0 &&
2657 			    fcport->port_type != FCT_INITIATOR &&
2658 			    fcport->port_type != FCT_BROADCAST) {
2659 				ha->isp_ops->fabric_logout(ha, fcport->loop_id,
2660 				    fcport->d_id.b.domain, fcport->d_id.b.area,
2661 				    fcport->d_id.b.al_pa);
2662 				fcport->loop_id = FC_NO_LOOP_ID;
2663 			}
2664 
2665 			break;
2666 		}
2667 
2668 		if (found)
2669 			continue;
2670 
2671 		/* If device was not in our fcports list, then add it. */
2672 		list_add_tail(&new_fcport->list, new_fcports);
2673 
2674 		/* Allocate a new replacement fcport. */
2675 		nxt_d_id.b24 = new_fcport->d_id.b24;
2676 		new_fcport = qla2x00_alloc_fcport(ha, GFP_KERNEL);
2677 		if (new_fcport == NULL) {
2678 			kfree(swl);
2679 			return (QLA_MEMORY_ALLOC_FAILED);
2680 		}
2681 		new_fcport->flags |= (FCF_FABRIC_DEVICE | FCF_LOGIN_NEEDED);
2682 		new_fcport->d_id.b24 = nxt_d_id.b24;
2683 		new_fcport->vp_idx = ha->vp_idx;
2684 	}
2685 
2686 	kfree(swl);
2687 	kfree(new_fcport);
2688 
2689 	if (!list_empty(new_fcports))
2690 		ha->device_flags |= DFLG_FABRIC_DEVICES;
2691 
2692 	return (rval);
2693 }
2694 
2695 /*
2696  * qla2x00_find_new_loop_id
2697  *	Scan through our port list and find a new usable loop ID.
2698  *
2699  * Input:
2700  *	ha:	adapter state pointer.
2701  *	dev:	port structure pointer.
2702  *
2703  * Returns:
2704  *	qla2x00 local function return status code.
2705  *
2706  * Context:
2707  *	Kernel context.
2708  */
2709 static int
2710 qla2x00_find_new_loop_id(scsi_qla_host_t *ha, fc_port_t *dev)
2711 {
2712 	int	rval;
2713 	int	found;
2714 	fc_port_t *fcport;
2715 	uint16_t first_loop_id;
2716 	scsi_qla_host_t *pha = to_qla_parent(ha);
2717 
2718 	rval = QLA_SUCCESS;
2719 
2720 	/* Save starting loop ID. */
2721 	first_loop_id = dev->loop_id;
2722 
2723 	for (;;) {
2724 		/* Skip loop ID if already used by adapter. */
2725 		if (dev->loop_id == ha->loop_id) {
2726 			dev->loop_id++;
2727 		}
2728 
2729 		/* Skip reserved loop IDs. */
2730 		while (qla2x00_is_reserved_id(ha, dev->loop_id)) {
2731 			dev->loop_id++;
2732 		}
2733 
2734 		/* Reset loop ID if passed the end. */
2735 		if (dev->loop_id > ha->last_loop_id) {
2736 			/* first loop ID. */
2737 			dev->loop_id = ha->min_external_loopid;
2738 		}
2739 
2740 		/* Check for loop ID being already in use. */
2741 		found = 0;
2742 		fcport = NULL;
2743 		list_for_each_entry(fcport, &pha->fcports, list) {
2744 			if (fcport->loop_id == dev->loop_id && fcport != dev) {
2745 				/* ID possibly in use */
2746 				found++;
2747 				break;
2748 			}
2749 		}
2750 
2751 		/* If not in use then it is free to use. */
2752 		if (!found) {
2753 			break;
2754 		}
2755 
2756 		/* ID in use. Try next value. */
2757 		dev->loop_id++;
2758 
2759 		/* If wrap around. No free ID to use. */
2760 		if (dev->loop_id == first_loop_id) {
2761 			dev->loop_id = FC_NO_LOOP_ID;
2762 			rval = QLA_FUNCTION_FAILED;
2763 			break;
2764 		}
2765 	}
2766 
2767 	return (rval);
2768 }
2769 
2770 /*
2771  * qla2x00_device_resync
2772  *	Marks devices in the database that needs resynchronization.
2773  *
2774  * Input:
2775  *	ha = adapter block pointer.
2776  *
2777  * Context:
2778  *	Kernel context.
2779  */
2780 static int
2781 qla2x00_device_resync(scsi_qla_host_t *ha)
2782 {
2783 	int	rval;
2784 	uint32_t mask;
2785 	fc_port_t *fcport;
2786 	uint32_t rscn_entry;
2787 	uint8_t rscn_out_iter;
2788 	uint8_t format;
2789 	port_id_t d_id;
2790 	scsi_qla_host_t *pha = to_qla_parent(ha);
2791 
2792 	rval = QLA_RSCNS_HANDLED;
2793 
2794 	while (ha->rscn_out_ptr != ha->rscn_in_ptr ||
2795 	    ha->flags.rscn_queue_overflow) {
2796 
2797 		rscn_entry = ha->rscn_queue[ha->rscn_out_ptr];
2798 		format = MSB(MSW(rscn_entry));
2799 		d_id.b.domain = LSB(MSW(rscn_entry));
2800 		d_id.b.area = MSB(LSW(rscn_entry));
2801 		d_id.b.al_pa = LSB(LSW(rscn_entry));
2802 
2803 		DEBUG(printk("scsi(%ld): RSCN queue entry[%d] = "
2804 		    "[%02x/%02x%02x%02x].\n",
2805 		    ha->host_no, ha->rscn_out_ptr, format, d_id.b.domain,
2806 		    d_id.b.area, d_id.b.al_pa));
2807 
2808 		ha->rscn_out_ptr++;
2809 		if (ha->rscn_out_ptr == MAX_RSCN_COUNT)
2810 			ha->rscn_out_ptr = 0;
2811 
2812 		/* Skip duplicate entries. */
2813 		for (rscn_out_iter = ha->rscn_out_ptr;
2814 		    !ha->flags.rscn_queue_overflow &&
2815 		    rscn_out_iter != ha->rscn_in_ptr;
2816 		    rscn_out_iter = (rscn_out_iter ==
2817 			(MAX_RSCN_COUNT - 1)) ? 0: rscn_out_iter + 1) {
2818 
2819 			if (rscn_entry != ha->rscn_queue[rscn_out_iter])
2820 				break;
2821 
2822 			DEBUG(printk("scsi(%ld): Skipping duplicate RSCN queue "
2823 			    "entry found at [%d].\n", ha->host_no,
2824 			    rscn_out_iter));
2825 
2826 			ha->rscn_out_ptr = rscn_out_iter;
2827 		}
2828 
2829 		/* Queue overflow, set switch default case. */
2830 		if (ha->flags.rscn_queue_overflow) {
2831 			DEBUG(printk("scsi(%ld): device_resync: rscn "
2832 			    "overflow.\n", ha->host_no));
2833 
2834 			format = 3;
2835 			ha->flags.rscn_queue_overflow = 0;
2836 		}
2837 
2838 		switch (format) {
2839 		case 0:
2840 			mask = 0xffffff;
2841 			break;
2842 		case 1:
2843 			mask = 0xffff00;
2844 			break;
2845 		case 2:
2846 			mask = 0xff0000;
2847 			break;
2848 		default:
2849 			mask = 0x0;
2850 			d_id.b24 = 0;
2851 			ha->rscn_out_ptr = ha->rscn_in_ptr;
2852 			break;
2853 		}
2854 
2855 		rval = QLA_SUCCESS;
2856 
2857 		list_for_each_entry(fcport, &pha->fcports, list) {
2858 			if (fcport->vp_idx != ha->vp_idx)
2859 				continue;
2860 
2861 			if ((fcport->flags & FCF_FABRIC_DEVICE) == 0 ||
2862 			    (fcport->d_id.b24 & mask) != d_id.b24 ||
2863 			    fcport->port_type == FCT_BROADCAST)
2864 				continue;
2865 
2866 			if (atomic_read(&fcport->state) == FCS_ONLINE) {
2867 				if (format != 3 ||
2868 				    fcport->port_type != FCT_INITIATOR) {
2869 					qla2x00_mark_device_lost(ha, fcport,
2870 					    0, 0);
2871 				}
2872 			}
2873 			fcport->flags &= ~FCF_FARP_DONE;
2874 		}
2875 	}
2876 	return (rval);
2877 }
2878 
2879 /*
2880  * qla2x00_fabric_dev_login
2881  *	Login fabric target device and update FC port database.
2882  *
2883  * Input:
2884  *	ha:		adapter state pointer.
2885  *	fcport:		port structure list pointer.
2886  *	next_loopid:	contains value of a new loop ID that can be used
2887  *			by the next login attempt.
2888  *
2889  * Returns:
2890  *	qla2x00 local function return status code.
2891  *
2892  * Context:
2893  *	Kernel context.
2894  */
2895 static int
2896 qla2x00_fabric_dev_login(scsi_qla_host_t *ha, fc_port_t *fcport,
2897     uint16_t *next_loopid)
2898 {
2899 	int	rval;
2900 	int	retry;
2901 	uint8_t opts;
2902 
2903 	rval = QLA_SUCCESS;
2904 	retry = 0;
2905 
2906 	rval = qla2x00_fabric_login(ha, fcport, next_loopid);
2907 	if (rval == QLA_SUCCESS) {
2908 		/* Send an ADISC to tape devices.*/
2909 		opts = 0;
2910 		if (fcport->flags & FCF_TAPE_PRESENT)
2911 			opts |= BIT_1;
2912 		rval = qla2x00_get_port_database(ha, fcport, opts);
2913 		if (rval != QLA_SUCCESS) {
2914 			ha->isp_ops->fabric_logout(ha, fcport->loop_id,
2915 			    fcport->d_id.b.domain, fcport->d_id.b.area,
2916 			    fcport->d_id.b.al_pa);
2917 			qla2x00_mark_device_lost(ha, fcport, 1, 0);
2918 		} else {
2919 			qla2x00_update_fcport(ha, fcport);
2920 		}
2921 	}
2922 
2923 	return (rval);
2924 }
2925 
2926 /*
2927  * qla2x00_fabric_login
2928  *	Issue fabric login command.
2929  *
2930  * Input:
2931  *	ha = adapter block pointer.
2932  *	device = pointer to FC device type structure.
2933  *
2934  * Returns:
2935  *      0 - Login successfully
2936  *      1 - Login failed
2937  *      2 - Initiator device
2938  *      3 - Fatal error
2939  */
2940 int
2941 qla2x00_fabric_login(scsi_qla_host_t *ha, fc_port_t *fcport,
2942     uint16_t *next_loopid)
2943 {
2944 	int	rval;
2945 	int	retry;
2946 	uint16_t tmp_loopid;
2947 	uint16_t mb[MAILBOX_REGISTER_COUNT];
2948 
2949 	retry = 0;
2950 	tmp_loopid = 0;
2951 
2952 	for (;;) {
2953 		DEBUG(printk("scsi(%ld): Trying Fabric Login w/loop id 0x%04x "
2954  		    "for port %02x%02x%02x.\n",
2955  		    ha->host_no, fcport->loop_id, fcport->d_id.b.domain,
2956 		    fcport->d_id.b.area, fcport->d_id.b.al_pa));
2957 
2958 		/* Login fcport on switch. */
2959 		ha->isp_ops->fabric_login(ha, fcport->loop_id,
2960 		    fcport->d_id.b.domain, fcport->d_id.b.area,
2961 		    fcport->d_id.b.al_pa, mb, BIT_0);
2962 		if (mb[0] == MBS_PORT_ID_USED) {
2963 			/*
2964 			 * Device has another loop ID.  The firmware team
2965 			 * recommends the driver perform an implicit login with
2966 			 * the specified ID again. The ID we just used is save
2967 			 * here so we return with an ID that can be tried by
2968 			 * the next login.
2969 			 */
2970 			retry++;
2971 			tmp_loopid = fcport->loop_id;
2972 			fcport->loop_id = mb[1];
2973 
2974 			DEBUG(printk("Fabric Login: port in use - next "
2975  			    "loop id=0x%04x, port Id=%02x%02x%02x.\n",
2976 			    fcport->loop_id, fcport->d_id.b.domain,
2977 			    fcport->d_id.b.area, fcport->d_id.b.al_pa));
2978 
2979 		} else if (mb[0] == MBS_COMMAND_COMPLETE) {
2980 			/*
2981 			 * Login succeeded.
2982 			 */
2983 			if (retry) {
2984 				/* A retry occurred before. */
2985 				*next_loopid = tmp_loopid;
2986 			} else {
2987 				/*
2988 				 * No retry occurred before. Just increment the
2989 				 * ID value for next login.
2990 				 */
2991 				*next_loopid = (fcport->loop_id + 1);
2992 			}
2993 
2994 			if (mb[1] & BIT_0) {
2995 				fcport->port_type = FCT_INITIATOR;
2996 			} else {
2997 				fcport->port_type = FCT_TARGET;
2998 				if (mb[1] & BIT_1) {
2999 					fcport->flags |= FCF_TAPE_PRESENT;
3000 				}
3001 			}
3002 
3003 			if (mb[10] & BIT_0)
3004 				fcport->supported_classes |= FC_COS_CLASS2;
3005 			if (mb[10] & BIT_1)
3006 				fcport->supported_classes |= FC_COS_CLASS3;
3007 
3008 			rval = QLA_SUCCESS;
3009 			break;
3010 		} else if (mb[0] == MBS_LOOP_ID_USED) {
3011 			/*
3012 			 * Loop ID already used, try next loop ID.
3013 			 */
3014 			fcport->loop_id++;
3015 			rval = qla2x00_find_new_loop_id(ha, fcport);
3016 			if (rval != QLA_SUCCESS) {
3017 				/* Ran out of loop IDs to use */
3018 				break;
3019 			}
3020 		} else if (mb[0] == MBS_COMMAND_ERROR) {
3021 			/*
3022 			 * Firmware possibly timed out during login. If NO
3023 			 * retries are left to do then the device is declared
3024 			 * dead.
3025 			 */
3026 			*next_loopid = fcport->loop_id;
3027 			ha->isp_ops->fabric_logout(ha, fcport->loop_id,
3028 			    fcport->d_id.b.domain, fcport->d_id.b.area,
3029 			    fcport->d_id.b.al_pa);
3030 			qla2x00_mark_device_lost(ha, fcport, 1, 0);
3031 
3032 			rval = 1;
3033 			break;
3034 		} else {
3035 			/*
3036 			 * unrecoverable / not handled error
3037 			 */
3038 			DEBUG2(printk("%s(%ld): failed=%x port_id=%02x%02x%02x "
3039  			    "loop_id=%x jiffies=%lx.\n",
3040  			    __func__, ha->host_no, mb[0],
3041 			    fcport->d_id.b.domain, fcport->d_id.b.area,
3042 			    fcport->d_id.b.al_pa, fcport->loop_id, jiffies));
3043 
3044 			*next_loopid = fcport->loop_id;
3045 			ha->isp_ops->fabric_logout(ha, fcport->loop_id,
3046 			    fcport->d_id.b.domain, fcport->d_id.b.area,
3047 			    fcport->d_id.b.al_pa);
3048 			fcport->loop_id = FC_NO_LOOP_ID;
3049 			fcport->login_retry = 0;
3050 
3051 			rval = 3;
3052 			break;
3053 		}
3054 	}
3055 
3056 	return (rval);
3057 }
3058 
3059 /*
3060  * qla2x00_local_device_login
3061  *	Issue local device login command.
3062  *
3063  * Input:
3064  *	ha = adapter block pointer.
3065  *	loop_id = loop id of device to login to.
3066  *
3067  * Returns (Where's the #define!!!!):
3068  *      0 - Login successfully
3069  *      1 - Login failed
3070  *      3 - Fatal error
3071  */
3072 int
3073 qla2x00_local_device_login(scsi_qla_host_t *ha, fc_port_t *fcport)
3074 {
3075 	int		rval;
3076 	uint16_t	mb[MAILBOX_REGISTER_COUNT];
3077 
3078 	memset(mb, 0, sizeof(mb));
3079 	rval = qla2x00_login_local_device(ha, fcport, mb, BIT_0);
3080 	if (rval == QLA_SUCCESS) {
3081 		/* Interrogate mailbox registers for any errors */
3082 		if (mb[0] == MBS_COMMAND_ERROR)
3083 			rval = 1;
3084 		else if (mb[0] == MBS_COMMAND_PARAMETER_ERROR)
3085 			/* device not in PCB table */
3086 			rval = 3;
3087 	}
3088 
3089 	return (rval);
3090 }
3091 
3092 /*
3093  *  qla2x00_loop_resync
3094  *      Resync with fibre channel devices.
3095  *
3096  * Input:
3097  *      ha = adapter block pointer.
3098  *
3099  * Returns:
3100  *      0 = success
3101  */
3102 int
3103 qla2x00_loop_resync(scsi_qla_host_t *ha)
3104 {
3105 	int   rval;
3106 	uint32_t wait_time;
3107 
3108 	rval = QLA_SUCCESS;
3109 
3110 	atomic_set(&ha->loop_state, LOOP_UPDATE);
3111 	clear_bit(ISP_ABORT_RETRY, &ha->dpc_flags);
3112 	if (ha->flags.online) {
3113 		if (!(rval = qla2x00_fw_ready(ha))) {
3114 			/* Wait at most MAX_TARGET RSCNs for a stable link. */
3115 			wait_time = 256;
3116 			do {
3117 				atomic_set(&ha->loop_state, LOOP_UPDATE);
3118 
3119 				/* Issue a marker after FW becomes ready. */
3120 				qla2x00_marker(ha, 0, 0, MK_SYNC_ALL);
3121 				ha->marker_needed = 0;
3122 
3123 				/* Remap devices on Loop. */
3124 				clear_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
3125 
3126 				qla2x00_configure_loop(ha);
3127 				wait_time--;
3128 			} while (!atomic_read(&ha->loop_down_timer) &&
3129 				!(test_bit(ISP_ABORT_NEEDED, &ha->dpc_flags)) &&
3130 				wait_time &&
3131 				(test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags)));
3132 		}
3133 	}
3134 
3135 	if (test_bit(ISP_ABORT_NEEDED, &ha->dpc_flags)) {
3136 		return (QLA_FUNCTION_FAILED);
3137 	}
3138 
3139 	if (rval) {
3140 		DEBUG2_3(printk("%s(): **** FAILED ****\n", __func__));
3141 	}
3142 
3143 	return (rval);
3144 }
3145 
3146 void
3147 qla2x00_rescan_fcports(scsi_qla_host_t *ha)
3148 {
3149 	int rescan_done;
3150 	fc_port_t *fcport;
3151 
3152 	rescan_done = 0;
3153 	list_for_each_entry(fcport, &ha->fcports, list) {
3154 		if ((fcport->flags & FCF_RESCAN_NEEDED) == 0)
3155 			continue;
3156 
3157 		qla2x00_update_fcport(ha, fcport);
3158 		fcport->flags &= ~FCF_RESCAN_NEEDED;
3159 
3160 		rescan_done = 1;
3161 	}
3162 	qla2x00_probe_for_all_luns(ha);
3163 }
3164 
3165 void
3166 qla2x00_update_fcports(scsi_qla_host_t *ha)
3167 {
3168 	fc_port_t *fcport;
3169 
3170 	/* Go with deferred removal of rport references. */
3171 	list_for_each_entry(fcport, &ha->fcports, list)
3172 		if (fcport->drport)
3173 			qla2x00_rport_del(fcport);
3174 }
3175 
3176 /*
3177 *  qla2x00_abort_isp
3178 *      Resets ISP and aborts all outstanding commands.
3179 *
3180 * Input:
3181 *      ha           = adapter block pointer.
3182 *
3183 * Returns:
3184 *      0 = success
3185 */
3186 int
3187 qla2x00_abort_isp(scsi_qla_host_t *ha)
3188 {
3189 	int rval;
3190 	unsigned long flags = 0;
3191 	uint16_t       cnt;
3192 	srb_t          *sp;
3193 	uint8_t        status = 0;
3194 
3195 	if (ha->flags.online) {
3196 		ha->flags.online = 0;
3197 		clear_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
3198 
3199 		qla_printk(KERN_INFO, ha,
3200 		    "Performing ISP error recovery - ha= %p.\n", ha);
3201 		ha->isp_ops->reset_chip(ha);
3202 
3203 		atomic_set(&ha->loop_down_timer, LOOP_DOWN_TIME);
3204 		if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
3205 			atomic_set(&ha->loop_state, LOOP_DOWN);
3206 			qla2x00_mark_all_devices_lost(ha, 0);
3207 		} else {
3208 			if (!atomic_read(&ha->loop_down_timer))
3209 				atomic_set(&ha->loop_down_timer,
3210 				    LOOP_DOWN_TIME);
3211 		}
3212 
3213 		spin_lock_irqsave(&ha->hardware_lock, flags);
3214 		/* Requeue all commands in outstanding command list. */
3215 		for (cnt = 1; cnt < MAX_OUTSTANDING_COMMANDS; cnt++) {
3216 			sp = ha->outstanding_cmds[cnt];
3217 			if (sp) {
3218 				ha->outstanding_cmds[cnt] = NULL;
3219 				sp->flags = 0;
3220 				sp->cmd->result = DID_RESET << 16;
3221 				sp->cmd->host_scribble = (unsigned char *)NULL;
3222 				qla2x00_sp_compl(ha, sp);
3223 			}
3224 		}
3225 		spin_unlock_irqrestore(&ha->hardware_lock, flags);
3226 
3227 		ha->isp_ops->get_flash_version(ha, ha->request_ring);
3228 
3229 		ha->isp_ops->nvram_config(ha);
3230 
3231 		if (!qla2x00_restart_isp(ha)) {
3232 			clear_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
3233 
3234 			if (!atomic_read(&ha->loop_down_timer)) {
3235 				/*
3236 				 * Issue marker command only when we are going
3237 				 * to start the I/O .
3238 				 */
3239 				ha->marker_needed = 1;
3240 			}
3241 
3242 			ha->flags.online = 1;
3243 
3244 			ha->isp_ops->enable_intrs(ha);
3245 
3246 			ha->isp_abort_cnt = 0;
3247 			clear_bit(ISP_ABORT_RETRY, &ha->dpc_flags);
3248 
3249 			if (ha->eft) {
3250 				rval = qla2x00_trace_control(ha, TC_ENABLE,
3251 				    ha->eft_dma, EFT_NUM_BUFFERS);
3252 				if (rval) {
3253 					qla_printk(KERN_WARNING, ha,
3254 					    "Unable to reinitialize EFT "
3255 					    "(%d).\n", rval);
3256 				}
3257 			}
3258 		} else {	/* failed the ISP abort */
3259 			ha->flags.online = 1;
3260 			if (test_bit(ISP_ABORT_RETRY, &ha->dpc_flags)) {
3261 				if (ha->isp_abort_cnt == 0) {
3262  					qla_printk(KERN_WARNING, ha,
3263 					    "ISP error recovery failed - "
3264 					    "board disabled\n");
3265 					/*
3266 					 * The next call disables the board
3267 					 * completely.
3268 					 */
3269 					ha->isp_ops->reset_adapter(ha);
3270 					ha->flags.online = 0;
3271 					clear_bit(ISP_ABORT_RETRY,
3272 					    &ha->dpc_flags);
3273 					status = 0;
3274 				} else { /* schedule another ISP abort */
3275 					ha->isp_abort_cnt--;
3276 					DEBUG(printk("qla%ld: ISP abort - "
3277 					    "retry remaining %d\n",
3278 					    ha->host_no, ha->isp_abort_cnt));
3279 					status = 1;
3280 				}
3281 			} else {
3282 				ha->isp_abort_cnt = MAX_RETRIES_OF_ISP_ABORT;
3283 				DEBUG(printk("qla2x00(%ld): ISP error recovery "
3284 				    "- retrying (%d) more times\n",
3285 				    ha->host_no, ha->isp_abort_cnt));
3286 				set_bit(ISP_ABORT_RETRY, &ha->dpc_flags);
3287 				status = 1;
3288 			}
3289 		}
3290 
3291 	}
3292 
3293 	if (status) {
3294 		qla_printk(KERN_INFO, ha,
3295 			"qla2x00_abort_isp: **** FAILED ****\n");
3296 	} else {
3297 		DEBUG(printk(KERN_INFO
3298 				"qla2x00_abort_isp(%ld): exiting.\n",
3299 				ha->host_no));
3300 	}
3301 
3302 	return(status);
3303 }
3304 
3305 /*
3306 *  qla2x00_restart_isp
3307 *      restarts the ISP after a reset
3308 *
3309 * Input:
3310 *      ha = adapter block pointer.
3311 *
3312 * Returns:
3313 *      0 = success
3314 */
3315 static int
3316 qla2x00_restart_isp(scsi_qla_host_t *ha)
3317 {
3318 	uint8_t		status = 0;
3319 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
3320 	unsigned long	flags = 0;
3321 	uint32_t wait_time;
3322 
3323 	/* If firmware needs to be loaded */
3324 	if (qla2x00_isp_firmware(ha)) {
3325 		ha->flags.online = 0;
3326 		if (!(status = ha->isp_ops->chip_diag(ha))) {
3327 			if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
3328 				status = qla2x00_setup_chip(ha);
3329 				goto done;
3330 			}
3331 
3332 			spin_lock_irqsave(&ha->hardware_lock, flags);
3333 
3334 			if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha) &&
3335 			    !IS_QLA25XX(ha)) {
3336 				/*
3337 				 * Disable SRAM, Instruction RAM and GP RAM
3338 				 * parity.
3339 				 */
3340 				WRT_REG_WORD(&reg->hccr,
3341 				    (HCCR_ENABLE_PARITY + 0x0));
3342 				RD_REG_WORD(&reg->hccr);
3343 			}
3344 
3345 			spin_unlock_irqrestore(&ha->hardware_lock, flags);
3346 
3347 			status = qla2x00_setup_chip(ha);
3348 
3349 			spin_lock_irqsave(&ha->hardware_lock, flags);
3350 
3351 			if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha) &&
3352 			    !IS_QLA25XX(ha)) {
3353 				/* Enable proper parity */
3354 				if (IS_QLA2300(ha))
3355 					/* SRAM parity */
3356 					WRT_REG_WORD(&reg->hccr,
3357 					    (HCCR_ENABLE_PARITY + 0x1));
3358 				else
3359 					/*
3360 					 * SRAM, Instruction RAM and GP RAM
3361 					 * parity.
3362 					 */
3363 					WRT_REG_WORD(&reg->hccr,
3364 					    (HCCR_ENABLE_PARITY + 0x7));
3365 				RD_REG_WORD(&reg->hccr);
3366 			}
3367 
3368 			spin_unlock_irqrestore(&ha->hardware_lock, flags);
3369 		}
3370 	}
3371 
3372  done:
3373 	if (!status && !(status = qla2x00_init_rings(ha))) {
3374 		clear_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
3375 		if (!(status = qla2x00_fw_ready(ha))) {
3376 			DEBUG(printk("%s(): Start configure loop, "
3377 			    "status = %d\n", __func__, status));
3378 
3379 			/* Issue a marker after FW becomes ready. */
3380 			qla2x00_marker(ha, 0, 0, MK_SYNC_ALL);
3381 
3382 			ha->flags.online = 1;
3383 			/* Wait at most MAX_TARGET RSCNs for a stable link. */
3384 			wait_time = 256;
3385 			do {
3386 				clear_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
3387 				qla2x00_configure_loop(ha);
3388 				wait_time--;
3389 			} while (!atomic_read(&ha->loop_down_timer) &&
3390 				!(test_bit(ISP_ABORT_NEEDED, &ha->dpc_flags)) &&
3391 				wait_time &&
3392 				(test_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags)));
3393 		}
3394 
3395 		/* if no cable then assume it's good */
3396 		if ((ha->device_flags & DFLG_NO_CABLE))
3397 			status = 0;
3398 
3399 		DEBUG(printk("%s(): Configure loop done, status = 0x%x\n",
3400 				__func__,
3401 				status));
3402 	}
3403 	return (status);
3404 }
3405 
3406 /*
3407 * qla2x00_reset_adapter
3408 *      Reset adapter.
3409 *
3410 * Input:
3411 *      ha = adapter block pointer.
3412 */
3413 void
3414 qla2x00_reset_adapter(scsi_qla_host_t *ha)
3415 {
3416 	unsigned long flags = 0;
3417 	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
3418 
3419 	ha->flags.online = 0;
3420 	ha->isp_ops->disable_intrs(ha);
3421 
3422 	spin_lock_irqsave(&ha->hardware_lock, flags);
3423 	WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
3424 	RD_REG_WORD(&reg->hccr);			/* PCI Posting. */
3425 	WRT_REG_WORD(&reg->hccr, HCCR_RELEASE_RISC);
3426 	RD_REG_WORD(&reg->hccr);			/* PCI Posting. */
3427 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
3428 }
3429 
3430 void
3431 qla24xx_reset_adapter(scsi_qla_host_t *ha)
3432 {
3433 	unsigned long flags = 0;
3434 	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
3435 
3436 	ha->flags.online = 0;
3437 	ha->isp_ops->disable_intrs(ha);
3438 
3439 	spin_lock_irqsave(&ha->hardware_lock, flags);
3440 	WRT_REG_DWORD(&reg->hccr, HCCRX_SET_RISC_RESET);
3441 	RD_REG_DWORD(&reg->hccr);
3442 	WRT_REG_DWORD(&reg->hccr, HCCRX_REL_RISC_PAUSE);
3443 	RD_REG_DWORD(&reg->hccr);
3444 	spin_unlock_irqrestore(&ha->hardware_lock, flags);
3445 }
3446 
3447 /* On sparc systems, obtain port and node WWN from firmware
3448  * properties.
3449  */
3450 static void qla24xx_nvram_wwn_from_ofw(scsi_qla_host_t *ha, struct nvram_24xx *nv)
3451 {
3452 #ifdef CONFIG_SPARC
3453 	struct pci_dev *pdev = ha->pdev;
3454 	struct device_node *dp = pci_device_to_OF_node(pdev);
3455 	const u8 *val;
3456 	int len;
3457 
3458 	val = of_get_property(dp, "port-wwn", &len);
3459 	if (val && len >= WWN_SIZE)
3460 		memcpy(nv->port_name, val, WWN_SIZE);
3461 
3462 	val = of_get_property(dp, "node-wwn", &len);
3463 	if (val && len >= WWN_SIZE)
3464 		memcpy(nv->node_name, val, WWN_SIZE);
3465 #endif
3466 }
3467 
3468 int
3469 qla24xx_nvram_config(scsi_qla_host_t *ha)
3470 {
3471 	int   rval;
3472 	struct init_cb_24xx *icb;
3473 	struct nvram_24xx *nv;
3474 	uint32_t *dptr;
3475 	uint8_t  *dptr1, *dptr2;
3476 	uint32_t chksum;
3477 	uint16_t cnt;
3478 
3479 	rval = QLA_SUCCESS;
3480 	icb = (struct init_cb_24xx *)ha->init_cb;
3481 	nv = ha->nvram;
3482 
3483 	/* Determine NVRAM starting address. */
3484 	ha->nvram_size = sizeof(struct nvram_24xx);
3485 	ha->nvram_base = FA_NVRAM_FUNC0_ADDR;
3486 	ha->vpd_size = FA_NVRAM_VPD_SIZE;
3487 	ha->vpd_base = FA_NVRAM_VPD0_ADDR;
3488 	if (PCI_FUNC(ha->pdev->devfn)) {
3489 		ha->nvram_base = FA_NVRAM_FUNC1_ADDR;
3490 		ha->vpd_base = FA_NVRAM_VPD1_ADDR;
3491 	}
3492 
3493 	/* Get VPD data into cache */
3494 	ha->vpd = ha->nvram + VPD_OFFSET;
3495 	ha->isp_ops->read_nvram(ha, (uint8_t *)ha->vpd,
3496 	    ha->nvram_base - FA_NVRAM_FUNC0_ADDR, FA_NVRAM_VPD_SIZE * 4);
3497 
3498 	/* Get NVRAM data into cache and calculate checksum. */
3499 	dptr = (uint32_t *)nv;
3500 	ha->isp_ops->read_nvram(ha, (uint8_t *)dptr, ha->nvram_base,
3501 	    ha->nvram_size);
3502 	for (cnt = 0, chksum = 0; cnt < ha->nvram_size >> 2; cnt++)
3503 		chksum += le32_to_cpu(*dptr++);
3504 
3505 	DEBUG5(printk("scsi(%ld): Contents of NVRAM\n", ha->host_no));
3506 	DEBUG5(qla2x00_dump_buffer((uint8_t *)nv, ha->nvram_size));
3507 
3508 	/* Bad NVRAM data, set defaults parameters. */
3509 	if (chksum || nv->id[0] != 'I' || nv->id[1] != 'S' || nv->id[2] != 'P'
3510 	    || nv->id[3] != ' ' ||
3511 	    nv->nvram_version < __constant_cpu_to_le16(ICB_VERSION)) {
3512 		/* Reset NVRAM data. */
3513 		qla_printk(KERN_WARNING, ha, "Inconsistent NVRAM detected: "
3514 		    "checksum=0x%x id=%c version=0x%x.\n", chksum, nv->id[0],
3515 		    le16_to_cpu(nv->nvram_version));
3516 		qla_printk(KERN_WARNING, ha, "Falling back to functioning (yet "
3517 		    "invalid -- WWPN) defaults.\n");
3518 
3519 		/*
3520 		 * Set default initialization control block.
3521 		 */
3522 		memset(nv, 0, ha->nvram_size);
3523 		nv->nvram_version = __constant_cpu_to_le16(ICB_VERSION);
3524 		nv->version = __constant_cpu_to_le16(ICB_VERSION);
3525 		nv->frame_payload_size = __constant_cpu_to_le16(2048);
3526 		nv->execution_throttle = __constant_cpu_to_le16(0xFFFF);
3527 		nv->exchange_count = __constant_cpu_to_le16(0);
3528 		nv->hard_address = __constant_cpu_to_le16(124);
3529 		nv->port_name[0] = 0x21;
3530 		nv->port_name[1] = 0x00 + PCI_FUNC(ha->pdev->devfn);
3531 		nv->port_name[2] = 0x00;
3532 		nv->port_name[3] = 0xe0;
3533 		nv->port_name[4] = 0x8b;
3534 		nv->port_name[5] = 0x1c;
3535 		nv->port_name[6] = 0x55;
3536 		nv->port_name[7] = 0x86;
3537 		nv->node_name[0] = 0x20;
3538 		nv->node_name[1] = 0x00;
3539 		nv->node_name[2] = 0x00;
3540 		nv->node_name[3] = 0xe0;
3541 		nv->node_name[4] = 0x8b;
3542 		nv->node_name[5] = 0x1c;
3543 		nv->node_name[6] = 0x55;
3544 		nv->node_name[7] = 0x86;
3545 		qla24xx_nvram_wwn_from_ofw(ha, nv);
3546 		nv->login_retry_count = __constant_cpu_to_le16(8);
3547 		nv->interrupt_delay_timer = __constant_cpu_to_le16(0);
3548 		nv->login_timeout = __constant_cpu_to_le16(0);
3549 		nv->firmware_options_1 =
3550 		    __constant_cpu_to_le32(BIT_14|BIT_13|BIT_2|BIT_1);
3551 		nv->firmware_options_2 = __constant_cpu_to_le32(2 << 4);
3552 		nv->firmware_options_2 |= __constant_cpu_to_le32(BIT_12);
3553 		nv->firmware_options_3 = __constant_cpu_to_le32(2 << 13);
3554 		nv->host_p = __constant_cpu_to_le32(BIT_11|BIT_10);
3555 		nv->efi_parameters = __constant_cpu_to_le32(0);
3556 		nv->reset_delay = 5;
3557 		nv->max_luns_per_target = __constant_cpu_to_le16(128);
3558 		nv->port_down_retry_count = __constant_cpu_to_le16(30);
3559 		nv->link_down_timeout = __constant_cpu_to_le16(30);
3560 
3561 		rval = 1;
3562 	}
3563 
3564 	/* Reset Initialization control block */
3565 	memset(icb, 0, sizeof(struct init_cb_24xx));
3566 
3567 	/* Copy 1st segment. */
3568 	dptr1 = (uint8_t *)icb;
3569 	dptr2 = (uint8_t *)&nv->version;
3570 	cnt = (uint8_t *)&icb->response_q_inpointer - (uint8_t *)&icb->version;
3571 	while (cnt--)
3572 		*dptr1++ = *dptr2++;
3573 
3574 	icb->login_retry_count = nv->login_retry_count;
3575 	icb->link_down_on_nos = nv->link_down_on_nos;
3576 
3577 	/* Copy 2nd segment. */
3578 	dptr1 = (uint8_t *)&icb->interrupt_delay_timer;
3579 	dptr2 = (uint8_t *)&nv->interrupt_delay_timer;
3580 	cnt = (uint8_t *)&icb->reserved_3 -
3581 	    (uint8_t *)&icb->interrupt_delay_timer;
3582 	while (cnt--)
3583 		*dptr1++ = *dptr2++;
3584 
3585 	/*
3586 	 * Setup driver NVRAM options.
3587 	 */
3588 	qla2x00_set_model_info(ha, nv->model_name, sizeof(nv->model_name),
3589 	    "QLA2462");
3590 
3591 	/* Use alternate WWN? */
3592 	if (nv->host_p & __constant_cpu_to_le32(BIT_15)) {
3593 		memcpy(icb->node_name, nv->alternate_node_name, WWN_SIZE);
3594 		memcpy(icb->port_name, nv->alternate_port_name, WWN_SIZE);
3595 	}
3596 
3597 	/* Prepare nodename */
3598 	if ((icb->firmware_options_1 & __constant_cpu_to_le32(BIT_14)) == 0) {
3599 		/*
3600 		 * Firmware will apply the following mask if the nodename was
3601 		 * not provided.
3602 		 */
3603 		memcpy(icb->node_name, icb->port_name, WWN_SIZE);
3604 		icb->node_name[0] &= 0xF0;
3605 	}
3606 
3607 	/* Set host adapter parameters. */
3608 	ha->flags.disable_risc_code_load = 0;
3609 	ha->flags.enable_lip_reset = 0;
3610 	ha->flags.enable_lip_full_login =
3611 	    le32_to_cpu(nv->host_p) & BIT_10 ? 1: 0;
3612 	ha->flags.enable_target_reset =
3613 	    le32_to_cpu(nv->host_p) & BIT_11 ? 1: 0;
3614 	ha->flags.enable_led_scheme = 0;
3615 	ha->flags.disable_serdes = le32_to_cpu(nv->host_p) & BIT_5 ? 1: 0;
3616 
3617 	ha->operating_mode = (le32_to_cpu(icb->firmware_options_2) &
3618 	    (BIT_6 | BIT_5 | BIT_4)) >> 4;
3619 
3620 	memcpy(ha->fw_seriallink_options24, nv->seriallink_options,
3621 	    sizeof(ha->fw_seriallink_options24));
3622 
3623 	/* save HBA serial number */
3624 	ha->serial0 = icb->port_name[5];
3625 	ha->serial1 = icb->port_name[6];
3626 	ha->serial2 = icb->port_name[7];
3627 	ha->node_name = icb->node_name;
3628 	ha->port_name = icb->port_name;
3629 
3630 	icb->execution_throttle = __constant_cpu_to_le16(0xFFFF);
3631 
3632 	ha->retry_count = le16_to_cpu(nv->login_retry_count);
3633 
3634 	/* Set minimum login_timeout to 4 seconds. */
3635 	if (le16_to_cpu(nv->login_timeout) < ql2xlogintimeout)
3636 		nv->login_timeout = cpu_to_le16(ql2xlogintimeout);
3637 	if (le16_to_cpu(nv->login_timeout) < 4)
3638 		nv->login_timeout = __constant_cpu_to_le16(4);
3639 	ha->login_timeout = le16_to_cpu(nv->login_timeout);
3640 	icb->login_timeout = cpu_to_le16(nv->login_timeout);
3641 
3642 	/* Set minimum RATOV to 200 tenths of a second. */
3643 	ha->r_a_tov = 200;
3644 
3645 	ha->loop_reset_delay = nv->reset_delay;
3646 
3647 	/* Link Down Timeout = 0:
3648 	 *
3649 	 * 	When Port Down timer expires we will start returning
3650 	 *	I/O's to OS with "DID_NO_CONNECT".
3651 	 *
3652 	 * Link Down Timeout != 0:
3653 	 *
3654 	 *	 The driver waits for the link to come up after link down
3655 	 *	 before returning I/Os to OS with "DID_NO_CONNECT".
3656 	 */
3657 	if (le16_to_cpu(nv->link_down_timeout) == 0) {
3658 		ha->loop_down_abort_time =
3659 		    (LOOP_DOWN_TIME - LOOP_DOWN_TIMEOUT);
3660 	} else {
3661 		ha->link_down_timeout =	le16_to_cpu(nv->link_down_timeout);
3662 		ha->loop_down_abort_time =
3663 		    (LOOP_DOWN_TIME - ha->link_down_timeout);
3664 	}
3665 
3666 	/* Need enough time to try and get the port back. */
3667 	ha->port_down_retry_count = le16_to_cpu(nv->port_down_retry_count);
3668 	if (qlport_down_retry)
3669 		ha->port_down_retry_count = qlport_down_retry;
3670 
3671 	/* Set login_retry_count */
3672 	ha->login_retry_count  = le16_to_cpu(nv->login_retry_count);
3673 	if (ha->port_down_retry_count ==
3674 	    le16_to_cpu(nv->port_down_retry_count) &&
3675 	    ha->port_down_retry_count > 3)
3676 		ha->login_retry_count = ha->port_down_retry_count;
3677 	else if (ha->port_down_retry_count > (int)ha->login_retry_count)
3678 		ha->login_retry_count = ha->port_down_retry_count;
3679 	if (ql2xloginretrycount)
3680 		ha->login_retry_count = ql2xloginretrycount;
3681 
3682 	/* Enable ZIO. */
3683 	if (!ha->flags.init_done) {
3684 		ha->zio_mode = le32_to_cpu(icb->firmware_options_2) &
3685 		    (BIT_3 | BIT_2 | BIT_1 | BIT_0);
3686 		ha->zio_timer = le16_to_cpu(icb->interrupt_delay_timer) ?
3687 		    le16_to_cpu(icb->interrupt_delay_timer): 2;
3688 	}
3689 	icb->firmware_options_2 &= __constant_cpu_to_le32(
3690 	    ~(BIT_3 | BIT_2 | BIT_1 | BIT_0));
3691 	ha->flags.process_response_queue = 0;
3692 	if (ha->zio_mode != QLA_ZIO_DISABLED) {
3693 		ha->zio_mode = QLA_ZIO_MODE_6;
3694 
3695 		DEBUG2(printk("scsi(%ld): ZIO mode %d enabled; timer delay "
3696 		    "(%d us).\n", ha->host_no, ha->zio_mode,
3697 		    ha->zio_timer * 100));
3698 		qla_printk(KERN_INFO, ha,
3699 		    "ZIO mode %d enabled; timer delay (%d us).\n",
3700 		    ha->zio_mode, ha->zio_timer * 100);
3701 
3702 		icb->firmware_options_2 |= cpu_to_le32(
3703 		    (uint32_t)ha->zio_mode);
3704 		icb->interrupt_delay_timer = cpu_to_le16(ha->zio_timer);
3705 		ha->flags.process_response_queue = 1;
3706 	}
3707 
3708 	if (rval) {
3709 		DEBUG2_3(printk(KERN_WARNING
3710 		    "scsi(%ld): NVRAM configuration failed!\n", ha->host_no));
3711 	}
3712 	return (rval);
3713 }
3714 
3715 static int
3716 qla24xx_load_risc_flash(scsi_qla_host_t *ha, uint32_t *srisc_addr)
3717 {
3718 	int	rval;
3719 	int	segments, fragment;
3720 	uint32_t faddr;
3721 	uint32_t *dcode, dlen;
3722 	uint32_t risc_addr;
3723 	uint32_t risc_size;
3724 	uint32_t i;
3725 
3726 	rval = QLA_SUCCESS;
3727 
3728 	segments = FA_RISC_CODE_SEGMENTS;
3729 	faddr = FA_RISC_CODE_ADDR;
3730 	dcode = (uint32_t *)ha->request_ring;
3731 	*srisc_addr = 0;
3732 
3733 	/* Validate firmware image by checking version. */
3734 	qla24xx_read_flash_data(ha, dcode, faddr + 4, 4);
3735 	for (i = 0; i < 4; i++)
3736 		dcode[i] = be32_to_cpu(dcode[i]);
3737 	if ((dcode[0] == 0xffffffff && dcode[1] == 0xffffffff &&
3738 	    dcode[2] == 0xffffffff && dcode[3] == 0xffffffff) ||
3739 	    (dcode[0] == 0 && dcode[1] == 0 && dcode[2] == 0 &&
3740 		dcode[3] == 0)) {
3741 		qla_printk(KERN_WARNING, ha,
3742 		    "Unable to verify integrity of flash firmware image!\n");
3743 		qla_printk(KERN_WARNING, ha,
3744 		    "Firmware data: %08x %08x %08x %08x!\n", dcode[0],
3745 		    dcode[1], dcode[2], dcode[3]);
3746 
3747 		return QLA_FUNCTION_FAILED;
3748 	}
3749 
3750 	while (segments && rval == QLA_SUCCESS) {
3751 		/* Read segment's load information. */
3752 		qla24xx_read_flash_data(ha, dcode, faddr, 4);
3753 
3754 		risc_addr = be32_to_cpu(dcode[2]);
3755 		*srisc_addr = *srisc_addr == 0 ? risc_addr : *srisc_addr;
3756 		risc_size = be32_to_cpu(dcode[3]);
3757 
3758 		fragment = 0;
3759 		while (risc_size > 0 && rval == QLA_SUCCESS) {
3760 			dlen = (uint32_t)(ha->fw_transfer_size >> 2);
3761 			if (dlen > risc_size)
3762 				dlen = risc_size;
3763 
3764 			DEBUG7(printk("scsi(%ld): Loading risc segment@ risc "
3765 			    "addr %x, number of dwords 0x%x, offset 0x%x.\n",
3766 			    ha->host_no, risc_addr, dlen, faddr));
3767 
3768 			qla24xx_read_flash_data(ha, dcode, faddr, dlen);
3769 			for (i = 0; i < dlen; i++)
3770 				dcode[i] = swab32(dcode[i]);
3771 
3772 			rval = qla2x00_load_ram(ha, ha->request_dma, risc_addr,
3773 			    dlen);
3774 			if (rval) {
3775 				DEBUG(printk("scsi(%ld):[ERROR] Failed to load "
3776 				    "segment %d of firmware\n", ha->host_no,
3777 				    fragment));
3778 				qla_printk(KERN_WARNING, ha,
3779 				    "[ERROR] Failed to load segment %d of "
3780 				    "firmware\n", fragment);
3781 				break;
3782 			}
3783 
3784 			faddr += dlen;
3785 			risc_addr += dlen;
3786 			risc_size -= dlen;
3787 			fragment++;
3788 		}
3789 
3790 		/* Next segment. */
3791 		segments--;
3792 	}
3793 
3794 	return rval;
3795 }
3796 
3797 #define QLA_FW_URL "ftp://ftp.qlogic.com/outgoing/linux/firmware/"
3798 
3799 int
3800 qla2x00_load_risc(scsi_qla_host_t *ha, uint32_t *srisc_addr)
3801 {
3802 	int	rval;
3803 	int	i, fragment;
3804 	uint16_t *wcode, *fwcode;
3805 	uint32_t risc_addr, risc_size, fwclen, wlen, *seg;
3806 	struct fw_blob *blob;
3807 
3808 	/* Load firmware blob. */
3809 	blob = qla2x00_request_firmware(ha);
3810 	if (!blob) {
3811 		qla_printk(KERN_ERR, ha, "Firmware image unavailable.\n");
3812 		qla_printk(KERN_ERR, ha, "Firmware images can be retrieved "
3813 		    "from: " QLA_FW_URL ".\n");
3814 		return QLA_FUNCTION_FAILED;
3815 	}
3816 
3817 	rval = QLA_SUCCESS;
3818 
3819 	wcode = (uint16_t *)ha->request_ring;
3820 	*srisc_addr = 0;
3821 	fwcode = (uint16_t *)blob->fw->data;
3822 	fwclen = 0;
3823 
3824 	/* Validate firmware image by checking version. */
3825 	if (blob->fw->size < 8 * sizeof(uint16_t)) {
3826 		qla_printk(KERN_WARNING, ha,
3827 		    "Unable to verify integrity of firmware image (%Zd)!\n",
3828 		    blob->fw->size);
3829 		goto fail_fw_integrity;
3830 	}
3831 	for (i = 0; i < 4; i++)
3832 		wcode[i] = be16_to_cpu(fwcode[i + 4]);
3833 	if ((wcode[0] == 0xffff && wcode[1] == 0xffff && wcode[2] == 0xffff &&
3834 	    wcode[3] == 0xffff) || (wcode[0] == 0 && wcode[1] == 0 &&
3835 		wcode[2] == 0 && wcode[3] == 0)) {
3836 		qla_printk(KERN_WARNING, ha,
3837 		    "Unable to verify integrity of firmware image!\n");
3838 		qla_printk(KERN_WARNING, ha,
3839 		    "Firmware data: %04x %04x %04x %04x!\n", wcode[0],
3840 		    wcode[1], wcode[2], wcode[3]);
3841 		goto fail_fw_integrity;
3842 	}
3843 
3844 	seg = blob->segs;
3845 	while (*seg && rval == QLA_SUCCESS) {
3846 		risc_addr = *seg;
3847 		*srisc_addr = *srisc_addr == 0 ? *seg : *srisc_addr;
3848 		risc_size = be16_to_cpu(fwcode[3]);
3849 
3850 		/* Validate firmware image size. */
3851 		fwclen += risc_size * sizeof(uint16_t);
3852 		if (blob->fw->size < fwclen) {
3853 			qla_printk(KERN_WARNING, ha,
3854 			    "Unable to verify integrity of firmware image "
3855 			    "(%Zd)!\n", blob->fw->size);
3856 			goto fail_fw_integrity;
3857 		}
3858 
3859 		fragment = 0;
3860 		while (risc_size > 0 && rval == QLA_SUCCESS) {
3861 			wlen = (uint16_t)(ha->fw_transfer_size >> 1);
3862 			if (wlen > risc_size)
3863 				wlen = risc_size;
3864 
3865 			DEBUG7(printk("scsi(%ld): Loading risc segment@ risc "
3866 			    "addr %x, number of words 0x%x.\n", ha->host_no,
3867 			    risc_addr, wlen));
3868 
3869 			for (i = 0; i < wlen; i++)
3870 				wcode[i] = swab16(fwcode[i]);
3871 
3872 			rval = qla2x00_load_ram(ha, ha->request_dma, risc_addr,
3873 			    wlen);
3874 			if (rval) {
3875 				DEBUG(printk("scsi(%ld):[ERROR] Failed to load "
3876 				    "segment %d of firmware\n", ha->host_no,
3877 				    fragment));
3878 				qla_printk(KERN_WARNING, ha,
3879 				    "[ERROR] Failed to load segment %d of "
3880 				    "firmware\n", fragment);
3881 				break;
3882 			}
3883 
3884 			fwcode += wlen;
3885 			risc_addr += wlen;
3886 			risc_size -= wlen;
3887 			fragment++;
3888 		}
3889 
3890 		/* Next segment. */
3891 		seg++;
3892 	}
3893 	return rval;
3894 
3895 fail_fw_integrity:
3896 	return QLA_FUNCTION_FAILED;
3897 }
3898 
3899 int
3900 qla24xx_load_risc(scsi_qla_host_t *ha, uint32_t *srisc_addr)
3901 {
3902 	int	rval;
3903 	int	segments, fragment;
3904 	uint32_t *dcode, dlen;
3905 	uint32_t risc_addr;
3906 	uint32_t risc_size;
3907 	uint32_t i;
3908 	struct fw_blob *blob;
3909 	uint32_t *fwcode, fwclen;
3910 
3911 	/* Load firmware blob. */
3912 	blob = qla2x00_request_firmware(ha);
3913 	if (!blob) {
3914 		qla_printk(KERN_ERR, ha, "Firmware image unavailable.\n");
3915 		qla_printk(KERN_ERR, ha, "Firmware images can be retrieved "
3916 		    "from: " QLA_FW_URL ".\n");
3917 
3918 		/* Try to load RISC code from flash. */
3919 		qla_printk(KERN_ERR, ha, "Attempting to load (potentially "
3920 		    "outdated) firmware from flash.\n");
3921 		return qla24xx_load_risc_flash(ha, srisc_addr);
3922 	}
3923 
3924 	rval = QLA_SUCCESS;
3925 
3926 	segments = FA_RISC_CODE_SEGMENTS;
3927 	dcode = (uint32_t *)ha->request_ring;
3928 	*srisc_addr = 0;
3929 	fwcode = (uint32_t *)blob->fw->data;
3930 	fwclen = 0;
3931 
3932 	/* Validate firmware image by checking version. */
3933 	if (blob->fw->size < 8 * sizeof(uint32_t)) {
3934 		qla_printk(KERN_WARNING, ha,
3935 		    "Unable to verify integrity of firmware image (%Zd)!\n",
3936 		    blob->fw->size);
3937 		goto fail_fw_integrity;
3938 	}
3939 	for (i = 0; i < 4; i++)
3940 		dcode[i] = be32_to_cpu(fwcode[i + 4]);
3941 	if ((dcode[0] == 0xffffffff && dcode[1] == 0xffffffff &&
3942 	    dcode[2] == 0xffffffff && dcode[3] == 0xffffffff) ||
3943 	    (dcode[0] == 0 && dcode[1] == 0 && dcode[2] == 0 &&
3944 		dcode[3] == 0)) {
3945 		qla_printk(KERN_WARNING, ha,
3946 		    "Unable to verify integrity of firmware image!\n");
3947 		qla_printk(KERN_WARNING, ha,
3948 		    "Firmware data: %08x %08x %08x %08x!\n", dcode[0],
3949 		    dcode[1], dcode[2], dcode[3]);
3950 		goto fail_fw_integrity;
3951 	}
3952 
3953 	while (segments && rval == QLA_SUCCESS) {
3954 		risc_addr = be32_to_cpu(fwcode[2]);
3955 		*srisc_addr = *srisc_addr == 0 ? risc_addr : *srisc_addr;
3956 		risc_size = be32_to_cpu(fwcode[3]);
3957 
3958 		/* Validate firmware image size. */
3959 		fwclen += risc_size * sizeof(uint32_t);
3960 		if (blob->fw->size < fwclen) {
3961 			qla_printk(KERN_WARNING, ha,
3962 			    "Unable to verify integrity of firmware image "
3963 			    "(%Zd)!\n", blob->fw->size);
3964 
3965 			goto fail_fw_integrity;
3966 		}
3967 
3968 		fragment = 0;
3969 		while (risc_size > 0 && rval == QLA_SUCCESS) {
3970 			dlen = (uint32_t)(ha->fw_transfer_size >> 2);
3971 			if (dlen > risc_size)
3972 				dlen = risc_size;
3973 
3974 			DEBUG7(printk("scsi(%ld): Loading risc segment@ risc "
3975 			    "addr %x, number of dwords 0x%x.\n", ha->host_no,
3976 			    risc_addr, dlen));
3977 
3978 			for (i = 0; i < dlen; i++)
3979 				dcode[i] = swab32(fwcode[i]);
3980 
3981 			rval = qla2x00_load_ram(ha, ha->request_dma, risc_addr,
3982 			    dlen);
3983 			if (rval) {
3984 				DEBUG(printk("scsi(%ld):[ERROR] Failed to load "
3985 				    "segment %d of firmware\n", ha->host_no,
3986 				    fragment));
3987 				qla_printk(KERN_WARNING, ha,
3988 				    "[ERROR] Failed to load segment %d of "
3989 				    "firmware\n", fragment);
3990 				break;
3991 			}
3992 
3993 			fwcode += dlen;
3994 			risc_addr += dlen;
3995 			risc_size -= dlen;
3996 			fragment++;
3997 		}
3998 
3999 		/* Next segment. */
4000 		segments--;
4001 	}
4002 	return rval;
4003 
4004 fail_fw_integrity:
4005 	return QLA_FUNCTION_FAILED;
4006 }
4007 
4008 void
4009 qla2x00_try_to_stop_firmware(scsi_qla_host_t *ha)
4010 {
4011 	int ret, retries;
4012 
4013 	if (!IS_FWI2_CAPABLE(ha))
4014 		return;
4015 	if (!ha->fw_major_version)
4016 		return;
4017 
4018 	ret = qla2x00_stop_firmware(ha);
4019 	for (retries = 5; ret != QLA_SUCCESS && retries ; retries--) {
4020 		qla2x00_reset_chip(ha);
4021 		if (qla2x00_chip_diag(ha) != QLA_SUCCESS)
4022 			continue;
4023 		if (qla2x00_setup_chip(ha) != QLA_SUCCESS)
4024 			continue;
4025 		qla_printk(KERN_INFO, ha,
4026 		    "Attempting retry of stop-firmware command...\n");
4027 		ret = qla2x00_stop_firmware(ha);
4028 	}
4029 }
4030 
4031 int
4032 qla24xx_configure_vhba(scsi_qla_host_t *ha)
4033 {
4034 	int rval = QLA_SUCCESS;
4035 	uint16_t mb[MAILBOX_REGISTER_COUNT];
4036 
4037 	if (!ha->parent)
4038 		return -EINVAL;
4039 
4040 	rval = qla2x00_fw_ready(ha);
4041 	if (rval == QLA_SUCCESS) {
4042 		clear_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
4043 		qla2x00_marker(ha, 0, 0, MK_SYNC_ALL);
4044 	}
4045 
4046 	ha->flags.management_server_logged_in = 0;
4047 
4048 	/* Login to SNS first */
4049 	qla24xx_login_fabric(ha, NPH_SNS, 0xff, 0xff, 0xfc,
4050 	    mb, BIT_1);
4051 	if (mb[0] != MBS_COMMAND_COMPLETE) {
4052 		DEBUG15(qla_printk(KERN_INFO, ha,
4053 		    "Failed SNS login: loop_id=%x mb[0]=%x mb[1]=%x "
4054 		    "mb[2]=%x mb[6]=%x mb[7]=%x\n", NPH_SNS,
4055 		    mb[0], mb[1], mb[2], mb[6], mb[7]));
4056 		return (QLA_FUNCTION_FAILED);
4057 	}
4058 
4059 	atomic_set(&ha->loop_down_timer, 0);
4060 	atomic_set(&ha->loop_state, LOOP_UP);
4061 	set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
4062 	set_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags);
4063 	rval = qla2x00_loop_resync(ha);
4064 
4065 	return rval;
4066 }
4067