An ultimate I2C scanner. To be ultimate it should check speeds tbh. Arduino port really

Revision:
0:eac9f05ba8e0
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sat Jul 07 13:18:17 2018 +0000
@@ -0,0 +1,34 @@
+#include "mbed.h"
+
+Serial pc(USBTX, USBRX, 115200);
+
+
+I2C i2c(PC_1, PC_0); // SDA, SCL    L476 all on the left side
+//I2C i2c(PB_9, PB_8); // SDA, SCL    arduino pins
+//I2C i2c(PB_14, PB_13); // SDA, SCL
+DigitalOut led(D13);
+
+int main()
+{
+    i2c.frequency(100000);
+    while (1) {
+        pc.printf("Searching for I2C devices...\n\r");
+
+        int count = 0;
+        for (int address = 0; address < 255; address +=2) { // check only for device's read addres
+            if (!i2c.write(address, NULL, 0)) { // 0 returned is ok
+                pc.printf("I2C device found at address 0x%02X (0x%02X in 8-bit)\n\r", address >> 1, address);  // the address is without LSB, which is R/W flag. shoft it right once
+                count++;
+                led = 1;
+            }
+            wait(0.02);
+        }
+        if (count)
+            pc.printf("%d", count);
+        else
+            pc.printf("No");
+        pc.printf(" device%c found\n\r\n", count == 1?'\0':'s');
+        led = 0;
+        wait (1.8);
+    }
+}
\ No newline at end of file