Add support for writing data to EEPROM. Signed-off-by: Ben Dooks <ben@simtec.co.uk> Cc: Wolfram Sang <w.sang@pengutronix.de> Cc: Jean Delvare <khali@linux-fr.org> Cc: Linux Kernel <linux-kernel@vger.kernel.org> Signed-off-by: Stephen Boyd <sboyd@codeaurora.org> Signed-off-by: David S. Miller <davem@davemloft.net>
		
			
				
	
	
		
			321 lines
		
	
	
	
		
			7.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			321 lines
		
	
	
	
		
			7.3 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Copyright (C) 2004 - 2006 rt2x00 SourceForge Project
 | 
						|
 * <http://rt2x00.serialmonkey.com>
 | 
						|
 *
 | 
						|
 * This program is free software; you can redistribute it and/or modify
 | 
						|
 * it under the terms of the GNU General Public License as published by
 | 
						|
 * the Free Software Foundation; either version 2 of the License, or
 | 
						|
 * (at your option) any later version.
 | 
						|
 *
 | 
						|
 * This program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * Module: eeprom_93cx6
 | 
						|
 * Abstract: EEPROM reader routines for 93cx6 chipsets.
 | 
						|
 * Supported chipsets: 93c46 & 93c66.
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/delay.h>
 | 
						|
#include <linux/eeprom_93cx6.h>
 | 
						|
 | 
						|
MODULE_AUTHOR("http://rt2x00.serialmonkey.com");
 | 
						|
MODULE_VERSION("1.0");
 | 
						|
MODULE_DESCRIPTION("EEPROM 93cx6 chip driver");
 | 
						|
MODULE_LICENSE("GPL");
 | 
						|
 | 
						|
static inline void eeprom_93cx6_pulse_high(struct eeprom_93cx6 *eeprom)
 | 
						|
{
 | 
						|
	eeprom->reg_data_clock = 1;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Add a short delay for the pulse to work.
 | 
						|
	 * According to the specifications the "maximum minimum"
 | 
						|
	 * time should be 450ns.
 | 
						|
	 */
 | 
						|
	ndelay(450);
 | 
						|
}
 | 
						|
 | 
						|
static inline void eeprom_93cx6_pulse_low(struct eeprom_93cx6 *eeprom)
 | 
						|
{
 | 
						|
	eeprom->reg_data_clock = 0;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Add a short delay for the pulse to work.
 | 
						|
	 * According to the specifications the "maximum minimum"
 | 
						|
	 * time should be 450ns.
 | 
						|
	 */
 | 
						|
	ndelay(450);
 | 
						|
}
 | 
						|
 | 
						|
static void eeprom_93cx6_startup(struct eeprom_93cx6 *eeprom)
 | 
						|
{
 | 
						|
	/*
 | 
						|
	 * Clear all flags, and enable chip select.
 | 
						|
	 */
 | 
						|
	eeprom->register_read(eeprom);
 | 
						|
	eeprom->reg_data_in = 0;
 | 
						|
	eeprom->reg_data_out = 0;
 | 
						|
	eeprom->reg_data_clock = 0;
 | 
						|
	eeprom->reg_chip_select = 1;
 | 
						|
	eeprom->drive_data = 1;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * kick a pulse.
 | 
						|
	 */
 | 
						|
	eeprom_93cx6_pulse_high(eeprom);
 | 
						|
	eeprom_93cx6_pulse_low(eeprom);
 | 
						|
}
 | 
						|
 | 
						|
static void eeprom_93cx6_cleanup(struct eeprom_93cx6 *eeprom)
 | 
						|
{
 | 
						|
	/*
 | 
						|
	 * Clear chip_select and data_in flags.
 | 
						|
	 */
 | 
						|
	eeprom->register_read(eeprom);
 | 
						|
	eeprom->reg_data_in = 0;
 | 
						|
	eeprom->reg_chip_select = 0;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * kick a pulse.
 | 
						|
	 */
 | 
						|
	eeprom_93cx6_pulse_high(eeprom);
 | 
						|
	eeprom_93cx6_pulse_low(eeprom);
 | 
						|
}
 | 
						|
 | 
						|
