111 static void lpi2c_imx_intctrl(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_intctrl()  argument
114 	writel(enable, lpi2c_imx->base + LPI2C_MIER);  in lpi2c_imx_intctrl()
117 static int lpi2c_imx_bus_busy(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_bus_busy()  argument
123 		temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_bus_busy()
127 			writel(temp, lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_bus_busy()
135 			dev_dbg(&lpi2c_imx->adapter.dev, "bus not work\n");  in lpi2c_imx_bus_busy()
144 static void lpi2c_imx_set_mode(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_mode()  argument
146 	unsigned int bitrate = lpi2c_imx->bitrate;  in lpi2c_imx_set_mode()
160 	lpi2c_imx->mode = mode;  in lpi2c_imx_set_mode()
163 static int lpi2c_imx_start(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_start()  argument
168 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_start()
170 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_start()
171 	writel(0x7f00, lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_start()
174 	writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_start()
176 	return lpi2c_imx_bus_busy(lpi2c_imx);  in lpi2c_imx_start()
179 static void lpi2c_imx_stop(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_stop()  argument
184 	writel(GEN_STOP << 8, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_stop()
187 		temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_stop()
192 			dev_dbg(&lpi2c_imx->adapter.dev, "stop timeout\n");  in lpi2c_imx_stop()
201 static int lpi2c_imx_config(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_config()  argument
208 	lpi2c_imx_set_mode(lpi2c_imx);  in lpi2c_imx_config()
210 	clk_rate = clk_get_rate(lpi2c_imx->clk);  in lpi2c_imx_config()
211 	if (lpi2c_imx->mode == HS || lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
217 		clk_cycle = clk_rate / ((1 << prescale) * lpi2c_imx->bitrate)  in lpi2c_imx_config()
229 	if (lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
235 	if (lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
238 	writel(temp, lpi2c_imx->base + LPI2C_MCFGR1);  in lpi2c_imx_config()
242 	writel(temp, lpi2c_imx->base + LPI2C_MCFGR2);  in lpi2c_imx_config()
249 	if (lpi2c_imx->mode == HS)  in lpi2c_imx_config()
250 		writel(temp, lpi2c_imx->base + LPI2C_MCCR1);  in lpi2c_imx_config()
252 		writel(temp, lpi2c_imx->base + LPI2C_MCCR0);  in lpi2c_imx_config()
257 static int lpi2c_imx_master_enable(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_master_enable()  argument
262 	ret = pm_runtime_get_sync(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
267 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
268 	writel(0, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
270 	ret = lpi2c_imx_config(lpi2c_imx);  in lpi2c_imx_master_enable()
274 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
276 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
281 	pm_runtime_mark_last_busy(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
282 	pm_runtime_put_autosuspend(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
287 static int lpi2c_imx_master_disable(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_master_disable()  argument
291 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_disable()
293 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_disable()
295 	pm_runtime_mark_last_busy(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_disable()
296 	pm_runtime_put_autosuspend(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_disable()
301 static int lpi2c_imx_msg_complete(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_msg_complete()  argument
305 	timeout = wait_for_completion_timeout(&lpi2c_imx->complete, HZ);  in lpi2c_imx_msg_complete()
310 static int lpi2c_imx_txfifo_empty(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_txfifo_empty()  argument
316 		txcnt = readl(lpi2c_imx->base + LPI2C_MFSR) & 0xff;  in lpi2c_imx_txfifo_empty()
318 		if (readl(lpi2c_imx->base + LPI2C_MSR) & MSR_NDF) {  in lpi2c_imx_txfifo_empty()
319 			dev_dbg(&lpi2c_imx->adapter.dev, "NDF detected\n");  in lpi2c_imx_txfifo_empty()
324 			dev_dbg(&lpi2c_imx->adapter.dev, "txfifo empty timeout\n");  in lpi2c_imx_txfifo_empty()
334 static void lpi2c_imx_set_tx_watermark(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_tx_watermark()  argument
336 	writel(lpi2c_imx->txfifosize >> 1, lpi2c_imx->base + LPI2C_MFCR);  in lpi2c_imx_set_tx_watermark()
339 static void lpi2c_imx_set_rx_watermark(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_rx_watermark()  argument
343 	remaining = lpi2c_imx->msglen - lpi2c_imx->delivered;  in lpi2c_imx_set_rx_watermark()
345 	if (remaining > (lpi2c_imx->rxfifosize >> 1))  in lpi2c_imx_set_rx_watermark()
346 		temp = lpi2c_imx->rxfifosize >> 1;  in lpi2c_imx_set_rx_watermark()
350 	writel(temp << 16, lpi2c_imx->base + LPI2C_MFCR);  in lpi2c_imx_set_rx_watermark()
353 static void lpi2c_imx_write_txfifo(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_write_txfifo()  argument
357 	txcnt = readl(lpi2c_imx->base + LPI2C_MFSR) & 0xff;  in lpi2c_imx_write_txfifo()
359 	while (txcnt < lpi2c_imx->txfifosize) {  in lpi2c_imx_write_txfifo()
360 		if (lpi2c_imx->delivered == lpi2c_imx->msglen)  in lpi2c_imx_write_txfifo()
363 		data = lpi2c_imx->tx_buf[lpi2c_imx->delivered++];  in lpi2c_imx_write_txfifo()
364 		writel(data, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_write_txfifo()
368 	if (lpi2c_imx->delivered < lpi2c_imx->msglen)  in lpi2c_imx_write_txfifo()
369 		lpi2c_imx_intctrl(lpi2c_imx, MIER_TDIE | MIER_NDIE);  in lpi2c_imx_write_txfifo()
371 		complete(&lpi2c_imx->complete);  in lpi2c_imx_write_txfifo()
374 static void lpi2c_imx_read_rxfifo(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_read_rxfifo()  argument
380 		data = readl(lpi2c_imx->base + LPI2C_MRDR);  in lpi2c_imx_read_rxfifo()
384 		lpi2c_imx->rx_buf[lpi2c_imx->delivered++] = data & 0xff;  in lpi2c_imx_read_rxfifo()
391 	if (lpi2c_imx->block_data) {  in lpi2c_imx_read_rxfifo()
392 		blocklen = lpi2c_imx->rx_buf[0];  in lpi2c_imx_read_rxfifo()
393 		lpi2c_imx->msglen += blocklen;  in lpi2c_imx_read_rxfifo()
396 	remaining = lpi2c_imx->msglen - lpi2c_imx->delivered;  in lpi2c_imx_read_rxfifo()
399 		complete(&lpi2c_imx->complete);  in lpi2c_imx_read_rxfifo()
404 	lpi2c_imx_set_rx_watermark(lpi2c_imx);  in lpi2c_imx_read_rxfifo()
407 	if (lpi2c_imx->block_data) {  in lpi2c_imx_read_rxfifo()
408 		lpi2c_imx->block_data = 0;  in lpi2c_imx_read_rxfifo()
411 		writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read_rxfifo()
412 	} else if (!(lpi2c_imx->delivered & 0xff)) {  in lpi2c_imx_read_rxfifo()
415 		writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read_rxfifo()
418 	lpi2c_imx_intctrl(lpi2c_imx, MIER_RDIE);  in lpi2c_imx_read_rxfifo()
421 static void lpi2c_imx_write(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_write()  argument
424 	lpi2c_imx->tx_buf = msgs->buf;  in lpi2c_imx_write()
425 	lpi2c_imx_set_tx_watermark(lpi2c_imx);  in lpi2c_imx_write()
426 	lpi2c_imx_write_txfifo(lpi2c_imx);  in lpi2c_imx_write()
429 static void lpi2c_imx_read(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_read()  argument
434 	lpi2c_imx->rx_buf = msgs->buf;  in lpi2c_imx_read()
435 	lpi2c_imx->block_data = msgs->flags & I2C_M_RECV_LEN;  in lpi2c_imx_read()
437 	lpi2c_imx_set_rx_watermark(lpi2c_imx);  in lpi2c_imx_read()
440 	writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read()
442 	lpi2c_imx_intctrl(lpi2c_imx, MIER_RDIE | MIER_NDIE);  in lpi2c_imx_read()
448 	struct lpi2c_imx_struct *lpi2c_imx = i2c_get_adapdata(adapter);  in lpi2c_imx_xfer()  local
452 	result = lpi2c_imx_master_enable(lpi2c_imx);  in lpi2c_imx_xfer()
457 		result = lpi2c_imx_start(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
465 		lpi2c_imx->delivered = 0;  in lpi2c_imx_xfer()
466 		lpi2c_imx->msglen = msgs[i].len;  in lpi2c_imx_xfer()
467 		init_completion(&lpi2c_imx->complete);  in lpi2c_imx_xfer()
470 			lpi2c_imx_read(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
472 			lpi2c_imx_write(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
474 		result = lpi2c_imx_msg_complete(lpi2c_imx);  in lpi2c_imx_xfer()
479 			result = lpi2c_imx_txfifo_empty(lpi2c_imx);  in lpi2c_imx_xfer()
486 	lpi2c_imx_stop(lpi2c_imx);  in lpi2c_imx_xfer()
488 	temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_xfer()
493 	lpi2c_imx_master_disable(lpi2c_imx);  in lpi2c_imx_xfer()
495 	dev_dbg(&lpi2c_imx->adapter.dev, "<%s> exit with: %s: %d\n", __func__,  in lpi2c_imx_xfer()
504 	struct lpi2c_imx_struct *lpi2c_imx = dev_id;  in lpi2c_imx_isr()  local
507 	lpi2c_imx_intctrl(lpi2c_imx, 0);  in lpi2c_imx_isr()
508 	temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_isr()
511 		lpi2c_imx_read_rxfifo(lpi2c_imx);  in lpi2c_imx_isr()
514 		lpi2c_imx_write_txfifo(lpi2c_imx);  in lpi2c_imx_isr()
517 		complete(&lpi2c_imx->complete);  in lpi2c_imx_isr()
541 	struct lpi2c_imx_struct *lpi2c_imx;  in lpi2c_imx_probe()  local
545 	lpi2c_imx = devm_kzalloc(&pdev->dev, sizeof(*lpi2c_imx), GFP_KERNEL);  in lpi2c_imx_probe()
546 	if (!lpi2c_imx)  in lpi2c_imx_probe()
549 	lpi2c_imx->base = devm_platform_ioremap_resource(pdev, 0);  in lpi2c_imx_probe()
550 	if (IS_ERR(lpi2c_imx->base))  in lpi2c_imx_probe()
551 		return PTR_ERR(lpi2c_imx->base);  in lpi2c_imx_probe()
557 	lpi2c_imx->adapter.owner	= THIS_MODULE;  in lpi2c_imx_probe()
558 	lpi2c_imx->adapter.algo		= &lpi2c_imx_algo;  in lpi2c_imx_probe()
559 	lpi2c_imx->adapter.dev.parent	= &pdev->dev;  in lpi2c_imx_probe()
560 	lpi2c_imx->adapter.dev.of_node	= pdev->dev.of_node;  in lpi2c_imx_probe()
561 	strlcpy(lpi2c_imx->adapter.name, pdev->name,  in lpi2c_imx_probe()
562 		sizeof(lpi2c_imx->adapter.name));  in lpi2c_imx_probe()
564 	lpi2c_imx->clk = devm_clk_get(&pdev->dev, NULL);  in lpi2c_imx_probe()
565 	if (IS_ERR(lpi2c_imx->clk)) {  in lpi2c_imx_probe()
567 		return PTR_ERR(lpi2c_imx->clk);  in lpi2c_imx_probe()
571 				   "clock-frequency", &lpi2c_imx->bitrate);  in lpi2c_imx_probe()
573 		lpi2c_imx->bitrate = I2C_MAX_STANDARD_MODE_FREQ;  in lpi2c_imx_probe()
576 			       pdev->name, lpi2c_imx);  in lpi2c_imx_probe()
582 	i2c_set_adapdata(&lpi2c_imx->adapter, lpi2c_imx);  in lpi2c_imx_probe()
583 	platform_set_drvdata(pdev, lpi2c_imx);  in lpi2c_imx_probe()
585 	ret = clk_prepare_enable(lpi2c_imx->clk);  in lpi2c_imx_probe()
597 	temp = readl(lpi2c_imx->base + LPI2C_PARAM);  in lpi2c_imx_probe()
598 	lpi2c_imx->txfifosize = 1 << (temp & 0x0f);  in lpi2c_imx_probe()
599 	lpi2c_imx->rxfifosize = 1 << ((temp >> 8) & 0x0f);  in lpi2c_imx_probe()
601 	ret = i2c_add_adapter(&lpi2c_imx->adapter);  in lpi2c_imx_probe()
608 	dev_info(&lpi2c_imx->adapter.dev, "LPI2C adapter registered\n");  in lpi2c_imx_probe()
622 	struct lpi2c_imx_struct *lpi2c_imx = platform_get_drvdata(pdev);  in lpi2c_imx_remove()  local
624 	i2c_del_adapter(&lpi2c_imx->adapter);  in lpi2c_imx_remove()
634 	struct lpi2c_imx_struct *lpi2c_imx = dev_get_drvdata(dev);  in lpi2c_runtime_suspend()  local
636 	clk_disable_unprepare(lpi2c_imx->clk);  in lpi2c_runtime_suspend()
644 	struct lpi2c_imx_struct *lpi2c_imx = dev_get_drvdata(dev);  in lpi2c_runtime_resume()  local
648 	ret = clk_prepare_enable(lpi2c_imx->clk);  in lpi2c_runtime_resume()