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.arib...@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.arib...@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; > +} _______________________________________________ U-Boot mailing list U-Boot@lists.denx.de http://lists.denx.de/mailman/listinfo/u-boot