55d2a66cfe
As part of the ongoing i2c transition to the simple probe
("probe_new"), this patch uses i2c_match_id to retrieve the
driver_data for the probed device. The id parameter is thus no longer
necessary and the simple probe can be used instead.
The i2c id table is moved up before the probe function, as suggested
by Wolfram Sang.
Signed-off-by: Stephen Kitt <steve@sk2.org>
Link: https://lore.kernel.org/r/20220501171009.45060-1-steve@sk2.org
Signed-off-by: Mark Brown <broonie@kernel.org>
331 lines
8.6 KiB
C
331 lines
8.6 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* ALSA SoC Texas Instruments TPA6130A2 headset stereo amplifier driver
|
|
*
|
|
* Copyright (C) Nokia Corporation
|
|
*
|
|
* Author: Peter Ujfalusi <peter.ujfalusi@ti.com>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/device.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/slab.h>
|
|
#include <sound/tpa6130a2-plat.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/tlv.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/regmap.h>
|
|
|
|
#include "tpa6130a2.h"
|
|
|
|
enum tpa_model {
|
|
TPA6130A2,
|
|
TPA6140A2,
|
|
};
|
|
|
|
/* This struct is used to save the context */
|
|
struct tpa6130a2_data {
|
|
struct device *dev;
|
|
struct regmap *regmap;
|
|
struct regulator *supply;
|
|
int power_gpio;
|
|
enum tpa_model id;
|
|
};
|
|
|
|
static int tpa6130a2_power(struct tpa6130a2_data *data, bool enable)
|
|
{
|
|
int ret = 0, ret2;
|
|
|
|
if (enable) {
|
|
ret = regulator_enable(data->supply);
|
|
if (ret != 0) {
|
|
dev_err(data->dev,
|
|
"Failed to enable supply: %d\n", ret);
|
|
return ret;
|
|
}
|
|
/* Power on */
|
|
if (data->power_gpio >= 0)
|
|
gpio_set_value(data->power_gpio, 1);
|
|
|
|
/* Sync registers */
|
|
regcache_cache_only(data->regmap, false);
|
|
ret = regcache_sync(data->regmap);
|
|
if (ret != 0) {
|
|
dev_err(data->dev,
|
|
"Failed to sync registers: %d\n", ret);
|
|
regcache_cache_only(data->regmap, true);
|
|
if (data->power_gpio >= 0)
|
|
gpio_set_value(data->power_gpio, 0);
|
|
ret2 = regulator_disable(data->supply);
|
|
if (ret2 != 0)
|
|
dev_err(data->dev,
|
|
"Failed to disable supply: %d\n", ret2);
|
|
return ret;
|
|
}
|
|
} else {
|
|
/* Powered off device does not retain registers. While device
|
|
* is off, any register updates (i.e. volume changes) should
|
|
* happen in cache only.
|
|
*/
|
|
regcache_mark_dirty(data->regmap);
|
|
regcache_cache_only(data->regmap, true);
|
|
|
|
/* Power off */
|
|
if (data->power_gpio >= 0)
|
|
gpio_set_value(data->power_gpio, 0);
|
|
|
|
ret = regulator_disable(data->supply);
|
|
if (ret != 0) {
|
|
dev_err(data->dev,
|
|
"Failed to disable supply: %d\n", ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int tpa6130a2_power_event(struct snd_soc_dapm_widget *w,
|
|
struct snd_kcontrol *kctrl, int event)
|
|
{
|
|
struct snd_soc_component *c = snd_soc_dapm_to_component(w->dapm);
|
|
struct tpa6130a2_data *data = snd_soc_component_get_drvdata(c);
|
|
|
|
if (SND_SOC_DAPM_EVENT_ON(event)) {
|
|
/* Before widget power up: turn chip on, sync registers */
|
|
return tpa6130a2_power(data, true);
|
|
} else {
|
|
/* After widget power down: turn chip off */
|
|
return tpa6130a2_power(data, false);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* TPA6130 volume. From -59.5 to 4 dB with increasing step size when going
|
|
* down in gain.
|
|
*/
|
|
static const DECLARE_TLV_DB_RANGE(tpa6130_tlv,
|
|
0, 1, TLV_DB_SCALE_ITEM(-5950, 600, 0),
|
|
2, 3, TLV_DB_SCALE_ITEM(-5000, 250, 0),
|
|
4, 5, TLV_DB_SCALE_ITEM(-4550, 160, 0),
|
|
6, 7, TLV_DB_SCALE_ITEM(-4140, 190, 0),
|
|
8, 9, TLV_DB_SCALE_ITEM(-3650, 120, 0),
|
|
10, 11, TLV_DB_SCALE_ITEM(-3330, 160, 0),
|
|
12, 13, TLV_DB_SCALE_ITEM(-3040, 180, 0),
|
|
14, 20, TLV_DB_SCALE_ITEM(-2710, 110, 0),
|
|
21, 37, TLV_DB_SCALE_ITEM(-1960, 74, 0),
|
|
38, 63, TLV_DB_SCALE_ITEM(-720, 45, 0)
|
|
);
|
|
|
|
static const struct snd_kcontrol_new tpa6130a2_controls[] = {
|
|
SOC_SINGLE_TLV("Headphone Playback Volume",
|
|
TPA6130A2_REG_VOL_MUTE, 0, 0x3f, 0,
|
|
tpa6130_tlv),
|
|
};
|
|
|
|
static const DECLARE_TLV_DB_RANGE(tpa6140_tlv,
|
|
0, 8, TLV_DB_SCALE_ITEM(-5900, 400, 0),
|
|
9, 16, TLV_DB_SCALE_ITEM(-2500, 200, 0),
|
|
17, 31, TLV_DB_SCALE_ITEM(-1000, 100, 0)
|
|
);
|
|
|
|
static const struct snd_kcontrol_new tpa6140a2_controls[] = {
|
|
SOC_SINGLE_TLV("Headphone Playback Volume",
|
|
TPA6130A2_REG_VOL_MUTE, 1, 0x1f, 0,
|
|
tpa6140_tlv),
|
|
};
|
|
|
|
static int tpa6130a2_component_probe(struct snd_soc_component *component)
|
|
{
|
|
struct tpa6130a2_data *data = snd_soc_component_get_drvdata(component);
|
|
|
|
if (data->id == TPA6140A2)
|
|
return snd_soc_add_component_controls(component,
|
|
tpa6140a2_controls, ARRAY_SIZE(tpa6140a2_controls));
|
|
else
|
|
return snd_soc_add_component_controls(component,
|
|
tpa6130a2_controls, ARRAY_SIZE(tpa6130a2_controls));
|
|
}
|
|
|
|
static const struct snd_soc_dapm_widget tpa6130a2_dapm_widgets[] = {
|
|
SND_SOC_DAPM_INPUT("LEFTIN"),
|
|
SND_SOC_DAPM_INPUT("RIGHTIN"),
|
|
SND_SOC_DAPM_OUTPUT("HPLEFT"),
|
|
SND_SOC_DAPM_OUTPUT("HPRIGHT"),
|
|
|
|
SND_SOC_DAPM_PGA("Left Mute", TPA6130A2_REG_VOL_MUTE,
|
|
TPA6130A2_HP_EN_L_SHIFT, 1, NULL, 0),
|
|
SND_SOC_DAPM_PGA("Right Mute", TPA6130A2_REG_VOL_MUTE,
|
|
TPA6130A2_HP_EN_R_SHIFT, 1, NULL, 0),
|
|
SND_SOC_DAPM_PGA("Left PGA", TPA6130A2_REG_CONTROL,
|
|
TPA6130A2_HP_EN_L_SHIFT, 0, NULL, 0),
|
|
SND_SOC_DAPM_PGA("Right PGA", TPA6130A2_REG_CONTROL,
|
|
TPA6130A2_HP_EN_R_SHIFT, 0, NULL, 0),
|
|
|
|
SND_SOC_DAPM_SUPPLY("Power", TPA6130A2_REG_CONTROL,
|
|
TPA6130A2_SWS_SHIFT, 1, tpa6130a2_power_event,
|
|
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
|
|
};
|
|
|
|
static const struct snd_soc_dapm_route tpa6130a2_dapm_routes[] = {
|
|
{ "Left PGA", NULL, "LEFTIN" },
|
|
{ "Right PGA", NULL, "RIGHTIN" },
|
|
|
|
{ "Left Mute", NULL, "Left PGA" },
|
|
{ "Right Mute", NULL, "Right PGA" },
|
|
|
|
{ "HPLEFT", NULL, "Left Mute" },
|
|
{ "HPRIGHT", NULL, "Right Mute" },
|
|
|
|
{ "Left PGA", NULL, "Power" },
|
|
{ "Right PGA", NULL, "Power" },
|
|
};
|
|
|
|
static const struct snd_soc_component_driver tpa6130a2_component_driver = {
|
|
.name = "tpa6130a2",
|
|
.probe = tpa6130a2_component_probe,
|
|
.dapm_widgets = tpa6130a2_dapm_widgets,
|
|
.num_dapm_widgets = ARRAY_SIZE(tpa6130a2_dapm_widgets),
|
|
.dapm_routes = tpa6130a2_dapm_routes,
|
|
.num_dapm_routes = ARRAY_SIZE(tpa6130a2_dapm_routes),
|
|
};
|
|
|
|
static const struct reg_default tpa6130a2_reg_defaults[] = {
|
|
{ TPA6130A2_REG_CONTROL, TPA6130A2_SWS },
|
|
{ TPA6130A2_REG_VOL_MUTE, TPA6130A2_MUTE_R | TPA6130A2_MUTE_L },
|
|
};
|
|
|
|
static const struct regmap_config tpa6130a2_regmap_config = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
.max_register = TPA6130A2_REG_VERSION,
|
|
.reg_defaults = tpa6130a2_reg_defaults,
|
|
.num_reg_defaults = ARRAY_SIZE(tpa6130a2_reg_defaults),
|
|
.cache_type = REGCACHE_RBTREE,
|
|
};
|
|
|
|
static const struct i2c_device_id tpa6130a2_id[] = {
|
|
{ "tpa6130a2", TPA6130A2 },
|
|
{ "tpa6140a2", TPA6140A2 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, tpa6130a2_id);
|
|
|
|
static int tpa6130a2_probe(struct i2c_client *client)
|
|
{
|
|
struct device *dev;
|
|
struct tpa6130a2_data *data;
|
|
struct tpa6130a2_platform_data *pdata = client->dev.platform_data;
|
|
struct device_node *np = client->dev.of_node;
|
|
const struct i2c_device_id *id;
|
|
const char *regulator;
|
|
unsigned int version;
|
|
int ret;
|
|
|
|
dev = &client->dev;
|
|
|
|
data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
data->dev = dev;
|
|
|
|
data->regmap = devm_regmap_init_i2c(client, &tpa6130a2_regmap_config);
|
|
if (IS_ERR(data->regmap))
|
|
return PTR_ERR(data->regmap);
|
|
|
|
if (pdata) {
|
|
data->power_gpio = pdata->power_gpio;
|
|
} else if (np) {
|
|
data->power_gpio = of_get_named_gpio(np, "power-gpio", 0);
|
|
} else {
|
|
dev_err(dev, "Platform data not set\n");
|
|
dump_stack();
|
|
return -ENODEV;
|
|
}
|
|
|
|
i2c_set_clientdata(client, data);
|
|
|
|
id = i2c_match_id(tpa6130a2_id, client);
|
|
data->id = id->driver_data;
|
|
|
|
if (data->power_gpio >= 0) {
|
|
ret = devm_gpio_request(dev, data->power_gpio,
|
|
"tpa6130a2 enable");
|
|
if (ret < 0) {
|
|
dev_err(dev, "Failed to request power GPIO (%d)\n",
|
|
data->power_gpio);
|
|
return ret;
|
|
}
|
|
gpio_direction_output(data->power_gpio, 0);
|
|
}
|
|
|
|
switch (data->id) {
|
|
default:
|
|
dev_warn(dev, "Unknown TPA model (%d). Assuming 6130A2\n",
|
|
data->id);
|
|
fallthrough;
|
|
case TPA6130A2:
|
|
regulator = "Vdd";
|
|
break;
|
|
case TPA6140A2:
|
|
regulator = "AVdd";
|
|
break;
|
|
}
|
|
|
|
data->supply = devm_regulator_get(dev, regulator);
|
|
if (IS_ERR(data->supply)) {
|
|
ret = PTR_ERR(data->supply);
|
|
dev_err(dev, "Failed to request supply: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = tpa6130a2_power(data, true);
|
|
if (ret != 0)
|
|
return ret;
|
|
|
|
|
|
/* Read version */
|
|
regmap_read(data->regmap, TPA6130A2_REG_VERSION, &version);
|
|
version &= TPA6130A2_VERSION_MASK;
|
|
if ((version != 1) && (version != 2))
|
|
dev_warn(dev, "UNTESTED version detected (%d)\n", version);
|
|
|
|
/* Disable the chip */
|
|
ret = tpa6130a2_power(data, false);
|
|
if (ret != 0)
|
|
return ret;
|
|
|
|
return devm_snd_soc_register_component(&client->dev,
|
|
&tpa6130a2_component_driver, NULL, 0);
|
|
}
|
|
|
|
#if IS_ENABLED(CONFIG_OF)
|
|
static const struct of_device_id tpa6130a2_of_match[] = {
|
|
{ .compatible = "ti,tpa6130a2", },
|
|
{ .compatible = "ti,tpa6140a2" },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, tpa6130a2_of_match);
|
|
#endif
|
|
|
|
static struct i2c_driver tpa6130a2_i2c_driver = {
|
|
.driver = {
|
|
.name = "tpa6130a2",
|
|
.of_match_table = of_match_ptr(tpa6130a2_of_match),
|
|
},
|
|
.probe_new = tpa6130a2_probe,
|
|
.id_table = tpa6130a2_id,
|
|
};
|
|
|
|
module_i2c_driver(tpa6130a2_i2c_driver);
|
|
|
|
MODULE_AUTHOR("Peter Ujfalusi <peter.ujfalusi@ti.com>");
|
|
MODULE_DESCRIPTION("TPA6130A2 Headphone amplifier driver");
|
|
MODULE_LICENSE("GPL");
|