Fixed corner case where stop bit was not applied from i2cget commands. Tidied code