Updated test sketch to use I2C defines