91 static inline void xlp9xx_write_i2c_reg(struct xlp9xx_i2c_dev *priv,  in xlp9xx_write_i2c_reg()  argument
94 	writel(val, priv->base + reg);  in xlp9xx_write_i2c_reg()
97 static inline u32 xlp9xx_read_i2c_reg(struct xlp9xx_i2c_dev *priv,  in xlp9xx_read_i2c_reg()  argument
100 	return readl(priv->base + reg);  in xlp9xx_read_i2c_reg()
103 static void xlp9xx_i2c_mask_irq(struct xlp9xx_i2c_dev *priv, u32 mask)  in xlp9xx_i2c_mask_irq()  argument
107 	inten = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_INTEN) & ~mask;  in xlp9xx_i2c_mask_irq()
108 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTEN, inten);  in xlp9xx_i2c_mask_irq()
111 static void xlp9xx_i2c_unmask_irq(struct xlp9xx_i2c_dev *priv, u32 mask)  in xlp9xx_i2c_unmask_irq()  argument
115 	inten = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_INTEN) | mask;  in xlp9xx_i2c_unmask_irq()
116 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTEN, inten);  in xlp9xx_i2c_unmask_irq()
119 static void xlp9xx_i2c_update_rx_fifo_thres(struct xlp9xx_i2c_dev *priv)  in xlp9xx_i2c_update_rx_fifo_thres()  argument
123 	thres = min(priv->msg_buf_remaining, XLP9XX_I2C_FIFO_SIZE);  in xlp9xx_i2c_update_rx_fifo_thres()
124 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_MFIFOCTRL,  in xlp9xx_i2c_update_rx_fifo_thres()
128 static void xlp9xx_i2c_fill_tx_fifo(struct xlp9xx_i2c_dev *priv)  in xlp9xx_i2c_fill_tx_fifo()  argument
131 	u8 *buf = priv->msg_buf;  in xlp9xx_i2c_fill_tx_fifo()
133 	len = min(priv->msg_buf_remaining, XLP9XX_I2C_FIFO_SIZE);  in xlp9xx_i2c_fill_tx_fifo()
135 		xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_MTXFIFO, buf[i]);  in xlp9xx_i2c_fill_tx_fifo()
136 	priv->msg_buf_remaining -= len;  in xlp9xx_i2c_fill_tx_fifo()
137 	priv->msg_buf += len;  in xlp9xx_i2c_fill_tx_fifo()
140 static void xlp9xx_i2c_drain_rx_fifo(struct xlp9xx_i2c_dev *priv)  in xlp9xx_i2c_drain_rx_fifo()  argument
143 	u8 *buf = priv->msg_buf;  in xlp9xx_i2c_drain_rx_fifo()
145 	len = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_FIFOWCNT) &  in xlp9xx_i2c_drain_rx_fifo()
147 	len = min(priv->msg_buf_remaining, len);  in xlp9xx_i2c_drain_rx_fifo()
149 		*buf = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_MRXFIFO);  in xlp9xx_i2c_drain_rx_fifo()
151 	priv->msg_buf_remaining -= len;  in xlp9xx_i2c_drain_rx_fifo()
152 	priv->msg_buf = buf;  in xlp9xx_i2c_drain_rx_fifo()
154 	if (priv->msg_buf_remaining)  in xlp9xx_i2c_drain_rx_fifo()
155 		xlp9xx_i2c_update_rx_fifo_thres(priv);  in xlp9xx_i2c_drain_rx_fifo()
160 	struct xlp9xx_i2c_dev *priv = dev_id;  in xlp9xx_i2c_isr()  local
163 	status = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_INTST);  in xlp9xx_i2c_isr()
167 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTST, status);  in xlp9xx_i2c_isr()
169 		priv->msg_err = status;  in xlp9xx_i2c_isr()
174 	if ((status & XLP9XX_I2C_INTEN_SADDR) && (priv->msg_len == 0))  in xlp9xx_i2c_isr()
177 	if (!priv->msg_read) {  in xlp9xx_i2c_isr()
180 			if (priv->msg_buf_remaining)  in xlp9xx_i2c_isr()
181 				xlp9xx_i2c_fill_tx_fifo(priv);  in xlp9xx_i2c_isr()
183 				xlp9xx_i2c_mask_irq(priv,  in xlp9xx_i2c_isr()
190 			if (priv->msg_buf_remaining)  in xlp9xx_i2c_isr()
191 				xlp9xx_i2c_drain_rx_fifo(priv);  in xlp9xx_i2c_isr()
202 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTEN, 0);  in xlp9xx_i2c_isr()
203 	complete(&priv->msg_complete);  in xlp9xx_i2c_isr()
207 static int xlp9xx_i2c_init(struct xlp9xx_i2c_dev *priv)  in xlp9xx_i2c_init()  argument
215 	prescale = DIV_ROUND_UP(XLP9XX_I2C_IP_CLK_FREQ, priv->clk_hz);  in xlp9xx_i2c_init()
217 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_CTRL, XLP9XX_I2C_CTRL_RST);  in xlp9xx_i2c_init()
218 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_CTRL, XLP9XX_I2C_CTRL_EN |  in xlp9xx_i2c_init()
220 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_DIV, prescale);  in xlp9xx_i2c_init()
221 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTEN, 0);  in xlp9xx_i2c_init()
226 static int xlp9xx_i2c_xfer_msg(struct xlp9xx_i2c_dev *priv, struct i2c_msg *msg,  in xlp9xx_i2c_xfer_msg()  argument
232 	priv->msg_buf = msg->buf;  in xlp9xx_i2c_xfer_msg()
233 	priv->msg_buf_remaining = priv->msg_len = msg->len;  in xlp9xx_i2c_xfer_msg()
234 	priv->msg_err = 0;  in xlp9xx_i2c_xfer_msg()
235 	priv->msg_read = (msg->flags & I2C_M_RD);  in xlp9xx_i2c_xfer_msg()
236 	reinit_completion(&priv->msg_complete);  in xlp9xx_i2c_xfer_msg()
239 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_MFIFOCTRL,  in xlp9xx_i2c_xfer_msg()
243 	if (priv->msg_read)  in xlp9xx_i2c_xfer_msg()
244 		xlp9xx_i2c_update_rx_fifo_thres(priv);  in xlp9xx_i2c_xfer_msg()
247 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_SLAVEADDR,  in xlp9xx_i2c_xfer_msg()
249 			     (priv->msg_read ? XLP9XX_I2C_SLAVEADDR_RW : 0));  in xlp9xx_i2c_xfer_msg()
252 	val = xlp9xx_read_i2c_reg(priv, XLP9XX_I2C_CTRL);  in xlp9xx_i2c_xfer_msg()
253 	if (!priv->msg_read)  in xlp9xx_i2c_xfer_msg()
266 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_CTRL, val);  in xlp9xx_i2c_xfer_msg()
269 	if (!priv->msg_read)  in xlp9xx_i2c_xfer_msg()
270 		xlp9xx_i2c_fill_tx_fifo(priv);  in xlp9xx_i2c_xfer_msg()
276 	if (priv->msg_read) {  in xlp9xx_i2c_xfer_msg()
286 	xlp9xx_i2c_unmask_irq(priv, intr_mask);  in xlp9xx_i2c_xfer_msg()
290 	cmd |= (priv->msg_read ? XLP9XX_I2C_CMD_READ : XLP9XX_I2C_CMD_WRITE);  in xlp9xx_i2c_xfer_msg()
294 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_CMD, cmd);  in xlp9xx_i2c_xfer_msg()
297 	timeleft = wait_for_completion_timeout(&priv->msg_complete, timeleft);  in xlp9xx_i2c_xfer_msg()
299 	if (priv->msg_err) {  in xlp9xx_i2c_xfer_msg()
300 		dev_dbg(priv->dev, "transfer error %x!\n", priv->msg_err);  in xlp9xx_i2c_xfer_msg()
301 		if (priv->msg_err & XLP9XX_I2C_INTEN_BUSERR)  in xlp9xx_i2c_xfer_msg()
302 			xlp9xx_i2c_init(priv);  in xlp9xx_i2c_xfer_msg()
307 		dev_dbg(priv->dev, "i2c transfer timed out!\n");  in xlp9xx_i2c_xfer_msg()
308 		xlp9xx_i2c_init(priv);  in xlp9xx_i2c_xfer_msg()
319 	struct xlp9xx_i2c_dev *priv = i2c_get_adapdata(adap);  in xlp9xx_i2c_xfer()  local
322 		ret = xlp9xx_i2c_xfer_msg(priv, &msgs[i], i == num - 1);  in xlp9xx_i2c_xfer()
342 				    struct xlp9xx_i2c_dev *priv)  in xlp9xx_i2c_get_frequency()  argument
357 	priv->clk_hz = freq;  in xlp9xx_i2c_get_frequency()
364 	struct xlp9xx_i2c_dev *priv;  in xlp9xx_i2c_probe()  local
368 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);  in xlp9xx_i2c_probe()
369 	if (!priv)  in xlp9xx_i2c_probe()
373 	priv->base = devm_ioremap_resource(&pdev->dev, res);  in xlp9xx_i2c_probe()
374 	if (IS_ERR(priv->base))  in xlp9xx_i2c_probe()
375 		return PTR_ERR(priv->base);  in xlp9xx_i2c_probe()
377 	priv->irq = platform_get_irq(pdev, 0);  in xlp9xx_i2c_probe()
378 	if (priv->irq <= 0) {  in xlp9xx_i2c_probe()
380 		return priv->irq;  in xlp9xx_i2c_probe()
383 	xlp9xx_i2c_get_frequency(pdev, priv);  in xlp9xx_i2c_probe()
384 	xlp9xx_i2c_init(priv);  in xlp9xx_i2c_probe()
386 	err = devm_request_irq(&pdev->dev, priv->irq, xlp9xx_i2c_isr, 0,  in xlp9xx_i2c_probe()
387 			       pdev->name, priv);  in xlp9xx_i2c_probe()
393 	init_completion(&priv->msg_complete);  in xlp9xx_i2c_probe()
394 	priv->adapter.dev.parent = &pdev->dev;  in xlp9xx_i2c_probe()
395 	priv->adapter.algo = &xlp9xx_i2c_algo;  in xlp9xx_i2c_probe()
396 	priv->adapter.dev.of_node = pdev->dev.of_node;  in xlp9xx_i2c_probe()
397 	priv->dev = &pdev->dev;  in xlp9xx_i2c_probe()
399 	snprintf(priv->adapter.name, sizeof(priv->adapter.name), "xlp9xx-i2c");  in xlp9xx_i2c_probe()
400 	i2c_set_adapdata(&priv->adapter, priv);  in xlp9xx_i2c_probe()
402 	err = i2c_add_adapter(&priv->adapter);  in xlp9xx_i2c_probe()
408 	platform_set_drvdata(pdev, priv);  in xlp9xx_i2c_probe()
409 	dev_dbg(&pdev->dev, "I2C bus:%d added\n", priv->adapter.nr);  in xlp9xx_i2c_probe()
416 	struct xlp9xx_i2c_dev *priv;  in xlp9xx_i2c_remove()  local
418 	priv = platform_get_drvdata(pdev);  in xlp9xx_i2c_remove()
419 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_INTEN, 0);  in xlp9xx_i2c_remove()
420 	synchronize_irq(priv->irq);  in xlp9xx_i2c_remove()
421 	i2c_del_adapter(&priv->adapter);  in xlp9xx_i2c_remove()
422 	xlp9xx_write_i2c_reg(priv, XLP9XX_I2C_CTRL, 0);  in xlp9xx_i2c_remove()