Quelle  ql4_init.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * QLogic iSCSI HBA Driver
 * Copyright (c)  2003-2013 QLogic Corporation
 */

#include <scsi/iscsi_if.h>
#include "ql4_def.h"
#include "ql4_glbl.h"
#include "ql4_dbg.h"
#include "ql4_inline.h"

static void ql4xxx_set_mac_number(struct scsi_qla_host *ha)
{
 uint32_t value;
 unsigned long flags;

 /* Get the function number */
 spin_lock_irqsave(&ha->hardware_lock, flags);
 value = readw(&ha->reg->ctrl_status);
 spin_unlock_irqrestore(&ha->hardware_lock, flags);

 switch (value & ISP_CONTROL_FN_MASK) {
 case ISP_CONTROL_FN0_SCSI:
  ha->mac_index = 1;
  break;
 case ISP_CONTROL_FN1_SCSI:
  ha->mac_index = 3;
  break;
 default:
  DEBUG2(printk("scsi%ld: %s: Invalid function number, "
         "ispControlStatus = 0x%x\n", ha->host_no,
         __func__, value));
  break;
 }
 DEBUG2(printk("scsi%ld: %s: mac_index %d.\n", ha->host_no, __func__,
        ha->mac_index));
}

/**
 * qla4xxx_free_ddb - deallocate ddb
 * @ha: pointer to host adapter structure.
 * @ddb_entry: pointer to device database entry
 *
 * This routine marks a DDB entry INVALID
 **/
void qla4xxx_free_ddb(struct scsi_qla_host *ha,
    struct ddb_entry *ddb_entry)
{
 /* Remove device pointer from index mapping arrays */
 ha->fw_ddb_index_map[ddb_entry->fw_ddb_index] =
  (struct ddb_entry *) INVALID_ENTRY;
 ha->tot_ddbs--;
}

/**
 * qla4xxx_init_response_q_entries() - Initializes response queue entries.
 * @ha: HA context
 *
 * Beginning of request ring has initialization control block already built
 * by nvram config routine.
 **/
static void qla4xxx_init_response_q_entries(struct scsi_qla_host *ha)
{
 uint16_t cnt;
 struct response *pkt;

 pkt = (struct response *)ha->response_ptr;
 for (cnt = 0; cnt < RESPONSE_QUEUE_DEPTH; cnt++) {
  pkt->signature = RESPONSE_PROCESSED;
  pkt++;
 }
}

/**
 * qla4xxx_init_rings - initialize hw queues
 * @ha: pointer to host adapter structure.
 *
 * This routine initializes the internal queues for the specified adapter.
 * The QLA4010 requires us to restart the queues at index 0.
 * The QLA4000 doesn't care, so just default to QLA4010's requirement.
 **/
int qla4xxx_init_rings(struct scsi_qla_host *ha)
{
 unsigned long flags = 0;
 int i;

 /* Initialize request queue. */
 spin_lock_irqsave(&ha->hardware_lock, flags);
 ha->request_out = 0;
 ha->request_in = 0;
 ha->request_ptr = &ha->request_ring[ha->request_in];
 ha->req_q_count = REQUEST_QUEUE_DEPTH;

 /* Initialize response queue. */
 ha->response_in = 0;
 ha->response_out = 0;
 ha->response_ptr = &ha->response_ring[ha->response_out];

 if (is_qla8022(ha)) {
  writel(0,
      (unsigned long  __iomem *)&ha->qla4_82xx_reg->req_q_out);
  writel(0,
      (unsigned long  __iomem *)&ha->qla4_82xx_reg->rsp_q_in);
  writel(0,
      (unsigned long  __iomem *)&ha->qla4_82xx_reg->rsp_q_out);
 } else if (is_qla8032(ha) || is_qla8042(ha)) {
  writel(0,
         (unsigned long __iomem *)&ha->qla4_83xx_reg->req_q_in);
  writel(0,
         (unsigned long __iomem *)&ha->qla4_83xx_reg->rsp_q_in);
  writel(0,
         (unsigned long __iomem *)&ha->qla4_83xx_reg->rsp_q_out);
 } else {
  /*
   * Initialize DMA Shadow registers.  The firmware is really
   * supposed to take care of this, but on some uniprocessor
   * systems, the shadow registers aren't cleared-- causing
   * the interrupt_handler to think there are responses to be
   * processed when there aren't.
 */
  ha->shadow_regs->req_q_out = cpu_to_le32(0);
  ha->shadow_regs->rsp_q_in = cpu_to_le32(0);
  wmb();

  writel(0, &ha->reg->req_q_in);
  writel(0, &ha->reg->rsp_q_out);
  readl(&ha->reg->rsp_q_out);
 }

 qla4xxx_init_response_q_entries(ha);

 /* Initialize mailbox active array */
 for (i = 0; i < MAX_MRB; i++)
  ha->active_mrb_array[i] = NULL;

 spin_unlock_irqrestore(&ha->hardware_lock, flags);

 return QLA_SUCCESS;
}

/**
 * qla4xxx_get_sys_info - validate adapter MAC address(es)
 * @ha: pointer to host adapter structure.
 *
 **/
int qla4xxx_get_sys_info(struct scsi_qla_host *ha)
{
 struct flash_sys_info *sys_info;
 dma_addr_t sys_info_dma;
 int status = QLA_ERROR;

 sys_info = dma_alloc_coherent(&ha->pdev->dev, sizeof(*sys_info),
          &sys_info_dma, GFP_KERNEL);
 if (sys_info == NULL) {
  DEBUG2(printk("scsi%ld: %s: Unable to allocate dma buffer.\n",
         ha->host_no, __func__));

  goto exit_get_sys_info_no_free;
 }

 /* Get flash sys info */
 if (qla4xxx_get_flash(ha, sys_info_dma, FLASH_OFFSET_SYS_INFO,
         sizeof(*sys_info)) != QLA_SUCCESS) {
  DEBUG2(printk("scsi%ld: %s: get_flash FLASH_OFFSET_SYS_INFO "
         "failed\n", ha->host_no, __func__));

  goto exit_get_sys_info;
 }

 /* Save M.A.C. address & serial_number */
 memcpy(ha->my_mac, &sys_info->physAddr[0].address[0],
        min(sizeof(ha->my_mac),
     sizeof(sys_info->physAddr[0].address)));
 memcpy(ha->serial_number, &sys_info->acSerialNumber,
        min(sizeof(ha->serial_number),
     sizeof(sys_info->acSerialNumber)));

 status = QLA_SUCCESS;

exit_get_sys_info:
 dma_free_coherent(&ha->pdev->dev, sizeof(*sys_info), sys_info,
     sys_info_dma);

exit_get_sys_info_no_free:
 return status;
}

