|
@@ -34,7 +34,10 @@
|
|
|
|
|
|
struct arizona_micsupp {
|
|
|
struct regulator_dev *regulator;
|
|
|
- struct arizona *arizona;
|
|
|
+ struct regmap *regmap;
|
|
|
+ struct snd_soc_dapm_context **dapm;
|
|
|
+ unsigned int enable_reg;
|
|
|
+ struct device *dev;
|
|
|
|
|
|
struct regulator_consumer_supply supply;
|
|
|
struct regulator_init_data init_data;
|
|
@@ -46,21 +49,22 @@ static void arizona_micsupp_check_cp(struct work_struct *work)
|
|
|
{
|
|
|
struct arizona_micsupp *micsupp =
|
|
|
container_of(work, struct arizona_micsupp, check_cp_work);
|
|
|
- struct snd_soc_dapm_context *dapm = micsupp->arizona->dapm;
|
|
|
- struct snd_soc_component *component = snd_soc_dapm_to_component(dapm);
|
|
|
- struct arizona *arizona = micsupp->arizona;
|
|
|
- struct regmap *regmap = arizona->regmap;
|
|
|
- unsigned int reg;
|
|
|
+ struct snd_soc_dapm_context *dapm = *micsupp->dapm;
|
|
|
+ struct snd_soc_component *component;
|
|
|
+ unsigned int val;
|
|
|
int ret;
|
|
|
|
|
|
- ret = regmap_read(regmap, ARIZONA_MIC_CHARGE_PUMP_1, ®);
|
|
|
+ ret = regmap_read(micsupp->regmap, micsupp->enable_reg, &val);
|
|
|
if (ret != 0) {
|
|
|
- dev_err(arizona->dev, "Failed to read CP state: %d\n", ret);
|
|
|
+ dev_err(micsupp->dev,
|
|
|
+ "Failed to read CP state: %d\n", ret);
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
if (dapm) {
|
|
|
- if ((reg & (ARIZONA_CPMIC_ENA | ARIZONA_CPMIC_BYPASS)) ==
|
|
|
+ component = snd_soc_dapm_to_component(dapm);
|
|
|
+
|
|
|
+ if ((val & (ARIZONA_CPMIC_ENA | ARIZONA_CPMIC_BYPASS)) ==
|
|
|
ARIZONA_CPMIC_ENA)
|
|
|
snd_soc_component_force_enable_pin(component,
|
|
|
"MICSUPP");
|
|
@@ -240,7 +244,9 @@ static int arizona_micsupp_probe(struct platform_device *pdev)
|
|
|
if (!micsupp)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- micsupp->arizona = arizona;
|
|
|
+ micsupp->regmap = arizona->regmap;
|
|
|
+ micsupp->dapm = &arizona->dapm;
|
|
|
+ micsupp->dev = arizona->dev;
|
|
|
INIT_WORK(&micsupp->check_cp_work, arizona_micsupp_check_cp);
|
|
|
|
|
|
/*
|
|
@@ -263,6 +269,7 @@ static int arizona_micsupp_probe(struct platform_device *pdev)
|
|
|
micsupp->init_data.consumer_supplies = &micsupp->supply;
|
|
|
micsupp->supply.supply = "MICVDD";
|
|
|
micsupp->supply.dev_name = dev_name(arizona->dev);
|
|
|
+ micsupp->enable_reg = desc->enable_reg;
|
|
|
|
|
|
config.dev = arizona->dev;
|
|
|
config.driver_data = micsupp;
|