117 static void lpi2c_imx_intctrl(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_intctrl()  argument
120 	writel(enable, lpi2c_imx->base + LPI2C_MIER);  in lpi2c_imx_intctrl()
123 static int lpi2c_imx_bus_busy(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_bus_busy()  argument
129 		temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_bus_busy()
133 			writel(temp, lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_bus_busy()
141 			dev_dbg(&lpi2c_imx->adapter.dev, "bus not work\n");  in lpi2c_imx_bus_busy()
150 static void lpi2c_imx_set_mode(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_mode()  argument
152 	unsigned int bitrate = lpi2c_imx->bitrate;  in lpi2c_imx_set_mode()
166 	lpi2c_imx->mode = mode;  in lpi2c_imx_set_mode()
169 static int lpi2c_imx_start(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_start()  argument
174 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_start()
176 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_start()
177 	writel(0x7f00, lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_start()
180 	writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_start()
182 	return lpi2c_imx_bus_busy(lpi2c_imx);  in lpi2c_imx_start()
185 static void lpi2c_imx_stop(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_stop()  argument
190 	writel(GEN_STOP << 8, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_stop()
193 		temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_stop()
198 			dev_dbg(&lpi2c_imx->adapter.dev, "stop timeout\n");  in lpi2c_imx_stop()
207 static int lpi2c_imx_config(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_config()  argument
214 	lpi2c_imx_set_mode(lpi2c_imx);  in lpi2c_imx_config()
216 	clk_rate = clk_get_rate(lpi2c_imx->clk);  in lpi2c_imx_config()
217 	if (lpi2c_imx->mode == HS || lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
223 		clk_cycle = clk_rate / ((1 << prescale) * lpi2c_imx->bitrate)  in lpi2c_imx_config()
235 	if (lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
241 	if (lpi2c_imx->mode == ULTRA_FAST)  in lpi2c_imx_config()
244 	writel(temp, lpi2c_imx->base + LPI2C_MCFGR1);  in lpi2c_imx_config()
248 	writel(temp, lpi2c_imx->base + LPI2C_MCFGR2);  in lpi2c_imx_config()
255 	if (lpi2c_imx->mode == HS)  in lpi2c_imx_config()
256 		writel(temp, lpi2c_imx->base + LPI2C_MCCR1);  in lpi2c_imx_config()
258 		writel(temp, lpi2c_imx->base + LPI2C_MCCR0);  in lpi2c_imx_config()
263 static int lpi2c_imx_master_enable(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_master_enable()  argument
268 	ret = pm_runtime_get_sync(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
273 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
274 	writel(0, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
276 	ret = lpi2c_imx_config(lpi2c_imx);  in lpi2c_imx_master_enable()
280 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
282 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_enable()
287 	pm_runtime_mark_last_busy(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
288 	pm_runtime_put_autosuspend(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_enable()
293 static int lpi2c_imx_master_disable(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_master_disable()  argument
297 	temp = readl(lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_disable()
299 	writel(temp, lpi2c_imx->base + LPI2C_MCR);  in lpi2c_imx_master_disable()
301 	pm_runtime_mark_last_busy(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_disable()
302 	pm_runtime_put_autosuspend(lpi2c_imx->adapter.dev.parent);  in lpi2c_imx_master_disable()
307 static int lpi2c_imx_msg_complete(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_msg_complete()  argument
311 	timeout = wait_for_completion_timeout(&lpi2c_imx->complete, HZ);  in lpi2c_imx_msg_complete()
316 static int lpi2c_imx_txfifo_empty(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_txfifo_empty()  argument
322 		txcnt = readl(lpi2c_imx->base + LPI2C_MFSR) & 0xff;  in lpi2c_imx_txfifo_empty()
324 		if (readl(lpi2c_imx->base + LPI2C_MSR) & MSR_NDF) {  in lpi2c_imx_txfifo_empty()
325 			dev_dbg(&lpi2c_imx->adapter.dev, "NDF detected\n");  in lpi2c_imx_txfifo_empty()
330 			dev_dbg(&lpi2c_imx->adapter.dev, "txfifo empty timeout\n");  in lpi2c_imx_txfifo_empty()
340 static void lpi2c_imx_set_tx_watermark(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_tx_watermark()  argument
342 	writel(lpi2c_imx->txfifosize >> 1, lpi2c_imx->base + LPI2C_MFCR);  in lpi2c_imx_set_tx_watermark()
345 static void lpi2c_imx_set_rx_watermark(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_set_rx_watermark()  argument
349 	remaining = lpi2c_imx->msglen - lpi2c_imx->delivered;  in lpi2c_imx_set_rx_watermark()
351 	if (remaining > (lpi2c_imx->rxfifosize >> 1))  in lpi2c_imx_set_rx_watermark()
352 		temp = lpi2c_imx->rxfifosize >> 1;  in lpi2c_imx_set_rx_watermark()
356 	writel(temp << 16, lpi2c_imx->base + LPI2C_MFCR);  in lpi2c_imx_set_rx_watermark()
359 static void lpi2c_imx_write_txfifo(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_write_txfifo()  argument
363 	txcnt = readl(lpi2c_imx->base + LPI2C_MFSR) & 0xff;  in lpi2c_imx_write_txfifo()
365 	while (txcnt < lpi2c_imx->txfifosize) {  in lpi2c_imx_write_txfifo()
366 		if (lpi2c_imx->delivered == lpi2c_imx->msglen)  in lpi2c_imx_write_txfifo()
369 		data = lpi2c_imx->tx_buf[lpi2c_imx->delivered++];  in lpi2c_imx_write_txfifo()
370 		writel(data, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_write_txfifo()
374 	if (lpi2c_imx->delivered < lpi2c_imx->msglen)  in lpi2c_imx_write_txfifo()
375 		lpi2c_imx_intctrl(lpi2c_imx, MIER_TDIE | MIER_NDIE);  in lpi2c_imx_write_txfifo()
377 		complete(&lpi2c_imx->complete);  in lpi2c_imx_write_txfifo()
380 static void lpi2c_imx_read_rxfifo(struct lpi2c_imx_struct *lpi2c_imx)  in lpi2c_imx_read_rxfifo()  argument
386 		data = readl(lpi2c_imx->base + LPI2C_MRDR);  in lpi2c_imx_read_rxfifo()
390 		lpi2c_imx->rx_buf[lpi2c_imx->delivered++] = data & 0xff;  in lpi2c_imx_read_rxfifo()
397 	if (lpi2c_imx->block_data) {  in lpi2c_imx_read_rxfifo()
398 		blocklen = lpi2c_imx->rx_buf[0];  in lpi2c_imx_read_rxfifo()
399 		lpi2c_imx->msglen += blocklen;  in lpi2c_imx_read_rxfifo()
402 	remaining = lpi2c_imx->msglen - lpi2c_imx->delivered;  in lpi2c_imx_read_rxfifo()
405 		complete(&lpi2c_imx->complete);  in lpi2c_imx_read_rxfifo()
410 	lpi2c_imx_set_rx_watermark(lpi2c_imx);  in lpi2c_imx_read_rxfifo()
413 	if (lpi2c_imx->block_data) {  in lpi2c_imx_read_rxfifo()
414 		lpi2c_imx->block_data = 0;  in lpi2c_imx_read_rxfifo()
417 		writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read_rxfifo()
418 	} else if (!(lpi2c_imx->delivered & 0xff)) {  in lpi2c_imx_read_rxfifo()
421 		writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read_rxfifo()
424 	lpi2c_imx_intctrl(lpi2c_imx, MIER_RDIE);  in lpi2c_imx_read_rxfifo()
427 static void lpi2c_imx_write(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_write()  argument
430 	lpi2c_imx->tx_buf = msgs->buf;  in lpi2c_imx_write()
431 	lpi2c_imx_set_tx_watermark(lpi2c_imx);  in lpi2c_imx_write()
432 	lpi2c_imx_write_txfifo(lpi2c_imx);  in lpi2c_imx_write()
435 static void lpi2c_imx_read(struct lpi2c_imx_struct *lpi2c_imx,  in lpi2c_imx_read()  argument
440 	lpi2c_imx->rx_buf = msgs->buf;  in lpi2c_imx_read()
441 	lpi2c_imx->block_data = msgs->flags & I2C_M_RECV_LEN;  in lpi2c_imx_read()
443 	lpi2c_imx_set_rx_watermark(lpi2c_imx);  in lpi2c_imx_read()
446 	writel(temp, lpi2c_imx->base + LPI2C_MTDR);  in lpi2c_imx_read()
448 	lpi2c_imx_intctrl(lpi2c_imx, MIER_RDIE | MIER_NDIE);  in lpi2c_imx_read()
454 	struct lpi2c_imx_struct *lpi2c_imx = i2c_get_adapdata(adapter);  in lpi2c_imx_xfer()  local
458 	result = lpi2c_imx_master_enable(lpi2c_imx);  in lpi2c_imx_xfer()
463 		result = lpi2c_imx_start(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
471 		lpi2c_imx->rx_buf = NULL;  in lpi2c_imx_xfer()
472 		lpi2c_imx->tx_buf = NULL;  in lpi2c_imx_xfer()
473 		lpi2c_imx->delivered = 0;  in lpi2c_imx_xfer()
474 		lpi2c_imx->msglen = msgs[i].len;  in lpi2c_imx_xfer()
475 		init_completion(&lpi2c_imx->complete);  in lpi2c_imx_xfer()
478 			lpi2c_imx_read(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
480 			lpi2c_imx_write(lpi2c_imx, &msgs[i]);  in lpi2c_imx_xfer()
482 		result = lpi2c_imx_msg_complete(lpi2c_imx);  in lpi2c_imx_xfer()
487 			result = lpi2c_imx_txfifo_empty(lpi2c_imx);  in lpi2c_imx_xfer()
494 	lpi2c_imx_stop(lpi2c_imx);  in lpi2c_imx_xfer()
496 	temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_xfer()
501 	lpi2c_imx_master_disable(lpi2c_imx);  in lpi2c_imx_xfer()
503 	dev_dbg(&lpi2c_imx->adapter.dev, "<%s> exit with: %s: %d\n", __func__,  in lpi2c_imx_xfer()
512 	struct lpi2c_imx_struct *lpi2c_imx = dev_id;  in lpi2c_imx_isr()  local
516 	enabled = readl(lpi2c_imx->base + LPI2C_MIER);  in lpi2c_imx_isr()
518 	lpi2c_imx_intctrl(lpi2c_imx, 0);  in lpi2c_imx_isr()
519 	temp = readl(lpi2c_imx->base + LPI2C_MSR);  in lpi2c_imx_isr()
523 		lpi2c_imx_read_rxfifo(lpi2c_imx);  in lpi2c_imx_isr()
526 		lpi2c_imx_write_txfifo(lpi2c_imx);  in lpi2c_imx_isr()
529 		complete(&lpi2c_imx->complete);  in lpi2c_imx_isr()
553 	struct lpi2c_imx_struct *lpi2c_imx;  in lpi2c_imx_probe()  local
558 	lpi2c_imx = devm_kzalloc(&pdev->dev, sizeof(*lpi2c_imx), GFP_KERNEL);  in lpi2c_imx_probe()
559 	if (!lpi2c_imx)  in lpi2c_imx_probe()
563 	lpi2c_imx->base = devm_ioremap_resource(&pdev->dev, res);  in lpi2c_imx_probe()
564 	if (IS_ERR(lpi2c_imx->base))  in lpi2c_imx_probe()
565 		return PTR_ERR(lpi2c_imx->base);  in lpi2c_imx_probe()
573 	lpi2c_imx->adapter.owner	= THIS_MODULE;  in lpi2c_imx_probe()
574 	lpi2c_imx->adapter.algo		= &lpi2c_imx_algo;  in lpi2c_imx_probe()
575 	lpi2c_imx->adapter.dev.parent	= &pdev->dev;  in lpi2c_imx_probe()
576 	lpi2c_imx->adapter.dev.of_node	= pdev->dev.of_node;  in lpi2c_imx_probe()
577 	strlcpy(lpi2c_imx->adapter.name, pdev->name,  in lpi2c_imx_probe()
578 		sizeof(lpi2c_imx->adapter.name));  in lpi2c_imx_probe()
580 	lpi2c_imx->clk = devm_clk_get(&pdev->dev, NULL);  in lpi2c_imx_probe()
581 	if (IS_ERR(lpi2c_imx->clk)) {  in lpi2c_imx_probe()
583 		return PTR_ERR(lpi2c_imx->clk);  in lpi2c_imx_probe()
587 				   "clock-frequency", &lpi2c_imx->bitrate);  in lpi2c_imx_probe()
589 		lpi2c_imx->bitrate = LPI2C_DEFAULT_RATE;  in lpi2c_imx_probe()
592 			       pdev->name, lpi2c_imx);  in lpi2c_imx_probe()
598 	i2c_set_adapdata(&lpi2c_imx->adapter, lpi2c_imx);  in lpi2c_imx_probe()
599 	platform_set_drvdata(pdev, lpi2c_imx);  in lpi2c_imx_probe()
601 	ret = clk_prepare_enable(lpi2c_imx->clk);  in lpi2c_imx_probe()
613 	temp = readl(lpi2c_imx->base + LPI2C_PARAM);  in lpi2c_imx_probe()
614 	lpi2c_imx->txfifosize = 1 << (temp & 0x0f);  in lpi2c_imx_probe()
615 	lpi2c_imx->rxfifosize = 1 << ((temp >> 8) & 0x0f);  in lpi2c_imx_probe()
617 	ret = i2c_add_adapter(&lpi2c_imx->adapter);  in lpi2c_imx_probe()
624 	dev_info(&lpi2c_imx->adapter.dev, "LPI2C adapter registered\n");  in lpi2c_imx_probe()
638 	struct lpi2c_imx_struct *lpi2c_imx = platform_get_drvdata(pdev);  in lpi2c_imx_remove()  local
640 	i2c_del_adapter(&lpi2c_imx->adapter);  in lpi2c_imx_remove()
651 	struct lpi2c_imx_struct *lpi2c_imx = dev_get_drvdata(dev);  in lpi2c_runtime_suspend()  local
653 	clk_disable_unprepare(lpi2c_imx->clk);  in lpi2c_runtime_suspend()
661 	struct lpi2c_imx_struct *lpi2c_imx = dev_get_drvdata(dev);  in lpi2c_runtime_resume()  local
665 	ret = clk_prepare_enable(lpi2c_imx->clk);  in lpi2c_runtime_resume()