/**
 * qla4xxx_init_local_data - initialize adapter specific local data
 * @ha: pointer to host adapter structure.
 *
 **/
static void qla4xxx_init_local_data(struct scsi_qla_host *ha)
{
 /* Initialize aen queue */
 ha->aen_q_count = MAX_AEN_ENTRIES;
}

static uint8_t
qla4xxx_wait_for_ip_config(struct scsi_qla_host *ha)
{
 uint8_t ipv4_wait = 0;
 uint8_t ipv6_wait = 0;
 int8_t ip_address[IPv6_ADDR_LEN] = {0} ;

 /* If both IPv4 & IPv6 are enabled, possibly only one
  * IP address may be acquired, so check to see if we
 * need to wait for another */
 if (is_ipv4_enabled(ha) && is_ipv6_enabled(ha)) {
  if (((ha->addl_fw_state & FW_ADDSTATE_DHCPv4_ENABLED) != 0) &&
      ((ha->addl_fw_state &
        FW_ADDSTATE_DHCPv4_LEASE_ACQUIRED) == 0)) {
   ipv4_wait = 1;
  }
  if (((ha->ip_config.ipv6_addl_options &
        IPV6_ADDOPT_NEIGHBOR_DISCOVERY_ADDR_ENABLE) != 0) &&
      ((ha->ip_config.ipv6_link_local_state ==
        IP_ADDRSTATE_ACQUIRING) ||
       (ha->ip_config.ipv6_addr0_state ==
        IP_ADDRSTATE_ACQUIRING) ||
       (ha->ip_config.ipv6_addr1_state ==
        IP_ADDRSTATE_ACQUIRING))) {

   ipv6_wait = 1;

   if ((ha->ip_config.ipv6_link_local_state ==
        IP_ADDRSTATE_PREFERRED) ||
       (ha->ip_config.ipv6_addr0_state ==
        IP_ADDRSTATE_PREFERRED) ||
       (ha->ip_config.ipv6_addr1_state ==
        IP_ADDRSTATE_PREFERRED)) {
    DEBUG2(printk(KERN_INFO "scsi%ld: %s: "
           "Preferred IP configured."
           " Don't wait!\n", ha->host_no,
           __func__));
    ipv6_wait = 0;
   }
   if (memcmp(&ha->ip_config.ipv6_default_router_addr,
       ip_address, IPv6_ADDR_LEN) == 0) {
    DEBUG2(printk(KERN_INFO "scsi%ld: %s: "
           "No Router configured. "
           "Don't wait!\n", ha->host_no,
           __func__));
    ipv6_wait = 0;
   }
   if ((ha->ip_config.ipv6_default_router_state ==
        IPV6_RTRSTATE_MANUAL) &&
       (ha->ip_config.ipv6_link_local_state ==
        IP_ADDRSTATE_TENTATIVE) &&
       (memcmp(&ha->ip_config.ipv6_link_local_addr,
        &ha->ip_config.ipv6_default_router_addr, 4) ==
        0)) {
    DEBUG2(printk("scsi%ld: %s: LinkLocal Router & "
     "IP configured. Don't wait!\n",
     ha->host_no, __func__));
    ipv6_wait = 0;
   }
  }
  if (ipv4_wait || ipv6_wait) {
   DEBUG2(printk("scsi%ld: %s: Wait for additional "
          "IP(s) \"", ha->host_no, __func__));
   if (ipv4_wait)
    DEBUG2(printk("IPv4 "));
   if (ha->ip_config.ipv6_link_local_state ==
       IP_ADDRSTATE_ACQUIRING)
    DEBUG2(printk("IPv6LinkLocal "));
   if (ha->ip_config.ipv6_addr0_state ==
       IP_ADDRSTATE_ACQUIRING)
    DEBUG2(printk("IPv6Addr0 "));
   if (ha->ip_config.ipv6_addr1_state ==
       IP_ADDRSTATE_ACQUIRING)
    DEBUG2(printk("IPv6Addr1 "));
   DEBUG2(printk("\"\n"));
  }
 }

 return ipv4_wait|ipv6_wait;
}

static int qla4_80xx_is_minidump_dma_capable(struct scsi_qla_host *ha,
  struct qla4_8xxx_minidump_template_hdr *md_hdr)
{
 int offset = (is_qla8022(ha)) ? QLA8022_TEMPLATE_CAP_OFFSET :
     QLA83XX_TEMPLATE_CAP_OFFSET;
 int rval = 1;
 uint32_t *cap_offset;

 cap_offset = (uint32_t *)((char *)md_hdr + offset);

 if (!(le32_to_cpu(*cap_offset) & BIT_0)) {
  ql4_printk(KERN_INFO, ha, "PEX DMA Not supported %d\n",
      *cap_offset);
  rval = 0;
 }

 return rval;
}

/**
 * qla4xxx_alloc_fw_dump - Allocate memory for minidump data.
 * @ha: pointer to host adapter structure.
 **/
