
Hello Albert,
Albert Aribaud wrote:
This driver is for the Marvell TWSI/I2C module found in the orion and kirkwood families among others.
Signed-off-by: Albert Aribaud albert.aribaud@free.fr
While the 'kirkwood_i2c' driver for the Marvell TWSI module is already available in u-boot, this one is 25% smaller, less complex (no state machine) and much faster (i2c probe on an ED Mini V2 takes no noticeable time vs. half a second).
Great!
As the kirkwood_i2c driver is actually not used in any board, we should remove it completely, can you add this for v2?
Beside of that, I have just some minor codstyling comments:
drivers/i2c/Makefile | 1 + drivers/i2c/mvtwsi.c | 419 ++++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 420 insertions(+), 0 deletions(-) create mode 100644 drivers/i2c/mvtwsi.c
diff --git a/drivers/i2c/Makefile b/drivers/i2c/Makefile index d2c2515..73c415d 100644 --- a/drivers/i2c/Makefile +++ b/drivers/i2c/Makefile @@ -30,6 +30,7 @@ COBJS-$(CONFIG_DRIVER_DAVINCI_I2C) += davinci_i2c.o COBJS-$(CONFIG_FSL_I2C) += fsl_i2c.o COBJS-$(CONFIG_I2C_KIRKWOOD) += kirkwood_i2c.o COBJS-$(CONFIG_I2C_MXC) += mxc_i2c.o +COBJS-$(CONFIG_I2C_DRIVER_MVTWSI) += mvtwsi.o COBJS-$(CONFIG_DRIVER_OMAP1510_I2C) += omap1510_i2c.o COBJS-$(CONFIG_DRIVER_OMAP24XX_I2C) += omap24xx_i2c.o COBJS-$(CONFIG_DRIVER_OMAP34XX_I2C) += omap24xx_i2c.o diff --git a/drivers/i2c/mvtwsi.c b/drivers/i2c/mvtwsi.c new file mode 100644 index 0000000..b591328 --- /dev/null +++ b/drivers/i2c/mvtwsi.c @@ -0,0 +1,419 @@ +/*
- Driver for the TWSI (i2c) controller on the Marvell orion5x
- Author: Albert Aribaud albert.aribaud@free.fr
- 2005 (c) MontaVista, Software, Inc.
- See file CREDITS for list of people who contributed to this
- project.
- 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.
- You should have received a copy of the GNU General Public License
- along with this program; if not, write to the Free Software
- Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
- MA 02110-1301 USA
- */
+#include <common.h> +#include <i2c.h> +#include <asm/errno.h> +#include <asm/io.h>
+/*
- include a file that will provide CONFIG_I2C_MVTWSI_BASE
- and possibly other settings
- */
+#if defined(CONFIG_ORION5X) +#include <asm/arch/orion5x.h> +#else +#error Driver mvtwsi not supported by SoC or board +#endif
+/*
- TWSI register structure
- */
+struct mvtwsi_registers {
- u32 slave_address;
- u32 data;
- u32 control;
- union {
u32 status; /* when reading */
u32 baudrate; /* when writing */
- };
- u32 extended_slave_address;
- u32 reserved[2];
- u32 soft_reset;
+};
+/*
- Control register fields
- */
+#define MVTWSI_CONTROL_ACK 0x00000004 +#define MVTWSI_CONTROL_IFLG 0x00000008 +#define MVTWSI_CONTROL_STOP 0x00000010 +#define MVTWSI_CONTROL_START 0x00000020 +#define MVTWSI_CONTROL_TWSIEN 0x00000040 +#define MVTWSI_CONTROL_INTEN 0x00000080
+/*
- Status register values -- only those expected in normal master
- operation on non-10-bit-address devices; whatever status we don't
- expect in nominal conditions (bus errors, arbitration losses,
- missing ACKs...) we just pass back to the caller as an error
- code.
- */
+#define MVTWSI_STATUS_START 0x08 +#define MVTWSI_STATUS_REPEATED_START 0x10 +#define MVTWSI_STATUS_ADDR_W_ACK 0x18 +#define MVTWSI_STATUS_DATA_W_ACK 0x28 +#define MVTWSI_STATUS_ADDR_R_ACK 0x40 +#define MVTWSI_STATUS_ADDR_R_NAK 0x48 +#define MVTWSI_STATUS_DATA_R_ACK 0x50 +#define MVTWSI_STATUS_DATA_R_NAK 0x58 /* our NAK, not the slave's */
line too long.
+#define MVTWSI_STATUS_IDLE 0xF8
+/*
- The single instance of the controller we'll be dealing with
- */
+static struct mvtwsi_registers *twsi =
- (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE;
+/*
- Returned statuses are 0 for success and nonzero otherwise.
- Currently, cmd_i2c and cmd_eeprom do not interpret an error status.
- Thus to ease debugging, the return status contains some debug info:
- bits 31..24 are an error class: 0x01 is timeout, 0x02 is 'status mismatch'.
- bits 23..16 are the last value of the control register.
- bits 15..8 are the last value of the status register.
- bits 7..0 are the expected value of the status register.
- */
+#define MVTWSI_ERROR_WRONG_STATUS 0x01 +#define MVTWSI_ERROR_TIMEOUT 0x02
+#define MVTWSI_ERROR(ec,lc,ls,es) ( ( (ec << 24) & 0xFF000000) | \
- ( (lc << 16) & 0x00FF0000) | ( (ls<<8) & 0x0000FF00) | (es & 0xFF) )
+/*
- Wait for IFLG to raise, or return 'timeout'; then if status is as expected,
- return 0 (ok) or return 'wrong status'.
- */
blank line not necessary.
+static int twsi_wait(int expected_status) +{
- int control,status;
- int timeout = 1000;
please insert a blank line, check this on other places too.
- do {
control = readl(&twsi->control);
if (control & MVTWSI_CONTROL_IFLG) {
status = readl(&twsi->status);
if (status==expected_status)
please insert a space between "=="
return 0;
else
return MVTWSI_ERROR(MVTWSI_ERROR_WRONG_STATUS,control, status,
line too long, also please insert a space after a "," Please check this for the whole file.
expected_status);
}
udelay(10);
- } while (timeout--);
- status = readl(&twsi->status);
- return MVTWSI_ERROR(MVTWSI_ERROR_TIMEOUT,control,status,expected_status);
+}
+/*
- These flags are ORed to any write to the control register
- They allow global setting of TWSIEN and ACK.
- By default none are set.
- twsi_start() sets TWSIEN (in case the controller was disabled)
- twsi_recv() sets ACK or resets it depending on expected status.
- */
blank line not necessary. Please check the whole file
+static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
+/*
- Assert the START condition, either in a single I2C transaction
- or inside back-to-back ones (repeated starts).
- */
+static int twsi_start(int expected_status) +{
- /* globally set TWSIEN in case it was not */
- twsi_control_flags |= MVTWSI_CONTROL_TWSIEN;
- /* assert START */
- writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control);
- /* wait for controller to process START */
- return twsi_wait(expected_status);
+}
+/*
- Send a byte (i2c address or data).
- */
+static int twsi_send(u8 byte, int expected_status) +{
- /* put byte in data register for sending */
- writel(byte, &twsi->data);
- /* clear any pending interrupt -- that'll cause sending */
- writel(twsi_control_flags, &twsi->control);
- /* wait for controller to receive byte and check ACK */
- return twsi_wait(expected_status);
+}
+/*
- Receive a byte.
- Global mvtwsi_control_flags variable says if we should ack or nak.
- */
+static int twsi_recv(u8 *byte) +{
- int expected_status, status;
- /* compute expected status based on ACK bit in global control flags */
- if (twsi_control_flags & MVTWSI_CONTROL_ACK)
expected_status = MVTWSI_STATUS_DATA_R_ACK;
- else
expected_status = MVTWSI_STATUS_DATA_R_NAK;
- /* acknowledge *previous state* and launch receive */
- writel(twsi_control_flags, &twsi->control);
- /* wait for controller to receive byte and assert ACK or NAK */
- status = twsi_wait(expected_status);
- /* if we did receive expected byte then store it */
- if (status==0)
*byte = readl(&twsi->data);
- /* return status */
comment not necessary.
- return status;
+}
+/*
- Assert the STOP condition.
- This is also used to force the bus back in idle (SDA=SCL=1).
- */
+static int twsi_stop(void) +{
- int control,status;
- int timeout = 1000;
- /* assert STOP */
- control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
- writel(control, &twsi->control);
- /* wait for idle condition. There won't be an IFLG so we cannot use twsi_wait(). */
- do {
status = readl(&twsi->status);
if (status==MVTWSI_STATUS_IDLE)
return 0;
udelay(10);
- } while (timeout--);
- control = readl(&twsi->control);
- return MVTWSI_ERROR(MVTWSI_ERROR_TIMEOUT,control,status,MVTWSI_STATUS_IDLE);
+}
+/*
- Ugly formula to convert m and n values to a frequency comes from
- TWSI specifications
- */
+#define TWSI_FREQUENCY(m,n) \
- ( (u8) (CONFIG_SYS_TCLK / (10 * (m + 1) * 2 * (1 << n))) )
+/*
- These are required to be reprogrammed before enabling the controller
- because a reset loses them.
- Default values come from the spec, but a twsi_reset will change them.
- */
+static u8 twsi_baud_rate = 0x44; +static u8 twsi_actual_speed = TWSI_FREQUENCY(4,4); +static u8 twsi_slave_address = 0;
+/*
- Reset controller.
- Called at end of i2c_init unsuccessful i2c transactions.
- Controller reset also resets the baud rate and slave address, so
- re-establish them.
- */
+static void twsi_reset(void) +{
- /* ensure controller will be enabled by any twsi*() function */
- twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
- /* reset controller */
- writel(0, &twsi->soft_reset);
- /* wait 2 ms -- this is what the Marvell LSP does */
- udelay(20000);
- /* set baud rate */
- writel(twsi_baud_rate, &twsi->baudrate);
- /* set slave address even though we don't use it */
- writel(twsi_slave_address, &twsi->slave_address);
- writel(0, &twsi->extended_slave_address);
- /* assert STOP but don't care for the result */
- (void) twsi_stop();
+}
+/*
- I2C init called by cmd_i2c when doing 'i2c reset'.
- Sets baud to the highest possible value not exceeding requested one.
- */
+void i2c_init(int requested_speed, int slaveadd) +{
- int tmp_speed, highest_speed, n, m;
- int baud = 0x44; /* value at controller reset */
- /* use actual speed to collect progressively higher values */
- highest_speed = 0;
- /* compute m,n setting for highest speed not above requested speed */
- for (n = 0; n < 8; n++) {
for (m = 0; m < 16; m++) {
tmp_speed = TWSI_FREQUENCY(m,n);
if (tmp_speed <= requested_speed)
if (tmp_speed > highest_speed) {
highest_speed = tmp_speed;
baud = (m << 3) | n;
}
}
- }
- /* save baud rate and slave for later calls to twsi_reset */
- twsi_baud_rate = baud;
- twsi_actual_speed = highest_speed;
- twsi_slave_address = slaveadd;
- /* reset controller */
- twsi_reset();
+}
+/*
- Begin I2C transaction with expected start status, at given address.
- Common to i2c_probe, i2c_read and i2c_write.
- Expected address status will derive from direction bit (bit 0) in addr.
- */
+static int i2c_begin(int expected_start_status, u8 addr) +{
- int status, expected_addr_status;
- /* compute expected address status from direction bit in addr */
- if (addr & 1) /* reading */
expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
- else /* writing */
expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
- /* assert START */
- status = twsi_start(expected_start_status);
- /* send out the address if the start went well */
- if (status == 0)
status = twsi_send(addr, expected_addr_status);
- /* return ok or status of first failure to caller */
- return status;
+}
+/*
- End I2C transaction, of which the current status is given.
- Common to i2c_probe, i2c_read and i2c_write.
- */
+static int i2c_end(int status) +{
- /* if transaction went well so far, try to assert a STOP */
- /*if (status == 0)*/
Don;t add dead code.
twsi_stop();
- /* if anything went wrong (including the STOP we tried), do a reset */
- /*else
twsi_reset();*/
here too.
- /* return ok or status of first failure to caller */
- return status;
+}
+/*
- I2C probe called by cmd_i2c when doing 'i2c probe'.
- Begin read, nak data byte, end.
- */
+int i2c_probe(uchar chip) +{
- u8 dummy_byte;
- int status;
- /* begin i2c read */
- status = i2c_begin(MVTWSI_STATUS_START, (chip << 1) | 1 );
- /* dummy read was accepted: receive byte but NAK it. */
- if (status==0)
status = twsi_recv( &dummy_byte);
- /* We expected either 0 (ok) or MVTWSI_STATUS_ADDR_R_NAK */
- return i2c_end( (status==MVTWSI_STATUS_ADDR_R_NAK) ? 0: status);
+}
+/*
- I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c
- Begin write, send address byte(s), begin read, receive data bytes, end.
- */
+int i2c_read(u8 dev, uint addr, int alen, u8 *data, int length) +{
- int status;
- /* begin i2c write to send the address bytes */
- status = i2c_begin(MVTWSI_STATUS_START, (dev << 1) );
- /* send addr bytes */
- while ( (status==0) && alen--)
status = twsi_send(addr >> (8*alen), MVTWSI_STATUS_DATA_W_ACK);
- /* NOTE: should we send a stop before a start? That's eeprom-level stuff */
- /* begin i2c read to receive eeprom data bytes */
- if (status == 0)
status = i2c_begin(MVTWSI_STATUS_REPEATED_START, (dev << 1) | 1);
- /* prepare ACK if at least one byte must be received */
- if (length > 0)
twsi_control_flags |= MVTWSI_CONTROL_ACK;
- /* now receive actual bytes */
- while ( (status==0) && length-- ) {
/* reset NAK if we if no more to read now */
if (length == 0)
twsi_control_flags &= ~MVTWSI_CONTROL_ACK;
/* read current byte */
status = twsi_recv(data++);
- }
- /* end i2c transaction */
- return i2c_end(status);
+}
+/*
- I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c
- Begin write, send address byte(s), send data bytes, end.
- */
+int i2c_write(u8 dev, uint addr, int alen, u8 *data, int length) +{
- int status;
- /* begin i2c write to send the eeprom adress bytes then data bytes */
- status = i2c_begin(MVTWSI_STATUS_START, (dev << 1) );
- /* send addr bytes */
- while ( (status==0) && alen--)
status = twsi_send(addr >> (8*alen), MVTWSI_STATUS_DATA_W_ACK);
- /* send data bytes */
- while ( (status==0) && (length-->0) )
status = twsi_send(*(data++), MVTWSI_STATUS_DATA_W_ACK);
- /* end i2c transaction */
- return i2c_end(status);
+}
+/*
- Bus set/get routines: we only support bus 0.
- */
+int i2c_set_bus_num(unsigned int bus) +{
- if (bus > 0) {
return -1;
- }
- return 0;
+}
+unsigned int i2c_get_bus_num(void) +{
- return 0;
+}