ASoC: tpa6130a2: Add support for regulator framework
Take the regulator framework in use for managing the power sources Signed-off-by: Ilkka Koskinen <ilkka.koskinen@nokia.com> Acked-by: Peter Ujfalusi <peter.ujfalusi@nokia.com> Acked-by: Eduardo Valentin <eduardo.valentin@nokia.com> Acked-by: Liam Girdwood <lrg@slimlogic.co.uk> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
parent
0fe692292a
commit
7c4e649220
@ -25,6 +25,7 @@
|
|||||||
#include <linux/device.h>
|
#include <linux/device.h>
|
||||||
#include <linux/i2c.h>
|
#include <linux/i2c.h>
|
||||||
#include <linux/gpio.h>
|
#include <linux/gpio.h>
|
||||||
|
#include <linux/regulator/consumer.h>
|
||||||
#include <sound/tpa6130a2-plat.h>
|
#include <sound/tpa6130a2-plat.h>
|
||||||
#include <sound/soc.h>
|
#include <sound/soc.h>
|
||||||
#include <sound/soc-dapm.h>
|
#include <sound/soc-dapm.h>
|
||||||
@ -34,10 +35,17 @@
|
|||||||
|
|
||||||
static struct i2c_client *tpa6130a2_client;
|
static struct i2c_client *tpa6130a2_client;
|
||||||
|
|
||||||
|
#define TPA6130A2_NUM_SUPPLIES 2
|
||||||
|
static const char *tpa6130a2_supply_names[TPA6130A2_NUM_SUPPLIES] = {
|
||||||
|
"CPVSS",
|
||||||
|
"Vdd",
|
||||||
|
};
|
||||||
|
|
||||||
/* This struct is used to save the context */
|
/* This struct is used to save the context */
|
||||||
struct tpa6130a2_data {
|
struct tpa6130a2_data {
|
||||||
struct mutex mutex;
|
struct mutex mutex;
|
||||||
unsigned char regs[TPA6130A2_CACHEREGNUM];
|
unsigned char regs[TPA6130A2_CACHEREGNUM];
|
||||||
|
struct regulator_bulk_data supplies[TPA6130A2_NUM_SUPPLIES];
|
||||||
int power_gpio;
|
int power_gpio;
|
||||||
unsigned char power_state;
|
unsigned char power_state;
|
||||||
};
|
};
|
||||||
@ -106,10 +114,11 @@ static void tpa6130a2_initialize(void)
|
|||||||
tpa6130a2_i2c_write(i, data->regs[i]);
|
tpa6130a2_i2c_write(i, data->regs[i]);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void tpa6130a2_power(int power)
|
static int tpa6130a2_power(int power)
|
||||||
{
|
{
|
||||||
struct tpa6130a2_data *data;
|
struct tpa6130a2_data *data;
|
||||||
u8 val;
|
u8 val;
|
||||||
|
int ret;
|
||||||
|
|
||||||
BUG_ON(tpa6130a2_client == NULL);
|
BUG_ON(tpa6130a2_client == NULL);
|
||||||
data = i2c_get_clientdata(tpa6130a2_client);
|
data = i2c_get_clientdata(tpa6130a2_client);
|
||||||
@ -117,11 +126,20 @@ static void tpa6130a2_power(int power)
|
|||||||
mutex_lock(&data->mutex);
|
mutex_lock(&data->mutex);
|
||||||
if (power) {
|
if (power) {
|
||||||
/* Power on */
|
/* Power on */
|
||||||
if (data->power_gpio >= 0) {
|
if (data->power_gpio >= 0)
|
||||||
gpio_set_value(data->power_gpio, 1);
|
gpio_set_value(data->power_gpio, 1);
|
||||||
|
|
||||||
|
ret = regulator_bulk_enable(ARRAY_SIZE(data->supplies),
|
||||||
|
data->supplies);
|
||||||
|
if (ret != 0) {
|
||||||
|
dev_err(&tpa6130a2_client->dev,
|
||||||
|
"Failed to enable supplies: %d\n", ret);
|
||||||
|
goto exit;
|
||||||
|
}
|
||||||
|
|
||||||
data->power_state = 1;
|
data->power_state = 1;
|
||||||
tpa6130a2_initialize();
|
tpa6130a2_initialize();
|
||||||
}
|
|
||||||
/* Clear SWS */
|
/* Clear SWS */
|
||||||
val = tpa6130a2_read(TPA6130A2_REG_CONTROL);
|
val = tpa6130a2_read(TPA6130A2_REG_CONTROL);
|
||||||
val &= ~TPA6130A2_SWS;
|
val &= ~TPA6130A2_SWS;
|
||||||
@ -131,13 +149,25 @@ static void tpa6130a2_power(int power)
|
|||||||
val = tpa6130a2_read(TPA6130A2_REG_CONTROL);
|
val = tpa6130a2_read(TPA6130A2_REG_CONTROL);
|
||||||
val |= TPA6130A2_SWS;
|
val |= TPA6130A2_SWS;
|
||||||
tpa6130a2_i2c_write(TPA6130A2_REG_CONTROL, val);
|
tpa6130a2_i2c_write(TPA6130A2_REG_CONTROL, val);
|
||||||
|
|
||||||
/* Power off */
|
/* Power off */
|
||||||
if (data->power_gpio >= 0) {
|
if (data->power_gpio >= 0)
|
||||||
gpio_set_value(data->power_gpio, 0);
|
gpio_set_value(data->power_gpio, 0);
|
||||||
|
|
||||||
|
ret = regulator_bulk_disable(ARRAY_SIZE(data->supplies),
|
||||||
|
data->supplies);
|
||||||
|
if (ret != 0) {
|
||||||
|
dev_err(&tpa6130a2_client->dev,
|
||||||
|
"Failed to disable supplies: %d\n", ret);
|
||||||
|
goto exit;
|
||||||
|
}
|
||||||
|
|
||||||
data->power_state = 0;
|
data->power_state = 0;
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
exit:
|
||||||
mutex_unlock(&data->mutex);
|
mutex_unlock(&data->mutex);
|
||||||
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int tpa6130a2_get_reg(struct snd_kcontrol *kcontrol,
|
static int tpa6130a2_get_reg(struct snd_kcontrol *kcontrol,
|
||||||
@ -299,15 +329,17 @@ static int tpa6130a2_right_event(struct snd_soc_dapm_widget *w,
|
|||||||
static int tpa6130a2_supply_event(struct snd_soc_dapm_widget *w,
|
static int tpa6130a2_supply_event(struct snd_soc_dapm_widget *w,
|
||||||
struct snd_kcontrol *kcontrol, int event)
|
struct snd_kcontrol *kcontrol, int event)
|
||||||
{
|
{
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
switch (event) {
|
switch (event) {
|
||||||
case SND_SOC_DAPM_POST_PMU:
|
case SND_SOC_DAPM_POST_PMU:
|
||||||
tpa6130a2_power(1);
|
ret = tpa6130a2_power(1);
|
||||||
break;
|
break;
|
||||||
case SND_SOC_DAPM_POST_PMD:
|
case SND_SOC_DAPM_POST_PMD:
|
||||||
tpa6130a2_power(0);
|
ret = tpa6130a2_power(0);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
return 0;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct snd_soc_dapm_widget tpa6130a2_dapm_widgets[] = {
|
static const struct snd_soc_dapm_widget tpa6130a2_dapm_widgets[] = {
|
||||||
@ -352,7 +384,7 @@ static int tpa6130a2_probe(struct i2c_client *client,
|
|||||||
struct device *dev;
|
struct device *dev;
|
||||||
struct tpa6130a2_data *data;
|
struct tpa6130a2_data *data;
|
||||||
struct tpa6130a2_platform_data *pdata;
|
struct tpa6130a2_platform_data *pdata;
|
||||||
int ret;
|
int i, ret;
|
||||||
|
|
||||||
dev = &client->dev;
|
dev = &client->dev;
|
||||||
|
|
||||||
@ -387,15 +419,25 @@ static int tpa6130a2_probe(struct i2c_client *client,
|
|||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "Failed to request power GPIO (%d)\n",
|
dev_err(dev, "Failed to request power GPIO (%d)\n",
|
||||||
data->power_gpio);
|
data->power_gpio);
|
||||||
goto fail;
|
goto err_gpio;
|
||||||
}
|
}
|
||||||
gpio_direction_output(data->power_gpio, 0);
|
gpio_direction_output(data->power_gpio, 0);
|
||||||
} else {
|
|
||||||
data->power_state = 1;
|
|
||||||
tpa6130a2_initialize();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
tpa6130a2_power(1);
|
for (i = 0; i < ARRAY_SIZE(data->supplies); i++)
|
||||||
|
data->supplies[i].supply = tpa6130a2_supply_names[i];
|
||||||
|
|
||||||
|
ret = regulator_bulk_get(dev, ARRAY_SIZE(data->supplies),
|
||||||
|
data->supplies);
|
||||||
|
if (ret != 0) {
|
||||||
|
dev_err(dev, "Failed to request supplies: %d\n", ret);
|
||||||
|
goto err_regulator;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = tpa6130a2_power(1);
|
||||||
|
if (ret != 0)
|
||||||
|
goto err_power;
|
||||||
|
|
||||||
|
|
||||||
/* Read version */
|
/* Read version */
|
||||||
ret = tpa6130a2_i2c_read(TPA6130A2_REG_VERSION) &
|
ret = tpa6130a2_i2c_read(TPA6130A2_REG_VERSION) &
|
||||||
@ -404,10 +446,18 @@ static int tpa6130a2_probe(struct i2c_client *client,
|
|||||||
dev_warn(dev, "UNTESTED version detected (%d)\n", ret);
|
dev_warn(dev, "UNTESTED version detected (%d)\n", ret);
|
||||||
|
|
||||||
/* Disable the chip */
|
/* Disable the chip */
|
||||||
tpa6130a2_power(0);
|
ret = tpa6130a2_power(0);
|
||||||
|
if (ret != 0)
|
||||||
|
goto err_power;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
fail:
|
|
||||||
|
err_power:
|
||||||
|
regulator_bulk_free(ARRAY_SIZE(data->supplies), data->supplies);
|
||||||
|
err_regulator:
|
||||||
|
if (data->power_gpio >= 0)
|
||||||
|
gpio_free(data->power_gpio);
|
||||||
|
err_gpio:
|
||||||
kfree(data);
|
kfree(data);
|
||||||
i2c_set_clientdata(tpa6130a2_client, NULL);
|
i2c_set_clientdata(tpa6130a2_client, NULL);
|
||||||
tpa6130a2_client = NULL;
|
tpa6130a2_client = NULL;
|
||||||
@ -423,6 +473,9 @@ static int tpa6130a2_remove(struct i2c_client *client)
|
|||||||
|
|
||||||
if (data->power_gpio >= 0)
|
if (data->power_gpio >= 0)
|
||||||
gpio_free(data->power_gpio);
|
gpio_free(data->power_gpio);
|
||||||
|
|
||||||
|
regulator_bulk_free(ARRAY_SIZE(data->supplies), data->supplies);
|
||||||
|
|
||||||
kfree(data);
|
kfree(data);
|
||||||
tpa6130a2_client = NULL;
|
tpa6130a2_client = NULL;
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user