void qla4xxx_alloc_fw_dump(struct scsi_qla_host *ha)
{
 int status;
 uint32_t capture_debug_level;
 int hdr_entry_bit, k;
 void *md_tmp;
 dma_addr_t md_tmp_dma;
 struct qla4_8xxx_minidump_template_hdr *md_hdr;
 int dma_capable;

 if (ha->fw_dump) {
  ql4_printk(KERN_WARNING, ha,
      "Firmware dump previously allocated.\n");
  return;
 }

 status = qla4xxx_req_template_size(ha);
 if (status != QLA_SUCCESS) {
  ql4_printk(KERN_INFO, ha,
      "scsi%ld: Failed to get template size\n",
      ha->host_no);
  return;
 }

 clear_bit(AF_82XX_FW_DUMPED, &ha->flags);

 /* Allocate memory for saving the template */
 md_tmp = dma_alloc_coherent(&ha->pdev->dev, ha->fw_dump_tmplt_size,
        &md_tmp_dma, GFP_KERNEL);
 if (!md_tmp) {
  ql4_printk(KERN_INFO, ha,
      "scsi%ld: Failed to allocate DMA memory\n",
      ha->host_no);
  return;
 }

 /* Request template */
 status =  qla4xxx_get_minidump_template(ha, md_tmp_dma);
 if (status != QLA_SUCCESS) {
  ql4_printk(KERN_INFO, ha,
      "scsi%ld: Failed to get minidump template\n",
      ha->host_no);
  goto alloc_cleanup;
 }

 md_hdr = (struct qla4_8xxx_minidump_template_hdr *)md_tmp;

 dma_capable = qla4_80xx_is_minidump_dma_capable(ha, md_hdr);

 capture_debug_level = md_hdr->capture_debug_level;

 /* Get capture mask based on module loadtime setting. */
 if ((ql4xmdcapmask >= 0x3 && ql4xmdcapmask <= 0x7F) ||
     (ql4xmdcapmask == 0xFF && dma_capable))  {
  ha->fw_dump_capture_mask = ql4xmdcapmask;
 } else {
  if (ql4xmdcapmask == 0xFF)
   ql4_printk(KERN_INFO, ha, "Falling back to default capture mask, as PEX DMA is not supported\n");
  ha->fw_dump_capture_mask = capture_debug_level;
 }

 md_hdr->driver_capture_mask = ha->fw_dump_capture_mask;

 DEBUG2(ql4_printk(KERN_INFO, ha, "Minimum num of entries = %d\n",
     md_hdr->num_of_entries));
 DEBUG2(ql4_printk(KERN_INFO, ha, "Dump template size  = %d\n",
     ha->fw_dump_tmplt_size));
 DEBUG2(ql4_printk(KERN_INFO, ha, "Selected Capture mask =0x%x\n",
     ha->fw_dump_capture_mask));

 /* Calculate fw_dump_size */
 for (hdr_entry_bit = 0x2, k = 1; (hdr_entry_bit & 0xFF);
      hdr_entry_bit <<= 1, k++) {
  if (hdr_entry_bit & ha->fw_dump_capture_mask)
   ha->fw_dump_size += md_hdr->capture_size_array[k];
 }

 /* Total firmware dump size including command header */
 ha->fw_dump_size += ha->fw_dump_tmplt_size;
 ha->fw_dump = vmalloc(ha->fw_dump_size);
 if (!ha->fw_dump)
  goto alloc_cleanup;

 DEBUG2(ql4_printk(KERN_INFO, ha,
     "Minidump Template Size = 0x%x KB\n",
     ha->fw_dump_tmplt_size));
 DEBUG2(ql4_printk(KERN_INFO, ha,
     "Total Minidump size = 0x%x KB\n", ha->fw_dump_size));

 memcpy(ha->fw_dump, md_tmp, ha->fw_dump_tmplt_size);
 ha->fw_dump_tmplt_hdr = ha->fw_dump;

alloc_cleanup:
 dma_free_coherent(&ha->pdev->dev, ha->fw_dump_tmplt_size,
     md_tmp, md_tmp_dma);
}

