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 +#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