| /* |
| * QLogic iSCSI HBA Driver |
| * Copyright (c) 2003-2006 QLogic Corporation |
| * |
| * See LICENSE.qla4xxx for copyright and licensing details. |
| */ |
| |
| #include "ql4_def.h" |
| |
| static inline void eeprom_cmd(uint32_t cmd, struct scsi_qla_host *ha) |
| { |
| writel(cmd, isp_nvram(ha)); |
| readl(isp_nvram(ha)); |
| udelay(1); |
| } |
| |
| static inline int eeprom_size(struct scsi_qla_host *ha) |
| { |
| return is_qla4010(ha) ? FM93C66A_SIZE_16 : FM93C86A_SIZE_16; |
| } |
| |
| static inline int eeprom_no_addr_bits(struct scsi_qla_host *ha) |
| { |
| return is_qla4010(ha) ? FM93C56A_NO_ADDR_BITS_16 : |
| FM93C86A_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; |
| eeprom_cmd(ha->eeprom_cmd_data, 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. */ |
| eeprom_cmd(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1, ha); |
| |
| eeprom_cmd(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1 | |
| AUBURN_EEPROM_CLK_RISE, ha); |
| eeprom_cmd(ha->eeprom_cmd_data | AUBURN_EEPROM_DO_1 | |
| AUBURN_EEPROM_CLK_FALL, 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. |
| */ |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit, ha); |
| previousBit = dataBit; |
| } |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit | |
| AUBURN_EEPROM_CLK_RISE, ha); |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit | |
| AUBURN_EEPROM_CLK_FALL, 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. |
| */ |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit, ha); |
| |
| previousBit = dataBit; |
| } |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit | |
| AUBURN_EEPROM_CLK_RISE, ha); |
| eeprom_cmd(ha->eeprom_cmd_data | dataBit | |
| AUBURN_EEPROM_CLK_FALL, ha); |
| |
| addr = addr << 1; |
| } |
| return 1; |
| } |
| |
| static int fm93c56a_deselect(struct scsi_qla_host * ha) |
| { |
| ha->eeprom_cmd_data = AUBURN_EEPROM_CS_0 | 0x000f0000; |
| eeprom_cmd(ha->eeprom_cmd_data, 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++) { |
| eeprom_cmd(ha->eeprom_cmd_data | |
| AUBURN_EEPROM_CLK_RISE, ha); |
| eeprom_cmd(ha->eeprom_cmd_data | |
| AUBURN_EEPROM_CLK_FALL, 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; |
| } |