70 static int mtk_i2c_wait_idle(struct mtk_i2c *i2c)  in mtk_i2c_wait_idle()  argument
75 	ret = readl_relaxed_poll_timeout(i2c->base + REG_SM0CTL1_REG,  in mtk_i2c_wait_idle()
79 		dev_dbg(i2c->dev, "idle err(%d)\n", ret);  in mtk_i2c_wait_idle()
84 static void mtk_i2c_reset(struct mtk_i2c *i2c)  in mtk_i2c_reset()  argument
88 	ret = device_reset(i2c->adap.dev.parent);  in mtk_i2c_reset()
90 		dev_err(i2c->dev, "I2C reset failed!\n");  in mtk_i2c_reset()
96 	iowrite32(((i2c->clk_div << 16) & SM0CTL0_CLK_DIV_MASK) | SM0CTL0_EN |  in mtk_i2c_reset()
97 		  SM0CTL0_SCL_STRETCH, i2c->base + REG_SM0CTL0_REG);  in mtk_i2c_reset()
98 	iowrite32(0, i2c->base + REG_SM0CFG2_REG);  in mtk_i2c_reset()
101 static void mtk_i2c_dump_reg(struct mtk_i2c *i2c)  in mtk_i2c_dump_reg()  argument
103 	dev_dbg(i2c->dev,  in mtk_i2c_dump_reg()
105 		ioread32(i2c->base + REG_SM0CFG2_REG),  in mtk_i2c_dump_reg()
106 		ioread32(i2c->base + REG_SM0CTL0_REG),  in mtk_i2c_dump_reg()
107 		ioread32(i2c->base + REG_SM0CTL1_REG),  in mtk_i2c_dump_reg()
108 		ioread32(i2c->base + REG_SM0D0_REG),  in mtk_i2c_dump_reg()
109 		ioread32(i2c->base + REG_SM0D1_REG));  in mtk_i2c_dump_reg()
112 static int mtk_i2c_check_ack(struct mtk_i2c *i2c, u32 expected)  in mtk_i2c_check_ack()  argument
114 	u32 ack = readl_relaxed(i2c->base + REG_SM0CTL1_REG);  in mtk_i2c_check_ack()
120 static int mtk_i2c_start(struct mtk_i2c *i2c)  in mtk_i2c_start()  argument
122 	iowrite32(SM0CTL1_START | SM0CTL1_TRI, i2c->base + REG_SM0CTL1_REG);  in mtk_i2c_start()
123 	return mtk_i2c_wait_idle(i2c);  in mtk_i2c_start()
126 static int mtk_i2c_stop(struct mtk_i2c *i2c)  in mtk_i2c_stop()  argument
128 	iowrite32(SM0CTL1_STOP | SM0CTL1_TRI, i2c->base + REG_SM0CTL1_REG);  in mtk_i2c_stop()
129 	return mtk_i2c_wait_idle(i2c);  in mtk_i2c_stop()
132 static int mtk_i2c_cmd(struct mtk_i2c *i2c, u32 cmd, int page_len)  in mtk_i2c_cmd()  argument
135 		  i2c->base + REG_SM0CTL1_REG);  in mtk_i2c_cmd()
136 	return mtk_i2c_wait_idle(i2c);  in mtk_i2c_cmd()
142 	struct mtk_i2c *i2c;  in mtk_i2c_xfer()  local
149 	i2c = i2c_get_adapdata(adap);  in mtk_i2c_xfer()
155 		ret = mtk_i2c_wait_idle(i2c);  in mtk_i2c_xfer()
160 		ret = mtk_i2c_start(i2c);  in mtk_i2c_xfer()
171 			iowrite32(addr, i2c->base + REG_SM0D0_REG);  in mtk_i2c_xfer()
172 			ret = mtk_i2c_cmd(i2c, SM0CTL1_WRITE, 2);  in mtk_i2c_xfer()
178 			iowrite32(addr, i2c->base + REG_SM0D0_REG);  in mtk_i2c_xfer()
179 			ret = mtk_i2c_cmd(i2c, SM0CTL1_WRITE, 1);  in mtk_i2c_xfer()
186 			ret = mtk_i2c_check_ack(i2c, BIT(0));  in mtk_i2c_xfer()
200 				iowrite32(data[0], i2c->base + REG_SM0D0_REG);  in mtk_i2c_xfer()
201 				iowrite32(data[1], i2c->base + REG_SM0D1_REG);  in mtk_i2c_xfer()
205 			ret = mtk_i2c_cmd(i2c, cmd, page_len);  in mtk_i2c_xfer()
210 				data[0] = ioread32(i2c->base + REG_SM0D0_REG);  in mtk_i2c_xfer()
211 				data[1] = ioread32(i2c->base + REG_SM0D1_REG);  in mtk_i2c_xfer()
215 					ret = mtk_i2c_check_ack(i2c,  in mtk_i2c_xfer()
225 	ret = mtk_i2c_stop(i2c);  in mtk_i2c_xfer()
233 	ret = mtk_i2c_stop(i2c);  in mtk_i2c_xfer()
239 	mtk_i2c_dump_reg(i2c);  in mtk_i2c_xfer()
240 	mtk_i2c_reset(i2c);  in mtk_i2c_xfer()
261 static void mtk_i2c_init(struct mtk_i2c *i2c)  in mtk_i2c_init()  argument
263 	i2c->clk_div = clk_get_rate(i2c->clk) / i2c->bus_freq - 1;  in mtk_i2c_init()
264 	if (i2c->clk_div < 99)  in mtk_i2c_init()
265 		i2c->clk_div = 99;  in mtk_i2c_init()
266 	if (i2c->clk_div > SM0CTL0_CLK_DIV_MAX)  in mtk_i2c_init()
267 		i2c->clk_div = SM0CTL0_CLK_DIV_MAX;  in mtk_i2c_init()
269 	mtk_i2c_reset(i2c);  in mtk_i2c_init()
274 	struct mtk_i2c *i2c;  in mtk_i2c_probe()  local
278 	i2c = devm_kzalloc(&pdev->dev, sizeof(struct mtk_i2c), GFP_KERNEL);  in mtk_i2c_probe()
279 	if (!i2c)  in mtk_i2c_probe()
282 	i2c->base = devm_platform_get_and_ioremap_resource(pdev, 0, NULL);  in mtk_i2c_probe()
283 	if (IS_ERR(i2c->base))  in mtk_i2c_probe()
284 		return PTR_ERR(i2c->base);  in mtk_i2c_probe()
286 	i2c->clk = devm_clk_get_enabled(&pdev->dev, NULL);  in mtk_i2c_probe()
287 	if (IS_ERR(i2c->clk)) {  in mtk_i2c_probe()
289 		return PTR_ERR(i2c->clk);  in mtk_i2c_probe()
292 	i2c->dev = &pdev->dev;  in mtk_i2c_probe()
295 				 &i2c->bus_freq))  in mtk_i2c_probe()
296 		i2c->bus_freq = I2C_MAX_STANDARD_MODE_FREQ;  in mtk_i2c_probe()
298 	if (i2c->bus_freq == 0) {  in mtk_i2c_probe()
299 		dev_warn(i2c->dev, "clock-frequency 0 not supported\n");  in mtk_i2c_probe()
303 	adap = &i2c->adap;  in mtk_i2c_probe()
308 	i2c_set_adapdata(adap, i2c);  in mtk_i2c_probe()
312 	platform_set_drvdata(pdev, i2c);  in mtk_i2c_probe()
314 	mtk_i2c_init(i2c);  in mtk_i2c_probe()
320 	dev_info(&pdev->dev, "clock %u kHz\n", i2c->bus_freq / 1000);  in mtk_i2c_probe()
327 	struct mtk_i2c *i2c = platform_get_drvdata(pdev);  in mtk_i2c_remove()  local
329 	i2c_del_adapter(&i2c->adap);  in mtk_i2c_remove()