[ARM] Turn ARM RiscPC PCF8583 i2c RTC driver into a proper module (1d1fd66c) · Commits · e / devices / android_kernel_fairphone_FP5

drivers/acorn/char/pcf8583.c

+63 −17

Original line number	Original line	Diff line number	Diff line
	@@ -9,6 +9,7 @@
	*		*
	* Driver for PCF8583 RTC & RAM chip		* Driver for PCF8583 RTC & RAM chip
	*/		*/
			#include <linux/module.h>
	#include <linux/i2c.h>		#include <linux/i2c.h>
	#include <linux/slab.h>		#include <linux/slab.h>
	#include <linux/string.h>		#include <linux/string.h>
	@@ -32,7 +33,8 @@ static struct i2c_client_address_data addr_data = {
	.forces = forces,		.forces = forces,
	};		};

	#define DAT(x) ((unsigned int)(x->dev.driver_data))		#define set_ctrl(x, v) i2c_set_clientdata(x, (void *)(unsigned int)(v))
			#define get_ctrl(x) ((unsigned int)i2c_get_clientdata(x))

	static int		static int
	pcf8583_attach(struct i2c_adapter *adap, int addr, int kind)		pcf8583_attach(struct i2c_adapter *adap, int addr, int kind)
	@@ -40,8 +42,17 @@ pcf8583_attach(struct i2c_adapter *adap, int addr, int kind)
	struct i2c_client *c;		struct i2c_client *c;
	unsigned char buf[1], ad[1] = { 0 };		unsigned char buf[1], ad[1] = { 0 };
	struct i2c_msg msgs[2] = {		struct i2c_msg msgs[2] = {
	{ addr, 0, 1, ad },		{
	{ addr, I2C_M_RD, 1, buf }		.addr = addr,
			.flags = 0,
			.len = 1,
			.buf = ad,
			}, {
			.addr = addr,
			.flags = I2C_M_RD,
			.len = 1,
			.buf = buf,
			}
	};		};

	c = kmalloc(sizeof(*c), GFP_KERNEL);		c = kmalloc(sizeof(*c), GFP_KERNEL);
	@@ -54,7 +65,7 @@ pcf8583_attach(struct i2c_adapter *adap, int addr, int kind)
	c->driver = &pcf8583_driver;		c->driver = &pcf8583_driver;

	if (i2c_transfer(c->adapter, msgs, 2) == 2)		if (i2c_transfer(c->adapter, msgs, 2) == 2)
	DAT(c) = buf[0];		set_ctrl(c, buf[0]);

	return i2c_attach_client(c);		return i2c_attach_client(c);
	}		}
	@@ -78,8 +89,17 @@ pcf8583_get_datetime(struct i2c_client client, struct rtc_tm dt)
	{		{
	unsigned char buf[8], addr[1] = { 1 };		unsigned char buf[8], addr[1] = { 1 };
	struct i2c_msg msgs[2] = {		struct i2c_msg msgs[2] = {
	{ client->addr, 0, 1, addr },		{
	{ client->addr, I2C_M_RD, 6, buf }		.addr = client->addr,
			.flags = 0,
			.len = 1,
			.buf = addr,
			}, {
			.addr = client->addr,
			.flags = I2C_M_RD,
			.len = 6,
			.buf = buf,
			}
	};		};
	int ret = -EIO;		int ret = -EIO;

	@@ -113,7 +133,7 @@ pcf8583_set_datetime(struct i2c_client client, struct rtc_tm dt, int datetoo)
	int ret, len = 6;		int ret, len = 6;

	buf[0] = 0;		buf[0] = 0;
	buf[1] = DAT(client) \| 0x80;		buf[1] = get_ctrl(client) \| 0x80;
	buf[2] = BIN_TO_BCD(dt->cs);		buf[2] = BIN_TO_BCD(dt->cs);
	buf[3] = BIN_TO_BCD(dt->secs);		buf[3] = BIN_TO_BCD(dt->secs);
	buf[4] = BIN_TO_BCD(dt->mins);		buf[4] = BIN_TO_BCD(dt->mins);
	@@ -129,7 +149,7 @@ pcf8583_set_datetime(struct i2c_client client, struct rtc_tm dt, int datetoo)
	if (ret == len)		if (ret == len)
	ret = 0;		ret = 0;

	buf[1] = DAT(client);		buf[1] = get_ctrl(client);
	i2c_master_send(client, (char *)buf, 2);		i2c_master_send(client, (char *)buf, 2);

	return ret;		return ret;
	@@ -138,7 +158,7 @@ pcf8583_set_datetime(struct i2c_client client, struct rtc_tm dt, int datetoo)
	static int		static int
	pcf8583_get_ctrl(struct i2c_client client, unsigned char ctrl)		pcf8583_get_ctrl(struct i2c_client client, unsigned char ctrl)
	{		{
	*ctrl = DAT(client);		*ctrl = get_ctrl(client);
	return 0;		return 0;
	}		}

	@@ -149,7 +169,7 @@ pcf8583_set_ctrl(struct i2c_client client, unsigned char ctrl)

	buf[0] = 0;		buf[0] = 0;
	buf[1] = *ctrl;		buf[1] = *ctrl;
	DAT(client) = *ctrl;		set_ctrl(client, *ctrl);

	return i2c_master_send(client, (char *)buf, 2);		return i2c_master_send(client, (char *)buf, 2);
	}		}
	@@ -159,15 +179,23 @@ pcf8583_read_mem(struct i2c_client client, struct mem mem)
	{		{
	unsigned char addr[1];		unsigned char addr[1];
	struct i2c_msg msgs[2] = {		struct i2c_msg msgs[2] = {
	{ client->addr, 0, 1, addr },		{
	{ client->addr, I2C_M_RD, 0, mem->data }		.addr = client->addr,
			.flags = 0,
			.len = 1,
			.buf = addr,
			}, {
			.addr = client->addr,
			.flags = I2C_M_RD,
			.len = mem->nr,
			.buf = mem->data,
			}
	};		};

	if (mem->loc < 8)		if (mem->loc < 8)
	return -EINVAL;		return -EINVAL;

	addr[0] = mem->loc;		addr[0] = mem->loc;
	msgs[1].len = mem->nr;

	return i2c_transfer(client->adapter, msgs, 2) == 2 ? 0 : -EIO;		return i2c_transfer(client->adapter, msgs, 2) == 2 ? 0 : -EIO;
	}		}
	@@ -177,15 +205,23 @@ pcf8583_write_mem(struct i2c_client client, struct mem mem)
	{		{
	unsigned char addr[1];		unsigned char addr[1];
	struct i2c_msg msgs[2] = {		struct i2c_msg msgs[2] = {
	{ client->addr, 0, 1, addr },		{
	{ client->addr, 0, 0, mem->data }		.addr = client->addr,
			.flags = 0,
			.len = 1,
			.buf = addr,
			}, {
			.addr = client->addr,
			.flags = I2C_M_NOSTART,
			.len = mem->nr,
			.buf = mem->data,
			}
	};		};

	if (mem->loc < 8)		if (mem->loc < 8)
	return -EINVAL;		return -EINVAL;

	addr[0] = mem->loc;		addr[0] = mem->loc;
	msgs[1].len = mem->nr;

	return i2c_transfer(client->adapter, msgs, 2) == 2 ? 0 : -EIO;		return i2c_transfer(client->adapter, msgs, 2) == 2 ? 0 : -EIO;
	}		}
	@@ -234,4 +270,14 @@ static __init int pcf8583_init(void)
	return i2c_add_driver(&pcf8583_driver);		return i2c_add_driver(&pcf8583_driver);
	}		}

	__initcall(pcf8583_init);		static __exit void pcf8583_exit(void)
			{
			i2c_del_driver(&pcf8583_driver);
			}

			module_init(pcf8583_init);
			module_exit(pcf8583_exit);

			MODULE_AUTHOR("Russell King");
			MODULE_DESCRIPTION("PCF8583 I2C RTC driver");
			MODULE_LICENSE("GPL");