Diff: mbed_i2c.c

Revision:

0:814475fdc553

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed_i2c.c	Tue Jul 05 07:19:59 2016 +0000
@@ -0,0 +1,122 @@
+
+#include <stdio.h>
+#include "i2c_api.h"
+#include "gpio_api.h"
+#include "wait_api.h"
+
+#ifdef TARGET_MCU_NRF51822
+#include "nrf51.h"
+static PinName mbed_i2c_sda_pin = NC;
+static PinName mbed_i2c_scl_pin = NC;
+static uint32_t mbed_i2c_sda_cnf;
+static uint32_t mbed_i2c_scl_cnf;
+#endif
+
+static i2c_t mbed_i2c_object = {0,};
+
+
+void mbed_i2c_init(PinName sda, PinName scl)
+{
+
+    mbed_i2c_sda_pin = sda;
+    mbed_i2c_scl_pin = scl;
+
+    i2c_init(&mbed_i2c_object, sda, scl);
+    i2c_frequency(&mbed_i2c_object, 100000);
+}
+
+int mbed_i2c_write(unsigned char slave_addr,
+                   unsigned char reg_addr,
+                   unsigned char length,
+                   unsigned char const *data)
+{
+    int i;
+    slave_addr = slave_addr << 1;
+    i2c_start(&mbed_i2c_object);
+    i2c_byte_write(&mbed_i2c_object, slave_addr);
+    i2c_byte_write(&mbed_i2c_object, reg_addr);
+    for (i = 0; i < length; i++) {
+        i2c_byte_write(&mbed_i2c_object, data[i]);
+    }
+    i2c_stop(&mbed_i2c_object);
+    return 0;
+}
+
+int mbed_i2c_read(unsigned char slave_addr,
+                  unsigned char reg_addr,
+                  unsigned char length,
+                  unsigned char *data)
+{
+    slave_addr = slave_addr << 1;
+    i2c_write(&mbed_i2c_object, slave_addr, &reg_addr, 1, 0);
+    return (i2c_read(&mbed_i2c_object, slave_addr, data, length, 1) == length) ? 0 : 1;
+}
+
+int mbed_i2c_clear(PinName sda, PinName scl)
+{
+    gpio_t sda_io, scl_io;
+
+#ifdef TARGET_MCU_NRF51822
+    uint32_t sda_cnf = NRF_GPIO->PIN_CNF[sda];
+    uint32_t scl_cnf = NRF_GPIO->PIN_CNF[scl];
+    if (mbed_i2c_object.i2c) {
+        mbed_i2c_object.i2c->PSELSCL = 0xFFFFFFFF;
+        mbed_i2c_object.i2c->PSELSDA = 0xFFFFFFFF;
+    }
+#endif
+
+    gpio_init_in(&sda_io, sda);
+
+    if (!gpio_read(&sda_io)) {
+        printf("sda is always 0, i2c bus is not released\r\n");
+        printf("try to clear i2c bus\r\n");
+        gpio_init_out(&scl_io, scl);
+
+        // Clock max 18 pulses worst case scenario(9 for master to send the rest of command and 9
+        // for slave to respond) to SCL line and wait for SDA come high.
+        for (int i = 0; i < 18; i++) {
+            gpio_write(&scl_io, 0);
+            wait_us(4);
+            gpio_write(&scl_io, 1);
+            wait_us(4);
+        }
+
+        if (!gpio_read(&sda_io)) {
+            printf("warning! sda is still 0,, i2c bus is not released\r\n");
+        }
+    }
+
+#ifdef TARGET_MCU_NRF51822
+    NRF_GPIO->PIN_CNF[sda] = sda_cnf;
+    NRF_GPIO->PIN_CNF[scl] = scl_cnf;
+    if (mbed_i2c_object.i2c) {
+        mbed_i2c_object.i2c->PSELSCL = scl;
+        mbed_i2c_object.i2c->PSELSDA = sda;
+    }
+#endif
+
+    return 0;
+}
+
+void mbed_i2c_enable(void)
+{
+#ifdef TARGET_MCU_NRF51822
+    NRF_GPIO->PIN_CNF[mbed_i2c_sda_pin] = mbed_i2c_sda_cnf;
+    NRF_GPIO->PIN_CNF[mbed_i2c_scl_pin] = mbed_i2c_scl_cnf;
+    
+    mbed_i2c_object.i2c->ENABLE = 4;
+#endif
+}
+
+void mbed_i2c_disable(void)
+{
+#ifdef TARGET_MCU_NRF51822
+    mbed_i2c_sda_cnf = NRF_GPIO->PIN_CNF[mbed_i2c_sda_pin];
+    mbed_i2c_scl_cnf = NRF_GPIO->PIN_CNF[mbed_i2c_scl_pin];
+    
+    mbed_i2c_object.i2c->ENABLE = 0;
+    
+    NRF_GPIO->PIN_CNF[mbed_i2c_sda_pin] = 2;
+    NRF_GPIO->PIN_CNF[mbed_i2c_scl_pin] = 2;
+#endif
+}