Commit 94389b28 authored by Alexandre Belloni's avatar Alexandre Belloni

rtc: rx8581: switch to regmap

Switch to regmap to simplify handling block read/write.
Signed-off-by: default avatarAlexandre Belloni <alexandre.belloni@bootlin.com>
parent 6e6111f6
...@@ -15,6 +15,7 @@ ...@@ -15,6 +15,7 @@
#include <linux/module.h> #include <linux/module.h>
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/bcd.h> #include <linux/bcd.h>
#include <linux/regmap.h>
#include <linux/rtc.h> #include <linux/rtc.h>
#include <linux/log2.h> #include <linux/log2.h>
...@@ -51,42 +52,10 @@ ...@@ -51,42 +52,10 @@
#define RX8581_CTRL_RESET 0x01 /* RESET bit */ #define RX8581_CTRL_RESET 0x01 /* RESET bit */
struct rx8581 { struct rx8581 {
struct i2c_client *client; struct regmap *regmap;
struct rtc_device *rtc; struct rtc_device *rtc;
s32 (*read_block_data)(const struct i2c_client *client, u8 command,
u8 length, u8 *values);
s32 (*write_block_data)(const struct i2c_client *client, u8 command,
u8 length, const u8 *values);
}; };
static int rx8581_read_block_data(const struct i2c_client *client, u8 command,
u8 length, u8 *values)
{
s32 i, data;
for (i = 0; i < length; i++) {
data = i2c_smbus_read_byte_data(client, command + i);
if (data < 0)
return data;
values[i] = data;
}
return i;
}
static int rx8581_write_block_data(const struct i2c_client *client, u8 command,
u8 length, const u8 *values)
{
s32 i, ret;
for (i = 0; i < length; i++) {
ret = i2c_smbus_write_byte_data(client, command + i,
values[i]);
if (ret < 0)
return ret;
}
return length;
}
/* /*
* In the routines that deal directly with the rx8581 hardware, we use * In the routines that deal directly with the rx8581 hardware, we use
* rtc_time -- month 0-11, hour 0-23, yr = calendar year-epoch. * rtc_time -- month 0-11, hour 0-23, yr = calendar year-epoch.
...@@ -95,7 +64,8 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm) ...@@ -95,7 +64,8 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm)
{ {
struct i2c_client *client = to_i2c_client(dev); struct i2c_client *client = to_i2c_client(dev);
unsigned char date[7]; unsigned char date[7];
int data, err; unsigned int data;
int err;
struct rx8581 *rx8581 = i2c_get_clientdata(client); struct rx8581 *rx8581 = i2c_get_clientdata(client);
/* First we ensure that the "update flag" is not set, we read the /* First we ensure that the "update flag" is not set, we read the
...@@ -103,11 +73,9 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm) ...@@ -103,11 +73,9 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm)
* has been set, we know that the time has changed during the read so * has been set, we know that the time has changed during the read so
* we repeat the whole process again. * we repeat the whole process again.
*/ */
data = i2c_smbus_read_byte_data(client, RX8581_REG_FLAG); err = regmap_read(rx8581->regmap, RX8581_REG_FLAG, &data);
if (data < 0) { if (err < 0)
dev_err(dev, "Unable to read device flags\n"); return err;
return -EIO;
}
if (data & RX8581_FLAG_VLF) { if (data & RX8581_FLAG_VLF) {
dev_warn(dev, dev_warn(dev,
...@@ -118,28 +86,22 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm) ...@@ -118,28 +86,22 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm)
do { do {
/* If update flag set, clear it */ /* If update flag set, clear it */
if (data & RX8581_FLAG_UF) { if (data & RX8581_FLAG_UF) {
err = i2c_smbus_write_byte_data(client, err = regmap_write(rx8581->regmap, RX8581_REG_FLAG,
RX8581_REG_FLAG, (data & ~RX8581_FLAG_UF)); data & ~RX8581_FLAG_UF);
if (err != 0) { if (err < 0)
dev_err(dev, "Unable to write device flags\n"); return err;
return -EIO;
}
} }
/* Now read time and date */ /* Now read time and date */
err = rx8581->read_block_data(client, RX8581_REG_SC, err = regmap_bulk_read(rx8581->regmap, RX8581_REG_SC, date,
7, date); sizeof(date));
if (err < 0) { if (err < 0)
dev_err(dev, "Unable to read date\n"); return err;
return -EIO;
}
/* Check flag register */ /* Check flag register */
data = i2c_smbus_read_byte_data(client, RX8581_REG_FLAG); err = regmap_read(rx8581->regmap, RX8581_REG_FLAG, &data);
if (data < 0) { if (err < 0)
dev_err(dev, "Unable to read device flags\n"); return err;
return -EIO;
}
} while (data & RX8581_FLAG_UF); } while (data & RX8581_FLAG_UF);
dev_dbg(dev, "%s: raw data is sec=%02x, min=%02x, hr=%02x, " dev_dbg(dev, "%s: raw data is sec=%02x, min=%02x, hr=%02x, "
...@@ -167,7 +129,7 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm) ...@@ -167,7 +129,7 @@ static int rx8581_rtc_read_time(struct device *dev, struct rtc_time *tm)
static int rx8581_rtc_set_time(struct device *dev, struct rtc_time *tm) static int rx8581_rtc_set_time(struct device *dev, struct rtc_time *tm)
{ {
struct i2c_client *client = to_i2c_client(dev); struct i2c_client *client = to_i2c_client(dev);
int data, err; int err;
unsigned char buf[7]; unsigned char buf[7];
struct rx8581 *rx8581 = i2c_get_clientdata(client); struct rx8581 *rx8581 = i2c_get_clientdata(client);
...@@ -192,55 +154,26 @@ static int rx8581_rtc_set_time(struct device *dev, struct rtc_time *tm) ...@@ -192,55 +154,26 @@ static int rx8581_rtc_set_time(struct device *dev, struct rtc_time *tm)
buf[RX8581_REG_DW] = (0x1 << tm->tm_wday); buf[RX8581_REG_DW] = (0x1 << tm->tm_wday);
/* Stop the clock */ /* Stop the clock */
data = i2c_smbus_read_byte_data(client, RX8581_REG_CTRL); err = regmap_update_bits(rx8581->regmap, RX8581_REG_CTRL,
if (data < 0) { RX8581_CTRL_STOP, RX8581_CTRL_STOP);
dev_err(dev, "Unable to read control register\n"); if (err < 0)
return -EIO; return err;
}
err = i2c_smbus_write_byte_data(client, RX8581_REG_CTRL,
(data | RX8581_CTRL_STOP));
if (err < 0) {
dev_err(dev, "Unable to write control register\n");
return -EIO;
}
/* write register's data */ /* write register's data */
err = rx8581->write_block_data(client, RX8581_REG_SC, 7, buf); err = regmap_bulk_write(rx8581->regmap, RX8581_REG_SC,
if (err < 0) { buf, sizeof(buf));
dev_err(dev, "Unable to write to date registers\n"); if (err < 0)
return -EIO; return err;
}
/* get VLF and clear it */ /* get VLF and clear it */
data = i2c_smbus_read_byte_data(client, RX8581_REG_FLAG); err = regmap_update_bits(rx8581->regmap, RX8581_REG_FLAG,
if (data < 0) { RX8581_FLAG_VLF, 0);
dev_err(dev, "Unable to read flag register\n"); if (err < 0)
return -EIO; return err;
}
err = i2c_smbus_write_byte_data(client, RX8581_REG_FLAG,
(data & ~(RX8581_FLAG_VLF)));
if (err != 0) {
dev_err(dev, "Unable to write flag register\n");
return -EIO;
}
/* Restart the clock */ /* Restart the clock */
data = i2c_smbus_read_byte_data(client, RX8581_REG_CTRL); return regmap_update_bits(rx8581->regmap, RX8581_REG_CTRL,
if (data < 0) { RX8581_CTRL_STOP, 0);
dev_err(dev, "Unable to read control register\n");
return -EIO;
}
err = i2c_smbus_write_byte_data(client, RX8581_REG_CTRL,
(data & ~(RX8581_CTRL_STOP)));
if (err != 0) {
dev_err(dev, "Unable to write control register\n");
return -EIO;
}
return 0;
} }
static const struct rtc_class_ops rx8581_rtc_ops = { static const struct rtc_class_ops rx8581_rtc_ops = {
...@@ -252,27 +185,23 @@ static int rx8581_probe(struct i2c_client *client, ...@@ -252,27 +185,23 @@ static int rx8581_probe(struct i2c_client *client,
const struct i2c_device_id *id) const struct i2c_device_id *id)
{ {
struct rx8581 *rx8581; struct rx8581 *rx8581;
static const struct regmap_config config = {
.reg_bits = 8,
.val_bits = 8,
.max_register = 0xf,
};
dev_dbg(&client->dev, "%s\n", __func__); dev_dbg(&client->dev, "%s\n", __func__);
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)
&& !i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK))
return -EIO;
rx8581 = devm_kzalloc(&client->dev, sizeof(struct rx8581), GFP_KERNEL); rx8581 = devm_kzalloc(&client->dev, sizeof(struct rx8581), GFP_KERNEL);
if (!rx8581) if (!rx8581)
return -ENOMEM; return -ENOMEM;
i2c_set_clientdata(client, rx8581); i2c_set_clientdata(client, rx8581);
rx8581->client = client;
rx8581->regmap = devm_regmap_init_i2c(client, &config);
if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) { if (IS_ERR(rx8581->regmap))
rx8581->read_block_data = i2c_smbus_read_i2c_block_data; return PTR_ERR(rx8581->regmap);
rx8581->write_block_data = i2c_smbus_write_i2c_block_data;
} else {
rx8581->read_block_data = rx8581_read_block_data;
rx8581->write_block_data = rx8581_write_block_data;
}
rx8581->rtc = devm_rtc_allocate_device(&client->dev); rx8581->rtc = devm_rtc_allocate_device(&client->dev);
if (IS_ERR(rx8581->rtc)) if (IS_ERR(rx8581->rtc))
......
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