static int qla4xxx_fw_ready(struct scsi_qla_host *ha)
{
 uint32_t timeout_count;
 int ready = 0;

 DEBUG2(ql4_printk(KERN_INFO, ha, "Waiting for Firmware Ready..\n"));
 for (timeout_count = ADAPTER_INIT_TOV; timeout_count > 0;
      timeout_count--) {
  if (test_and_clear_bit(DPC_GET_DHCP_IP_ADDR, &ha->dpc_flags))
   qla4xxx_get_dhcp_ip_address(ha);

  /* Get firmware state. */
  if (qla4xxx_get_firmware_state(ha) != QLA_SUCCESS) {
   DEBUG2(printk("scsi%ld: %s: unable to get firmware "
          "state\n", ha->host_no, __func__));
   break;
  }

  if (ha->firmware_state & FW_STATE_ERROR) {
   DEBUG2(printk("scsi%ld: %s: an unrecoverable error has"
          " occurred\n", ha->host_no, __func__));
   break;

  }
  if (ha->firmware_state & FW_STATE_CONFIG_WAIT) {
   /*
    * The firmware has not yet been issued an Initialize
    * Firmware command, so issue it now.
 */
   if (qla4xxx_initialize_fw_cb(ha) == QLA_ERROR)
    break;

   /* Go back and test for ready state - no wait. */
   continue;
  }

  if (ha->firmware_state & FW_STATE_WAIT_AUTOCONNECT) {
   DEBUG2(printk(KERN_INFO "scsi%ld: %s: fwstate:"
          "AUTOCONNECT in progress\n",
          ha->host_no, __func__));
  }

  if (ha->firmware_state & FW_STATE_CONFIGURING_IP) {
   DEBUG2(printk(KERN_INFO "scsi%ld: %s: fwstate:"
          " CONFIGURING IP\n",
          ha->host_no, __func__));
   /*
    * Check for link state after 15 secs and if link is
    * still DOWN then, cable is unplugged. Ignore "DHCP
    * in Progress/CONFIGURING IP" bit to check if firmware
    * is in ready state or not after 15 secs.
    * This is applicable for both 2.x & 3.x firmware
 */
   if (timeout_count <= (ADAPTER_INIT_TOV - 15)) {
    if (ha->addl_fw_state & FW_ADDSTATE_LINK_UP) {
     DEBUG2(printk(KERN_INFO "scsi%ld: %s:"
        " LINK UP (Cable plugged)\n",
        ha->host_no, __func__));
    } else if (ha->firmware_state &
       (FW_STATE_CONFIGURING_IP |
            FW_STATE_READY)) {
     DEBUG2(printk(KERN_INFO "scsi%ld: %s: "
      "LINK DOWN (Cable unplugged)\n",
      ha->host_no, __func__));
     ha->firmware_state = FW_STATE_READY;
    }
   }
  }

  if (ha->firmware_state == FW_STATE_READY) {
   /* If DHCP IP Addr is available, retrieve it now. */
   if (test_and_clear_bit(DPC_GET_DHCP_IP_ADDR,
        &ha->dpc_flags))
    qla4xxx_get_dhcp_ip_address(ha);

   if (!qla4xxx_wait_for_ip_config(ha) ||
       timeout_count == 1) {
    DEBUG2(ql4_printk(KERN_INFO, ha,
        "Firmware Ready..\n"));
    /* The firmware is ready to process SCSI
   commands. */
    DEBUG2(ql4_printk(KERN_INFO, ha,
     "scsi%ld: %s: MEDIA TYPE"
     " - %s\n", ha->host_no,
     __func__, (ha->addl_fw_state &
     FW_ADDSTATE_OPTICAL_MEDIA)
     != 0 ? "OPTICAL" : "COPPER"));
    DEBUG2(ql4_printk(KERN_INFO, ha,
     "scsi%ld: %s: DHCPv4 STATE"
     " Enabled %s\n", ha->host_no,
      __func__, (ha->addl_fw_state &
      FW_ADDSTATE_DHCPv4_ENABLED) != 0 ?
     "YES" : "NO"));
    DEBUG2(ql4_printk(KERN_INFO, ha,
     "scsi%ld: %s: LINK %s\n",
     ha->host_no, __func__,
     (ha->addl_fw_state &
      FW_ADDSTATE_LINK_UP) != 0 ?
     "UP" : "DOWN"));
    DEBUG2(ql4_printk(KERN_INFO, ha,
     "scsi%ld: %s: iSNS Service "
     "Started %s\n",
     ha->host_no, __func__,
     (ha->addl_fw_state &
      FW_ADDSTATE_ISNS_SVC_ENABLED) != 0 ?
     "YES" : "NO"));

    ready = 1;
    break;
   }
  }
  DEBUG2(printk("scsi%ld: %s: waiting on fw, state=%x:%x - "
         "seconds expired= %d\n", ha->host_no, __func__,
         ha->firmware_state, ha->addl_fw_state,
         timeout_count));
  if (is_qla4032(ha) &&
   !(ha->addl_fw_state & FW_ADDSTATE_LINK_UP) &&
   (timeout_count < ADAPTER_INIT_TOV - 5)) {
   break;
  }

  msleep(1000);
 }   /* end of for */

 if (timeout_count <= 0)
  DEBUG2(printk("scsi%ld: %s: FW Initialization timed out!\n",
         ha->host_no, __func__));

 if (ha->firmware_state & FW_STATE_CONFIGURING_IP) {
  DEBUG2(printk("scsi%ld: %s: FW initialized, but is reporting "
         "it's waiting to configure an IP address\n",
          ha->host_no, __func__));
  ready = 1;
 } else if (ha->firmware_state & FW_STATE_WAIT_AUTOCONNECT) {
  DEBUG2(printk("scsi%ld: %s: FW initialized, but "
         "auto-discovery still in process\n",
          ha->host_no, __func__));
  ready = 1;
 }

 return ready;
}

/**
 * qla4xxx_init_firmware - initializes the firmware.
 * @ha: pointer to host adapter structure.
 *
 **/
static int qla4xxx_init_firmware(struct scsi_qla_host *ha)
{
 int status = QLA_ERROR;

 if (is_aer_supported(ha) &&
     test_bit(AF_PCI_CHANNEL_IO_PERM_FAILURE, &ha->flags))
  return status;

 /* For 82xx, stop firmware before initializing because if BIOS
  * has previously initialized firmware, then driver's initialize
 * firmware will fail. */
 if (is_qla80XX(ha))
  qla4_8xxx_stop_firmware(ha);

 ql4_printk(KERN_INFO, ha, "Initializing firmware..\n");
 if (qla4xxx_initialize_fw_cb(ha) == QLA_ERROR) {
  DEBUG2(printk("scsi%ld: %s: Failed to initialize firmware "
         "control block\n", ha->host_no, __func__));
  return status;
 }

 if (!qla4xxx_fw_ready(ha))
  return status;

 if (is_qla80XX(ha) && !test_bit(AF_INIT_DONE, &ha->flags))
  qla4xxx_alloc_fw_dump(ha);

 return qla4xxx_get_firmware_status(ha);
}

static void qla4xxx_set_model_info(struct scsi_qla_host *ha)
{
 uint16_t board_id_string[8];
 int i;
 int size = sizeof(ha->nvram->isp4022.boardIdStr);
 int offset = offsetof(struct eeprom_data, isp4022.boardIdStr) / 2;

 for (i = 0; i < (size / 2) ; i++) {
  board_id_string[i] = rd_nvram_word(ha, offset);
  offset += 1;
 }

 memcpy(ha->model_name, board_id_string, size);
}

static int qla4xxx_config_nvram(struct scsi_qla_host *ha)
{
 unsigned long flags;
 union external_hw_config_reg extHwConfig;

 DEBUG2(printk("scsi%ld: %s: Get EEProm parameters \n", ha->host_no,
        __func__));
 if (ql4xxx_lock_flash(ha) != QLA_SUCCESS)
  return QLA_ERROR;
 if (ql4xxx_lock_nvram(ha) != QLA_SUCCESS) {
  ql4xxx_unlock_flash(ha);
  return QLA_ERROR;
 }

 /* Get EEPRom Parameters from NVRAM and validate */
 ql4_printk(KERN_INFO, ha, "Configuring NVRAM ...\n");
 if (qla4xxx_is_nvram_configuration_valid(ha) == QLA_SUCCESS) {
  spin_lock_irqsave(&ha->hardware_lock, flags);
  extHwConfig.Asuint32_t =
   rd_nvram_word(ha, eeprom_ext_hw_conf_offset(ha));
  spin_unlock_irqrestore(&ha->hardware_lock, flags);
 } else {
  ql4_printk(KERN_WARNING, ha,
      "scsi%ld: %s: EEProm checksum invalid.  "
      "Please update your EEPROM\n", ha->host_no,
      __func__);

  /* Attempt to set defaults */
  if (is_qla4010(ha))
   extHwConfig.Asuint32_t = 0x1912;
  else if (is_qla4022(ha) | is_qla4032(ha))
   extHwConfig.Asuint32_t = 0x0023;
  else
   return QLA_ERROR;
 }

 if (is_qla4022(ha) || is_qla4032(ha))
  qla4xxx_set_model_info(ha);
 else
  strcpy(ha->model_name, "QLA4010");

 DEBUG(printk("scsi%ld: %s: Setting extHwConfig to 0xFFFF%04x\n",
       ha->host_no, __func__, extHwConfig.Asuint32_t));

 spin_lock_irqsave(&ha->hardware_lock, flags);
 writel((0xFFFF << 16) | extHwConfig.Asuint32_t, isp_ext_hw_conf(ha));
 readl(isp_ext_hw_conf(ha));
 spin_unlock_irqrestore(&ha->hardware_lock, flags);

 ql4xxx_unlock_nvram(ha);
 ql4xxx_unlock_flash(ha);

 return QLA_SUCCESS;
}

