Add I2C Lib. Other Small Changes.

Currently I2C Lib can only use in master mode.