Add i2c & lcd driver modules
Updated lcd code