add axp192 v-bus check

m5stack · Dec 21, 2021 · 2e3f34b · 2e3f34b
1 parent 0f35979
commit 2e3f34b
Show file tree

Hide file tree

Showing 2 changed files with 18 additions and 3 deletions.
diff --git a/src/AXP192.cpp b/src/AXP192.cpp
@@ -4,9 +4,15 @@ AXP192::AXP192()
 {
 }
 
+
+// Will be deprecated
 void AXP192::begin(mbus_mode_t mode)
 {
+    begin();
+}
 
+void AXP192::begin()
+{
     Wire1.begin(21, 22);
     Wire1.setClock(400000);
 
@@ -61,8 +67,15 @@ void AXP192::begin(mbus_mode_t mode)
     delay(100);
     // I2C_WriteByteDataAt(0X15,0XFE,0XFF);
 
-    //  bus power mode_output
-    SetBusPowerMode(mode);
+    // axp: check v-bus status
+    if(Read8bit(0x00) & 0x08) {
+        Write1Byte(0x30, Read8bit(0x30) | 0x80);
+        // if v-bus can use, disable M-Bus 5V output to input
+        SetBusPowerMode(kMBusModeInput);
+    }else{
+        // if not, enable M-Bus 5V output
+        SetBusPowerMode(kMBusModeOutput);
+    }
 }
 
 void AXP192::Write1Byte(uint8_t Addr, uint8_t Data)

diff --git a/src/AXP192.h b/src/AXP192.h
@@ -44,7 +44,9 @@ class AXP192 {
     };
 
   	AXP192();
-  	void  begin(mbus_mode_t mode = kMBusModeOutput);
+  	void  begin();
+	// Will be deprecated
+  	void  begin(mbus_mode_t mode);
 	void  ScreenBreath(uint8_t brightness);
 	bool  GetBatState();