twl-core: abstract twl4030 and add twlcore driver

Add a general twl device driver twlcore to call i2c send/write
functions.
Abstract twl4030 to call twlcore functions.

Fixed some code-styling issues pointed out by checkpatch.

Signed-off-by: Alexander Aring <a.aring@phytec.de>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

1 files changed, 8 insertions, 134 deletions

diff --git a/drivers/mfd/twl4030.c b/drivers/mfd/twl4030.c
index 6a06bd44bb..191c91f36a 100644
--- a/drivers/mfd/twl4030.c
+++ b/drivers/mfd/twl4030.c
@@ -29,145 +29,19 @@ struct twl4030 *twl4030_get(void)
 }
 EXPORT_SYMBOL(twl4030_get);
 
-int twl4030_reg_read(struct twl4030 *twl4030, u16 reg, u8 *val)
-{
-	int ret;
-	struct i2c_msg xfer_msg[2];
-	struct i2c_msg *msg;
-	int i2c_addr;
-	unsigned char buf = reg & 0xff;
-
-	i2c_addr = twl4030->client->addr + (reg / 0x100);
-
-	/* [MSG1] fill the register address data */
-	msg = &xfer_msg[0];
-	msg->addr = i2c_addr;
-	msg->len = 1;
-	msg->flags = 0;	/* Read the register value */
-	msg->buf = &buf;
-	/* [MSG2] fill the data rx buffer */
-	msg = &xfer_msg[1];
-	msg->addr = i2c_addr;
-	msg->flags = I2C_M_RD;	/* Read the register value */
-	msg->len = 1;	/* only n bytes */
-	msg->buf = val;
-	ret = i2c_transfer(twl4030->client->adapter, xfer_msg, 2);
-
-	/* i2c_transfer returns number of messages transferred */
-	if (ret < 0) {
-		pr_err("%s: failed to transfer all messages: %s\n", __func__, strerror(-ret));
-		return ret;
-	}
-	return 0;
-}
-EXPORT_SYMBOL(twl4030_reg_read);
-
-int twl4030_reg_write(struct twl4030 *twl4030, u16 reg, u8 val)
-{
-	int ret;
-	struct i2c_msg xfer_msg[1];
-	struct i2c_msg *msg;
-	int i2c_addr;
-	u8 buf[2];
-
-	buf[0] = reg & 0xff;
-	buf[1] = val;
-
-	i2c_addr = twl4030->client->addr + (reg / 0x100);
-
-	/*
-	 * [MSG1]: fill the register address data
-	 * fill the data Tx buffer
-	 */
-	msg = xfer_msg;
-	msg->addr = i2c_addr;
-	msg->len = 2;
-	msg->flags = 0;
-	msg->buf = buf;
-	/* over write the first byte of buffer with the register address */
-	ret = i2c_transfer(twl4030->client->adapter, xfer_msg, 1);
-
-	/* i2c_transfer returns number of messages transferred */
-	if (ret < 0) {
-		pr_err("%s: failed to transfer all messages: %s\n", __func__, strerror(-ret));
-		return ret;
-	}
-	return 0;
-}
-EXPORT_SYMBOL(twl4030_reg_write);
-
-int twl4030_set_bits(struct twl4030 *twl4030, enum twl4030_reg reg, u8 mask, u8 val)
-{
-	u8 tmp;
-	int err;
-
-	err = twl4030_reg_read(twl4030, reg, &tmp);
-	tmp = (tmp & ~mask) | val;
-
-	if (!err)
-		err = twl4030_reg_write(twl4030, reg, tmp);
-
-	return err;
-}
-EXPORT_SYMBOL(twl4030_set_bits);
-
-static ssize_t twl_read(struct cdev *cdev, void *_buf, size_t count, ulong offset, ulong flags)
-{
-	struct twl4030 *priv = to_twl4030(cdev);
-	u8 *buf = _buf;
-	size_t i = count;
-	int err;
-
-	while (i) {
-		err = twl4030_reg_read(priv, offset, buf);
-		if (err)
-			return (ssize_t)err;
-		buf++;
-		i--;
-		offset++;
-	}
-
-	return count;
-}
-
-static ssize_t twl_write(struct cdev *cdev, const void *_buf, size_t count, ulong offset, ulong flags)
-{
-	struct twl4030 *twl4030 = to_twl4030(cdev);
-	const u8 *buf = _buf;
-	size_t i = count;
-	int err;
-
-	while (i) {
-		err = twl4030_reg_write(twl4030, offset, *buf);
-		if (err)
-			return (ssize_t)err;
-		buf++;
-		i--;
-		offset++;
-	}
-
-	return count;
-}
-
-static struct file_operations twl_fops = {
-	.lseek	= dev_lseek_default,
-	.read	= twl_read,
-	.write	= twl_write,
-};
-
 static int twl_probe(struct device_d *dev)
 {
 	if (twl_dev)
 		return -EBUSY;
 
 	twl_dev = xzalloc(sizeof(struct twl4030));
-	twl_dev->cdev.name = DRIVERNAME;
-	twl_dev->client = to_i2c_client(dev);
-	twl_dev->cdev.size = 1024;
-	twl_dev->cdev.dev = dev;
-	twl_dev->cdev.ops = &twl_fops;
+	twl_dev->core.cdev.name = DRIVERNAME;
+	twl_dev->core.client = to_i2c_client(dev);
+	twl_dev->core.cdev.size = 1024;
+	twl_dev->core.cdev.dev = dev;
+	twl_dev->core.cdev.ops = &twl_fops;
 
-	devfs_create(&twl_dev->cdev);
+	devfs_create(&(twl_dev->core.cdev));
 
 	return 0;
 }
@@ -179,8 +53,8 @@ static struct driver_d twl_driver = {
 
 static int twl_init(void)
 {
-        register_driver(&twl_driver);
-        return 0;
+	register_driver(&twl_driver);
+	return 0;
 }
 
 device_initcall(twl_init);