xref: /linux/drivers/i2c/busses/i2c-emev2.c (revision c31d0a00021d7289c01edc3d9670da52132d0457)
15faf6e1fSWolfram Sang /*
25faf6e1fSWolfram Sang  * I2C driver for the Renesas EMEV2 SoC
35faf6e1fSWolfram Sang  *
45faf6e1fSWolfram Sang  * Copyright (C) 2015 Wolfram Sang <wsa@sang-engineering.com>
55faf6e1fSWolfram Sang  * Copyright 2013 Codethink Ltd.
65faf6e1fSWolfram Sang  * Copyright 2010-2015 Renesas Electronics Corporation
75faf6e1fSWolfram Sang  *
85faf6e1fSWolfram Sang  * This program is free software; you can redistribute it and/or modify
95faf6e1fSWolfram Sang  * it under the terms of the GNU General Public License version 2
105faf6e1fSWolfram Sang  * as published by the Free Software Foundation.
115faf6e1fSWolfram Sang  */
125faf6e1fSWolfram Sang 
135faf6e1fSWolfram Sang #include <linux/clk.h>
145faf6e1fSWolfram Sang #include <linux/completion.h>
155faf6e1fSWolfram Sang #include <linux/device.h>
165faf6e1fSWolfram Sang #include <linux/i2c.h>
175faf6e1fSWolfram Sang #include <linux/init.h>
185faf6e1fSWolfram Sang #include <linux/interrupt.h>
195faf6e1fSWolfram Sang #include <linux/io.h>
205faf6e1fSWolfram Sang #include <linux/kernel.h>
215faf6e1fSWolfram Sang #include <linux/module.h>
225faf6e1fSWolfram Sang #include <linux/of_device.h>
235faf6e1fSWolfram Sang #include <linux/platform_device.h>
245faf6e1fSWolfram Sang #include <linux/sched.h>
255faf6e1fSWolfram Sang 
265faf6e1fSWolfram Sang /* I2C Registers */
275faf6e1fSWolfram Sang #define I2C_OFS_IICACT0		0x00	/* start */
285faf6e1fSWolfram Sang #define I2C_OFS_IIC0		0x04	/* shift */
295faf6e1fSWolfram Sang #define I2C_OFS_IICC0		0x08	/* control */
305faf6e1fSWolfram Sang #define I2C_OFS_SVA0		0x0c	/* slave address */
315faf6e1fSWolfram Sang #define I2C_OFS_IICCL0		0x10	/* clock select */
325faf6e1fSWolfram Sang #define I2C_OFS_IICX0		0x14	/* extension */
335faf6e1fSWolfram Sang #define I2C_OFS_IICS0		0x18	/* status */
345faf6e1fSWolfram Sang #define I2C_OFS_IICSE0		0x1c	/* status For emulation */
355faf6e1fSWolfram Sang #define I2C_OFS_IICF0		0x20	/* IIC flag */
365faf6e1fSWolfram Sang 
375faf6e1fSWolfram Sang /* I2C IICACT0 Masks */
385faf6e1fSWolfram Sang #define I2C_BIT_IICE0		0x0001
395faf6e1fSWolfram Sang 
405faf6e1fSWolfram Sang /* I2C IICC0 Masks */
415faf6e1fSWolfram Sang #define I2C_BIT_LREL0		0x0040
425faf6e1fSWolfram Sang #define I2C_BIT_WREL0		0x0020
435faf6e1fSWolfram Sang #define I2C_BIT_SPIE0		0x0010
445faf6e1fSWolfram Sang #define I2C_BIT_WTIM0		0x0008
455faf6e1fSWolfram Sang #define I2C_BIT_ACKE0		0x0004
465faf6e1fSWolfram Sang #define I2C_BIT_STT0		0x0002
475faf6e1fSWolfram Sang #define I2C_BIT_SPT0		0x0001
485faf6e1fSWolfram Sang 
495faf6e1fSWolfram Sang /* I2C IICCL0 Masks */
505faf6e1fSWolfram Sang #define I2C_BIT_SMC0		0x0008
515faf6e1fSWolfram Sang #define I2C_BIT_DFC0		0x0004
525faf6e1fSWolfram Sang 
535faf6e1fSWolfram Sang /* I2C IICSE0 Masks */
545faf6e1fSWolfram Sang #define I2C_BIT_MSTS0		0x0080
555faf6e1fSWolfram Sang #define I2C_BIT_ALD0		0x0040
565faf6e1fSWolfram Sang #define I2C_BIT_EXC0		0x0020
575faf6e1fSWolfram Sang #define I2C_BIT_COI0		0x0010
585faf6e1fSWolfram Sang #define I2C_BIT_TRC0		0x0008
595faf6e1fSWolfram Sang #define I2C_BIT_ACKD0		0x0004
605faf6e1fSWolfram Sang #define I2C_BIT_STD0		0x0002
615faf6e1fSWolfram Sang #define I2C_BIT_SPD0		0x0001
625faf6e1fSWolfram Sang 
635faf6e1fSWolfram Sang /* I2C IICF0 Masks */
645faf6e1fSWolfram Sang #define I2C_BIT_STCF		0x0080
655faf6e1fSWolfram Sang #define I2C_BIT_IICBSY		0x0040
665faf6e1fSWolfram Sang #define I2C_BIT_STCEN		0x0002
675faf6e1fSWolfram Sang #define I2C_BIT_IICRSV		0x0001
685faf6e1fSWolfram Sang 
695faf6e1fSWolfram Sang struct em_i2c_device {
705faf6e1fSWolfram Sang 	void __iomem *base;
715faf6e1fSWolfram Sang 	struct i2c_adapter adap;
725faf6e1fSWolfram Sang 	struct completion msg_done;
735faf6e1fSWolfram Sang 	struct clk *sclk;
74*c31d0a00SNiklas Söderlund 	struct i2c_client *slave;
755faf6e1fSWolfram Sang };
765faf6e1fSWolfram Sang 
775faf6e1fSWolfram Sang static inline void em_clear_set_bit(struct em_i2c_device *priv, u8 clear, u8 set, u8 reg)
785faf6e1fSWolfram Sang {
795faf6e1fSWolfram Sang 	writeb((readb(priv->base + reg) & ~clear) | set, priv->base + reg);
805faf6e1fSWolfram Sang }
815faf6e1fSWolfram Sang 
825faf6e1fSWolfram Sang static int em_i2c_wait_for_event(struct em_i2c_device *priv)
835faf6e1fSWolfram Sang {
845faf6e1fSWolfram Sang 	unsigned long time_left;
855faf6e1fSWolfram Sang 	int status;
865faf6e1fSWolfram Sang 
875faf6e1fSWolfram Sang 	reinit_completion(&priv->msg_done);
885faf6e1fSWolfram Sang 
895faf6e1fSWolfram Sang 	time_left = wait_for_completion_timeout(&priv->msg_done, priv->adap.timeout);
905faf6e1fSWolfram Sang 
915faf6e1fSWolfram Sang 	if (!time_left)
925faf6e1fSWolfram Sang 		return -ETIMEDOUT;
935faf6e1fSWolfram Sang 
945faf6e1fSWolfram Sang 	status = readb(priv->base + I2C_OFS_IICSE0);
955faf6e1fSWolfram Sang 	return status & I2C_BIT_ALD0 ? -EAGAIN : status;
965faf6e1fSWolfram Sang }
975faf6e1fSWolfram Sang 
985faf6e1fSWolfram Sang static void em_i2c_stop(struct em_i2c_device *priv)
995faf6e1fSWolfram Sang {
1005faf6e1fSWolfram Sang 	/* Send Stop condition */
1015faf6e1fSWolfram Sang 	em_clear_set_bit(priv, 0, I2C_BIT_SPT0 | I2C_BIT_SPIE0, I2C_OFS_IICC0);
1025faf6e1fSWolfram Sang 
1035faf6e1fSWolfram Sang 	/* Wait for stop condition */
1045faf6e1fSWolfram Sang 	em_i2c_wait_for_event(priv);
1055faf6e1fSWolfram Sang }
1065faf6e1fSWolfram Sang 
1075faf6e1fSWolfram Sang static void em_i2c_reset(struct i2c_adapter *adap)
1085faf6e1fSWolfram Sang {
1095faf6e1fSWolfram Sang 	struct em_i2c_device *priv = i2c_get_adapdata(adap);
1105faf6e1fSWolfram Sang 	int retr;
1115faf6e1fSWolfram Sang 
1125faf6e1fSWolfram Sang 	/* If I2C active */
1135faf6e1fSWolfram Sang 	if (readb(priv->base + I2C_OFS_IICACT0) & I2C_BIT_IICE0) {
1145faf6e1fSWolfram Sang 		/* Disable I2C operation */
1155faf6e1fSWolfram Sang 		writeb(0, priv->base + I2C_OFS_IICACT0);
1165faf6e1fSWolfram Sang 
1175faf6e1fSWolfram Sang 		retr = 1000;
1185faf6e1fSWolfram Sang 		while (readb(priv->base + I2C_OFS_IICACT0) == 1 && retr)
1195faf6e1fSWolfram Sang 			retr--;
1205faf6e1fSWolfram Sang 		WARN_ON(retr == 0);
1215faf6e1fSWolfram Sang 	}
1225faf6e1fSWolfram Sang 
1235faf6e1fSWolfram Sang 	/* Transfer mode set */
1245faf6e1fSWolfram Sang 	writeb(I2C_BIT_DFC0, priv->base + I2C_OFS_IICCL0);
1255faf6e1fSWolfram Sang 
1265faf6e1fSWolfram Sang 	/* Can Issue start without detecting a stop, Reservation disabled. */
1275faf6e1fSWolfram Sang 	writeb(I2C_BIT_STCEN | I2C_BIT_IICRSV, priv->base + I2C_OFS_IICF0);
1285faf6e1fSWolfram Sang 
1295faf6e1fSWolfram Sang 	/* I2C enable, 9 bit interrupt mode */
1305faf6e1fSWolfram Sang 	writeb(I2C_BIT_WTIM0, priv->base + I2C_OFS_IICC0);
1315faf6e1fSWolfram Sang 
1325faf6e1fSWolfram Sang 	/* Enable I2C operation */
1335faf6e1fSWolfram Sang 	writeb(I2C_BIT_IICE0, priv->base + I2C_OFS_IICACT0);
1345faf6e1fSWolfram Sang 
1355faf6e1fSWolfram Sang 	retr = 1000;
1365faf6e1fSWolfram Sang 	while (readb(priv->base + I2C_OFS_IICACT0) == 0 && retr)
1375faf6e1fSWolfram Sang 		retr--;
1385faf6e1fSWolfram Sang 	WARN_ON(retr == 0);
1395faf6e1fSWolfram Sang }
1405faf6e1fSWolfram Sang 
1415faf6e1fSWolfram Sang static int __em_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msg,
1425faf6e1fSWolfram Sang 				int stop)
1435faf6e1fSWolfram Sang {
1445faf6e1fSWolfram Sang 	struct em_i2c_device *priv = i2c_get_adapdata(adap);
1455faf6e1fSWolfram Sang 	int count, status, read = !!(msg->flags & I2C_M_RD);
1465faf6e1fSWolfram Sang 
1475faf6e1fSWolfram Sang 	/* Send start condition */
1485faf6e1fSWolfram Sang 	em_clear_set_bit(priv, 0, I2C_BIT_ACKE0 | I2C_BIT_WTIM0, I2C_OFS_IICC0);
1495faf6e1fSWolfram Sang 	em_clear_set_bit(priv, 0, I2C_BIT_STT0, I2C_OFS_IICC0);
1505faf6e1fSWolfram Sang 
1515faf6e1fSWolfram Sang 	/* Send slave address and R/W type */
1525faf6e1fSWolfram Sang 	writeb((msg->addr << 1) | read, priv->base + I2C_OFS_IIC0);
1535faf6e1fSWolfram Sang 
1545faf6e1fSWolfram Sang 	/* Wait for transaction */
1555faf6e1fSWolfram Sang 	status = em_i2c_wait_for_event(priv);
1565faf6e1fSWolfram Sang 	if (status < 0)
1575faf6e1fSWolfram Sang 		goto out_reset;
1585faf6e1fSWolfram Sang 
1595faf6e1fSWolfram Sang 	/* Received NACK (result of setting slave address and R/W) */
1605faf6e1fSWolfram Sang 	if (!(status & I2C_BIT_ACKD0)) {
1615faf6e1fSWolfram Sang 		em_i2c_stop(priv);
1625faf6e1fSWolfram Sang 		goto out;
1635faf6e1fSWolfram Sang 	}
1645faf6e1fSWolfram Sang 
1655faf6e1fSWolfram Sang 	/* Extra setup for read transactions */
1665faf6e1fSWolfram Sang 	if (read) {
1675faf6e1fSWolfram Sang 		/* 8 bit interrupt mode */
1685faf6e1fSWolfram Sang 		em_clear_set_bit(priv, I2C_BIT_WTIM0, I2C_BIT_ACKE0, I2C_OFS_IICC0);
1695faf6e1fSWolfram Sang 		em_clear_set_bit(priv, I2C_BIT_WTIM0, I2C_BIT_WREL0, I2C_OFS_IICC0);
1705faf6e1fSWolfram Sang 
1715faf6e1fSWolfram Sang 		/* Wait for transaction */
1725faf6e1fSWolfram Sang 		status = em_i2c_wait_for_event(priv);
1735faf6e1fSWolfram Sang 		if (status < 0)
1745faf6e1fSWolfram Sang 			goto out_reset;
1755faf6e1fSWolfram Sang 	}
1765faf6e1fSWolfram Sang 
1775faf6e1fSWolfram Sang 	/* Send / receive data */
1785faf6e1fSWolfram Sang 	for (count = 0; count < msg->len; count++) {
1795faf6e1fSWolfram Sang 		if (read) { /* Read transaction */
1805faf6e1fSWolfram Sang 			msg->buf[count] = readb(priv->base + I2C_OFS_IIC0);
1815faf6e1fSWolfram Sang 			em_clear_set_bit(priv, 0, I2C_BIT_WREL0, I2C_OFS_IICC0);
1825faf6e1fSWolfram Sang 
1835faf6e1fSWolfram Sang 		} else { /* Write transaction */
1845faf6e1fSWolfram Sang 			/* Received NACK */
1855faf6e1fSWolfram Sang 			if (!(status & I2C_BIT_ACKD0)) {
1865faf6e1fSWolfram Sang 				em_i2c_stop(priv);
1875faf6e1fSWolfram Sang 				goto out;
1885faf6e1fSWolfram Sang 			}
1895faf6e1fSWolfram Sang 
1905faf6e1fSWolfram Sang 			/* Write data */
1915faf6e1fSWolfram Sang 			writeb(msg->buf[count], priv->base + I2C_OFS_IIC0);
1925faf6e1fSWolfram Sang 		}
1935faf6e1fSWolfram Sang 
1945faf6e1fSWolfram Sang 		/* Wait for R/W transaction */
1955faf6e1fSWolfram Sang 		status = em_i2c_wait_for_event(priv);
1965faf6e1fSWolfram Sang 		if (status < 0)
1975faf6e1fSWolfram Sang 			goto out_reset;
1985faf6e1fSWolfram Sang 	}
1995faf6e1fSWolfram Sang 
2005faf6e1fSWolfram Sang 	if (stop)
2015faf6e1fSWolfram Sang 		em_i2c_stop(priv);
2025faf6e1fSWolfram Sang 
2035faf6e1fSWolfram Sang 	return count;
2045faf6e1fSWolfram Sang 
2055faf6e1fSWolfram Sang out_reset:
2065faf6e1fSWolfram Sang 	em_i2c_reset(adap);
2075faf6e1fSWolfram Sang out:
2085faf6e1fSWolfram Sang 	return status < 0 ? status : -ENXIO;
2095faf6e1fSWolfram Sang }
2105faf6e1fSWolfram Sang 
2115faf6e1fSWolfram Sang static int em_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
2125faf6e1fSWolfram Sang 	int num)
2135faf6e1fSWolfram Sang {
2145faf6e1fSWolfram Sang 	struct em_i2c_device *priv = i2c_get_adapdata(adap);
2155faf6e1fSWolfram Sang 	int ret, i;
2165faf6e1fSWolfram Sang 
2175faf6e1fSWolfram Sang 	if (readb(priv->base + I2C_OFS_IICF0) & I2C_BIT_IICBSY)
2185faf6e1fSWolfram Sang 		return -EAGAIN;
2195faf6e1fSWolfram Sang 
2205faf6e1fSWolfram Sang 	for (i = 0; i < num; i++) {
2215faf6e1fSWolfram Sang 		ret = __em_i2c_xfer(adap, &msgs[i], (i == (num - 1)));
2225faf6e1fSWolfram Sang 		if (ret < 0)
2235faf6e1fSWolfram Sang 			return ret;
2245faf6e1fSWolfram Sang 	}
2255faf6e1fSWolfram Sang 
2265faf6e1fSWolfram Sang 	/* I2C transfer completed */
2275faf6e1fSWolfram Sang 	return num;
2285faf6e1fSWolfram Sang }
2295faf6e1fSWolfram Sang 
230*c31d0a00SNiklas Söderlund static bool em_i2c_slave_irq(struct em_i2c_device *priv)
231*c31d0a00SNiklas Söderlund {
232*c31d0a00SNiklas Söderlund 	u8 status, value;
233*c31d0a00SNiklas Söderlund 	enum i2c_slave_event event;
234*c31d0a00SNiklas Söderlund 	int ret;
235*c31d0a00SNiklas Söderlund 
236*c31d0a00SNiklas Söderlund 	if (!priv->slave)
237*c31d0a00SNiklas Söderlund 		return false;
238*c31d0a00SNiklas Söderlund 
239*c31d0a00SNiklas Söderlund 	status = readb(priv->base + I2C_OFS_IICSE0);
240*c31d0a00SNiklas Söderlund 
241*c31d0a00SNiklas Söderlund 	/* Extension code, do not participate */
242*c31d0a00SNiklas Söderlund 	if (status & I2C_BIT_EXC0) {
243*c31d0a00SNiklas Söderlund 		em_clear_set_bit(priv, 0, I2C_BIT_LREL0, I2C_OFS_IICC0);
244*c31d0a00SNiklas Söderlund 		return true;
245*c31d0a00SNiklas Söderlund 	}
246*c31d0a00SNiklas Söderlund 
247*c31d0a00SNiklas Söderlund 	/* Stop detected, we don't know if it's for slave or master */
248*c31d0a00SNiklas Söderlund 	if (status & I2C_BIT_SPD0) {
249*c31d0a00SNiklas Söderlund 		/* Notify slave device */
250*c31d0a00SNiklas Söderlund 		i2c_slave_event(priv->slave, I2C_SLAVE_STOP, &value);
251*c31d0a00SNiklas Söderlund 		/* Pretend we did not handle the interrupt */
252*c31d0a00SNiklas Söderlund 		return false;
253*c31d0a00SNiklas Söderlund 	}
254*c31d0a00SNiklas Söderlund 
255*c31d0a00SNiklas Söderlund 	/* Only handle interrupts addressed to us */
256*c31d0a00SNiklas Söderlund 	if (!(status & I2C_BIT_COI0))
257*c31d0a00SNiklas Söderlund 		return false;
258*c31d0a00SNiklas Söderlund 
259*c31d0a00SNiklas Söderlund 	/* Enable stop interrupts */
260*c31d0a00SNiklas Söderlund 	em_clear_set_bit(priv, 0, I2C_BIT_SPIE0, I2C_OFS_IICC0);
261*c31d0a00SNiklas Söderlund 
262*c31d0a00SNiklas Söderlund 	/* Transmission or Reception */
263*c31d0a00SNiklas Söderlund 	if (status & I2C_BIT_TRC0) {
264*c31d0a00SNiklas Söderlund 		if (status & I2C_BIT_ACKD0) {
265*c31d0a00SNiklas Söderlund 			/* 9 bit interrupt mode */
266*c31d0a00SNiklas Söderlund 			em_clear_set_bit(priv, 0, I2C_BIT_WTIM0, I2C_OFS_IICC0);
267*c31d0a00SNiklas Söderlund 
268*c31d0a00SNiklas Söderlund 			/* Send data */
269*c31d0a00SNiklas Söderlund 			event = status & I2C_BIT_STD0 ?
270*c31d0a00SNiklas Söderlund 				I2C_SLAVE_READ_REQUESTED :
271*c31d0a00SNiklas Söderlund 				I2C_SLAVE_READ_PROCESSED;
272*c31d0a00SNiklas Söderlund 			i2c_slave_event(priv->slave, event, &value);
273*c31d0a00SNiklas Söderlund 			writeb(value, priv->base + I2C_OFS_IIC0);
274*c31d0a00SNiklas Söderlund 		} else {
275*c31d0a00SNiklas Söderlund 			/* NACK, stop transmitting */
276*c31d0a00SNiklas Söderlund 			em_clear_set_bit(priv, 0, I2C_BIT_LREL0, I2C_OFS_IICC0);
277*c31d0a00SNiklas Söderlund 		}
278*c31d0a00SNiklas Söderlund 	} else {
279*c31d0a00SNiklas Söderlund 		/* 8 bit interrupt mode */
280*c31d0a00SNiklas Söderlund 		em_clear_set_bit(priv, I2C_BIT_WTIM0, I2C_BIT_ACKE0,
281*c31d0a00SNiklas Söderlund 				I2C_OFS_IICC0);
282*c31d0a00SNiklas Söderlund 		em_clear_set_bit(priv, I2C_BIT_WTIM0, I2C_BIT_WREL0,
283*c31d0a00SNiklas Söderlund 				I2C_OFS_IICC0);
284*c31d0a00SNiklas Söderlund 
285*c31d0a00SNiklas Söderlund 		if (status & I2C_BIT_STD0) {
286*c31d0a00SNiklas Söderlund 			i2c_slave_event(priv->slave, I2C_SLAVE_WRITE_REQUESTED,
287*c31d0a00SNiklas Söderlund 					&value);
288*c31d0a00SNiklas Söderlund 		} else {
289*c31d0a00SNiklas Söderlund 			/* Recv data */
290*c31d0a00SNiklas Söderlund 			value = readb(priv->base + I2C_OFS_IIC0);
291*c31d0a00SNiklas Söderlund 			ret = i2c_slave_event(priv->slave,
292*c31d0a00SNiklas Söderlund 					I2C_SLAVE_WRITE_RECEIVED, &value);
293*c31d0a00SNiklas Söderlund 			if (ret < 0)
294*c31d0a00SNiklas Söderlund 				em_clear_set_bit(priv, I2C_BIT_ACKE0, 0,
295*c31d0a00SNiklas Söderlund 						I2C_OFS_IICC0);
296*c31d0a00SNiklas Söderlund 		}
297*c31d0a00SNiklas Söderlund 	}
298*c31d0a00SNiklas Söderlund 
299*c31d0a00SNiklas Söderlund 	return true;
300*c31d0a00SNiklas Söderlund }
301*c31d0a00SNiklas Söderlund 
3025faf6e1fSWolfram Sang static irqreturn_t em_i2c_irq_handler(int this_irq, void *dev_id)
3035faf6e1fSWolfram Sang {
3045faf6e1fSWolfram Sang 	struct em_i2c_device *priv = dev_id;
3055faf6e1fSWolfram Sang 
306*c31d0a00SNiklas Söderlund 	if (em_i2c_slave_irq(priv))
307*c31d0a00SNiklas Söderlund 		return IRQ_HANDLED;
308*c31d0a00SNiklas Söderlund 
3095faf6e1fSWolfram Sang 	complete(&priv->msg_done);
310*c31d0a00SNiklas Söderlund 
3115faf6e1fSWolfram Sang 	return IRQ_HANDLED;
3125faf6e1fSWolfram Sang }
3135faf6e1fSWolfram Sang 
3145faf6e1fSWolfram Sang static u32 em_i2c_func(struct i2c_adapter *adap)
3155faf6e1fSWolfram Sang {
316*c31d0a00SNiklas Söderlund 	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_SLAVE;
317*c31d0a00SNiklas Söderlund }
318*c31d0a00SNiklas Söderlund 
319*c31d0a00SNiklas Söderlund static int em_i2c_reg_slave(struct i2c_client *slave)
320*c31d0a00SNiklas Söderlund {
321*c31d0a00SNiklas Söderlund 	struct em_i2c_device *priv = i2c_get_adapdata(slave->adapter);
322*c31d0a00SNiklas Söderlund 
323*c31d0a00SNiklas Söderlund 	if (priv->slave)
324*c31d0a00SNiklas Söderlund 		return -EBUSY;
325*c31d0a00SNiklas Söderlund 
326*c31d0a00SNiklas Söderlund 	if (slave->flags & I2C_CLIENT_TEN)
327*c31d0a00SNiklas Söderlund 		return -EAFNOSUPPORT;
328*c31d0a00SNiklas Söderlund 
329*c31d0a00SNiklas Söderlund 	priv->slave = slave;
330*c31d0a00SNiklas Söderlund 
331*c31d0a00SNiklas Söderlund 	/* Set slave address */
332*c31d0a00SNiklas Söderlund 	writeb(slave->addr << 1, priv->base + I2C_OFS_SVA0);
333*c31d0a00SNiklas Söderlund 
334*c31d0a00SNiklas Söderlund 	return 0;
335*c31d0a00SNiklas Söderlund }
336*c31d0a00SNiklas Söderlund 
337*c31d0a00SNiklas Söderlund static int em_i2c_unreg_slave(struct i2c_client *slave)
338*c31d0a00SNiklas Söderlund {
339*c31d0a00SNiklas Söderlund 	struct em_i2c_device *priv = i2c_get_adapdata(slave->adapter);
340*c31d0a00SNiklas Söderlund 
341*c31d0a00SNiklas Söderlund 	WARN_ON(!priv->slave);
342*c31d0a00SNiklas Söderlund 
343*c31d0a00SNiklas Söderlund 	writeb(0, priv->base + I2C_OFS_SVA0);
344*c31d0a00SNiklas Söderlund 
345*c31d0a00SNiklas Söderlund 	priv->slave = NULL;
346*c31d0a00SNiklas Söderlund 
347*c31d0a00SNiklas Söderlund 	return 0;
3485faf6e1fSWolfram Sang }
3495faf6e1fSWolfram Sang 
3505faf6e1fSWolfram Sang static struct i2c_algorithm em_i2c_algo = {
3515faf6e1fSWolfram Sang 	.master_xfer = em_i2c_xfer,
3525faf6e1fSWolfram Sang 	.functionality = em_i2c_func,
353*c31d0a00SNiklas Söderlund 	.reg_slave      = em_i2c_reg_slave,
354*c31d0a00SNiklas Söderlund 	.unreg_slave    = em_i2c_unreg_slave,
3555faf6e1fSWolfram Sang };
3565faf6e1fSWolfram Sang 
3575faf6e1fSWolfram Sang static int em_i2c_probe(struct platform_device *pdev)
3585faf6e1fSWolfram Sang {
3595faf6e1fSWolfram Sang 	struct em_i2c_device *priv;
3605faf6e1fSWolfram Sang 	struct resource *r;
3615faf6e1fSWolfram Sang 	int irq, ret;
3625faf6e1fSWolfram Sang 
3635faf6e1fSWolfram Sang 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
3645faf6e1fSWolfram Sang 	if (!priv)
3655faf6e1fSWolfram Sang 		return -ENOMEM;
3665faf6e1fSWolfram Sang 
3675faf6e1fSWolfram Sang 	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
3685faf6e1fSWolfram Sang 	priv->base = devm_ioremap_resource(&pdev->dev, r);
3695faf6e1fSWolfram Sang 	if (IS_ERR(priv->base))
3705faf6e1fSWolfram Sang 		return PTR_ERR(priv->base);
3715faf6e1fSWolfram Sang 
3725faf6e1fSWolfram Sang 	strlcpy(priv->adap.name, "EMEV2 I2C", sizeof(priv->adap.name));
3735faf6e1fSWolfram Sang 
3745faf6e1fSWolfram Sang 	priv->sclk = devm_clk_get(&pdev->dev, "sclk");
3755faf6e1fSWolfram Sang 	if (IS_ERR(priv->sclk))
3765faf6e1fSWolfram Sang 		return PTR_ERR(priv->sclk);
3775faf6e1fSWolfram Sang 
3785faf6e1fSWolfram Sang 	clk_prepare_enable(priv->sclk);
3795faf6e1fSWolfram Sang 
3805faf6e1fSWolfram Sang 	priv->adap.timeout = msecs_to_jiffies(100);
3815faf6e1fSWolfram Sang 	priv->adap.retries = 5;
3825faf6e1fSWolfram Sang 	priv->adap.dev.parent = &pdev->dev;
3835faf6e1fSWolfram Sang 	priv->adap.algo = &em_i2c_algo;
3845faf6e1fSWolfram Sang 	priv->adap.owner = THIS_MODULE;
3855faf6e1fSWolfram Sang 	priv->adap.dev.of_node = pdev->dev.of_node;
3865faf6e1fSWolfram Sang 
3875faf6e1fSWolfram Sang 	init_completion(&priv->msg_done);
3885faf6e1fSWolfram Sang 
3895faf6e1fSWolfram Sang 	platform_set_drvdata(pdev, priv);
3905faf6e1fSWolfram Sang 	i2c_set_adapdata(&priv->adap, priv);
3915faf6e1fSWolfram Sang 
3925faf6e1fSWolfram Sang 	em_i2c_reset(&priv->adap);
3935faf6e1fSWolfram Sang 
3945faf6e1fSWolfram Sang 	irq = platform_get_irq(pdev, 0);
3955faf6e1fSWolfram Sang 	ret = devm_request_irq(&pdev->dev, irq, em_i2c_irq_handler, 0,
3965faf6e1fSWolfram Sang 				"em_i2c", priv);
3975faf6e1fSWolfram Sang 	if (ret)
3985faf6e1fSWolfram Sang 		goto err_clk;
3995faf6e1fSWolfram Sang 
4005faf6e1fSWolfram Sang 	ret = i2c_add_adapter(&priv->adap);
4015faf6e1fSWolfram Sang 
4025faf6e1fSWolfram Sang 	if (ret)
4035faf6e1fSWolfram Sang 		goto err_clk;
4045faf6e1fSWolfram Sang 
4055faf6e1fSWolfram Sang 	dev_info(&pdev->dev, "Added i2c controller %d, irq %d\n", priv->adap.nr, irq);
4065faf6e1fSWolfram Sang 
4075faf6e1fSWolfram Sang 	return 0;
4085faf6e1fSWolfram Sang 
4095faf6e1fSWolfram Sang err_clk:
4105faf6e1fSWolfram Sang 	clk_disable_unprepare(priv->sclk);
4115faf6e1fSWolfram Sang 	return ret;
4125faf6e1fSWolfram Sang }
4135faf6e1fSWolfram Sang 
4145faf6e1fSWolfram Sang static int em_i2c_remove(struct platform_device *dev)
4155faf6e1fSWolfram Sang {
4165faf6e1fSWolfram Sang 	struct em_i2c_device *priv = platform_get_drvdata(dev);
4175faf6e1fSWolfram Sang 
4185faf6e1fSWolfram Sang 	i2c_del_adapter(&priv->adap);
4195faf6e1fSWolfram Sang 	clk_disable_unprepare(priv->sclk);
4205faf6e1fSWolfram Sang 
4215faf6e1fSWolfram Sang 	return 0;
4225faf6e1fSWolfram Sang }
4235faf6e1fSWolfram Sang 
4245faf6e1fSWolfram Sang static const struct of_device_id em_i2c_ids[] = {
4255faf6e1fSWolfram Sang 	{ .compatible = "renesas,iic-emev2", },
4265faf6e1fSWolfram Sang 	{ }
4275faf6e1fSWolfram Sang };
4285faf6e1fSWolfram Sang 
4295faf6e1fSWolfram Sang static struct platform_driver em_i2c_driver = {
4305faf6e1fSWolfram Sang 	.probe = em_i2c_probe,
4315faf6e1fSWolfram Sang 	.remove = em_i2c_remove,
4325faf6e1fSWolfram Sang 	.driver = {
4335faf6e1fSWolfram Sang 		.name = "em-i2c",
4345faf6e1fSWolfram Sang 		.of_match_table = em_i2c_ids,
4355faf6e1fSWolfram Sang 	}
4365faf6e1fSWolfram Sang };
4375faf6e1fSWolfram Sang module_platform_driver(em_i2c_driver);
4385faf6e1fSWolfram Sang 
4395faf6e1fSWolfram Sang MODULE_DESCRIPTION("EMEV2 I2C bus driver");
4405faf6e1fSWolfram Sang MODULE_AUTHOR("Ian Molton and Wolfram Sang <wsa@sang-engineering.com>");
4415faf6e1fSWolfram Sang MODULE_LICENSE("GPL v2");
4425faf6e1fSWolfram Sang MODULE_DEVICE_TABLE(of, em_i2c_ids);
443