1 files changed, 84 insertions, 179 deletions

diff --git a/drivers/scsi/qla2xxx/qla_sup.c b/drivers/scsi/qla2xxx/qla_sup.c
index c538ee1b1a31..303f8ee11f25 100644
--- a/drivers/scsi/qla2xxx/qla_sup.c
+++ b/drivers/scsi/qla2xxx/qla_sup.c
@@ -425,27 +425,27 @@ qla2x00_set_nvram_protection(struct qla_hw_data *ha, int stat)
 #define OPTROM_BURST_DWORDS     (OPTROM_BURST_SIZE / 4)
 
 static inline uint32_t
-flash_conf_to_access_addr(uint32_t faddr)
+flash_conf_addr(struct qla_hw_data *ha, uint32_t faddr)
 {
-        return FARX_ACCESS_FLASH_CONF | faddr;
+        return ha->flash_conf_off | faddr;
 }
 
 static inline uint32_t
-flash_data_to_access_addr(uint32_t faddr)
+flash_data_addr(struct qla_hw_data *ha, uint32_t faddr)
 {
-        return FARX_ACCESS_FLASH_DATA | faddr;
+        return ha->flash_data_off | faddr;
 }
 
 static inline uint32_t
-nvram_conf_to_access_addr(uint32_t naddr)
+nvram_conf_addr(struct qla_hw_data *ha, uint32_t naddr)
 {
-        return FARX_ACCESS_NVRAM_CONF | naddr;
+        return ha->nvram_conf_off | naddr;
 }
 
 static inline uint32_t
-nvram_data_to_access_addr(uint32_t naddr)
+nvram_data_addr(struct qla_hw_data *ha, uint32_t naddr)
 {
-        return FARX_ACCESS_NVRAM_DATA | naddr;
+        return ha->nvram_data_off | naddr;
 }
 
 static uint32_t
@@ -481,10 +481,12 @@ qla24xx_read_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr,
     uint32_t dwords)
 {
         uint32_t i;
+        struct qla_hw_data *ha = vha->hw;
+
         /* Dword reads to flash. */
         for (i = 0; i < dwords; i++, faddr++)
-                dwptr[i] = cpu_to_le32(qla24xx_read_flash_dword(vha->hw,
-                    flash_data_to_access_addr(faddr)));
+                dwptr[i] = cpu_to_le32(qla24xx_read_flash_dword(ha,
+                    flash_data_addr(ha, faddr)));
 
         return dwptr;
 }
