Add support for more i2c devices.

[bertos.git] / bertos / drv / i2c.c

diff --git a/bertos/drv/i2c.c b/bertos/drv/i2c.c
index 575dc7681e49648b789f61b53a68f4d96c9cffc6..af3eabbb06055f5154fdcb6cad241068b8129133 100644 (file)
--- a/bertos/drv/i2c.c
+++ b/bertos/drv/i2c.c
@@ -88,3 +88,21 @@ bool i2c_recv(void *_buf, size_t count)
        return true;
 }
 
+
+void i2c_swSend(struct I2c *i2c, const void *_buf, size_t count)
+{
+       const uint8_t *buf = (const uint8_t *)_buf;
+
+       while (count--)
+               i2c_put(i2c, *buf++);
+}
+
+void i2c_swRecv(struct I2c *i2c, void *_buf, size_t count)
+{
+       uint8_t *buf = (uint8_t *)_buf;
+
+       while (count--)
+               *buf++ = i2c_get(i2c);
+}
+
+