poprawka digitalRead dla MCP

krycha88 · Sep 9, 2021 · 1151a89 · 1151a89
1 parent d96d68a
commit 1151a89
Showing 1 changed file with 6 additions and 9 deletions.
diff --git a/lib/SuplaDeviceExtensions/src/supla/control/MCP_23017.cpp b/lib/SuplaDeviceExtensions/src/supla/control/MCP_23017.cpp
@@ -93,16 +93,13 @@ void MCP23017::setPullup(uint8_t pin, bool pullup, bool inverse) {
 }
 
 bool MCP23017::digitalRead(uint8_t pin) {
-  unsigned long now = millis();
-  if (now > get_ba) {
-    ba = readReg16(MCP23017_GPIOA);  // --------- reads "readReg16" only once
-                                     // every 20 ms  ----
-    get_ba = now + 20;
+  if (millis() - get_ba > 30) {
+    ba = readReg16(MCP23017_GPIOA);
+    get_ba = millis();
   }
-  if (pin < 16) {
-    return ((ba >> (pin % 16)) & 0x01);
-  }
-  return false;
+  // if (pin < 16) {
+  return ((ba >> (pin % 16)) & 0x01);
+  // }
 }
 
 void MCP23017::digitalWrite(uint8_t pin, bool value) {