@@ -518,7 +520,7 @@ qla24xx_get_flash_manufacturer(struct qla_hw_data *ha, uint8_t *man_id,
 {
         uint32_t ids;
 
-        ids = qla24xx_read_flash_dword(ha, flash_data_to_access_addr(0xd03ab));
+        ids = qla24xx_read_flash_dword(ha, flash_conf_addr(ha, 0x03ab));
         *man_id = LSB(ids);
         *flash_id = MSB(ids);
 
@@ -530,8 +532,7 @@ qla24xx_get_flash_manufacturer(struct qla_hw_data *ha, uint8_t *man_id,
                  * Example: ATMEL 0x00 01 45 1F
                  * Extract MFG and Dev ID from last two bytes.
                  */
-                ids = qla24xx_read_flash_dword(ha,
-                    flash_data_to_access_addr(0xd009f));
+                ids = qla24xx_read_flash_dword(ha, flash_conf_addr(ha, 0x009f));
                 *man_id = LSB(ids);
                 *flash_id = MSB(ids);
         }
@@ -555,9 +556,13 @@ qla2xxx_find_flt_start(scsi_qla_host_t *vha, uint32_t *start)
 
         /* Begin with sane defaults. */
         loc = locations[0];
-        *start = IS_QLA24XX_TYPE(ha) ? FA_FLASH_LAYOUT_ADDR_24:
-            FA_FLASH_LAYOUT_ADDR;
-
+        *start = 0;
+        if (IS_QLA24XX_TYPE(ha))
+                *start = FA_FLASH_LAYOUT_ADDR_24;
+        else if (IS_QLA25XX(ha))
+                *start = FA_FLASH_LAYOUT_ADDR;
+        else if (IS_QLA81XX(ha))
+                *start = FA_FLASH_LAYOUT_ADDR_81;
         /* Begin with first PCI expansion ROM header. */
         buf = (uint8_t *)req->ring;
         dcode = (uint32_t *)req->ring;
@@ -618,6 +623,22 @@ static void
 qla2xxx_get_flt_info(scsi_qla_host_t *vha, uint32_t flt_addr)
 {
         const char *loc, *locations[] = { "DEF", "FLT" };
+        const uint32_t def_fw[] =
+                { FA_RISC_CODE_ADDR, FA_RISC_CODE_ADDR, FA_RISC_CODE_ADDR_81 };
+        const uint32_t def_boot[] =
+                { FA_BOOT_CODE_ADDR, FA_BOOT_CODE_ADDR, FA_BOOT_CODE_ADDR_81 };
+        const uint32_t def_vpd_nvram[] =
+                { FA_VPD_NVRAM_ADDR, FA_VPD_NVRAM_ADDR, FA_VPD_NVRAM_ADDR_81 };
+        const uint32_t def_fdt[] =
+                { FA_FLASH_DESCR_ADDR_24, FA_FLASH_DESCR_ADDR,
+                        FA_FLASH_DESCR_ADDR_81 };
+        const uint32_t def_npiv_conf0[] =
+                { FA_NPIV_CONF0_ADDR_24, FA_NPIV_CONF0_ADDR,
+                        FA_NPIV_CONF0_ADDR_81 };
+        const uint32_t def_npiv_conf1[] =
+                { FA_NPIV_CONF1_ADDR_24, FA_NPIV_CONF1_ADDR,
+                        FA_NPIV_CONF1_ADDR_81 };
+        uint32_t def;
         uint16_t *wptr;
         uint16_t cnt, chksum;
         uint32_t start;
@@ -676,20 +697,12 @@ qla2xxx_get_flt_info(scsi_qla_host_t *vha, uint32_t flt_addr)
                 case FLT_REG_FDT:
                         ha->flt_region_fdt = start;
                         break;
-                case FLT_REG_HW_EVENT_0:
-                        if (!PCI_FUNC(ha->pdev->devfn))
-                                ha->flt_region_hw_event = start;
-                        break;
-                case FLT_REG_HW_EVENT_1:
-                        if (PCI_FUNC(ha->pdev->devfn))
-                                ha->flt_region_hw_event = start;
-                        break;
                 case FLT_REG_NPIV_CONF_0:
-                        if (!PCI_FUNC(ha->pdev->devfn))
+                        if (!(PCI_FUNC(ha->pdev->devfn) & 1))
                                 ha->flt_region_npiv_conf = start;
                         break;
                 case FLT_REG_NPIV_CONF_1:
-                        if (PCI_FUNC(ha->pdev->devfn))
+                        if (PCI_FUNC(ha->pdev->devfn) & 1)
                                 ha->flt_region_npiv_conf = start;
                         break;
                 }
@@ -699,22 +712,24 @@ qla2xxx_get_flt_info(scsi_qla_host_t *vha, uint32_t flt_addr)
 no_flash_data:
         /* Use hardcoded defaults. */
         loc = locations[0];
-        ha->flt_region_fw = FA_RISC_CODE_ADDR;
-        ha->flt_region_boot = FA_BOOT_CODE_ADDR;
-        ha->flt_region_vpd_nvram = FA_VPD_NVRAM_ADDR;
-        ha->flt_region_fdt = IS_QLA24XX_TYPE(ha) ? FA_FLASH_DESCR_ADDR_24:
-            FA_FLASH_DESCR_ADDR;
-        ha->flt_region_hw_event = !PCI_FUNC(ha->pdev->devfn) ?
-            FA_HW_EVENT0_ADDR: FA_HW_EVENT1_ADDR;
-        ha->flt_region_npiv_conf = !PCI_FUNC(ha->pdev->devfn) ?
-            (IS_QLA24XX_TYPE(ha) ? FA_NPIV_CONF0_ADDR_24: FA_NPIV_CONF0_ADDR):
-            (IS_QLA24XX_TYPE(ha) ? FA_NPIV_CONF1_ADDR_24: FA_NPIV_CONF1_ADDR);
+        def = 0;
+        if (IS_QLA24XX_TYPE(ha))
+                def = 0;
+        else if (IS_QLA25XX(ha))
+                def = 1;
+        else if (IS_QLA81XX(ha))
+                def = 2;
+        ha->flt_region_fw = def_fw[def];
+        ha->flt_region_boot = def_boot[def];
+        ha->flt_region_vpd_nvram = def_vpd_nvram[def];
+        ha->flt_region_fdt = def_fdt[def];
+        ha->flt_region_npiv_conf = !(PCI_FUNC(ha->pdev->devfn) & 1) ?
+            def_npiv_conf0[def]: def_npiv_conf1[def];
 done:
         DEBUG2(qla_printk(KERN_DEBUG, ha, "FLT[%s]: boot=0x%x fw=0x%x "
-            "vpd_nvram=0x%x fdt=0x%x flt=0x%x hwe=0x%x npiv=0x%x.\n", loc,
+            "vpd_nvram=0x%x fdt=0x%x flt=0x%x npiv=0x%x.\n", loc,
             ha->flt_region_boot, ha->flt_region_fw, ha->flt_region_vpd_nvram,
-            ha->flt_region_fdt, ha->flt_region_flt, ha->flt_region_hw_event,
-            ha->flt_region_npiv_conf));
+            ha->flt_region_fdt, ha->flt_region_flt, ha->flt_region_npiv_conf));
 }
 
 static void
