summaryrefslogtreecommitdiff
path: root/drivers
diff options
context:
space:
mode:
Diffstat (limited to 'drivers')
-rw-r--r--drivers/fsl_i2c.c52
1 files changed, 21 insertions, 31 deletions
diff --git a/drivers/fsl_i2c.c b/drivers/fsl_i2c.c
index 72b2556..af19191 100644
--- a/drivers/fsl_i2c.c
+++ b/drivers/fsl_i2c.c
@@ -16,18 +16,16 @@
* MA 02111-1307 USA
*/
-
#include <common.h>
-#include <command.h>
#ifdef CONFIG_HARD_I2C
+#include <command.h>
#include <asm/io.h>
#include <asm/fsl_i2c.h>
#define I2C_TIMEOUT (CFG_HZ / 4)
-
-#define I2C ((struct fsl_i2c *)(CFG_IMMR + CFG_I2C_OFFSET))
+#define I2C ((struct fsl_i2c *)(CFG_IMMR + CFG_I2C_OFFSET))
void
@@ -170,24 +168,19 @@ i2c_read(u8 dev, uint addr, int alen, u8 *data, int length)
int i = 0;
u8 *a = (u8*)&addr;
- if (i2c_wait4bus () < 0)
- goto exit;
-
- if (i2c_write_addr(dev, I2C_WRITE, 0) == 0)
- goto exit;
-
- if (__i2c_write(&a[4 - alen], alen) != alen)
- goto exit;
-
- if (i2c_write_addr(dev, I2C_READ, 1) == 0)
- goto exit;
-
- i = __i2c_read(data, length);
+ if (i2c_wait4bus() >= 0
+ && i2c_write_addr(dev, I2C_WRITE, 0) != 0
+ && __i2c_write(&a[4 - alen], alen) == alen
+ && i2c_write_addr(dev, I2C_READ, 1) != 0) {
+ i = __i2c_read(data, length);
+ }
- exit:
writeb(I2C_CR_MEN, &I2C->cr);
- return !(i == length);
+ if (i == length)
+ return 0;
+
+ return -1;
}
int
@@ -196,21 +189,18 @@ i2c_write(u8 dev, uint addr, int alen, u8 *data, int length)
int i = 0;
u8 *a = (u8*)&addr;
- if (i2c_wait4bus() < 0)
- goto exit;
-
- if (i2c_write_addr(dev, I2C_WRITE, 0) == 0)
- goto exit;
-
- if (__i2c_write(&a[4 - alen], alen) != alen)
- goto exit;
-
- i = __i2c_write(data, length);
+ if (i2c_wait4bus() >= 0
+ && i2c_write_addr(dev, I2C_WRITE, 0) != 0
+ && __i2c_write(&a[4 - alen], alen) == alen) {
+ i = __i2c_write(data, length);
+ }
- exit:
writeb(I2C_CR_MEN, &I2C->cr);
- return !(i == length);
+ if (i == length)
+ return 0;
+
+ return -1;
}
int