Added I2c to main sketch - not tested