Fixed missing mask register setting for I2C