Fixed some bugs with I2C bit order