static void eeprom_93cx6_write_bits(struct eeprom_93cx6 *eeprom,
 | 
						|
	const u16 data, const u16 count)
 | 
						|
{
 | 
						|
	unsigned int i;
 | 
						|
 | 
						|
	eeprom->register_read(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Clear data flags.
 | 
						|
	 */
 | 
						|
	eeprom->reg_data_in = 0;
 | 
						|
	eeprom->reg_data_out = 0;
 | 
						|
	eeprom->drive_data = 1;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Start writing all bits.
 | 
						|
	 */
 | 
						|
	for (i = count; i > 0; i--) {
 | 
						|
		/*
 | 
						|
		 * Check if this bit needs to be set.
 | 
						|
		 */
 | 
						|
		eeprom->reg_data_in = !!(data & (1 << (i - 1)));
 | 
						|
 | 
						|
		/*
 | 
						|
		 * Write the bit to the eeprom register.
 | 
						|
		 */
 | 
						|
		eeprom->register_write(eeprom);
 | 
						|
 | 
						|
		/*
 | 
						|
		 * Kick a pulse.
 | 
						|
		 */
 | 
						|
		eeprom_93cx6_pulse_high(eeprom);
 | 
						|
		eeprom_93cx6_pulse_low(eeprom);
 | 
						|
	}
 | 
						|
 | 
						|
	eeprom->reg_data_in = 0;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
}
 | 
						|
 | 
						|
static void eeprom_93cx6_read_bits(struct eeprom_93cx6 *eeprom,
 | 
						|
	u16 *data, const u16 count)
 | 
						|
{
 | 
						|
	unsigned int i;
 | 
						|
	u16 buf = 0;
 | 
						|
 | 
						|
	eeprom->register_read(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Clear data flags.
 | 
						|
	 */
 | 
						|
	eeprom->reg_data_in = 0;
 | 
						|
	eeprom->reg_data_out = 0;
 | 
						|
	eeprom->drive_data = 0;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Start reading all bits.
 | 
						|
	 */
 | 
						|
	for (i = count; i > 0; i--) {
 | 
						|
		eeprom_93cx6_pulse_high(eeprom);
 | 
						|
 | 
						|
		eeprom->register_read(eeprom);
 | 
						|
 | 
						|
		/*
 | 
						|
		 * Clear data_in flag.
 | 
						|
		 */
 | 
						|
		eeprom->reg_data_in = 0;
 | 
						|
 | 
						|
		/*
 | 
						|
		 * Read if the bit has been set.
 | 
						|
		 */
 | 
						|
		if (eeprom->reg_data_out)
 | 
						|
			buf |= (1 << (i - 1));
 | 
						|
 | 
						|
		eeprom_93cx6_pulse_low(eeprom);
 | 
						|
	}
 | 
						|
 | 
						|
	*data = buf;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * eeprom_93cx6_read - Read multiple words from eeprom
 | 
						|
 * @eeprom: Pointer to eeprom structure
 | 
						|
 * @word: Word index from where we should start reading
 | 
						|
 * @data: target pointer where the information will have to be stored
 | 
						|
 *
 | 
						|
 * This function will read the eeprom data as host-endian word
 | 
						|
 * into the given data pointer.
 | 
						|
 */
 | 
						|
void eeprom_93cx6_read(struct eeprom_93cx6 *eeprom, const u8 word,
 | 
						|
	u16 *data)
 | 
						|
{
 | 
						|
	u16 command;
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Initialize the eeprom register
 | 
						|
	 */
 | 
						|
	eeprom_93cx6_startup(eeprom);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Select the read opcode and the word to be read.
 | 
						|
	 */
 | 
						|
	command = (PCI_EEPROM_READ_OPCODE << eeprom->width) | word;
 | 
						|
	eeprom_93cx6_write_bits(eeprom, command,
 | 
						|
		PCI_EEPROM_WIDTH_OPCODE + eeprom->width);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Read the requested 16 bits.
 | 
						|
	 */
 | 
						|
	eeprom_93cx6_read_bits(eeprom, data, 16);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Cleanup eeprom register.
 | 
						|
	 */
 | 
						|
	eeprom_93cx6_cleanup(eeprom);
 | 
						|
}
 | 
						|
EXPORT_SYMBOL_GPL(eeprom_93cx6_read);
 | 
						|
 | 
						|
/**
 | 
						|
 * eeprom_93cx6_multiread - Read multiple words from eeprom
 | 
						|
 * @eeprom: Pointer to eeprom structure
 | 
						|
 * @word: Word index from where we should start reading
 | 
						|
 * @data: target pointer where the information will have to be stored
 | 
						|
 * @words: Number of words that should be read.
 | 
						|
 *
 | 
						|
 * This function will read all requested words from the eeprom,
 | 
						|
 * this is done by calling eeprom_93cx6_read() multiple times.
 | 
						|
 * But with the additional change that while the eeprom_93cx6_read
 | 
						|
 * will return host ordered bytes, this method will return little
 | 
						|
 * endian words.
 | 
						|
 */
 | 
						|
void eeprom_93cx6_multiread(struct eeprom_93cx6 *eeprom, const u8 word,
 | 
						|
	__le16 *data, const u16 words)
 | 
						|
{
 | 
						|
	unsigned int i;
 | 
						|
	u16 tmp;
 | 
						|
 | 
						|
	for (i = 0; i < words; i++) {
 | 
						|
		tmp = 0;
 | 
						|
		eeprom_93cx6_read(eeprom, word + i, &tmp);
 | 
						|
		data[i] = cpu_to_le16(tmp);
 | 
						|
	}
 | 
						|
}
 | 
						|
EXPORT_SYMBOL_GPL(eeprom_93cx6_multiread);
 | 
						|
 | 
						|
/**
 | 
						|
 * eeprom_93cx6_wren - set the write enable state
 | 
						|
 * @eeprom: Pointer to eeprom structure
 | 
						|
 * @enable: true to enable writes, otherwise disable writes
 | 
						|
 *
 | 
						|
 * Set the EEPROM write enable state to either allow or deny
 | 
						|
 * writes depending on the @enable value.
 | 
						|
 */
 | 
						|
void eeprom_93cx6_wren(struct eeprom_93cx6 *eeprom, bool enable)
 | 
						|
{
 | 
						|
	u16 command;
 | 
						|
 | 
						|
	/* start the command */
 | 
						|
	eeprom_93cx6_startup(eeprom);
 | 
						|
 | 
						|
	/* create command to enable/disable */
 | 
						|
 | 
						|
	command = enable ? PCI_EEPROM_EWEN_OPCODE : PCI_EEPROM_EWDS_OPCODE;
 | 
						|
	command <<= (eeprom->width - 2);
 | 
						|
 | 
						|
	eeprom_93cx6_write_bits(eeprom, command,
 | 
						|
				PCI_EEPROM_WIDTH_OPCODE + eeprom->width);
 | 
						|
 | 
						|
	eeprom_93cx6_cleanup(eeprom);
 | 
						|
}
 | 
						|
EXPORT_SYMBOL_GPL(eeprom_93cx6_wren);
 | 
						|
 | 
						|
/**
 | 
						|
 * eeprom_93cx6_write - write data to the EEPROM
 | 
						|
 * @eeprom: Pointer to eeprom structure
 | 
						|
 * @addr: Address to write data to.
 | 
						|
 * @data: The data to write to address @addr.
 | 
						|
 *
 | 
						|
 * Write the @data to the specified @addr in the EEPROM and
 | 
						|
 * waiting for the device to finish writing.
 | 
						|
 *
 | 
						|
 * Note, since we do not expect large number of write operations
 | 
						|
 * we delay in between parts of the operation to avoid using excessive
 | 
						|
 * amounts of CPU time busy waiting.
 | 
						|
 */
 | 
						|
void eeprom_93cx6_write(struct eeprom_93cx6 *eeprom, u8 addr, u16 data)
 | 
						|
{
 | 
						|
	int timeout = 100;
 | 
						|
	u16 command;
 | 
						|
 | 
						|
	/* start the command */
 | 
						|
	eeprom_93cx6_startup(eeprom);
 | 
						|
 | 
						|
	command = PCI_EEPROM_WRITE_OPCODE << eeprom->width;
 | 
						|
	command |= addr;
 | 
						|
 | 
						|
	/* send write command */
 | 
						|
	eeprom_93cx6_write_bits(eeprom, command,
 | 
						|
				PCI_EEPROM_WIDTH_OPCODE + eeprom->width);
 | 
						|
 | 
						|
	/* send data */
 | 
						|
	eeprom_93cx6_write_bits(eeprom, data, 16);
 | 
						|
 | 
						|
	/* get ready to check for busy */
 | 
						|
	eeprom->drive_data = 0;
 | 
						|
	eeprom->reg_chip_select = 1;
 | 
						|
	eeprom->register_write(eeprom);
 | 
						|
 | 
						|
	/* wait at-least 250ns to get DO to be the busy signal */
 | 
						|
	usleep_range(1000, 2000);
 | 
						|
 | 
						|
	/* wait for DO to go high to signify finish */
 | 
						|
 | 
						|
	while (true) {
 | 
						|
		eeprom->register_read(eeprom);
 | 
						|
 | 
						|
		if (eeprom->reg_data_out)
 | 
						|
			break;
 | 
						|
 | 
						|
		usleep_range(1000, 2000);
 | 
						|
 | 
						|
		if (--timeout <= 0) {
 | 
						|
			printk(KERN_ERR "%s: timeout\n", __func__);
 | 
						|
			break;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	eeprom_93cx6_cleanup(eeprom);
 | 
						|
}
 | 
						|
EXPORT_SYMBOL_GPL(eeprom_93cx6_write);
 |