Modified for I2C read debug