rtc: rv3029: drop rv3029_read_regs and rv3029_write_regs
rv3029_read_regs and rv3029_write_regs are simply calling regmap_bulk_{read,write}. Drop them and call regmap_{,bulk}_{read,write} as appropriate. Link: https://lore.kernel.org/r/20191214221022.622482-10-alexandre.belloni@bootlin.com Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com>
This commit is contained in:
@@ -121,22 +121,6 @@ struct rv3029_data {
|
|||||||
int irq;
|
int irq;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int rv3029_read_regs(struct device *dev, u8 reg, u8 *buf,
|
|
||||||
unsigned int len)
|
|
||||||
{
|
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
|
||||||
|
|
||||||
return regmap_bulk_read(rv3029->regmap, reg, buf, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rv3029_write_regs(struct device *dev, u8 reg, u8 const buf[],
|
|
||||||
unsigned int len)
|
|
||||||
{
|
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
|
||||||
|
|
||||||
return regmap_bulk_write(rv3029->regmap, reg, buf, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rv3029_eeprom_busywait(struct rv3029_data *rv3029)
|
static int rv3029_eeprom_busywait(struct rv3029_data *rv3029)
|
||||||
{
|
{
|
||||||
unsigned int sr;
|
unsigned int sr;
|
||||||
@@ -158,19 +142,16 @@ static int rv3029_eeprom_busywait(struct rv3029_data *rv3029)
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rv3029_eeprom_exit(struct device *dev)
|
static int rv3029_eeprom_exit(struct rv3029_data *rv3029)
|
||||||
{
|
{
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
|
||||||
|
|
||||||
/* Re-enable eeprom refresh */
|
/* Re-enable eeprom refresh */
|
||||||
return regmap_update_bits(rv3029->regmap, RV3029_ONOFF_CTRL,
|
return regmap_update_bits(rv3029->regmap, RV3029_ONOFF_CTRL,
|
||||||
RV3029_ONOFF_CTRL_EERE,
|
RV3029_ONOFF_CTRL_EERE,
|
||||||
RV3029_ONOFF_CTRL_EERE);
|
RV3029_ONOFF_CTRL_EERE);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rv3029_eeprom_enter(struct device *dev)
|
static int rv3029_eeprom_enter(struct rv3029_data *rv3029)
|
||||||
{
|
{
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
|
||||||
unsigned int sr;
|
unsigned int sr;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
@@ -192,7 +173,7 @@ static int rv3029_eeprom_enter(struct device *dev)
|
|||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
if (sr & (RV3029_STATUS_VLOW1 | RV3029_STATUS_VLOW2)) {
|
if (sr & (RV3029_STATUS_VLOW1 | RV3029_STATUS_VLOW2)) {
|
||||||
dev_err(dev,
|
dev_err(rv3029->dev,
|
||||||
"Supply voltage is too low to safely access the EEPROM.\n");
|
"Supply voltage is too low to safely access the EEPROM.\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
@@ -207,47 +188,47 @@ static int rv3029_eeprom_enter(struct device *dev)
|
|||||||
/* Wait for any previous eeprom accesses to finish. */
|
/* Wait for any previous eeprom accesses to finish. */
|
||||||
ret = rv3029_eeprom_busywait(rv3029);
|
ret = rv3029_eeprom_busywait(rv3029);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
rv3029_eeprom_exit(dev);
|
rv3029_eeprom_exit(rv3029);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rv3029_eeprom_read(struct device *dev, u8 reg,
|
static int rv3029_eeprom_read(struct rv3029_data *rv3029, u8 reg,
|
||||||
u8 buf[], size_t len)
|
u8 buf[], size_t len)
|
||||||
{
|
{
|
||||||
int ret, err;
|
int ret, err;
|
||||||
|
|
||||||
err = rv3029_eeprom_enter(dev);
|
err = rv3029_eeprom_enter(rv3029);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, reg, buf, len);
|
ret = regmap_bulk_read(rv3029->regmap, reg, buf, len);
|
||||||
|
|
||||||
err = rv3029_eeprom_exit(dev);
|
err = rv3029_eeprom_exit(rv3029);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rv3029_eeprom_write(struct device *dev, u8 reg,
|
static int rv3029_eeprom_write(struct rv3029_data *rv3029, u8 reg,
|
||||||
u8 const buf[], size_t len)
|
u8 const buf[], size_t len)
|
||||||
{
|
{
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
unsigned int tmp;
|
||||||
int ret, err;
|
int ret, err;
|
||||||
size_t i;
|
size_t i;
|
||||||
u8 tmp;
|
|
||||||
|
|
||||||
err = rv3029_eeprom_enter(dev);
|
err = rv3029_eeprom_enter(rv3029);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
|
||||||
for (i = 0; i < len; i++, reg++) {
|
for (i = 0; i < len; i++, reg++) {
|
||||||
ret = rv3029_read_regs(dev, reg, &tmp, 1);
|
ret = regmap_read(rv3029->regmap, reg, &tmp);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
break;
|
break;
|
||||||
if (tmp != buf[i]) {
|
if (tmp != buf[i]) {
|
||||||
ret = rv3029_write_regs(dev, reg, &buf[i], 1);
|
tmp = buf[i];
|
||||||
|
ret = regmap_write(rv3029->regmap, reg, tmp);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
@@ -256,25 +237,25 @@ static int rv3029_eeprom_write(struct device *dev, u8 reg,
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
err = rv3029_eeprom_exit(dev);
|
err = rv3029_eeprom_exit(rv3029);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rv3029_eeprom_update_bits(struct device *dev,
|
static int rv3029_eeprom_update_bits(struct rv3029_data *rv3029,
|
||||||
u8 reg, u8 mask, u8 set)
|
u8 reg, u8 mask, u8 set)
|
||||||
{
|
{
|
||||||
u8 buf;
|
u8 buf;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = rv3029_eeprom_read(dev, reg, &buf, 1);
|
ret = rv3029_eeprom_read(rv3029, reg, &buf, 1);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
buf &= ~mask;
|
buf &= ~mask;
|
||||||
buf |= set & mask;
|
buf |= set & mask;
|
||||||
ret = rv3029_eeprom_write(dev, reg, &buf, 1);
|
ret = rv3029_eeprom_write(rv3029, reg, &buf, 1);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
@@ -286,20 +267,20 @@ static irqreturn_t rv3029_handle_irq(int irq, void *dev_id)
|
|||||||
struct device *dev = dev_id;
|
struct device *dev = dev_id;
|
||||||
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
struct mutex *lock = &rv3029->rtc->ops_lock;
|
struct mutex *lock = &rv3029->rtc->ops_lock;
|
||||||
|
unsigned int flags, controls;
|
||||||
unsigned long events = 0;
|
unsigned long events = 0;
|
||||||
u8 flags, controls;
|
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
mutex_lock(lock);
|
mutex_lock(lock);
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_IRQ_CTRL, &controls, 1);
|
ret = regmap_read(rv3029->regmap, RV3029_IRQ_CTRL, &controls);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_warn(dev, "Read IRQ Control Register error %d\n", ret);
|
dev_warn(dev, "Read IRQ Control Register error %d\n", ret);
|
||||||
mutex_unlock(lock);
|
mutex_unlock(lock);
|
||||||
return IRQ_NONE;
|
return IRQ_NONE;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_IRQ_FLAGS, &flags, 1);
|
ret = regmap_read(rv3029->regmap, RV3029_IRQ_FLAGS, &flags);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_warn(dev, "Read IRQ Flags Register error %d\n", ret);
|
dev_warn(dev, "Read IRQ Flags Register error %d\n", ret);
|
||||||
mutex_unlock(lock);
|
mutex_unlock(lock);
|
||||||
@@ -314,8 +295,8 @@ static irqreturn_t rv3029_handle_irq(int irq, void *dev_id)
|
|||||||
|
|
||||||
if (events) {
|
if (events) {
|
||||||
rtc_update_irq(rv3029->rtc, 1, events);
|
rtc_update_irq(rv3029->rtc, 1, events);
|
||||||
rv3029_write_regs(dev, RV3029_IRQ_FLAGS, &flags, 1);
|
regmap_write(rv3029->regmap, RV3029_IRQ_FLAGS, flags);
|
||||||
rv3029_write_regs(dev, RV3029_IRQ_CTRL, &controls, 1);
|
regmap_write(rv3029->regmap, RV3029_IRQ_CTRL, controls);
|
||||||
}
|
}
|
||||||
mutex_unlock(lock);
|
mutex_unlock(lock);
|
||||||
|
|
||||||
@@ -324,10 +305,11 @@ static irqreturn_t rv3029_handle_irq(int irq, void *dev_id)
|
|||||||
|
|
||||||
static int rv3029_read_time(struct device *dev, struct rtc_time *tm)
|
static int rv3029_read_time(struct device *dev, struct rtc_time *tm)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
int ret;
|
int ret;
|
||||||
u8 regs[RV3029_WATCH_SECTION_LEN] = { 0, };
|
u8 regs[RV3029_WATCH_SECTION_LEN] = { 0, };
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_W_SEC, regs,
|
ret = regmap_bulk_read(rv3029->regmap, RV3029_W_SEC, regs,
|
||||||
RV3029_WATCH_SECTION_LEN);
|
RV3029_WATCH_SECTION_LEN);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%s: reading RTC section failed\n", __func__);
|
dev_err(dev, "%s: reading RTC section failed\n", __func__);
|
||||||
@@ -360,24 +342,25 @@ static int rv3029_read_time(struct device *dev, struct rtc_time *tm)
|
|||||||
|
|
||||||
static int rv3029_read_alarm(struct device *dev, struct rtc_wkalrm *alarm)
|
static int rv3029_read_alarm(struct device *dev, struct rtc_wkalrm *alarm)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
struct rtc_time *const tm = &alarm->time;
|
struct rtc_time *const tm = &alarm->time;
|
||||||
|
unsigned int controls, flags;
|
||||||
int ret;
|
int ret;
|
||||||
u8 regs[8], controls, flags;
|
u8 regs[8];
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_A_SC, regs,
|
ret = regmap_bulk_read(rv3029->regmap, RV3029_A_SC, regs,
|
||||||
RV3029_ALARM_SECTION_LEN);
|
RV3029_ALARM_SECTION_LEN);
|
||||||
|
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%s: reading alarm section failed\n", __func__);
|
dev_err(dev, "%s: reading alarm section failed\n", __func__);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_IRQ_CTRL, &controls, 1);
|
ret = regmap_read(rv3029->regmap, RV3029_IRQ_CTRL, &controls);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(dev, "Read IRQ Control Register error %d\n", ret);
|
dev_err(dev, "Read IRQ Control Register error %d\n", ret);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
ret = rv3029_read_regs(dev, RV3029_IRQ_FLAGS, &flags, 1);
|
ret = regmap_read(rv3029->regmap, RV3029_IRQ_FLAGS, &flags);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "Read IRQ Flags Register error %d\n", ret);
|
dev_err(dev, "Read IRQ Flags Register error %d\n", ret);
|
||||||
return ret;
|
return ret;
|
||||||
@@ -408,6 +391,7 @@ static int rv3029_alarm_irq_enable(struct device *dev, unsigned int enable)
|
|||||||
|
|
||||||
static int rv3029_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
|
static int rv3029_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
struct rtc_time *const tm = &alarm->time;
|
struct rtc_time *const tm = &alarm->time;
|
||||||
int ret;
|
int ret;
|
||||||
u8 regs[8];
|
u8 regs[8];
|
||||||
@@ -435,7 +419,7 @@ static int rv3029_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
|
|||||||
| RV3029_A_AE_X;
|
| RV3029_A_AE_X;
|
||||||
|
|
||||||
/* Write the alarm */
|
/* Write the alarm */
|
||||||
ret = rv3029_write_regs(dev, RV3029_A_SC, regs,
|
ret = regmap_bulk_write(rv3029->regmap, RV3029_A_SC, regs,
|
||||||
RV3029_ALARM_SECTION_LEN);
|
RV3029_ALARM_SECTION_LEN);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
@@ -465,7 +449,7 @@ static int rv3029_set_time(struct device *dev, struct rtc_time *tm)
|
|||||||
regs[RV3029_W_DAYS - RV3029_W_SEC] = bin2bcd(tm->tm_wday + 1) & 0x7;
|
regs[RV3029_W_DAYS - RV3029_W_SEC] = bin2bcd(tm->tm_wday + 1) & 0x7;
|
||||||
regs[RV3029_W_YEARS - RV3029_W_SEC] = bin2bcd(tm->tm_year - 100);
|
regs[RV3029_W_YEARS - RV3029_W_SEC] = bin2bcd(tm->tm_year - 100);
|
||||||
|
|
||||||
ret = rv3029_write_regs(dev, RV3029_W_SEC, regs,
|
ret = regmap_bulk_write(rv3029->regmap, RV3029_W_SEC, regs,
|
||||||
RV3029_WATCH_SECTION_LEN);
|
RV3029_WATCH_SECTION_LEN);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
@@ -534,6 +518,7 @@ static const struct rv3029_trickle_tab_elem {
|
|||||||
|
|
||||||
static void rv3029_trickle_config(struct device *dev)
|
static void rv3029_trickle_config(struct device *dev)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
struct device_node *of_node = dev->of_node;
|
struct device_node *of_node = dev->of_node;
|
||||||
const struct rv3029_trickle_tab_elem *elem;
|
const struct rv3029_trickle_tab_elem *elem;
|
||||||
int i, err;
|
int i, err;
|
||||||
@@ -560,7 +545,7 @@ static void rv3029_trickle_config(struct device *dev)
|
|||||||
"Trickle charger enabled at %d ohms resistance.\n",
|
"Trickle charger enabled at %d ohms resistance.\n",
|
||||||
elem->r);
|
elem->r);
|
||||||
}
|
}
|
||||||
err = rv3029_eeprom_update_bits(dev, RV3029_CONTROL_E2P_EECTRL,
|
err = rv3029_eeprom_update_bits(rv3029, RV3029_CONTROL_E2P_EECTRL,
|
||||||
RV3029_TRICKLE_MASK,
|
RV3029_TRICKLE_MASK,
|
||||||
trickle_set_bits);
|
trickle_set_bits);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
@@ -569,12 +554,12 @@ static void rv3029_trickle_config(struct device *dev)
|
|||||||
|
|
||||||
#ifdef CONFIG_RTC_DRV_RV3029_HWMON
|
#ifdef CONFIG_RTC_DRV_RV3029_HWMON
|
||||||
|
|
||||||
static int rv3029_read_temp(struct device *dev, int *temp_mC)
|
static int rv3029_read_temp(struct rv3029_data *rv3029, int *temp_mC)
|
||||||
{
|
{
|
||||||
|
unsigned int temp;
|
||||||
int ret;
|
int ret;
|
||||||
u8 temp;
|
|
||||||
|
|
||||||
ret = rv3029_read_regs(dev, RV3029_TEMP_PAGE, &temp, 1);
|
ret = regmap_read(rv3029->regmap, RV3029_TEMP_PAGE, &temp);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
@@ -587,9 +572,10 @@ static ssize_t rv3029_hwmon_show_temp(struct device *dev,
|
|||||||
struct device_attribute *attr,
|
struct device_attribute *attr,
|
||||||
char *buf)
|
char *buf)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
int ret, temp_mC;
|
int ret, temp_mC;
|
||||||
|
|
||||||
ret = rv3029_read_temp(dev, &temp_mC);
|
ret = rv3029_read_temp(rv3029, &temp_mC);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
@@ -601,9 +587,10 @@ static ssize_t rv3029_hwmon_set_update_interval(struct device *dev,
|
|||||||
const char *buf,
|
const char *buf,
|
||||||
size_t count)
|
size_t count)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
|
unsigned int th_set_bits = 0;
|
||||||
unsigned long interval_ms;
|
unsigned long interval_ms;
|
||||||
int ret;
|
int ret;
|
||||||
u8 th_set_bits = 0;
|
|
||||||
|
|
||||||
ret = kstrtoul(buf, 10, &interval_ms);
|
ret = kstrtoul(buf, 10, &interval_ms);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
@@ -614,7 +601,7 @@ static ssize_t rv3029_hwmon_set_update_interval(struct device *dev,
|
|||||||
if (interval_ms >= 16000)
|
if (interval_ms >= 16000)
|
||||||
th_set_bits |= RV3029_EECTRL_THP;
|
th_set_bits |= RV3029_EECTRL_THP;
|
||||||
}
|
}
|
||||||
ret = rv3029_eeprom_update_bits(dev, RV3029_CONTROL_E2P_EECTRL,
|
ret = rv3029_eeprom_update_bits(rv3029, RV3029_CONTROL_E2P_EECTRL,
|
||||||
RV3029_EECTRL_THE | RV3029_EECTRL_THP,
|
RV3029_EECTRL_THE | RV3029_EECTRL_THP,
|
||||||
th_set_bits);
|
th_set_bits);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
@@ -627,10 +614,11 @@ static ssize_t rv3029_hwmon_show_update_interval(struct device *dev,
|
|||||||
struct device_attribute *attr,
|
struct device_attribute *attr,
|
||||||
char *buf)
|
char *buf)
|
||||||
{
|
{
|
||||||
|
struct rv3029_data *rv3029 = dev_get_drvdata(dev);
|
||||||
int ret, interval_ms;
|
int ret, interval_ms;
|
||||||
u8 eectrl;
|
u8 eectrl;
|
||||||
|
|
||||||
ret = rv3029_eeprom_read(dev, RV3029_CONTROL_E2P_EECTRL,
|
ret = rv3029_eeprom_read(rv3029, RV3029_CONTROL_E2P_EECTRL,
|
||||||
&eectrl, 1);
|
&eectrl, 1);
|
||||||
if (ret < 0)
|
if (ret < 0)
|
||||||
return ret;
|
return ret;
|
||||||
|
Reference in New Issue
Block a user