@@ -757,14 +772,14 @@ qla2xxx_get_fdt_info(scsi_qla_host_t *vha)
         mid = le16_to_cpu(fdt->man_id);
         fid = le16_to_cpu(fdt->id);
         ha->fdt_wrt_disable = fdt->wrt_disable_bits;
-        ha->fdt_erase_cmd = flash_conf_to_access_addr(0x0300 | fdt->erase_cmd);
+        ha->fdt_erase_cmd = flash_conf_addr(ha, 0x0300 | fdt->erase_cmd);
         ha->fdt_block_size = le32_to_cpu(fdt->block_size);
         if (fdt->unprotect_sec_cmd) {
-                ha->fdt_unprotect_sec_cmd = flash_conf_to_access_addr(0x0300 |
+                ha->fdt_unprotect_sec_cmd = flash_conf_addr(ha, 0x0300 |
                     fdt->unprotect_sec_cmd);
                 ha->fdt_protect_sec_cmd = fdt->protect_sec_cmd ?
-                    flash_conf_to_access_addr(0x0300 | fdt->protect_sec_cmd):
-                    flash_conf_to_access_addr(0x0336);
+                    flash_conf_addr(ha, 0x0300 | fdt->protect_sec_cmd):
+                    flash_conf_addr(ha, 0x0336);
         }
         goto done;
 no_flash_data:
@@ -773,7 +788,7 @@ no_flash_data:
         mid = man_id;
         fid = flash_id;
         ha->fdt_wrt_disable = 0x9c;
-        ha->fdt_erase_cmd = flash_conf_to_access_addr(0x03d8);
+        ha->fdt_erase_cmd = flash_conf_addr(ha, 0x03d8);
         switch (man_id) {
         case 0xbf: /* STT flash. */
                 if (flash_id == 0x8e)
@@ -782,16 +797,16 @@ no_flash_data:
                         ha->fdt_block_size = FLASH_BLK_SIZE_32K;
 
                 if (flash_id == 0x80)
-                        ha->fdt_erase_cmd = flash_conf_to_access_addr(0x0352);
+                        ha->fdt_erase_cmd = flash_conf_addr(ha, 0x0352);
                 break;
         case 0x13: /* ST M25P80. */
                 ha->fdt_block_size = FLASH_BLK_SIZE_64K;
                 break;
         case 0x1f: /* Atmel 26DF081A. */
                 ha->fdt_block_size = FLASH_BLK_SIZE_4K;
-                ha->fdt_erase_cmd = flash_conf_to_access_addr(0x0320);
-                ha->fdt_unprotect_sec_cmd = flash_conf_to_access_addr(0x0339);
-                ha->fdt_protect_sec_cmd = flash_conf_to_access_addr(0x0336);
+                ha->fdt_erase_cmd = flash_conf_addr(ha, 0x0320);
+                ha->fdt_unprotect_sec_cmd = flash_conf_addr(ha, 0x0339);
+                ha->fdt_protect_sec_cmd = flash_conf_addr(ha, 0x0336);
                 break;
         default:
                 /* Default to 64 kb sector size. */
@@ -813,7 +828,7 @@ qla2xxx_get_flash_info(scsi_qla_host_t *vha)
         uint32_t flt_addr;
         struct qla_hw_data *ha = vha->hw;
 
-        if (!IS_QLA24XX_TYPE(ha) && !IS_QLA25XX(ha))
+        if (!IS_QLA24XX_TYPE(ha) && !IS_QLA25XX(ha) && !IS_QLA81XX(ha))
                 return QLA_SUCCESS;
 
         ret = qla2xxx_find_flt_start(vha, &flt_addr);
@@ -838,7 +853,7 @@ qla2xxx_flash_npiv_conf(scsi_qla_host_t *vha)
         struct qla_npiv_entry *entry;
         struct qla_hw_data *ha = vha->hw;
 
-        if (!IS_QLA24XX_TYPE(ha) && !IS_QLA25XX(ha))
+        if (!IS_QLA24XX_TYPE(ha) && !IS_QLA25XX(ha) && !IS_QLA81XX(ha))
                 return;
 
         ha->isp_ops->read_optrom(vha, (uint8_t *)&hdr,
@@ -930,9 +945,9 @@ qla24xx_unprotect_flash(struct qla_hw_data *ha)
                 return;
 
         /* Disable flash write-protection. */
-        qla24xx_write_flash_dword(ha, flash_conf_to_access_addr(0x101), 0);
+        qla24xx_write_flash_dword(ha, flash_conf_addr(ha, 0x101), 0);
         /* Some flash parts need an additional zero-write to clear bits.*/
-        qla24xx_write_flash_dword(ha, flash_conf_to_access_addr(0x101), 0);
+        qla24xx_write_flash_dword(ha, flash_conf_addr(ha, 0x101), 0);
 }
 
 static void
@@ -945,11 +960,10 @@ qla24xx_protect_flash(struct qla_hw_data *ha)
                 goto skip_wrt_protect;
 
         /* Enable flash write-protection and wait for completion. */
-        qla24xx_write_flash_dword(ha, flash_conf_to_access_addr(0x101),
+        qla24xx_write_flash_dword(ha, flash_conf_addr(ha, 0x101),
             ha->fdt_wrt_disable);
         for (cnt = 300; cnt &&
-            qla24xx_read_flash_dword(ha,
-                    flash_conf_to_access_addr(0x005)) & BIT_0;
+            qla24xx_read_flash_dword(ha, flash_conf_addr(ha, 0x005)) & BIT_0;
             cnt--) {
                 udelay(10);
         }
@@ -977,7 +991,7 @@ qla24xx_write_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr,
         ret = QLA_SUCCESS;
 
         /* Prepare burst-capable write on supported ISPs. */
-        if (IS_QLA25XX(ha) && !(faddr & 0xfff) &&
+        if ((IS_QLA25XX(ha) || IS_QLA81XX(ha)) && !(faddr & 0xfff) &&
             dwords > OPTROM_BURST_DWORDS) {
                 optrom = dma_alloc_coherent(&ha->pdev->dev, OPTROM_BURST_SIZE,
                     &optrom_dma, GFP_KERNEL);
@@ -989,7 +1003,7 @@ qla24xx_write_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr,
         }
 
         rest_addr = (ha->fdt_block_size >> 2) - 1;
-        sec_mask = 0x80000 - (ha->fdt_block_size >> 2);
+        sec_mask = (ha->optrom_size >> 2) - (ha->fdt_block_size >> 2);
 
         qla24xx_unprotect_flash(ha);
 
@@ -1024,13 +1038,13 @@ qla24xx_write_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr,
                                 *s = cpu_to_le32(*d);
 
                         ret = qla2x00_load_ram(vha, optrom_dma,
-                            flash_data_to_access_addr(faddr),
+                            flash_data_addr(ha, faddr),
                             OPTROM_BURST_DWORDS);
                         if (ret != QLA_SUCCESS) {
                                 qla_printk(KERN_WARNING, ha,
                                     "Unable to burst-write optrom segment "
                                     "(%x/%x/%llx).\n", ret,
-                                    flash_data_to_access_addr(faddr),
+                                    flash_data_addr(ha, faddr),
                                     (unsigned long long)optrom_dma);
                                 qla_printk(KERN_WARNING, ha,
                                     "Reverting to slow-write.\n");
@@ -1047,7 +1061,7 @@ qla24xx_write_flash_data(scsi_qla_host_t *vha, uint32_t *dwptr, uint32_t faddr,
                 }
 
                 ret = qla24xx_write_flash_dword(ha,
-                    flash_data_to_access_addr(faddr), cpu_to_le32(*dwptr));
+                    flash_data_addr(ha, faddr), cpu_to_le32(*dwptr));
                 if (ret != QLA_SUCCESS) {
                         DEBUG9(printk("%s(%ld) Unable to program flash "
                             "address=%x data=%x.\n", __func__,
@@ -1098,12 +1112,13 @@ qla24xx_read_nvram_data(scsi_qla_host_t *vha, uint8_t *buf, uint32_t naddr,
 {
         uint32_t i;
         uint32_t *dwptr;
+        struct qla_hw_data *ha = vha->hw;
 
         /* Dword reads to flash. */
         dwptr = (uint32_t *)buf;
         for (i = 0; i < bytes >> 2; i++, naddr++)
-                dwptr[i] = cpu_to_le32(qla24xx_read_flash_dword(vha->hw,
-                    nvram_data_to_access_addr(naddr)));
+                dwptr[i] = cpu_to_le32(qla24xx_read_flash_dword(ha,
+                    nvram_data_addr(ha, naddr)));
 
         return buf;
 }
@@ -1160,17 +1175,14 @@ qla24xx_write_nvram_data(scsi_qla_host_t *vha, uint8_t *buf, uint32_t naddr,
         RD_REG_DWORD(&reg->ctrl_status);        /* PCI Posting. */
 
         /* Disable NVRAM write-protection. */
-        qla24xx_write_flash_dword(ha, nvram_conf_to_access_addr(0x101),
-            0);
-        qla24xx_write_flash_dword(ha, nvram_conf_to_access_addr(0x101),
-            0);
+        qla24xx_write_flash_dword(ha, nvram_conf_addr(ha, 0x101), 0);
+        qla24xx_write_flash_dword(ha, nvram_conf_addr(ha, 0x101), 0);
 
         /* Dword writes to flash. */
         dwptr = (uint32_t *)buf;
         for (i = 0; i < bytes >> 2; i++, naddr++, dwptr++) {
                 ret = qla24xx_write_flash_dword(ha,
-                    nvram_data_to_access_addr(naddr),
-                    cpu_to_le32(*dwptr));
+                    nvram_data_addr(ha, naddr), cpu_to_le32(*dwptr));
                 if (ret != QLA_SUCCESS) {
                         DEBUG9(qla_printk("Unable to program nvram address=%x "
                             "data=%x.\n", naddr, *dwptr));
@@ -1179,8 +1191,7 @@ qla24xx_write_nvram_data(scsi_qla_host_t *vha, uint8_t *buf, uint32_t naddr,
         }
 
         /* Enable NVRAM write-protection. */
-        qla24xx_write_flash_dword(ha, nvram_conf_to_access_addr(0x101),
-            0x8c);
+        qla24xx_write_flash_dword(ha, nvram_conf_addr(ha, 0x101), 0x8c);
 
         /* Disable flash write. */
         WRT_REG_DWORD(&reg->ctrl_status,
@@ -1202,8 +1213,7 @@ qla25xx_read_nvram_data(scsi_qla_host_t *vha, uint8_t *buf, uint32_t naddr,
         dwptr = (uint32_t *)buf;
         for (i = 0; i < bytes >> 2; i++, naddr++)
                 dwptr[i] = cpu_to_le32(qla24xx_read_flash_dword(ha,
-                    flash_data_to_access_addr(ha->flt_region_vpd_nvram |
-                    naddr)));
+                    flash_data_addr(ha, ha->flt_region_vpd_nvram | naddr)));
 
         return buf;
 }
@@ -2246,12 +2256,12 @@ qla25xx_read_optrom_data(struct scsi_qla_host *vha, uint8_t *buf,
                         burst = left;
 
                 rval = qla2x00_dump_ram(vha, optrom_dma,
-                    flash_data_to_access_addr(faddr), burst);
+                    flash_data_addr(ha, faddr), burst);
                 if (rval) {
                         qla_printk(KERN_WARNING, ha,
                             "Unable to burst-read optrom segment "
                             "(%x/%x/%llx).\n", rval,
-                            flash_data_to_access_addr(faddr),
+                            flash_data_addr(ha, faddr),
                             (unsigned long long)optrom_dma);
                         qla_printk(KERN_WARNING, ha,
                             "Reverting to slow-read.\n");
@@ -2648,108 +2658,3 @@ qla2xxx_get_vpd_field(scsi_qla_host_t *vha, char *key, char *str, size_t size)
 
         return 0;
 }
-
-static int
-qla2xxx_hw_event_store(scsi_qla_host_t *vha, uint32_t *fdata)
-{
-        uint32_t d[2], faddr;
-        struct qla_hw_data *ha = vha->hw;
-
-        /* Locate first empty entry. */
-        for (;;) {
-                if (ha->hw_event_ptr >=
-                    ha->flt_region_hw_event + FA_HW_EVENT_SIZE) {
-                        DEBUG2(qla_printk(KERN_WARNING, ha,
-                            "HW event -- Log Full!\n"));
-                        return QLA_MEMORY_ALLOC_FAILED;
-                }
-
-                qla24xx_read_flash_data(vha, d, ha->hw_event_ptr, 2);
-                faddr = flash_data_to_access_addr(ha->hw_event_ptr);
-                ha->hw_event_ptr += FA_HW_EVENT_ENTRY_SIZE;
-                if (d[0] == __constant_cpu_to_le32(0xffffffff) &&
-                    d[1] == __constant_cpu_to_le32(0xffffffff)) {
-                        qla24xx_unprotect_flash(ha);
-
-                        qla24xx_write_flash_dword(ha, faddr++,
-                            cpu_to_le32(jiffies));
-                        qla24xx_write_flash_dword(ha, faddr++, 0);
-                        qla24xx_write_flash_dword(ha, faddr++, *fdata++);
-                        qla24xx_write_flash_dword(ha, faddr++, *fdata);
-
-                        qla24xx_protect_flash(ha);
-                        break;
-                }
-        }
-        return QLA_SUCCESS;
-}
-
-int
-qla2xxx_hw_event_log(scsi_qla_host_t *vha, uint16_t code, uint16_t d1,
-    uint16_t d2, uint16_t d3)
-{
-#define QMARK(a, b, c, d) \
-    cpu_to_le32(LSB(a) << 24 | LSB(b) << 16 | LSB(c) << 8 | LSB(d))
-        struct qla_hw_data *ha = vha->hw;
-        int rval;
-        uint32_t marker[2], fdata[4];
-
-        if (ha->flt_region_hw_event == 0)
-                return QLA_FUNCTION_FAILED;
-
-        DEBUG2(qla_printk(KERN_WARNING, ha,
-            "HW event -- code=%x, d1=%x, d2=%x, d3=%x.\n", code, d1, d2, d3));
-
-        /* If marker not already found, locate or write.  */
-        if (!ha->flags.hw_event_marker_found) {
-                /* Create marker. */
-                marker[0] = QMARK('L', ha->fw_major_version,
-                    ha->fw_minor_version, ha->fw_subminor_version);
-                marker[1] = QMARK(QLA_DRIVER_MAJOR_VER, QLA_DRIVER_MINOR_VER,
-                    QLA_DRIVER_PATCH_VER, QLA_DRIVER_BETA_VER);
-
-                /* Locate marker. */
-                ha->hw_event_ptr = ha->flt_region_hw_event;
-                for (;;) {
-                        qla24xx_read_flash_data(vha, fdata, ha->hw_event_ptr,
-                            4);
-                        if (fdata[0] == __constant_cpu_to_le32(0xffffffff) &&
-                            fdata[1] == __constant_cpu_to_le32(0xffffffff))
-                                break;
-                        ha->hw_event_ptr += FA_HW_EVENT_ENTRY_SIZE;
-                        if (ha->hw_event_ptr >=
-                            ha->flt_region_hw_event + FA_HW_EVENT_SIZE) {
-                                DEBUG2(qla_printk(KERN_WARNING, ha,
-                                    "HW event -- Log Full!\n"));
-                                return QLA_MEMORY_ALLOC_FAILED;
-                        }
-                        if (fdata[2] == marker[0] && fdata[3] == marker[1]) {
-                                ha->flags.hw_event_marker_found = 1;
-                                break;
-                        }
-                }
-                /* No marker, write it. */
-                if (!ha->flags.hw_event_marker_found) {
-                        rval = qla2xxx_hw_event_store(vha, marker);
-                        if (rval != QLA_SUCCESS) {
-                                DEBUG2(qla_printk(KERN_WARNING, ha,
-                                    "HW event -- Failed marker write=%x.!\n",
-                                    rval));
-                                return rval;
-                        }
-                        ha->flags.hw_event_marker_found = 1;
-                }
-        }
-
-        /* Store error.  */
-        fdata[0] = cpu_to_le32(code << 16 | d1);
-        fdata[1] = cpu_to_le32(d2 << 16 | d3);
-        rval = qla2xxx_hw_event_store(vha, fdata);
-        if (rval != QLA_SUCCESS) {
-                DEBUG2(qla_printk(KERN_WARNING, ha,
-                    "HW event -- Failed error write=%x.!\n",
-                    rval));
-        }
-
-        return rval;
-}