fix build temporary
code cleanup
simple code for i2c[unfinish]