/**
 * qla4_8xxx_pci_config() - Setup ISP82xx PCI configuration registers.
 * @ha: HA context
 */
void qla4_8xxx_pci_config(struct scsi_qla_host *ha)
{
 pci_set_master(ha->pdev);
}

void qla4xxx_pci_config(struct scsi_qla_host *ha)
{
 uint16_t w;
 int status;

 ql4_printk(KERN_INFO, ha, "Configuring PCI space...\n");

 pci_set_master(ha->pdev);
 status = pci_set_mwi(ha->pdev);
 if (status)
  ql4_printk(KERN_WARNING, ha, "Failed to set MWI\n");

 /*
  * We want to respect framework's setting of PCI configuration space
  * command register and also want to make sure that all bits of
  * interest to us are properly set in command register.
 */
 pci_read_config_word(ha->pdev, PCI_COMMAND, &w);
 w |= PCI_COMMAND_PARITY | PCI_COMMAND_SERR;
 w &= ~PCI_COMMAND_INTX_DISABLE;
 pci_write_config_word(ha->pdev, PCI_COMMAND, w);
}

static int qla4xxx_start_firmware_from_flash(struct scsi_qla_host *ha)
{
 int status = QLA_ERROR;
 unsigned long max_wait_time;
 unsigned long flags;
 uint32_t mbox_status;

 ql4_printk(KERN_INFO, ha, "Starting firmware ...\n");

 /*
  * Start firmware from flash ROM
  *
  * WORKAROUND: Stuff a non-constant value that the firmware can
  * use as a seed for a random number generator in MB7 prior to
  * setting BOOT_ENABLE.  Fixes problem where the TCP
  * connections use the same TCP ports after each reboot,
  * causing some connections to not get re-established.
 */
 DEBUG(printk("scsi%d: %s: Start firmware from flash ROM\n",
       ha->host_no, __func__));

 spin_lock_irqsave(&ha->hardware_lock, flags);
 writel(jiffies, &ha->reg->mailbox[7]);
 if (is_qla4022(ha) | is_qla4032(ha))
  writel(set_rmask(NVR_WRITE_ENABLE),
         &ha->reg->u1.isp4022.nvram);

        writel(2, &ha->reg->mailbox[6]);
        readl(&ha->reg->mailbox[6]);

 writel(set_rmask(CSR_BOOT_ENABLE), &ha->reg->ctrl_status);
 readl(&ha->reg->ctrl_status);
 spin_unlock_irqrestore(&ha->hardware_lock, flags);

 /* Wait for firmware to come UP. */
 DEBUG2(printk(KERN_INFO "scsi%ld: %s: Wait up to %d seconds for "
        "boot firmware to complete...\n",
        ha->host_no, __func__, FIRMWARE_UP_TOV));
 max_wait_time = jiffies + (FIRMWARE_UP_TOV * HZ);
 do {
  uint32_t ctrl_status;

  spin_lock_irqsave(&ha->hardware_lock, flags);
  ctrl_status = readw(&ha->reg->ctrl_status);
  mbox_status = readw(&ha->reg->mailbox[0]);
  spin_unlock_irqrestore(&ha->hardware_lock, flags);

  if (ctrl_status & set_rmask(CSR_SCSI_PROCESSOR_INTR))
   break;
  if (mbox_status == MBOX_STS_COMMAND_COMPLETE)
   break;

  DEBUG2(printk(KERN_INFO "scsi%ld: %s: Waiting for boot "
      "firmware to complete... ctrl_sts=0x%x, remaining=%ld\n",
      ha->host_no, __func__, ctrl_status, max_wait_time));

  msleep_interruptible(250);
 } while (!time_after_eq(jiffies, max_wait_time));

 if (mbox_status == MBOX_STS_COMMAND_COMPLETE) {
  DEBUG(printk(KERN_INFO "scsi%ld: %s: Firmware has started\n",
        ha->host_no, __func__));

  spin_lock_irqsave(&ha->hardware_lock, flags);
  writel(set_rmask(CSR_SCSI_PROCESSOR_INTR),
         &ha->reg->ctrl_status);
  readl(&ha->reg->ctrl_status);
  spin_unlock_irqrestore(&ha->hardware_lock, flags);

  status = QLA_SUCCESS;
 } else {
  printk(KERN_INFO "scsi%ld: %s: Boot firmware failed "
         "-  mbox status 0x%x\n", ha->host_no, __func__,
         mbox_status);
  status = QLA_ERROR;
 }
 return status;
}

int ql4xxx_lock_drvr_wait(struct scsi_qla_host *a)
{
#define QL4_LOCK_DRVR_WAIT 60
#define QL4_LOCK_DRVR_SLEEP 1

 int drvr_wait = QL4_LOCK_DRVR_WAIT;
 while (drvr_wait) {
  if (ql4xxx_lock_drvr(a) == 0) {
   ssleep(QL4_LOCK_DRVR_SLEEP);
   DEBUG2(printk("scsi%ld: %s: Waiting for "
          "Global Init Semaphore(%d)...\n",
          a->host_no,
          __func__, drvr_wait));
   drvr_wait -= QL4_LOCK_DRVR_SLEEP;
  } else {
   DEBUG2(printk("scsi%ld: %s: Global Init Semaphore "
          "acquired\n", a->host_no, __func__));
   return QLA_SUCCESS;
  }
 }
 return QLA_ERROR;
}

