rewrited I2C read and write. Test it