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