/**
 * qla4xxx_start_firmware - starts qla4xxx firmware
 * @ha: Pointer to host adapter structure.
 *
 * This routine performs the necessary steps to start the firmware for
 * the QLA4010 adapter.
 **/
int qla4xxx_start_firmware(struct scsi_qla_host *ha)
{
 unsigned long flags = 0;
 uint32_t mbox_status;
 int status = QLA_ERROR;
 int soft_reset = 1;
 int config_chip = 0;

 if (is_qla4022(ha) | is_qla4032(ha))
  ql4xxx_set_mac_number(ha);

 if (ql4xxx_lock_drvr_wait(ha) != QLA_SUCCESS)
  return QLA_ERROR;

 spin_lock_irqsave(&ha->hardware_lock, flags);

 DEBUG2(printk("scsi%ld: %s: port_ctrl = 0x%08X\n", ha->host_no,
        __func__, readw(isp_port_ctrl(ha))));
 DEBUG(printk("scsi%ld: %s: port_status = 0x%08X\n", ha->host_no,
       __func__, readw(isp_port_status(ha))));

 /* Is Hardware already initialized? */
 if ((readw(isp_port_ctrl(ha)) & 0x8000) != 0) {
  DEBUG(printk("scsi%ld: %s: Hardware has already been "
        "initialized\n", ha->host_no, __func__));

  /* Receive firmware boot acknowledgement */
  mbox_status = readw(&ha->reg->mailbox[0]);

  DEBUG2(printk("scsi%ld: %s: H/W Config complete - mbox[0]= "
         "0x%x\n", ha->host_no, __func__, mbox_status));

  /* Is firmware already booted? */
  if (mbox_status == 0) {
   /* F/W not running, must be config by net driver */
   config_chip = 1;
   soft_reset = 0;
  } else {
   writel(set_rmask(CSR_SCSI_PROCESSOR_INTR),
          &ha->reg->ctrl_status);
   readl(&ha->reg->ctrl_status);
   writel(set_rmask(CSR_SCSI_COMPLETION_INTR),
          &ha->reg->ctrl_status);
   readl(&ha->reg->ctrl_status);
   spin_unlock_irqrestore(&ha->hardware_lock, flags);
   if (qla4xxx_get_firmware_state(ha) == QLA_SUCCESS) {
    DEBUG2(printk("scsi%ld: %s: Get firmware "
           "state -- state = 0x%x\n",
           ha->host_no,
           __func__, ha->firmware_state));
    /* F/W is running */
    if (ha->firmware_state &
        FW_STATE_CONFIG_WAIT) {
     DEBUG2(printk("scsi%ld: %s: Firmware "
            "in known state -- "
            "config and "
            "boot, state = 0x%x\n",
            ha->host_no, __func__,
            ha->firmware_state));
     config_chip = 1;
     soft_reset = 0;
    }
   } else {
    DEBUG2(printk("scsi%ld: %s: Firmware in "
           "unknown state -- resetting,"
           " state = "
           "0x%x\n", ha->host_no, __func__,
           ha->firmware_state));
   }
   spin_lock_irqsave(&ha->hardware_lock, flags);
  }
 } else {
  DEBUG(printk("scsi%ld: %s: H/W initialization hasn't been "
        "started - resetting\n", ha->host_no, __func__));
 }
 spin_unlock_irqrestore(&ha->hardware_lock, flags);

 DEBUG(printk("scsi%ld: %s: Flags soft_rest=%d, config= %d\n ",
       ha->host_no, __func__, soft_reset, config_chip));
 if (soft_reset) {
  DEBUG(printk("scsi%ld: %s: Issue Soft Reset\n", ha->host_no,
        __func__));
  status = qla4xxx_soft_reset(ha); /* NOTE: acquires drvr
 * lock again, but ok */
  if (status == QLA_ERROR) {
   DEBUG(printk("scsi%d: %s: Soft Reset failed!\n",
         ha->host_no, __func__));
   ql4xxx_unlock_drvr(ha);
   return QLA_ERROR;
  }
  config_chip = 1;

  /* Reset clears the semaphore, so acquire again */
  if (ql4xxx_lock_drvr_wait(ha) != QLA_SUCCESS)
   return QLA_ERROR;
 }

 if (config_chip) {
  if ((status = qla4xxx_config_nvram(ha)) == QLA_SUCCESS)
   status = qla4xxx_start_firmware_from_flash(ha);
 }

 ql4xxx_unlock_drvr(ha);
 if (status == QLA_SUCCESS) {
  if (test_and_clear_bit(AF_GET_CRASH_RECORD, &ha->flags))
   qla4xxx_get_crash_record(ha);

  qla4xxx_init_rings(ha);
 } else {
  DEBUG(printk("scsi%ld: %s: Firmware has NOT started\n",
        ha->host_no, __func__));
 }
 return status;
}
/**
 * qla4xxx_free_ddb_index - Free DDBs reserved by firmware
 * @ha: pointer to adapter structure
 *
 * Since firmware is not running in autoconnect mode the DDB indices should
 * be freed so that when login happens from user space there are free DDB
 * indices available.
 **/
void qla4xxx_free_ddb_index(struct scsi_qla_host *ha)
{
 int max_ddbs;
 int ret;
 uint32_t idx = 0, next_idx = 0;
 uint32_t state = 0, conn_err = 0;

 max_ddbs =  is_qla40XX(ha) ? MAX_DEV_DB_ENTRIES_40XX :
         MAX_DEV_DB_ENTRIES;

 for (idx = 0; idx < max_ddbs; idx = next_idx) {
  ret = qla4xxx_get_fwddb_entry(ha, idx, NULL, 0, NULL,
           &next_idx, &state, &conn_err,
      NULL, NULL);
  if (ret == QLA_ERROR) {
   next_idx++;
   continue;
  }
  if (state == DDB_DS_NO_CONNECTION_ACTIVE ||
      state == DDB_DS_SESSION_FAILED) {
   DEBUG2(ql4_printk(KERN_INFO, ha,
       "Freeing DDB index = 0x%x\n", idx));
   ret = qla4xxx_clear_ddb_entry(ha, idx);
   if (ret == QLA_ERROR)
    ql4_printk(KERN_ERR, ha,
        "Unable to clear DDB index = "
        "0x%x\n", idx);
  }
  if (next_idx == 0)
   break;
 }
}

