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