drivers: i2c: mchp_mss: Fix mss_i2c_configure()

Clear the clock bits before setting new ones.

Signed-off-by: Sebastian Huber <sebastian.huber@embedded-brains.de>

Author: sebhub

drivers/i2c/i2c_mchp_mss.c

@@ -127,23 +127,25 @@ struct mss_i2c_data {
 };
 
 
-static int mss_i2c_configure(const struct device *dev, uint32_t dev_config_raw)
+static int mss_i2c_configure(const struct device *dev, uint32_t dev_config)
 {
 	const struct mss_i2c_config *cfg = dev->config;
 
 	uint8_t ctrl = sys_read8(cfg->i2c_base_addr + CORE_I2C_CTRL);
+	ctrl &= ~CLK_MASK;
 
-	switch (I2C_SPEED_GET(dev_config_raw)) {
+	switch (I2C_SPEED_GET(dev_config)) {
 	case I2C_SPEED_STANDARD:
-		sys_write8((ctrl | PCLK_DIV_960), cfg->i2c_base_addr + CORE_I2C_CTRL);
+		ctrl |= PCLK_DIV_960;
 		break;
 	case I2C_SPEED_FAST:
-		sys_write8((ctrl | PCLK_DIV_256), cfg->i2c_base_addr + CORE_I2C_CTRL);
+		ctrl |= PCLK_DIV_256;
 		break;
 	default:
 		return -EINVAL;
 	}
 
+	sys_write8(ctrl, cfg->i2c_base_addr + CORE_I2C_CTRL);
 	return 0;
 }