update and fix I2C library
Merge pull request #2 from quang319/master

update and fix I2C library