brain-hackers_pepepper-mirror/u-boot-brain
1
0
Fork 0
mirror of https://github.com/brain-hackers/u-boot-brain synced 2024-09-21 04:00:25 +09:00
Code Issues Projects Releases Wiki Activity

mxc_i2c: create tx_byte function

Browse Source 
Use tx_byte function instead of having 3 copies
of the code.

Signed-off-by: Troy Kisky <troy.kisky@boundarydevices.com>
Acked-by: Marek Vasut <marex@denx.de>
This commit is contained in:
Troy Kisky 2012-07-19 08:18:04 +00:00 committed by Heiko Schocher
parent 24cd738bc4
commit cea60b0c6c
1 changed files with 24 additions and 58 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

82
drivers/i2c/mxc_i2c.c
View File

@ -33,6 +33,7 @@
#include <common.h> #include <common.h>
#include <asm/arch/clock.h> #include <asm/arch/clock.h>
#include <asm/arch/imx-regs.h> #include <asm/arch/imx-regs.h>
#include <asm/errno.h>
#include <asm/io.h> #include <asm/io.h>
#include <i2c.h> #include <i2c.h>
@ -207,17 +208,21 @@ int i2c_imx_trx_complete(void)
udelay(1); udelay(1);
} }
return 1; return -ETIMEDOUT;
} }
/* static int tx_byte(struct mxc_i2c_regs *i2c_regs, u8 byte)
* Check if the transaction was ACKed
*/
int i2c_imx_acked(void)
{ {
struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE; int ret;
return readb(&i2c_regs->i2sr) & I2SR_RX_NO_AK; writeb(byte, &i2c_regs->i2dr);
ret = i2c_imx_trx_complete();
if (ret < 0)
return ret;
ret = readb(&i2c_regs->i2sr);
if (ret & I2SR_RX_NO_AK)
return -ENODEV;
return 0;
} }
/* /*
@ -270,30 +275,6 @@ void i2c_imx_stop(void)
writeb(0, &i2c_regs->i2cr); writeb(0, &i2c_regs->i2cr);
} }
/*
* Set chip address and access mode
*
* read = 1: READ access
* read = 0: WRITE access
*/
int i2c_imx_set_chip_addr(uchar chip, int read)
{
struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
int ret;
writeb((chip << 1) | read, &i2c_regs->i2dr);
ret = i2c_imx_trx_complete();
if (ret)
return ret;
ret = i2c_imx_acked();
if (ret)
return ret;
return ret;
}
/* /*
* Write register address * Write register address
*/ */
@ -303,14 +284,8 @@ int i2c_imx_set_reg_addr(uint addr, int alen)
int ret = 0; int ret = 0;
while (alen--) { while (alen--) {
writeb((addr >> (alen * 8)) & 0xff, &i2c_regs->i2dr); ret = tx_byte(i2c_regs, (addr >> (alen * 8)) & 0xff);
if (ret < 0)
ret = i2c_imx_trx_complete();
if (ret)
break;
ret = i2c_imx_acked();
if (ret)
break; break;
} }
@ -322,18 +297,15 @@ int i2c_imx_set_reg_addr(uint addr, int alen)
*/ */
int i2c_probe(uchar chip) int i2c_probe(uchar chip)
{ {
struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
int ret; int ret;
ret = i2c_imx_start(); ret = i2c_imx_start();
if (ret) if (ret)
return ret; return ret;
ret = i2c_imx_set_chip_addr(chip, 0); ret = tx_byte(i2c_regs, chip << 1);
if (ret)
return ret;
i2c_imx_stop(); i2c_imx_stop();
return ret; return ret;
} }
@ -352,8 +324,8 @@ int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
return ret; return ret;
/* write slave address */ /* write slave address */
ret = i2c_imx_set_chip_addr(chip, 0); ret = tx_byte(i2c_regs, chip << 1);
if (ret) if (ret < 0)
return ret; return ret;
ret = i2c_imx_set_reg_addr(addr, alen); ret = i2c_imx_set_reg_addr(addr, alen);
@ -364,8 +336,8 @@ int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
temp |= I2CR_RSTA; temp |= I2CR_RSTA;
writeb(temp, &i2c_regs->i2cr); writeb(temp, &i2c_regs->i2cr);
ret = i2c_imx_set_chip_addr(chip, 1); ret = tx_byte(i2c_regs, (chip << 1) | 1);
if (ret) if (ret < 0)
return ret; return ret;
/* setup bus to read data */ /* setup bus to read data */
@ -419,8 +391,8 @@ int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
return ret; return ret;
/* write slave address */ /* write slave address */
ret = i2c_imx_set_chip_addr(chip, 0); ret = tx_byte(i2c_regs, chip << 1);
if (ret) if (ret < 0)
return ret; return ret;
ret = i2c_imx_set_reg_addr(addr, alen); ret = i2c_imx_set_reg_addr(addr, alen);
@ -428,14 +400,8 @@ int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
return ret; return ret;
for (i = 0; i < len; i++) { for (i = 0; i < len; i++) {
writeb(buf[i], &i2c_regs->i2dr); ret = tx_byte(i2c_regs, buf[i]);
if (ret < 0)
ret = i2c_imx_trx_complete();
if (ret)
return ret;
ret = i2c_imx_acked();
if (ret)
return ret; return ret;
} }