/**
 * qla4xxx_initialize_adapter - initiailizes hba
 * @ha: Pointer to host adapter structure.
 * @is_reset: Is this init path or reset path
 *
 * This routine parforms all of the steps necessary to initialize the adapter.
 *
 **/
int qla4xxx_initialize_adapter(struct scsi_qla_host *ha, int is_reset)
{
 int status = QLA_ERROR;

 ha->eeprom_cmd_data = 0;

 ql4_printk(KERN_INFO, ha, "Configuring PCI space...\n");
 ha->isp_ops->pci_config(ha);

 ha->isp_ops->disable_intrs(ha);

 /* Initialize the Host adapter request/response queues and firmware */
 if (ha->isp_ops->start_firmware(ha) == QLA_ERROR)
  goto exit_init_hba;

 /*
  * For ISP83XX, mailbox and IOCB interrupts are enabled separately.
  * Mailbox interrupts must be enabled prior to issuing any mailbox
  * command in order to prevent the possibility of losing interrupts
  * while switching from polling to interrupt mode. IOCB interrupts are
  * enabled via isp_ops->enable_intrs.
 */
 if (is_qla8032(ha) || is_qla8042(ha))
  qla4_83xx_enable_mbox_intrs(ha);

 if (qla4xxx_about_firmware(ha) == QLA_ERROR)
  goto exit_init_hba;

 if (ha->isp_ops->get_sys_info(ha) == QLA_ERROR)
  goto exit_init_hba;

 qla4xxx_init_local_data(ha);

 status = qla4xxx_init_firmware(ha);
 if (status == QLA_ERROR)
  goto exit_init_hba;

 if (is_reset == RESET_ADAPTER)
  qla4xxx_build_ddb_list(ha, is_reset);

 set_bit(AF_ONLINE, &ha->flags);

exit_init_hba:
 DEBUG2(printk("scsi%ld: initialize adapter: %s\n", ha->host_no,
     status == QLA_ERROR ? "FAILED" : "SUCCEEDED"));
 return status;
}

int qla4xxx_ddb_change(struct scsi_qla_host *ha, uint32_t fw_ddb_index,
         struct ddb_entry *ddb_entry, uint32_t state)
{
 uint32_t old_fw_ddb_device_state;
 int status = QLA_ERROR;

 old_fw_ddb_device_state = ddb_entry->fw_ddb_device_state;
 DEBUG2(ql4_printk(KERN_INFO, ha,
     "%s: DDB - old state = 0x%x, new state = 0x%x for "
     "index [%d]\n", __func__,
     ddb_entry->fw_ddb_device_state, state, fw_ddb_index));

 ddb_entry->fw_ddb_device_state = state;

 switch (old_fw_ddb_device_state) {
 case DDB_DS_LOGIN_IN_PROCESS:
  switch (state) {
  case DDB_DS_SESSION_ACTIVE:
  case DDB_DS_DISCOVERY:
   qla4xxx_update_session_conn_param(ha, ddb_entry);
   ddb_entry->unblock_sess(ddb_entry->sess);
   status = QLA_SUCCESS;
   break;
  case DDB_DS_SESSION_FAILED:
  case DDB_DS_NO_CONNECTION_ACTIVE:
   iscsi_conn_login_event(ddb_entry->conn,
            ISCSI_CONN_STATE_FREE);
   status = QLA_SUCCESS;
   break;
  }
  break;
 case DDB_DS_SESSION_ACTIVE:
 case DDB_DS_DISCOVERY:
  switch (state) {
  case DDB_DS_SESSION_FAILED:
   /*
    * iscsi_session failure  will cause userspace to
    * stop the connection which in turn would block the
    * iscsi_session and start relogin
 */
   iscsi_session_failure(ddb_entry->sess->dd_data,
           ISCSI_ERR_CONN_FAILED);
   status = QLA_SUCCESS;
   break;
  case DDB_DS_NO_CONNECTION_ACTIVE:
   clear_bit(fw_ddb_index, ha->ddb_idx_map);
   status = QLA_SUCCESS;
   break;
  }
  break;
 case DDB_DS_SESSION_FAILED:
  switch (state) {
  case DDB_DS_SESSION_ACTIVE:
  case DDB_DS_DISCOVERY:
   ddb_entry->unblock_sess(ddb_entry->sess);
   qla4xxx_update_session_conn_param(ha, ddb_entry);
   status = QLA_SUCCESS;
   break;
  case DDB_DS_SESSION_FAILED:
   iscsi_session_failure(ddb_entry->sess->dd_data,
           ISCSI_ERR_CONN_FAILED);
   status = QLA_SUCCESS;
   break;
  }
  break;
 default:
  DEBUG2(ql4_printk(KERN_INFO, ha, "%s: Unknown Event\n",
    __func__));
  break;
 }
 return status;
}

void qla4xxx_arm_relogin_timer(struct ddb_entry *ddb_entry)
{
 /*
  * This triggers a relogin.  After the relogin_timer
  * expires, the relogin gets scheduled.  We must wait a
  * minimum amount of time since receiving an 0x8014 AEN
  * with failed device_state or a logout response before
  * we can issue another relogin.
  *
  * Firmware pads this timeout: (time2wait +1).
  * Driver retry to login should be longer than F/W.
  * Otherwise F/W will fail
  * set_ddb() mbx cmd with 0x4005 since it still
  * counting down its time2wait.
 */
 atomic_set(&ddb_entry->relogin_timer, 0);
 atomic_set(&ddb_entry->retry_relogin_timer,
     ddb_entry->default_time2wait + 4);

}

int qla4xxx_flash_ddb_change(struct scsi_qla_host *ha, uint32_t fw_ddb_index,
        struct ddb_entry *ddb_entry, uint32_t state)
{
 uint32_t old_fw_ddb_device_state;
 int status = QLA_ERROR;

 old_fw_ddb_device_state = ddb_entry->fw_ddb_device_state;
 DEBUG2(ql4_printk(KERN_INFO, ha,
     "%s: DDB - old state = 0x%x, new state = 0x%x for "
     "index [%d]\n", __func__,
     ddb_entry->fw_ddb_device_state, state, fw_ddb_index));

