Fixed error in i2c write and working on tree for modules