X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fdrv%2Fi2c_bitbang.c;h=4d25731fd2c0e41199e87d2ff473848b7bf47ada;hb=1c11ac0ab0636d07db3899b02c5d89e2d0b020bc;hp=8d93e1b1187a5391e9352ed2fc7841e2cc6f708e;hpb=c9ecb3e0d18109842811a56e9fa816e58d2beb7c;p=bertos.git

diff --git a/bertos/drv/i2c_bitbang.c b/bertos/drv/i2c_bitbang.c
index 8d93e1b1..4d25731f 100644
--- a/bertos/drv/i2c_bitbang.c
+++ b/bertos/drv/i2c_bitbang.c
@@ -169,74 +169,122 @@ int i2c_bitbang_get(bool ack)
 	return (int)(uint8_t)data;
 }
 
-MOD_DEFINE(i2c);
-
-/**
- * Initialize i2c module.
- */
-void i2c_bitbang_init(void)
-{
-	MOD_CHECK(timer);
-	I2C_BITBANG_HW_INIT;
-	SDA_HI;
-	SCL_HI;
-	MOD_INIT(i2c);
-}
 #endif /* !CONFIG_I2C_DISABLE_OLD_API */
 
 /*
  * New I2C API
  */
+static bool old_api = false;
 #define I2C_DEV(i2c)            ((int)((i2c)->hw))
 
 static void i2c_bitbang_stop_1(struct I2c *i2c)
 {
-	i2c_sdaLo(I2C_DEV(i2c));
-	i2c_sclHi(I2C_DEV(i2c));
-	i2c_halfbitDelay(I2C_DEV(i2c));
-	i2c_sdaHi(I2C_DEV(i2c));
+	if (old_api)
+	{
+		SDA_LO;
+		SCL_HI;
+		I2C_HALFBIT_DELAY();
+		SDA_HI;
+	}
+	else
+	{
+		i2c_sdaLo(I2C_DEV(i2c));
+		i2c_sclHi(I2C_DEV(i2c));
+		i2c_halfbitDelay(I2C_DEV(i2c));
+		i2c_sdaHi(I2C_DEV(i2c));
+	}
 }
 
 INLINE bool i2c_bitbang_start_1(struct I2c *i2c)
 {
-	i2c_sdaHi(I2C_DEV(i2c));
-	i2c_sclHi(I2C_DEV(i2c));
-	i2c_halfbitDelay(I2C_DEV(i2c));
-	i2c_sdaLo(I2C_DEV(i2c));
-	i2c_halfbitDelay(I2C_DEV(i2c));
+	bool ret;
+	/* Clear all error, we restart */
+	i2c->errors &= ~(I2C_NO_ACK | I2C_ARB_LOST);
+
+	if (old_api)
+	{
+		SDA_HI;
+		SCL_HI;
+		I2C_HALFBIT_DELAY();
+		SDA_LO;
+		I2C_HALFBIT_DELAY();
+
+		ret = !SDA_IN;
+	}
+	else
+	{
+		i2c_sdaHi(I2C_DEV(i2c));
+		i2c_sclHi(I2C_DEV(i2c));
+		i2c_halfbitDelay(I2C_DEV(i2c));
+		i2c_sdaLo(I2C_DEV(i2c));
+		i2c_halfbitDelay(I2C_DEV(i2c));
 
-	return !i2c_sdaIn(I2C_DEV(i2c));
+		ret = !i2c_sdaIn(I2C_DEV(i2c));
+	}
+
+	return ret;
 }
 
 
 static uint8_t i2c_bitbang_getc(struct I2c *i2c)
 {
 	uint8_t data = 0;
-	for (uint8_t i = 0x80; i != 0; i >>= 1)
+	if (old_api)
 	{
-		i2c_sclLo(I2C_DEV(i2c));
-		i2c_halfbitDelay(I2C_DEV(i2c));
-		i2c_sclHi(I2C_DEV(i2c));
-		if (i2c_sdaIn(I2C_DEV(i2c)))
-			data |= i;
+		for (uint8_t i = 0x80; i != 0; i >>= 1)
+		{
+			SCL_LO;
+			I2C_HALFBIT_DELAY();
+			SCL_HI;
+			if (SDA_IN)
+				data |= i;
+			else
+				data &= ~i;
+
+			I2C_HALFBIT_DELAY();
+		}
+		SCL_LO;
+
+		/* Generate ACK/NACK */
+		if (i2c->xfer_size > 1)
+			SDA_LO;
 		else
-			data &= ~i;
+			SDA_HI;
 
-		i2c_halfbitDelay(I2C_DEV(i2c));
+		I2C_HALFBIT_DELAY();
+		SCL_HI;
+		I2C_HALFBIT_DELAY();
+		SCL_LO;
+		SDA_HI;
 	}
-	i2c_sclLo(I2C_DEV(i2c));
-
-	/* Generate ACK/NACK */
-	if (i2c->xfer_size > 1)
-		i2c_sdaLo(I2C_DEV(i2c));
 	else
-		i2c_sdaHi(I2C_DEV(i2c));
+	{
+		for (uint8_t i = 0x80; i != 0; i >>= 1)
+		{
+			i2c_sclLo(I2C_DEV(i2c));
+			i2c_halfbitDelay(I2C_DEV(i2c));
+			i2c_sclHi(I2C_DEV(i2c));
+			if (i2c_sdaIn(I2C_DEV(i2c)))
+				data |= i;
+			else
+				data &= ~i;
+
+			i2c_halfbitDelay(I2C_DEV(i2c));
+		}
+		i2c_sclLo(I2C_DEV(i2c));
 
-	i2c_halfbitDelay(I2C_DEV(i2c));
-	i2c_sclHi(I2C_DEV(i2c));
-	i2c_halfbitDelay(I2C_DEV(i2c));
-	i2c_sclLo(I2C_DEV(i2c));
-	i2c_sdaHi(I2C_DEV(i2c));
+		/* Generate ACK/NACK */
+		if (i2c->xfer_size > 1)
+			i2c_sdaLo(I2C_DEV(i2c));
+		else
+			i2c_sdaHi(I2C_DEV(i2c));
+
+		i2c_halfbitDelay(I2C_DEV(i2c));
+		i2c_sclHi(I2C_DEV(i2c));
+		i2c_halfbitDelay(I2C_DEV(i2c));
+		i2c_sclLo(I2C_DEV(i2c));
+		i2c_sdaHi(I2C_DEV(i2c));
+	}
 
 	/* Generate stop condition (if requested) */
 	if ((i2c->xfer_size == 1) && (i2c->flags & I2C_STOP))
@@ -249,29 +297,49 @@ static void i2c_bitbang_putc(struct I2c *i2c, uint8_t _data)
 {
 	/* Add ACK bit */
 	uint16_t data = (_data << 1) | 1;
+	bool ack;
 
-	for (uint16_t i = 0x100; i != 0; i >>= 1)
+	if (old_api)
 	{
-		i2c_sclLo(I2C_DEV(i2c));
-		if (data & i)
-			i2c_sdaHi(I2C_DEV(i2c));
-		else
-			i2c_sdaLo(I2C_DEV(i2c));
-		i2c_halfbitDelay(I2C_DEV(i2c));
+		for (uint16_t i = 0x100; i != 0; i >>= 1)
+		{
+			SCL_LO;
+			if (data & i)
+				SDA_HI;
+			else
+				SDA_LO;
+			I2C_HALFBIT_DELAY();
+
+			SCL_HI;
+			I2C_HALFBIT_DELAY();
+		}
 
-		i2c_sclHi(I2C_DEV(i2c));
-		i2c_halfbitDelay(I2C_DEV(i2c));
+		ack = !SDA_IN;
+		SCL_LO;
+		I2C_HALFBIT_DELAY();
 	}
+	else
+	{
+		for (uint16_t i = 0x100; i != 0; i >>= 1)
+		{
+			i2c_sclLo(I2C_DEV(i2c));
+			if (data & i)
+				i2c_sdaHi(I2C_DEV(i2c));
+			else
+				i2c_sdaLo(I2C_DEV(i2c));
+			i2c_halfbitDelay(I2C_DEV(i2c));
+
+			i2c_sclHi(I2C_DEV(i2c));
+			i2c_halfbitDelay(I2C_DEV(i2c));
+		}
+		ack = !i2c_sdaIn(I2C_DEV(i2c));
 
-	bool ack = !i2c_sdaIn(I2C_DEV(i2c));
-	i2c_sclLo(I2C_DEV(i2c));
-	i2c_halfbitDelay(I2C_DEV(i2c));
+		i2c_sclLo(I2C_DEV(i2c));
+		i2c_halfbitDelay(I2C_DEV(i2c));
+	}
 
 	if (!ack)
-	{
-		LOG_ERR("NO ACK received\n");
 		i2c->errors |= I2C_NO_ACK;
-	}
 
 	/* Generate stop condition (if requested) */
 	if (((i2c->xfer_size == 1) && (i2c->flags & I2C_STOP)) || i2c->errors)
@@ -331,11 +399,24 @@ static const I2cVT i2c_bitbang_vt =
 void i2c_hw_bitbangInit(I2c *i2c, int dev)
 {
 	MOD_CHECK(timer);
-	i2c->hw = (struct I2cHardware *)(dev - I2C_BITBANG0);
+	if (dev == I2C_BITBANG_OLD)
+		old_api = true;
+	else
+		i2c->hw = (struct I2cHardware *)(dev - I2C_BITBANG0);
+
 	i2c->vt = &i2c_bitbang_vt;
 
-	i2c_bitbangInit(I2C_DEV(i2c));
-	i2c_sdaHi(I2C_DEV(i2c));
-	i2c_sclHi(I2C_DEV(i2c));
+	if (old_api)
+	{
+		I2C_BITBANG_HW_INIT;
+		SDA_HI;
+		SCL_HI;
+	}
+	else
+	{
+		i2c_bitbangInit(I2C_DEV(i2c));
+		i2c_sdaHi(I2C_DEV(i2c));
+		i2c_sclHi(I2C_DEV(i2c));
+	}
 }