Fixed bug in setting stop bits in I2C