Commit 3f7e8275 authored by Rhyland Klein's avatar Rhyland Klein Committed by Samuel Ortiz

mfd: Commonize tps65910 regmap access through header

This change removes the read/write callback functions in favor of common
regmap accessors inside the header file. This change also makes use of
regmap_read/write for single register access which maps better onto what this
driver actually needs.
Signed-off-by: default avatarRhyland Klein <rklein@nvidia.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 7ccfe9b1
...@@ -23,9 +23,9 @@ ...@@ -23,9 +23,9 @@
static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset) static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset)
{ {
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio); struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
uint8_t val; unsigned int val;
tps65910->read(tps65910, TPS65910_GPIO0 + offset, 1, &val); tps65910_reg_read(tps65910, TPS65910_GPIO0 + offset, &val);
if (val & GPIO_STS_MASK) if (val & GPIO_STS_MASK)
return 1; return 1;
...@@ -39,10 +39,10 @@ static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset, ...@@ -39,10 +39,10 @@ static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset,
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio); struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
if (value) if (value)
tps65910_set_bits(tps65910, TPS65910_GPIO0 + offset, tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
GPIO_SET_MASK); GPIO_SET_MASK);
else else
tps65910_clear_bits(tps65910, TPS65910_GPIO0 + offset, tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
GPIO_SET_MASK); GPIO_SET_MASK);
} }
...@@ -54,7 +54,7 @@ static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset, ...@@ -54,7 +54,7 @@ static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset,
/* Set the initial value */ /* Set the initial value */
tps65910_gpio_set(gc, offset, value); tps65910_gpio_set(gc, offset, value);
return tps65910_set_bits(tps65910, TPS65910_GPIO0 + offset, return tps65910_reg_set_bits(tps65910, TPS65910_GPIO0 + offset,
GPIO_CFG_MASK); GPIO_CFG_MASK);
} }
...@@ -62,7 +62,7 @@ static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset) ...@@ -62,7 +62,7 @@ static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset)
{ {
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio); struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
return tps65910_clear_bits(tps65910, TPS65910_GPIO0 + offset, return tps65910_reg_clear_bits(tps65910, TPS65910_GPIO0 + offset,
GPIO_CFG_MASK); GPIO_CFG_MASK);
} }
...@@ -102,7 +102,7 @@ void tps65910_gpio_init(struct tps65910 *tps65910, int gpio_base) ...@@ -102,7 +102,7 @@ void tps65910_gpio_init(struct tps65910 *tps65910, int gpio_base)
int i; int i;
for (i = 0; i < tps65910->gpio.ngpio; ++i) { for (i = 0; i < tps65910->gpio.ngpio; ++i) {
if (board_data->en_gpio_sleep[i]) { if (board_data->en_gpio_sleep[i]) {
ret = tps65910_set_bits(tps65910, ret = tps65910_reg_set_bits(tps65910,
TPS65910_GPIO0 + i, GPIO_SLEEP_MASK); TPS65910_GPIO0 + i, GPIO_SLEEP_MASK);
if (ret < 0) if (ret < 0)
dev_warn(tps65910->dev, dev_warn(tps65910->dev,
......
...@@ -41,28 +41,28 @@ static inline int irq_to_tps65910_irq(struct tps65910 *tps65910, ...@@ -41,28 +41,28 @@ static inline int irq_to_tps65910_irq(struct tps65910 *tps65910,
static irqreturn_t tps65910_irq(int irq, void *irq_data) static irqreturn_t tps65910_irq(int irq, void *irq_data)
{ {
struct tps65910 *tps65910 = irq_data; struct tps65910 *tps65910 = irq_data;
unsigned int reg;
u32 irq_sts; u32 irq_sts;
u32 irq_mask; u32 irq_mask;
u8 reg;
int i; int i;
tps65910->read(tps65910, TPS65910_INT_STS, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_STS, &reg);
irq_sts = reg; irq_sts = reg;
tps65910->read(tps65910, TPS65910_INT_STS2, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_STS2, &reg);
irq_sts |= reg << 8; irq_sts |= reg << 8;
switch (tps65910_chip_id(tps65910)) { switch (tps65910_chip_id(tps65910)) {
case TPS65911: case TPS65911:
tps65910->read(tps65910, TPS65910_INT_STS3, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_STS3, &reg);
irq_sts |= reg << 16; irq_sts |= reg << 16;
} }
tps65910->read(tps65910, TPS65910_INT_MSK, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK, &reg);
irq_mask = reg; irq_mask = reg;
tps65910->read(tps65910, TPS65910_INT_MSK2, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK2, &reg);
irq_mask |= reg << 8; irq_mask |= reg << 8;
switch (tps65910_chip_id(tps65910)) { switch (tps65910_chip_id(tps65910)) {
case TPS65911: case TPS65911:
tps65910->read(tps65910, TPS65910_INT_MSK3, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK3, &reg);
irq_mask |= reg << 16; irq_mask |= reg << 16;
} }
...@@ -82,13 +82,13 @@ static irqreturn_t tps65910_irq(int irq, void *irq_data) ...@@ -82,13 +82,13 @@ static irqreturn_t tps65910_irq(int irq, void *irq_data)
/* Write the STS register back to clear IRQs we handled */ /* Write the STS register back to clear IRQs we handled */
reg = irq_sts & 0xFF; reg = irq_sts & 0xFF;
irq_sts >>= 8; irq_sts >>= 8;
tps65910->write(tps65910, TPS65910_INT_STS, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_STS, reg);
reg = irq_sts & 0xFF; reg = irq_sts & 0xFF;
tps65910->write(tps65910, TPS65910_INT_STS2, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_STS2, reg);
switch (tps65910_chip_id(tps65910)) { switch (tps65910_chip_id(tps65910)) {
case TPS65911: case TPS65911:
reg = irq_sts >> 8; reg = irq_sts >> 8;
tps65910->write(tps65910, TPS65910_INT_STS3, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_STS3, reg);
} }
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -105,27 +105,27 @@ static void tps65910_irq_sync_unlock(struct irq_data *data) ...@@ -105,27 +105,27 @@ static void tps65910_irq_sync_unlock(struct irq_data *data)
{ {
struct tps65910 *tps65910 = irq_data_get_irq_chip_data(data); struct tps65910 *tps65910 = irq_data_get_irq_chip_data(data);
u32 reg_mask; u32 reg_mask;
u8 reg; unsigned int reg;
tps65910->read(tps65910, TPS65910_INT_MSK, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK, &reg);
reg_mask = reg; reg_mask = reg;
tps65910->read(tps65910, TPS65910_INT_MSK2, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK2, &reg);
reg_mask |= reg << 8; reg_mask |= reg << 8;
switch (tps65910_chip_id(tps65910)) { switch (tps65910_chip_id(tps65910)) {
case TPS65911: case TPS65911:
tps65910->read(tps65910, TPS65910_INT_MSK3, 1, &reg); tps65910_reg_read(tps65910, TPS65910_INT_MSK3, &reg);
reg_mask |= reg << 16; reg_mask |= reg << 16;
} }
if (tps65910->irq_mask != reg_mask) { if (tps65910->irq_mask != reg_mask) {
reg = tps65910->irq_mask & 0xFF; reg = tps65910->irq_mask & 0xFF;
tps65910->write(tps65910, TPS65910_INT_MSK, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_MSK, reg);
reg = tps65910->irq_mask >> 8 & 0xFF; reg = tps65910->irq_mask >> 8 & 0xFF;
tps65910->write(tps65910, TPS65910_INT_MSK2, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_MSK2, reg);
switch (tps65910_chip_id(tps65910)) { switch (tps65910_chip_id(tps65910)) {
case TPS65911: case TPS65911:
reg = tps65910->irq_mask >> 16; reg = tps65910->irq_mask >> 16;
tps65910->write(tps65910, TPS65910_INT_MSK3, 1, &reg); tps65910_reg_write(tps65910, TPS65910_INT_MSK3, reg);
} }
} }
mutex_unlock(&tps65910->irq_lock); mutex_unlock(&tps65910->irq_lock);
......
...@@ -37,30 +37,6 @@ static struct mfd_cell tps65910s[] = { ...@@ -37,30 +37,6 @@ static struct mfd_cell tps65910s[] = {
}; };
static int tps65910_i2c_read(struct tps65910 *tps65910, u8 reg,
int bytes, void *dest)
{
return regmap_bulk_read(tps65910->regmap, reg, dest, bytes);
}
static int tps65910_i2c_write(struct tps65910 *tps65910, u8 reg,
int bytes, void *src)
{
return regmap_bulk_write(tps65910->regmap, reg, src, bytes);
}
int tps65910_set_bits(struct tps65910 *tps65910, u8 reg, u8 mask)
{
return regmap_update_bits(tps65910->regmap, reg, mask, mask);
}
EXPORT_SYMBOL_GPL(tps65910_set_bits);
int tps65910_clear_bits(struct tps65910 *tps65910, u8 reg, u8 mask)
{
return regmap_update_bits(tps65910->regmap, reg, mask, 0);
}
EXPORT_SYMBOL_GPL(tps65910_clear_bits);
static bool is_volatile_reg(struct device *dev, unsigned int reg) static bool is_volatile_reg(struct device *dev, unsigned int reg)
{ {
struct tps65910 *tps65910 = dev_get_drvdata(dev); struct tps65910 *tps65910 = dev_get_drvdata(dev);
...@@ -102,7 +78,7 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910, ...@@ -102,7 +78,7 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
return 0; return 0;
/* enabling SLEEP device state */ /* enabling SLEEP device state */
ret = tps65910_set_bits(tps65910, TPS65910_DEVCTRL, ret = tps65910_reg_set_bits(tps65910, TPS65910_DEVCTRL,
DEVCTRL_DEV_SLP_MASK); DEVCTRL_DEV_SLP_MASK);
if (ret < 0) { if (ret < 0) {
dev_err(dev, "set dev_slp failed: %d\n", ret); dev_err(dev, "set dev_slp failed: %d\n", ret);
...@@ -114,7 +90,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910, ...@@ -114,7 +90,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
return 0; return 0;
if (pmic_pdata->slp_keepon->therm_keepon) { if (pmic_pdata->slp_keepon->therm_keepon) {
ret = tps65910_set_bits(tps65910, TPS65910_SLEEP_KEEP_RES_ON, ret = tps65910_reg_set_bits(tps65910,
TPS65910_SLEEP_KEEP_RES_ON,
SLEEP_KEEP_RES_ON_THERM_KEEPON_MASK); SLEEP_KEEP_RES_ON_THERM_KEEPON_MASK);
if (ret < 0) { if (ret < 0) {
dev_err(dev, "set therm_keepon failed: %d\n", ret); dev_err(dev, "set therm_keepon failed: %d\n", ret);
...@@ -123,7 +100,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910, ...@@ -123,7 +100,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
} }
if (pmic_pdata->slp_keepon->clkout32k_keepon) { if (pmic_pdata->slp_keepon->clkout32k_keepon) {
ret = tps65910_set_bits(tps65910, TPS65910_SLEEP_KEEP_RES_ON, ret = tps65910_reg_set_bits(tps65910,
TPS65910_SLEEP_KEEP_RES_ON,
SLEEP_KEEP_RES_ON_CLKOUT32K_KEEPON_MASK); SLEEP_KEEP_RES_ON_CLKOUT32K_KEEPON_MASK);
if (ret < 0) { if (ret < 0) {
dev_err(dev, "set clkout32k_keepon failed: %d\n", ret); dev_err(dev, "set clkout32k_keepon failed: %d\n", ret);
...@@ -132,7 +110,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910, ...@@ -132,7 +110,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
} }
if (pmic_pdata->slp_keepon->i2chs_keepon) { if (pmic_pdata->slp_keepon->i2chs_keepon) {
ret = tps65910_set_bits(tps65910, TPS65910_SLEEP_KEEP_RES_ON, ret = tps65910_reg_set_bits(tps65910,
TPS65910_SLEEP_KEEP_RES_ON,
SLEEP_KEEP_RES_ON_I2CHS_KEEPON_MASK); SLEEP_KEEP_RES_ON_I2CHS_KEEPON_MASK);
if (ret < 0) { if (ret < 0) {
dev_err(dev, "set i2chs_keepon failed: %d\n", ret); dev_err(dev, "set i2chs_keepon failed: %d\n", ret);
...@@ -143,7 +122,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910, ...@@ -143,7 +122,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
return 0; return 0;
disable_dev_slp: disable_dev_slp:
tps65910_clear_bits(tps65910, TPS65910_DEVCTRL, DEVCTRL_DEV_SLP_MASK); tps65910_reg_clear_bits(tps65910, TPS65910_DEVCTRL,
DEVCTRL_DEV_SLP_MASK);
err_sleep_init: err_sleep_init:
return ret; return ret;
...@@ -176,8 +156,6 @@ static __devinit int tps65910_i2c_probe(struct i2c_client *i2c, ...@@ -176,8 +156,6 @@ static __devinit int tps65910_i2c_probe(struct i2c_client *i2c,
tps65910->dev = &i2c->dev; tps65910->dev = &i2c->dev;
tps65910->i2c_client = i2c; tps65910->i2c_client = i2c;
tps65910->id = id->driver_data; tps65910->id = id->driver_data;
tps65910->read = tps65910_i2c_read;
tps65910->write = tps65910_i2c_write;
mutex_init(&tps65910->io_mutex); mutex_init(&tps65910->io_mutex);
tps65910->regmap = regmap_init_i2c(i2c, &tps65910_regmap_config); tps65910->regmap = regmap_init_i2c(i2c, &tps65910_regmap_config);
......
...@@ -331,21 +331,16 @@ struct tps65910_reg { ...@@ -331,21 +331,16 @@ struct tps65910_reg {
static inline int tps65910_read(struct tps65910_reg *pmic, u8 reg) static inline int tps65910_read(struct tps65910_reg *pmic, u8 reg)
{ {
u8 val; unsigned int val;
int err; int err;
err = pmic->mfd->read(pmic->mfd, reg, 1, &val); err = tps65910_reg_read(pmic->mfd, reg, &val);
if (err) if (err)
return err; return err;
return val; return val;
} }
static inline int tps65910_write(struct tps65910_reg *pmic, u8 reg, u8 val)
{
return pmic->mfd->write(pmic->mfd, reg, 1, &val);
}
static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg, static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg,
u8 set_mask, u8 clear_mask) u8 set_mask, u8 clear_mask)
{ {
...@@ -362,7 +357,7 @@ static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg, ...@@ -362,7 +357,7 @@ static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg,
data &= ~clear_mask; data &= ~clear_mask;
data |= set_mask; data |= set_mask;
err = tps65910_write(pmic, reg, data); err = tps65910_reg_write(pmic->mfd, reg, data);
if (err) if (err)
dev_err(pmic->mfd->dev, "Write for reg 0x%x failed\n", reg); dev_err(pmic->mfd->dev, "Write for reg 0x%x failed\n", reg);
...@@ -371,7 +366,7 @@ static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg, ...@@ -371,7 +366,7 @@ static int tps65910_modify_bits(struct tps65910_reg *pmic, u8 reg,
return err; return err;
} }
static int tps65910_reg_read(struct tps65910_reg *pmic, u8 reg) static int tps65910_reg_read_locked(struct tps65910_reg *pmic, u8 reg)
{ {
int data; int data;
...@@ -385,13 +380,13 @@ static int tps65910_reg_read(struct tps65910_reg *pmic, u8 reg) ...@@ -385,13 +380,13 @@ static int tps65910_reg_read(struct tps65910_reg *pmic, u8 reg)
return data; return data;
} }
static int tps65910_reg_write(struct tps65910_reg *pmic, u8 reg, u8 val) static int tps65910_reg_write_locked(struct tps65910_reg *pmic, u8 reg, u8 val)
{ {
int err; int err;
mutex_lock(&pmic->mutex); mutex_lock(&pmic->mutex);
err = tps65910_write(pmic, reg, val); err = tps65910_reg_write(pmic->mfd, reg, val);
if (err < 0) if (err < 0)
dev_err(pmic->mfd->dev, "Write for reg 0x%x failed\n", reg); dev_err(pmic->mfd->dev, "Write for reg 0x%x failed\n", reg);
...@@ -476,7 +471,7 @@ static int tps65910_is_enabled(struct regulator_dev *dev) ...@@ -476,7 +471,7 @@ static int tps65910_is_enabled(struct regulator_dev *dev)
if (reg < 0) if (reg < 0)
return reg; return reg;
value = tps65910_reg_read(pmic, reg); value = tps65910_reg_read_locked(pmic, reg);
if (value < 0) if (value < 0)
return value; return value;
...@@ -493,7 +488,7 @@ static int tps65910_enable(struct regulator_dev *dev) ...@@ -493,7 +488,7 @@ static int tps65910_enable(struct regulator_dev *dev)
if (reg < 0) if (reg < 0)
return reg; return reg;
return tps65910_set_bits(mfd, reg, TPS65910_SUPPLY_STATE_ENABLED); return tps65910_reg_set_bits(mfd, reg, TPS65910_SUPPLY_STATE_ENABLED);
} }
static int tps65910_disable(struct regulator_dev *dev) static int tps65910_disable(struct regulator_dev *dev)
...@@ -506,7 +501,7 @@ static int tps65910_disable(struct regulator_dev *dev) ...@@ -506,7 +501,7 @@ static int tps65910_disable(struct regulator_dev *dev)
if (reg < 0) if (reg < 0)
return reg; return reg;
return tps65910_clear_bits(mfd, reg, TPS65910_SUPPLY_STATE_ENABLED); return tps65910_reg_clear_bits(mfd, reg, TPS65910_SUPPLY_STATE_ENABLED);
} }
static int tps65910_enable_time(struct regulator_dev *dev) static int tps65910_enable_time(struct regulator_dev *dev)
...@@ -532,9 +527,9 @@ static int tps65910_set_mode(struct regulator_dev *dev, unsigned int mode) ...@@ -532,9 +527,9 @@ static int tps65910_set_mode(struct regulator_dev *dev, unsigned int mode)
LDO_ST_MODE_BIT); LDO_ST_MODE_BIT);
case REGULATOR_MODE_IDLE: case REGULATOR_MODE_IDLE:
value = LDO_ST_ON_BIT | LDO_ST_MODE_BIT; value = LDO_ST_ON_BIT | LDO_ST_MODE_BIT;
return tps65910_set_bits(mfd, reg, value); return tps65910_reg_set_bits(mfd, reg, value);
case REGULATOR_MODE_STANDBY: case REGULATOR_MODE_STANDBY:
return tps65910_clear_bits(mfd, reg, LDO_ST_ON_BIT); return tps65910_reg_clear_bits(mfd, reg, LDO_ST_ON_BIT);
} }
return -EINVAL; return -EINVAL;
...@@ -549,7 +544,7 @@ static unsigned int tps65910_get_mode(struct regulator_dev *dev) ...@@ -549,7 +544,7 @@ static unsigned int tps65910_get_mode(struct regulator_dev *dev)
if (reg < 0) if (reg < 0)
return reg; return reg;
value = tps65910_reg_read(pmic, reg); value = tps65910_reg_read_locked(pmic, reg);
if (value < 0) if (value < 0)
return value; return value;
...@@ -569,28 +564,28 @@ static int tps65910_get_voltage_dcdc_sel(struct regulator_dev *dev) ...@@ -569,28 +564,28 @@ static int tps65910_get_voltage_dcdc_sel(struct regulator_dev *dev)
switch (id) { switch (id) {
case TPS65910_REG_VDD1: case TPS65910_REG_VDD1:
opvsel = tps65910_reg_read(pmic, TPS65910_VDD1_OP); opvsel = tps65910_reg_read_locked(pmic, TPS65910_VDD1_OP);
mult = tps65910_reg_read(pmic, TPS65910_VDD1); mult = tps65910_reg_read_locked(pmic, TPS65910_VDD1);
mult = (mult & VDD1_VGAIN_SEL_MASK) >> VDD1_VGAIN_SEL_SHIFT; mult = (mult & VDD1_VGAIN_SEL_MASK) >> VDD1_VGAIN_SEL_SHIFT;
srvsel = tps65910_reg_read(pmic, TPS65910_VDD1_SR); srvsel = tps65910_reg_read_locked(pmic, TPS65910_VDD1_SR);
sr = opvsel & VDD1_OP_CMD_MASK; sr = opvsel & VDD1_OP_CMD_MASK;
opvsel &= VDD1_OP_SEL_MASK; opvsel &= VDD1_OP_SEL_MASK;
srvsel &= VDD1_SR_SEL_MASK; srvsel &= VDD1_SR_SEL_MASK;
vselmax = 75; vselmax = 75;
break; break;
case TPS65910_REG_VDD2: case TPS65910_REG_VDD2:
opvsel = tps65910_reg_read(pmic, TPS65910_VDD2_OP); opvsel = tps65910_reg_read_locked(pmic, TPS65910_VDD2_OP);
mult = tps65910_reg_read(pmic, TPS65910_VDD2); mult = tps65910_reg_read_locked(pmic, TPS65910_VDD2);
mult = (mult & VDD2_VGAIN_SEL_MASK) >> VDD2_VGAIN_SEL_SHIFT; mult = (mult & VDD2_VGAIN_SEL_MASK) >> VDD2_VGAIN_SEL_SHIFT;
srvsel = tps65910_reg_read(pmic, TPS65910_VDD2_SR); srvsel = tps65910_reg_read_locked(pmic, TPS65910_VDD2_SR);
sr = opvsel & VDD2_OP_CMD_MASK; sr = opvsel & VDD2_OP_CMD_MASK;
opvsel &= VDD2_OP_SEL_MASK; opvsel &= VDD2_OP_SEL_MASK;
srvsel &= VDD2_SR_SEL_MASK; srvsel &= VDD2_SR_SEL_MASK;
vselmax = 75; vselmax = 75;
break; break;
case TPS65911_REG_VDDCTRL: case TPS65911_REG_VDDCTRL:
opvsel = tps65910_reg_read(pmic, TPS65911_VDDCTRL_OP); opvsel = tps65910_reg_read_locked(pmic, TPS65911_VDDCTRL_OP);
srvsel = tps65910_reg_read(pmic, TPS65911_VDDCTRL_SR); srvsel = tps65910_reg_read_locked(pmic, TPS65911_VDDCTRL_SR);
sr = opvsel & VDDCTRL_OP_CMD_MASK; sr = opvsel & VDDCTRL_OP_CMD_MASK;
opvsel &= VDDCTRL_OP_SEL_MASK; opvsel &= VDDCTRL_OP_SEL_MASK;
srvsel &= VDDCTRL_SR_SEL_MASK; srvsel &= VDDCTRL_SR_SEL_MASK;
...@@ -630,7 +625,7 @@ static int tps65910_get_voltage(struct regulator_dev *dev) ...@@ -630,7 +625,7 @@ static int tps65910_get_voltage(struct regulator_dev *dev)
if (reg < 0) if (reg < 0)
return reg; return reg;
value = tps65910_reg_read(pmic, reg); value = tps65910_reg_read_locked(pmic, reg);
if (value < 0) if (value < 0)
return value; return value;
...@@ -669,7 +664,7 @@ static int tps65911_get_voltage(struct regulator_dev *dev) ...@@ -669,7 +664,7 @@ static int tps65911_get_voltage(struct regulator_dev *dev)
reg = pmic->get_ctrl_reg(id); reg = pmic->get_ctrl_reg(id);
value = tps65910_reg_read(pmic, reg); value = tps65910_reg_read_locked(pmic, reg);
switch (id) { switch (id) {
case TPS65911_REG_LDO1: case TPS65911_REG_LDO1:
...@@ -728,7 +723,7 @@ static int tps65910_set_voltage_dcdc_sel(struct regulator_dev *dev, ...@@ -728,7 +723,7 @@ static int tps65910_set_voltage_dcdc_sel(struct regulator_dev *dev,
tps65910_modify_bits(pmic, TPS65910_VDD1, tps65910_modify_bits(pmic, TPS65910_VDD1,
(dcdc_mult << VDD1_VGAIN_SEL_SHIFT), (dcdc_mult << VDD1_VGAIN_SEL_SHIFT),
VDD1_VGAIN_SEL_MASK); VDD1_VGAIN_SEL_MASK);
tps65910_reg_write(pmic, TPS65910_VDD1_OP, vsel); tps65910_reg_write_locked(pmic, TPS65910_VDD1_OP, vsel);
break; break;
case TPS65910_REG_VDD2: case TPS65910_REG_VDD2:
dcdc_mult = (selector / VDD1_2_NUM_VOLT_FINE) + 1; dcdc_mult = (selector / VDD1_2_NUM_VOLT_FINE) + 1;
...@@ -739,11 +734,11 @@ static int tps65910_set_voltage_dcdc_sel(struct regulator_dev *dev, ...@@ -739,11 +734,11 @@ static int tps65910_set_voltage_dcdc_sel(struct regulator_dev *dev,
tps65910_modify_bits(pmic, TPS65910_VDD2, tps65910_modify_bits(pmic, TPS65910_VDD2,
(dcdc_mult << VDD2_VGAIN_SEL_SHIFT), (dcdc_mult << VDD2_VGAIN_SEL_SHIFT),
VDD1_VGAIN_SEL_MASK); VDD1_VGAIN_SEL_MASK);
tps65910_reg_write(pmic, TPS65910_VDD2_OP, vsel); tps65910_reg_write_locked(pmic, TPS65910_VDD2_OP, vsel);
break; break;
case TPS65911_REG_VDDCTRL: case TPS65911_REG_VDDCTRL:
vsel = selector + 3; vsel = selector + 3;
tps65910_reg_write(pmic, TPS65911_VDDCTRL_OP, vsel); tps65910_reg_write_locked(pmic, TPS65911_VDDCTRL_OP, vsel);
} }
return 0; return 0;
...@@ -994,10 +989,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic, ...@@ -994,10 +989,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic,
/* External EN1 control */ /* External EN1 control */
if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN1) if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN1)
ret = tps65910_set_bits(mfd, ret = tps65910_reg_set_bits(mfd,
TPS65910_EN1_LDO_ASS + regoffs, bit_pos); TPS65910_EN1_LDO_ASS + regoffs, bit_pos);
else else
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_EN1_LDO_ASS + regoffs, bit_pos); TPS65910_EN1_LDO_ASS + regoffs, bit_pos);
if (ret < 0) { if (ret < 0) {
dev_err(mfd->dev, dev_err(mfd->dev,
...@@ -1007,10 +1002,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic, ...@@ -1007,10 +1002,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic,
/* External EN2 control */ /* External EN2 control */
if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN2) if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN2)
ret = tps65910_set_bits(mfd, ret = tps65910_reg_set_bits(mfd,
TPS65910_EN2_LDO_ASS + regoffs, bit_pos); TPS65910_EN2_LDO_ASS + regoffs, bit_pos);
else else
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_EN2_LDO_ASS + regoffs, bit_pos); TPS65910_EN2_LDO_ASS + regoffs, bit_pos);
if (ret < 0) { if (ret < 0) {
dev_err(mfd->dev, dev_err(mfd->dev,
...@@ -1022,10 +1017,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic, ...@@ -1022,10 +1017,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic,
if ((tps65910_chip_id(mfd) == TPS65910) && if ((tps65910_chip_id(mfd) == TPS65910) &&
(id >= TPS65910_REG_VDIG1)) { (id >= TPS65910_REG_VDIG1)) {
if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN3) if (ext_sleep_config & TPS65910_SLEEP_CONTROL_EXT_INPUT_EN3)
ret = tps65910_set_bits(mfd, ret = tps65910_reg_set_bits(mfd,
TPS65910_EN3_LDO_ASS + regoffs, bit_pos); TPS65910_EN3_LDO_ASS + regoffs, bit_pos);
else else
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_EN3_LDO_ASS + regoffs, bit_pos); TPS65910_EN3_LDO_ASS + regoffs, bit_pos);
if (ret < 0) { if (ret < 0) {
dev_err(mfd->dev, dev_err(mfd->dev,
...@@ -1037,10 +1032,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic, ...@@ -1037,10 +1032,10 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic,
/* Return if no external control is selected */ /* Return if no external control is selected */
if (!(ext_sleep_config & EXT_SLEEP_CONTROL)) { if (!(ext_sleep_config & EXT_SLEEP_CONTROL)) {
/* Clear all sleep controls */ /* Clear all sleep controls */
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_SLEEP_KEEP_LDO_ON + regoffs, bit_pos); TPS65910_SLEEP_KEEP_LDO_ON + regoffs, bit_pos);
if (!ret) if (!ret)
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos); TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos);
if (ret < 0) if (ret < 0)
dev_err(mfd->dev, dev_err(mfd->dev,
...@@ -1059,32 +1054,33 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic, ...@@ -1059,32 +1054,33 @@ static int tps65910_set_ext_sleep_config(struct tps65910_reg *pmic,
(tps65910_chip_id(mfd) == TPS65911))) { (tps65910_chip_id(mfd) == TPS65911))) {
int op_reg_add = pmic->get_ctrl_reg(id) + 1; int op_reg_add = pmic->get_ctrl_reg(id) + 1;
int sr_reg_add = pmic->get_ctrl_reg(id) + 2; int sr_reg_add = pmic->get_ctrl_reg(id) + 2;
int opvsel = tps65910_reg_read(pmic, op_reg_add); int opvsel = tps65910_reg_read_locked(pmic, op_reg_add);
int srvsel = tps65910_reg_read(pmic, sr_reg_add); int srvsel = tps65910_reg_read_locked(pmic, sr_reg_add);
if (opvsel & VDD1_OP_CMD_MASK) { if (opvsel & VDD1_OP_CMD_MASK) {
u8 reg_val = srvsel & VDD1_OP_SEL_MASK; u8 reg_val = srvsel & VDD1_OP_SEL_MASK;
ret = tps65910_reg_write(pmic, op_reg_add, reg_val); ret = tps65910_reg_write_locked(pmic, op_reg_add,
reg_val);
if (ret < 0) { if (ret < 0) {
dev_err(mfd->dev, dev_err(mfd->dev,
"Error in configuring op register\n"); "Error in configuring op register\n");
return ret; return ret;
} }
} }
ret = tps65910_reg_write(pmic, sr_reg_add, 0); ret = tps65910_reg_write_locked(pmic, sr_reg_add, 0);
if (ret < 0) { if (ret < 0) {
dev_err(mfd->dev, "Error in settting sr register\n"); dev_err(mfd->dev, "Error in settting sr register\n");
return ret; return ret;
} }
} }
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_SLEEP_KEEP_LDO_ON + regoffs, bit_pos); TPS65910_SLEEP_KEEP_LDO_ON + regoffs, bit_pos);
if (!ret) { if (!ret) {
if (ext_sleep_config & TPS65911_SLEEP_CONTROL_EXT_INPUT_SLEEP) if (ext_sleep_config & TPS65911_SLEEP_CONTROL_EXT_INPUT_SLEEP)
ret = tps65910_set_bits(mfd, ret = tps65910_reg_set_bits(mfd,
TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos); TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos);
else else
ret = tps65910_clear_bits(mfd, ret = tps65910_reg_clear_bits(mfd,
TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos); TPS65910_SLEEP_SET_LDO_OFF + regoffs, bit_pos);
} }
if (ret < 0) if (ret < 0)
...@@ -1117,7 +1113,7 @@ static __devinit int tps65910_probe(struct platform_device *pdev) ...@@ -1117,7 +1113,7 @@ static __devinit int tps65910_probe(struct platform_device *pdev)
platform_set_drvdata(pdev, pmic); platform_set_drvdata(pdev, pmic);
/* Give control of all register to control port */ /* Give control of all register to control port */
tps65910_set_bits(pmic->mfd, TPS65910_DEVCTRL, tps65910_reg_set_bits(pmic->mfd, TPS65910_DEVCTRL,
DEVCTRL_SR_CTL_I2C_SEL_MASK); DEVCTRL_SR_CTL_I2C_SEL_MASK);
switch(tps65910_chip_id(tps65910)) { switch(tps65910_chip_id(tps65910)) {
......
...@@ -18,6 +18,7 @@ ...@@ -18,6 +18,7 @@
#define __LINUX_MFD_TPS65910_H #define __LINUX_MFD_TPS65910_H
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/regmap.h>
/* TPS chip id list */ /* TPS chip id list */
#define TPS65910 0 #define TPS65910 0
...@@ -823,8 +824,6 @@ struct tps65910 { ...@@ -823,8 +824,6 @@ struct tps65910 {
struct regmap *regmap; struct regmap *regmap;
struct mutex io_mutex; struct mutex io_mutex;
unsigned int id; unsigned int id;
int (*read)(struct tps65910 *tps65910, u8 reg, int size, void *dest);
int (*write)(struct tps65910 *tps65910, u8 reg, int size, void *src);
/* Client devices */ /* Client devices */
struct tps65910_pmic *pmic; struct tps65910_pmic *pmic;
...@@ -847,8 +846,6 @@ struct tps65910_platform_data { ...@@ -847,8 +846,6 @@ struct tps65910_platform_data {
int irq_base; int irq_base;
}; };
int tps65910_set_bits(struct tps65910 *tps65910, u8 reg, u8 mask);
int tps65910_clear_bits(struct tps65910 *tps65910, u8 reg, u8 mask);
void tps65910_gpio_init(struct tps65910 *tps65910, int gpio_base); void tps65910_gpio_init(struct tps65910 *tps65910, int gpio_base);
int tps65910_irq_init(struct tps65910 *tps65910, int irq, int tps65910_irq_init(struct tps65910 *tps65910, int irq,
struct tps65910_platform_data *pdata); struct tps65910_platform_data *pdata);
...@@ -859,4 +856,28 @@ static inline int tps65910_chip_id(struct tps65910 *tps65910) ...@@ -859,4 +856,28 @@ static inline int tps65910_chip_id(struct tps65910 *tps65910)
return tps65910->id; return tps65910->id;
} }
static inline int tps65910_reg_read(struct tps65910 *tps65910, u8 reg,
unsigned int *val)
{
return regmap_read(tps65910->regmap, reg, val);
}
static inline int tps65910_reg_write(struct tps65910 *tps65910, u8 reg,
unsigned int val)
{
return regmap_write(tps65910->regmap, reg, val);
}
static inline int tps65910_reg_set_bits(struct tps65910 *tps65910, u8 reg,
u8 mask)
{
return regmap_update_bits(tps65910->regmap, reg, mask, mask);
}
static inline int tps65910_reg_clear_bits(struct tps65910 *tps65910, u8 reg,
u8 mask)
{
return regmap_update_bits(tps65910->regmap, reg, mask, 0);
}
#endif /* __LINUX_MFD_TPS65910_H */ #endif /* __LINUX_MFD_TPS65910_H */
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