Adding an existing and proven I2C library. Will need to test if this is working fine on ESP32 too and try to move I2C functionality to use these functions.