Commit 1d1fd66c authored by Russell King's avatar Russell King Committed by Russell King

[ARM] Turn ARM RiscPC PCF8583 i2c RTC driver into a proper module

Signed-off-by: default avatarRussell King <rmk+kernel@arm.linux.org.uk>
parent b4c2803c
...@@ -9,6 +9,7 @@ ...@@ -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 = { ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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");
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment