mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-29 11:11:45 -04:00
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: Rhyland Klein <[email protected]> Signed-off-by: Samuel Ortiz <[email protected]>
This commit is contained in:
parent
7ccfe9b1d5
commit
3f7e82759c
5 changed files with 100 additions and 105 deletions
|
|
@ -41,28 +41,28 @@ static inline int irq_to_tps65910_irq(struct tps65910 *tps65910,
|
|||
static irqreturn_t tps65910_irq(int irq, void *irq_data)
|
||||
{
|
||||
struct tps65910 *tps65910 = irq_data;
|
||||
unsigned int reg;
|
||||
u32 irq_sts;
|
||||
u32 irq_mask;
|
||||
u8 reg;
|
||||
int i;
|
||||
|
||||
tps65910->read(tps65910, TPS65910_INT_STS, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_STS, ®);
|
||||
irq_sts = reg;
|
||||
tps65910->read(tps65910, TPS65910_INT_STS2, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_STS2, ®);
|
||||
irq_sts |= reg << 8;
|
||||
switch (tps65910_chip_id(tps65910)) {
|
||||
case TPS65911:
|
||||
tps65910->read(tps65910, TPS65910_INT_STS3, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_STS3, ®);
|
||||
irq_sts |= reg << 16;
|
||||
}
|
||||
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK, ®);
|
||||
irq_mask = reg;
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK2, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK2, ®);
|
||||
irq_mask |= reg << 8;
|
||||
switch (tps65910_chip_id(tps65910)) {
|
||||
case TPS65911:
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK3, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK3, ®);
|
||||
irq_mask |= reg << 16;
|
||||
}
|
||||
|
||||
|
|
@ -82,13 +82,13 @@ static irqreturn_t tps65910_irq(int irq, void *irq_data)
|
|||
/* Write the STS register back to clear IRQs we handled */
|
||||
reg = irq_sts & 0xFF;
|
||||
irq_sts >>= 8;
|
||||
tps65910->write(tps65910, TPS65910_INT_STS, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_STS, reg);
|
||||
reg = irq_sts & 0xFF;
|
||||
tps65910->write(tps65910, TPS65910_INT_STS2, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_STS2, reg);
|
||||
switch (tps65910_chip_id(tps65910)) {
|
||||
case TPS65911:
|
||||
reg = irq_sts >> 8;
|
||||
tps65910->write(tps65910, TPS65910_INT_STS3, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_STS3, reg);
|
||||
}
|
||||
|
||||
return IRQ_HANDLED;
|
||||
|
|
@ -105,27 +105,27 @@ static void tps65910_irq_sync_unlock(struct irq_data *data)
|
|||
{
|
||||
struct tps65910 *tps65910 = irq_data_get_irq_chip_data(data);
|
||||
u32 reg_mask;
|
||||
u8 reg;
|
||||
unsigned int reg;
|
||||
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK, ®);
|
||||
reg_mask = reg;
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK2, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK2, ®);
|
||||
reg_mask |= reg << 8;
|
||||
switch (tps65910_chip_id(tps65910)) {
|
||||
case TPS65911:
|
||||
tps65910->read(tps65910, TPS65910_INT_MSK3, 1, ®);
|
||||
tps65910_reg_read(tps65910, TPS65910_INT_MSK3, ®);
|
||||
reg_mask |= reg << 16;
|
||||
}
|
||||
|
||||
if (tps65910->irq_mask != reg_mask) {
|
||||
reg = tps65910->irq_mask & 0xFF;
|
||||
tps65910->write(tps65910, TPS65910_INT_MSK, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_MSK, reg);
|
||||
reg = tps65910->irq_mask >> 8 & 0xFF;
|
||||
tps65910->write(tps65910, TPS65910_INT_MSK2, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_MSK2, reg);
|
||||
switch (tps65910_chip_id(tps65910)) {
|
||||
case TPS65911:
|
||||
reg = tps65910->irq_mask >> 16;
|
||||
tps65910->write(tps65910, TPS65910_INT_MSK3, 1, ®);
|
||||
tps65910_reg_write(tps65910, TPS65910_INT_MSK3, reg);
|
||||
}
|
||||
}
|
||||
mutex_unlock(&tps65910->irq_lock);
|
||||
|
|
|
|||
|
|
@ -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)
|
||||
{
|
||||
struct tps65910 *tps65910 = dev_get_drvdata(dev);
|
||||
|
|
@ -102,7 +78,7 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
|
|||
return 0;
|
||||
|
||||
/* enabling SLEEP device state */
|
||||
ret = tps65910_set_bits(tps65910, TPS65910_DEVCTRL,
|
||||
ret = tps65910_reg_set_bits(tps65910, TPS65910_DEVCTRL,
|
||||
DEVCTRL_DEV_SLP_MASK);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "set dev_slp failed: %d\n", ret);
|
||||
|
|
@ -114,7 +90,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
|
|||
return 0;
|
||||
|
||||
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);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "set therm_keepon failed: %d\n", ret);
|
||||
|
|
@ -123,7 +100,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
|
|||
}
|
||||
|
||||
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);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "set clkout32k_keepon failed: %d\n", ret);
|
||||
|
|
@ -132,7 +110,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
|
|||
}
|
||||
|
||||
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);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "set i2chs_keepon failed: %d\n", ret);
|
||||
|
|
@ -143,7 +122,8 @@ static int __devinit tps65910_sleepinit(struct tps65910 *tps65910,
|
|||
return 0;
|
||||
|
||||
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:
|
||||
return ret;
|
||||
|
|
@ -176,8 +156,6 @@ static __devinit int tps65910_i2c_probe(struct i2c_client *i2c,
|
|||
tps65910->dev = &i2c->dev;
|
||||
tps65910->i2c_client = i2c;
|
||||
tps65910->id = id->driver_data;
|
||||
tps65910->read = tps65910_i2c_read;
|
||||
tps65910->write = tps65910_i2c_write;
|
||||
mutex_init(&tps65910->io_mutex);
|
||||
|
||||
tps65910->regmap = regmap_init_i2c(i2c, &tps65910_regmap_config);
|
||||
|
|
|
|||
Loading…
Reference in a new issue