 ddb_entry->fw_ddb_device_state = state;

 switch (old_fw_ddb_device_state) {
 case DDB_DS_LOGIN_IN_PROCESS:
 case DDB_DS_NO_CONNECTION_ACTIVE:
  switch (state) {
  case DDB_DS_SESSION_ACTIVE:
   ddb_entry->unblock_sess(ddb_entry->sess);
   qla4xxx_update_session_conn_fwddb_param(ha, ddb_entry);
   status = QLA_SUCCESS;
   break;
  case DDB_DS_SESSION_FAILED:
   iscsi_block_session(ddb_entry->sess);
   if (!test_bit(DF_RELOGIN, &ddb_entry->flags))
    qla4xxx_arm_relogin_timer(ddb_entry);
   status = QLA_SUCCESS;
   break;
  }
  break;
 case DDB_DS_SESSION_ACTIVE:
  switch (state) {
  case DDB_DS_SESSION_FAILED:
   iscsi_block_session(ddb_entry->sess);
   if (!test_bit(DF_RELOGIN, &ddb_entry->flags))
    qla4xxx_arm_relogin_timer(ddb_entry);
   status = QLA_SUCCESS;
   break;
  }
  break;
 case DDB_DS_SESSION_FAILED:
  switch (state) {
  case DDB_DS_SESSION_ACTIVE:
   ddb_entry->unblock_sess(ddb_entry->sess);
   qla4xxx_update_session_conn_fwddb_param(ha, ddb_entry);
   status = QLA_SUCCESS;
   break;
  case DDB_DS_SESSION_FAILED:
   if (!test_bit(DF_RELOGIN, &ddb_entry->flags))
    qla4xxx_arm_relogin_timer(ddb_entry);
   status = QLA_SUCCESS;
   break;
  }
  break;
 default:
  DEBUG2(ql4_printk(KERN_INFO, ha, "%s: Unknown Event\n",
      __func__));
  break;
 }
 return status;
}

/**
 * qla4xxx_process_ddb_changed - process ddb state change
 * @ha: Pointer to host adapter structure.
 * @fw_ddb_index: Firmware's device database index
 * @state: Device state
 * @conn_err: Unused
 *
 * This routine processes a Decive Database Changed AEN Event.
 **/
int qla4xxx_process_ddb_changed(struct scsi_qla_host *ha,
    uint32_t fw_ddb_index,
    uint32_t state, uint32_t conn_err)
{
 struct ddb_entry *ddb_entry;

 /* check for out of range index */
 if (fw_ddb_index >= MAX_DDB_ENTRIES)
  goto exit_ddb_event;

 /* Get the corresponging ddb entry */
 ddb_entry = qla4xxx_lookup_ddb_by_fw_index(ha, fw_ddb_index);
 /* Device does not currently exist in our database. */
 if (ddb_entry == NULL) {
  ql4_printk(KERN_ERR, ha, "%s: No ddb_entry at FW index [%d]\n",
      __func__, fw_ddb_index);

  if (state == DDB_DS_NO_CONNECTION_ACTIVE)
   clear_bit(fw_ddb_index, ha->ddb_idx_map);

  goto exit_ddb_event;
 }

 ddb_entry->ddb_change(ha, fw_ddb_index, ddb_entry, state);

exit_ddb_event:
 return QLA_ERROR;
}

/**
 * qla4xxx_login_flash_ddb - Login to target (DDB)
 * @cls_session: Pointer to the session to login
 *
 * This routine logins to the target.
 * Issues setddb and conn open mbx
 **/
void qla4xxx_login_flash_ddb(struct iscsi_cls_session *cls_session)
{
 struct iscsi_session *sess;
 struct ddb_entry *ddb_entry;
 struct scsi_qla_host *ha;
 struct dev_db_entry *fw_ddb_entry = NULL;
 dma_addr_t fw_ddb_dma;
 uint32_t mbx_sts = 0;
 int ret;

 sess = cls_session->dd_data;
 ddb_entry = sess->dd_data;
 ha =  ddb_entry->ha;

 if (!test_bit(AF_LINK_UP, &ha->flags))
  return;

 if (ddb_entry->ddb_type != FLASH_DDB) {
  DEBUG2(ql4_printk(KERN_INFO, ha,
      "Skipping login to non FLASH DB"));
  goto exit_login;
 }

 fw_ddb_entry = dma_pool_alloc(ha->fw_ddb_dma_pool, GFP_KERNEL,
          &fw_ddb_dma);
 if (fw_ddb_entry == NULL) {
  DEBUG2(ql4_printk(KERN_ERR, ha, "Out of memory\n"));
  goto exit_login;
 }

 if (ddb_entry->fw_ddb_index == INVALID_ENTRY) {
  ret = qla4xxx_get_ddb_index(ha, &ddb_entry->fw_ddb_index);
  if (ret == QLA_ERROR)
   goto exit_login;

  ha->fw_ddb_index_map[ddb_entry->fw_ddb_index] = ddb_entry;
  ha->tot_ddbs++;
 }

 memcpy(fw_ddb_entry, &ddb_entry->fw_ddb_entry,
        sizeof(struct dev_db_entry));
 ddb_entry->sess->target_id = ddb_entry->fw_ddb_index;

 ret = qla4xxx_set_ddb_entry(ha, ddb_entry->fw_ddb_index,
        fw_ddb_dma, &mbx_sts);
 if (ret == QLA_ERROR) {
  DEBUG2(ql4_printk(KERN_ERR, ha, "Set DDB failed\n"));
  goto exit_login;
 }

 ddb_entry->fw_ddb_device_state = DDB_DS_LOGIN_IN_PROCESS;
 ret = qla4xxx_conn_open(ha, ddb_entry->fw_ddb_index);
 if (ret == QLA_ERROR) {
  ql4_printk(KERN_ERR, ha, "%s: Login failed: %s\n", __func__,
      sess->targetname);
  goto exit_login;
 }

exit_login:
 if (fw_ddb_entry)
  dma_pool_free(ha->fw_ddb_dma_pool, fw_ddb_entry, fw_ddb_dma);
}