add i2c_en

src/i2c.c

@@ -5,6 +5,8 @@
 #include "global.h"
 #include "print.h"
 
+extern uint8_t I2C_EN;
+
 #define SCL_SET(n) SCL = n
 #define SDA_SET(n) SDA = n
 
@@ -29,6 +31,9 @@ void delay_10us() {
 #endif
 
 void I2C_start() {
+    if (!I2C_EN)
+        return;
+
     SDA_SET(1);
     DELAY_Q;
 
@@ -44,6 +49,9 @@ void I2C_start() {
 }
 
 void I2C_stop() {
+    if (!I2C_EN)
+        return;
+
     SDA_SET(0);
     DELAY_Q;
 
@@ -58,6 +66,9 @@ void I2C_stop() {
 uint8_t I2C_ack() {
     uint8_t ret;
 
+    if (!I2C_EN)
+        return 1;
+
     SDA_SET(1);
     DELAY_Q;
 
@@ -74,6 +85,10 @@ uint8_t I2C_ack() {
 
 uint8_t I2C_write_byte(uint8_t val) {
     uint8_t i;
+
+    if (!I2C_EN)
+        return 1;
+
     for (i = 0; i < 8; i++) {
         if (val >> 7)
             SDA_SET(1);
@@ -196,6 +211,9 @@ uint8_t I2C_read_byte(uint8_t no_ack) {
     uint8_t i;
     uint8_t val = 0;
 
+    if (!I2C_EN)
+        return 0;
+
     for (i = 0; i < 8; i++) {
         DELAY_Q;
         SCL_SET(1);

src/mcu.c

@@ -115,11 +115,16 @@ void version_info(void) {
 #endif
 }
 
+uint8_t I2C_EN = 0;
+
 void main(void) {
+    I2C_EN = 0;
 #if (1)
     uint16_t i;
 
-    WAIT(100);
+    WAIT(600);
+    I2C_EN = 1;
+
     // init
     CPU_init();
     WriteReg(0, 0xB0, 0x3E);