Optimize i2c driver