I2C refinement and sensor test