ASoC: codecs: tfa989x: Add support for optional vddd-supply

Allow specifying Vddd regulator/supply to be enabled on I2C probing.

Signed-off-by: Vincent Knecht <vincent.knecht@mailoo.org>
Reviewed-by: Stephan Gerhold <stephan@gerhold.net>
Link: https://lore.kernel.org/r/20210528105101.508254-4-vincent.knecht@mailoo.org
Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
Vincent Knecht 2021-05-28 12:51:01 +02:00 committed by Mark Brown
parent 9cf1a98e2b
commit 8e5607e994
No known key found for this signature in database
GPG Key ID: 24D68B725D5487D0

View File

@ -10,6 +10,7 @@
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/regmap.h> #include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <sound/soc.h> #include <sound/soc.h>
#define TFA989X_STATUSREG 0x00 #define TFA989X_STATUSREG 0x00
@ -51,6 +52,10 @@ struct tfa989x_rev {
int (*init)(struct regmap *regmap); int (*init)(struct regmap *regmap);
}; };
struct tfa989x {
struct regulator *vddd_supply;
};
static bool tfa989x_writeable_reg(struct device *dev, unsigned int reg) static bool tfa989x_writeable_reg(struct device *dev, unsigned int reg)
{ {
return reg > TFA989X_REVISIONNUMBER; return reg > TFA989X_REVISIONNUMBER;
@ -242,10 +247,18 @@ static int tfa989x_dsp_bypass(struct regmap *regmap)
BIT(TFA989X_SYS_CTRL_AMPC)); BIT(TFA989X_SYS_CTRL_AMPC));
} }
static void tfa989x_regulator_disable(void *data)
{
struct tfa989x *tfa989x = data;
regulator_disable(tfa989x->vddd_supply);
}
static int tfa989x_i2c_probe(struct i2c_client *i2c) static int tfa989x_i2c_probe(struct i2c_client *i2c)
{ {
struct device *dev = &i2c->dev; struct device *dev = &i2c->dev;
const struct tfa989x_rev *rev; const struct tfa989x_rev *rev;
struct tfa989x *tfa989x;
struct regmap *regmap; struct regmap *regmap;
unsigned int val; unsigned int val;
int ret; int ret;
@ -256,10 +269,31 @@ static int tfa989x_i2c_probe(struct i2c_client *i2c)
return -ENODEV; return -ENODEV;
} }
tfa989x = devm_kzalloc(dev, sizeof(*tfa989x), GFP_KERNEL);
if (!tfa989x)
return -ENOMEM;
i2c_set_clientdata(i2c, tfa989x);
tfa989x->vddd_supply = devm_regulator_get(dev, "vddd");
if (IS_ERR(tfa989x->vddd_supply))
return dev_err_probe(dev, PTR_ERR(tfa989x->vddd_supply),
"Failed to get vddd regulator\n");
regmap = devm_regmap_init_i2c(i2c, &tfa989x_regmap); regmap = devm_regmap_init_i2c(i2c, &tfa989x_regmap);
if (IS_ERR(regmap)) if (IS_ERR(regmap))
return PTR_ERR(regmap); return PTR_ERR(regmap);
ret = regulator_enable(tfa989x->vddd_supply);
if (ret) {
dev_err(dev, "Failed to enable vddd regulator: %d\n", ret);
return ret;
}
ret = devm_add_action_or_reset(dev, tfa989x_regulator_disable, tfa989x);
if (ret)
return ret;
/* Bypass regcache for reset and init sequence */ /* Bypass regcache for reset and init sequence */
regcache_cache_bypass(regmap, true); regcache_cache_bypass(regmap, true);