1 files changed, 224 insertions, 0 deletions

diff --git a/drivers/scsi/qla4xxx/ql4_nvram.c b/drivers/scsi/qla4xxx/ql4_nvram.c
new file mode 100644
index 00000000000..e3957ca5b64
--- /dev/null
+++ b/drivers/scsi/qla4xxx/ql4_nvram.c
@@ -0,0 +1,224 @@
+/*
+ * QLogic iSCSI HBA Driver
+ * Copyright (c)  2003-2006 QLogic Corporation
+ *
+ * See LICENSE.qla4xxx for copyright and licensing details.
+ */
+
+#include "ql4_def.h"
+
+static inline int eeprom_size(struct scsi_qla_host *ha)
+{
+        return is_qla4022(ha) ? FM93C86A_SIZE_16 : FM93C66A_SIZE_16;
+}
+
+static inline int eeprom_no_addr_bits(struct scsi_qla_host *ha)
+{
+        return is_qla4022(ha) ? FM93C86A_NO_ADDR_BITS_16 :
+                FM93C56A_NO_ADDR_BITS_16;
+}
+
+static inline int eeprom_no_data_bits(struct scsi_qla_host *ha)
+{
+        return FM93C56A_DATA_BITS_16;
+}
+
+static int fm93c56a_select(struct scsi_qla_host * ha)
+{
+        DEBUG5(printk(KERN_ERR "fm93c56a_select:\n"));
+
+        ha->eeprom_cmd_data = AUBURN_EEPROM_CS_1 | 0x000f0000;
+        writel(ha->eeprom_cmd_data, isp_nvram(ha));
+        readl(isp_nvram(ha));
+        return 1;
+}
+
+static int fm93c56a_cmd(struct scsi_qla_host * ha, int cmd, int addr)
+{
+        int i;
+        int mask;
+        int dataBit;
+        int previousBit;
+
+        /* Clock in a zero, then do the start bit. */
+        writel(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1, isp_nvram(ha));
+        writel(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1 |
+               AUBURN_EEPROM_CLK_RISE, isp_nvram(ha));
+        writel(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1 |
+               AUBURN_EEPROM_CLK_FALL, isp_nvram(ha));
+        readl(isp_nvram(ha));
+        mask = 1 << (FM93C56A_CMD_BITS - 1);
+
+        /* Force the previous data bit to be different. */
+        previousBit = 0xffff;
+        for (i = 0; i < FM93C56A_CMD_BITS; i++) {
+                dataBit =
+                        (cmd & mask) ? AUBURN_EEPROM_DO_1 : AUBURN_EEPROM_DO_0;
+                if (previousBit != dataBit) {
+
+                        /*
+                         * If the bit changed, then change the DO state to
+                         * match.
+                         */
+                        writel(ha->eeprom_cmd_data | dataBit, isp_nvram(ha));
+                        previousBit = dataBit;
+                }
+                writel(ha->eeprom_cmd_data | dataBit |
+                       AUBURN_EEPROM_CLK_RISE, isp_nvram(ha));
+                writel(ha->eeprom_cmd_data | dataBit |
+                       AUBURN_EEPROM_CLK_FALL, isp_nvram(ha));
+                readl(isp_nvram(ha));
+                cmd = cmd << 1;
+        }
+        mask = 1 << (eeprom_no_addr_bits(ha) - 1);
+
+        /* Force the previous data bit to be different. */
+        previousBit = 0xffff;
+        for (i = 0; i < eeprom_no_addr_bits(ha); i++) {
+                dataBit = addr & mask ? AUBURN_EEPROM_DO_1 :
+                        AUBURN_EEPROM_DO_0;
+                if (previousBit != dataBit) {
+                        /*
+                         * If the bit changed, then change the DO state to
+                         * match.
+                         */
+                        writel(ha->eeprom_cmd_data | dataBit, isp_nvram(ha));
+                        previousBit = dataBit;
+                }
+                writel(ha->eeprom_cmd_data | dataBit |
+                       AUBURN_EEPROM_CLK_RISE, isp_nvram(ha));
+                writel(ha->eeprom_cmd_data | dataBit |
+                       AUBURN_EEPROM_CLK_FALL, isp_nvram(ha));
+                readl(isp_nvram(ha));
+                addr = addr << 1;
+        }
+        return 1;
+}
+
+static int fm93c56a_deselect(struct scsi_qla_host * ha)
+{
+        ha->eeprom_cmd_data = AUBURN_EEPROM_CS_0 | 0x000f0000;
+        writel(ha->eeprom_cmd_data, isp_nvram(ha));
+        readl(isp_nvram(ha));
+        return 1;
+}
+
+static int fm93c56a_datain(struct scsi_qla_host * ha, unsigned short *value)
+{
+        int i;
+        int data = 0;
+        int dataBit;
+
+        /* Read the data bits
+         * The first bit is a dummy.  Clock right over it. */
+        for (i = 0; i < eeprom_no_data_bits(ha); i++) {
+                writel(ha->eeprom_cmd_data |
+                       AUBURN_EEPROM_CLK_RISE, isp_nvram(ha));
+                writel(ha->eeprom_cmd_data |
+                       AUBURN_EEPROM_CLK_FALL, isp_nvram(ha));
+                dataBit =
+                        (readw(isp_nvram(ha)) & AUBURN_EEPROM_DI_1) ? 1 : 0;
+                data = (data << 1) | dataBit;
+        }
+
+        *value = data;
+        return 1;
+}
+
+static int eeprom_readword(int eepromAddr, u16 * value,
+                           struct scsi_qla_host * ha)
+{
+        fm93c56a_select(ha);
+        fm93c56a_cmd(ha, FM93C56A_READ, eepromAddr);
+        fm93c56a_datain(ha, value);
+        fm93c56a_deselect(ha);
+        return 1;
+}
+
+/* Hardware_lock must be set before calling */
+u16 rd_nvram_word(struct scsi_qla_host * ha, int offset)
+{
+        u16 val;
+
+        /* NOTE: NVRAM uses half-word addresses */
+        eeprom_readword(offset, &val, ha);
+        return val;
+}
+
+int qla4xxx_is_nvram_configuration_valid(struct scsi_qla_host * ha)
+{
+        int status = QLA_ERROR;
+        uint16_t checksum = 0;
+        uint32_t index;
+        unsigned long flags;
+
+        spin_lock_irqsave(&ha->hardware_lock, flags);
+        for (index = 0; index < eeprom_size(ha); index++)
+                checksum += rd_nvram_word(ha, index);
+        spin_unlock_irqrestore(&ha->hardware_lock, flags);
+
+        if (checksum == 0)
+                status = QLA_SUCCESS;
+
+        return status;
+}
+
+/*************************************************************************
+ *
+ *                      Hardware Semaphore routines
+ *
+ *************************************************************************/
+int ql4xxx_sem_spinlock(struct scsi_qla_host * ha, u32 sem_mask, u32 sem_bits)
+{
+        uint32_t value;
+        unsigned long flags;
+        unsigned int seconds = 30;
+
+        DEBUG2(printk("scsi%ld : Trying to get SEM lock - mask= 0x%x, code = "
+                      "0x%x\n", ha->host_no, sem_mask, sem_bits));
+        do {
+                spin_lock_irqsave(&ha->hardware_lock, flags);
+                writel((sem_mask | sem_bits), isp_semaphore(ha));
+                value = readw(isp_semaphore(ha));
+                spin_unlock_irqrestore(&ha->hardware_lock, flags);
+                if ((value & (sem_mask >> 16)) == sem_bits) {
+                        DEBUG2(printk("scsi%ld : Got SEM LOCK - mask= 0x%x, "
+                                      "code = 0x%x\n", ha->host_no,
+                                      sem_mask, sem_bits));
+                        return QLA_SUCCESS;
+                }
+                ssleep(1);
+        } while (--seconds);
+        return QLA_ERROR;
+}
+
+void ql4xxx_sem_unlock(struct scsi_qla_host * ha, u32 sem_mask)
+{
+        unsigned long flags;
+
+        spin_lock_irqsave(&ha->hardware_lock, flags);
+        writel(sem_mask, isp_semaphore(ha));
+        readl(isp_semaphore(ha));
+        spin_unlock_irqrestore(&ha->hardware_lock, flags);
+
+        DEBUG2(printk("scsi%ld : UNLOCK SEM - mask= 0x%x\n", ha->host_no,
+                      sem_mask));
+}
+
+int ql4xxx_sem_lock(struct scsi_qla_host * ha, u32 sem_mask, u32 sem_bits)
+{
+        uint32_t value;
+        unsigned long flags;
+
+        spin_lock_irqsave(&ha->hardware_lock, flags);
+        writel((sem_mask | sem_bits), isp_semaphore(ha));
+        value = readw(isp_semaphore(ha));
+        spin_unlock_irqrestore(&ha->hardware_lock, flags);
+        if ((value & (sem_mask >> 16)) == sem_bits) {
+                DEBUG2(printk("scsi%ld : Got SEM LOCK - mask= 0x%x, code = "
+                              "0x%x, sema code=0x%x\n", ha->host_no,
+                              sem_mask, sem_bits, value));
+                return 1;
+        }
+        return 0;
+}