From a8d4e0a303b91261965bbba86e0dc77f5d82ab50 Mon Sep 17 00:00:00 2001
From: biver <batata@mail.ru>
Date: Fri, 24 Jun 2022 16:32:42 +0300
Subject: [PATCH] =?UTF-8?q?=D0=94=D0=BE=D0=B1=D0=B0=D0=B2=D0=BB=D1=8F?=
 =?UTF-8?q?=D0=B5=D0=BC=20=D0=B2=20=D1=8F=D0=B4=D1=80=D0=BE=20=D1=84=D1=83?=
 =?UTF-8?q?=D0=BD=D0=BA=D1=86=D0=B8=D1=8E=20=D1=81=D0=BA=D0=B0=D0=BD=D0=B8?=
 =?UTF-8?q?=D1=80=D0=BE=D0=B2=D0=B0=D0=BD=D0=B8=D1=8F=20=D1=88=D0=B8=D0=BD?=
 =?UTF-8?q?=D1=8B=20I2C?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 src/utils/I2CUtils.cpp | 35 +++++++++++++++++++++++++++++++++++
 1 file changed, 35 insertions(+)
 create mode 100644 src/utils/I2CUtils.cpp

diff --git a/src/utils/I2CUtils.cpp b/src/utils/I2CUtils.cpp
new file mode 100644
index 00000000..9d3f9032
--- /dev/null
+++ b/src/utils/I2CUtils.cpp
@@ -0,0 +1,35 @@
+#include <Wire.h>
+#include "utils/SerialPrint.h"
+
+void scanI2C() {
+    byte error, address;
+    int nDevices;
+ 
+    Serial.println("Scanning...");
+ 
+    nDevices = 0;
+    for(address = 8; address < 127; address++ ){
+        Wire.beginTransmission(address);
+        error = Wire.endTransmission();
+ 
+        if (error == 0){
+            Serial.print("I2C device found at address 0x");
+            if (address<16)
+                Serial.print("0");
+            Serial.print(address,HEX);
+            Serial.println(" !");
+ 
+            nDevices++;
+        }
+        else if (error==4) {
+            Serial.print("Unknow error at address 0x");
+            if (address<16)
+                Serial.print("0");
+            Serial.println(address,HEX);
+        } 
+    }
+    if (nDevices == 0)
+        Serial.println("No I2C devices found\n");
+    else
+        Serial.println("done\n");
+}
\ No newline at end of file