fix I2C reading bug