/*
#include "i2c.c"

void scan_i2c_devices(void) {
  char sbuf[32];
  int n_devices = 0;
  uint8_t addr = 0;
  for(; addr <= 128; addr++){
    uint8_t result = i2c_start_transmission(addr << 1);
    i2c_end_transmission();
    if (result) { // error
      // Serial.println(" --");
    } else {
      n_devices++;
      Serial.print("0x");
      Serial.println(addr,HEX);
    }
  }
  Serial.print("Devices found: ");
  Serial.println(n_devices);
  Serial.print("-------------------------------\n\n");
}

void setup(){
  Serial.begin(115200);
  init_i2c(400000);
}
void loop(){
  // Scaning program
  Serial.print("I2C Scan....\n");
  scan_i2c_devices();
  delay(1000);

}
*/