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