Added I2C test sketch