diff --git a/src/utils/I2CUtils.cpp b/src/utils/I2CUtils.cpp index 9d3f9032..a8c643c6 100644 --- a/src/utils/I2CUtils.cpp +++ b/src/utils/I2CUtils.cpp @@ -4,32 +4,29 @@ void scanI2C() { byte error, address; int nDevices; - - Serial.println("Scanning..."); + String message = ""; nDevices = 0; - for(address = 8; address < 127; address++ ){ + 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(" !"); + message += "I2C device found at address 0x"; + message += uint64ToString(address, 16); + message += " !"; nDevices++; } else if (error==4) { - Serial.print("Unknow error at address 0x"); - if (address<16) - Serial.print("0"); - Serial.println(address,HEX); + message += "Unknow error at address 0x"; + message += uint64ToString(address, 16); } } if (nDevices == 0) - Serial.println("No I2C devices found\n"); + message += "No I2C devices found\n"; else - Serial.println("done\n"); + message += "done\n"; + + SerialPrint("i", "I2C Scaner", message); } \ No newline at end of file