Fixed extraneous reads of bytes on i2c