Made I2C work finally :)