65 static inline void sif_set_bit(struct mtk_hdmi_ddc *ddc, unsigned int offset,  in sif_set_bit()  argument
68 	writel(readl(ddc->regs + offset) | val, ddc->regs + offset);  in sif_set_bit()
71 static inline void sif_clr_bit(struct mtk_hdmi_ddc *ddc, unsigned int offset,  in sif_clr_bit()  argument
74 	writel(readl(ddc->regs + offset) & ~val, ddc->regs + offset);  in sif_clr_bit()
77 static inline bool sif_bit_is_set(struct mtk_hdmi_ddc *ddc, unsigned int offset,  in sif_bit_is_set()  argument
80 	return (readl(ddc->regs + offset) & val) == val;  in sif_bit_is_set()
83 static inline void sif_write_mask(struct mtk_hdmi_ddc *ddc, unsigned int offset,  in sif_write_mask()  argument
89 	tmp = readl(ddc->regs + offset);  in sif_write_mask()
92 	writel(tmp, ddc->regs + offset);  in sif_write_mask()
95 static inline unsigned int sif_read_mask(struct mtk_hdmi_ddc *ddc,  in sif_read_mask()  argument
99 	return (readl(ddc->regs + offset) & mask) >> shift;  in sif_read_mask()
102 static void ddcm_trigger_mode(struct mtk_hdmi_ddc *ddc, int mode)  in ddcm_trigger_mode()  argument
106 	sif_write_mask(ddc, DDC_DDCMCTL1, DDCM_SIF_MODE_MASK,  in ddcm_trigger_mode()
108 	sif_set_bit(ddc, DDC_DDCMCTL1, DDCM_TRI);  in ddcm_trigger_mode()
109 	readl_poll_timeout(ddc->regs + DDC_DDCMCTL1, val,  in ddcm_trigger_mode()
113 static int mtk_hdmi_ddc_read_msg(struct mtk_hdmi_ddc *ddc, struct i2c_msg *msg)  in mtk_hdmi_ddc_read_msg()  argument
115 	struct device *dev = ddc->adap.dev.parent;  in mtk_hdmi_ddc_read_msg()
121 	ddcm_trigger_mode(ddc, DDCM_START);  in mtk_hdmi_ddc_read_msg()
122 	sif_write_mask(ddc, DDC_DDCMD0, 0xff, 0, (msg->addr << 1) | 0x01);  in mtk_hdmi_ddc_read_msg()
123 	sif_write_mask(ddc, DDC_DDCMCTL1, DDCM_PGLEN_MASK, DDCM_PGLEN_OFFSET,  in mtk_hdmi_ddc_read_msg()
125 	ddcm_trigger_mode(ddc, DDCM_WRITE_DATA);  in mtk_hdmi_ddc_read_msg()
126 	ack = sif_read_mask(ddc, DDC_DDCMCTL1, DDCM_ACK_MASK, DDCM_ACK_OFFSET);  in mtk_hdmi_ddc_read_msg()
147 		sif_write_mask(ddc, DDC_DDCMCTL1, DDCM_PGLEN_MASK,  in mtk_hdmi_ddc_read_msg()
149 		ddcm_trigger_mode(ddc, (ack_final == 1) ?  in mtk_hdmi_ddc_read_msg()
153 		ack = sif_read_mask(ddc, DDC_DDCMCTL1, DDCM_ACK_MASK,  in mtk_hdmi_ddc_read_msg()
176 			msg->buf[index + i - 1] = sif_read_mask(ddc, offset,  in mtk_hdmi_ddc_read_msg()
188 static int mtk_hdmi_ddc_write_msg(struct mtk_hdmi_ddc *ddc, struct i2c_msg *msg)  in mtk_hdmi_ddc_write_msg()  argument
190 	struct device *dev = ddc->adap.dev.parent;  in mtk_hdmi_ddc_write_msg()
193 	ddcm_trigger_mode(ddc, DDCM_START);  in mtk_hdmi_ddc_write_msg()
194 	sif_write_mask(ddc, DDC_DDCMD0, DDCM_DATA0, 0, msg->addr << 1);  in mtk_hdmi_ddc_write_msg()
195 	sif_write_mask(ddc, DDC_DDCMD0, DDCM_DATA1, 8, msg->buf[0]);  in mtk_hdmi_ddc_write_msg()
196 	sif_write_mask(ddc, DDC_DDCMCTL1, DDCM_PGLEN_MASK, DDCM_PGLEN_OFFSET,  in mtk_hdmi_ddc_write_msg()
198 	ddcm_trigger_mode(ddc, DDCM_WRITE_DATA);  in mtk_hdmi_ddc_write_msg()
200 	ack = sif_read_mask(ddc, DDC_DDCMCTL1, DDCM_ACK_MASK, DDCM_ACK_OFFSET);  in mtk_hdmi_ddc_write_msg()
214 	struct mtk_hdmi_ddc *ddc = adapter->algo_data;  in mtk_hdmi_ddc_xfer()  local
219 	if (!ddc) {  in mtk_hdmi_ddc_xfer()
224 	sif_set_bit(ddc, DDC_DDCMCTL0, DDCM_SCL_STRECH);  in mtk_hdmi_ddc_xfer()
225 	sif_set_bit(ddc, DDC_DDCMCTL0, DDCM_SM0EN);  in mtk_hdmi_ddc_xfer()
226 	sif_clr_bit(ddc, DDC_DDCMCTL0, DDCM_ODRAIN);  in mtk_hdmi_ddc_xfer()
228 	if (sif_bit_is_set(ddc, DDC_DDCMCTL1, DDCM_TRI)) {  in mtk_hdmi_ddc_xfer()
229 		dev_err(dev, "ddc line is busy!\n");  in mtk_hdmi_ddc_xfer()
233 	sif_write_mask(ddc, DDC_DDCMCTL0, DDCM_CLK_DIV_MASK,  in mtk_hdmi_ddc_xfer()
243 			ret = mtk_hdmi_ddc_read_msg(ddc, msg);  in mtk_hdmi_ddc_xfer()
245 			ret = mtk_hdmi_ddc_write_msg(ddc, msg);  in mtk_hdmi_ddc_xfer()
250 	ddcm_trigger_mode(ddc, DDCM_STOP);  in mtk_hdmi_ddc_xfer()
255 	ddcm_trigger_mode(ddc, DDCM_STOP);  in mtk_hdmi_ddc_xfer()
256 	dev_err(dev, "ddc failed!\n");  in mtk_hdmi_ddc_xfer()
273 	struct mtk_hdmi_ddc *ddc;  in mtk_hdmi_ddc_probe()  local
277 	ddc = devm_kzalloc(dev, sizeof(struct mtk_hdmi_ddc), GFP_KERNEL);  in mtk_hdmi_ddc_probe()
278 	if (!ddc)  in mtk_hdmi_ddc_probe()
281 	ddc->clk = devm_clk_get(dev, "ddc-i2c");  in mtk_hdmi_ddc_probe()
282 	if (IS_ERR(ddc->clk)) {  in mtk_hdmi_ddc_probe()
283 		dev_err(dev, "get ddc_clk failed: %p ,\n", ddc->clk);  in mtk_hdmi_ddc_probe()
284 		return PTR_ERR(ddc->clk);  in mtk_hdmi_ddc_probe()
288 	ddc->regs = devm_ioremap_resource(&pdev->dev, mem);  in mtk_hdmi_ddc_probe()
289 	if (IS_ERR(ddc->regs))  in mtk_hdmi_ddc_probe()
290 		return PTR_ERR(ddc->regs);  in mtk_hdmi_ddc_probe()
292 	ret = clk_prepare_enable(ddc->clk);  in mtk_hdmi_ddc_probe()
294 		dev_err(dev, "enable ddc clk failed!\n");  in mtk_hdmi_ddc_probe()
298 	strscpy(ddc->adap.name, "mediatek-hdmi-ddc", sizeof(ddc->adap.name));  in mtk_hdmi_ddc_probe()
299 	ddc->adap.owner = THIS_MODULE;  in mtk_hdmi_ddc_probe()
300 	ddc->adap.class = I2C_CLASS_DDC;  in mtk_hdmi_ddc_probe()
301 	ddc->adap.algo = &mtk_hdmi_ddc_algorithm;  in mtk_hdmi_ddc_probe()
302 	ddc->adap.retries = 3;  in mtk_hdmi_ddc_probe()
303 	ddc->adap.dev.of_node = dev->of_node;  in mtk_hdmi_ddc_probe()
304 	ddc->adap.algo_data = ddc;  in mtk_hdmi_ddc_probe()
305 	ddc->adap.dev.parent = &pdev->dev;  in mtk_hdmi_ddc_probe()
307 	ret = i2c_add_adapter(&ddc->adap);  in mtk_hdmi_ddc_probe()
313 	platform_set_drvdata(pdev, ddc);  in mtk_hdmi_ddc_probe()
315 	dev_dbg(dev, "ddc->adap: %p\n", &ddc->adap);  in mtk_hdmi_ddc_probe()
316 	dev_dbg(dev, "ddc->clk: %p\n", ddc->clk);  in mtk_hdmi_ddc_probe()
323 	clk_disable_unprepare(ddc->clk);  in mtk_hdmi_ddc_probe()
329 	struct mtk_hdmi_ddc *ddc = platform_get_drvdata(pdev);  in mtk_hdmi_ddc_remove()  local
331 	i2c_del_adapter(&ddc->adap);  in mtk_hdmi_ddc_remove()
332 	clk_disable_unprepare(ddc->clk);  in mtk_hdmi_ddc_remove()
336 	{ .compatible = "mediatek,mt8173-hdmi-ddc", },
345 		.name = "mediatek-hdmi-ddc",
351 MODULE_DESCRIPTION("MediaTek HDMI DDC Driver");