mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-15 16:24:13 +08:00
2ff4e003e8
Use the dev_err_probe() helper, instead of open-coding the same operation. Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Link: https://lore.kernel.org/r/20211214020843.2225831-17-kuninori.morimoto.gx@renesas.com Signed-off-by: Mark Brown <broonie@kernel.org>
328 lines
8.8 KiB
C
328 lines
8.8 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// Copyright (c) 2020 BayLibre, SAS.
|
|
// Author: Jerome Brunet <jbrunet@baylibre.com>
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/module.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/reset.h>
|
|
#include <sound/soc.h>
|
|
#include <sound/tlv.h>
|
|
|
|
#define BLOCK_EN 0x00
|
|
#define LORN_EN 0
|
|
#define LORP_EN 1
|
|
#define LOLN_EN 2
|
|
#define LOLP_EN 3
|
|
#define DACR_EN 4
|
|
#define DACL_EN 5
|
|
#define DACR_INV 20
|
|
#define DACL_INV 21
|
|
#define DACR_SRC 22
|
|
#define DACL_SRC 23
|
|
#define REFP_BUF_EN BIT(12)
|
|
#define BIAS_CURRENT_EN BIT(13)
|
|
#define VMID_GEN_FAST BIT(14)
|
|
#define VMID_GEN_EN BIT(15)
|
|
#define I2S_MODE BIT(30)
|
|
#define VOL_CTRL0 0x04
|
|
#define GAIN_H 31
|
|
#define GAIN_L 23
|
|
#define VOL_CTRL1 0x08
|
|
#define DAC_MONO 8
|
|
#define RAMP_RATE 10
|
|
#define VC_RAMP_MODE 12
|
|
#define MUTE_MODE 13
|
|
#define UNMUTE_MODE 14
|
|
#define DAC_SOFT_MUTE 15
|
|
#define DACR_VC 16
|
|
#define DACL_VC 24
|
|
#define LINEOUT_CFG 0x0c
|
|
#define LORN_POL 0
|
|
#define LORP_POL 4
|
|
#define LOLN_POL 8
|
|
#define LOLP_POL 12
|
|
#define POWER_CFG 0x10
|
|
|
|
struct t9015 {
|
|
struct clk *pclk;
|
|
struct regulator *avdd;
|
|
};
|
|
|
|
static int t9015_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
unsigned int val;
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
|
case SND_SOC_DAIFMT_CBM_CFM:
|
|
val = I2S_MODE;
|
|
break;
|
|
|
|
case SND_SOC_DAIFMT_CBS_CFS:
|
|
val = 0;
|
|
break;
|
|
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
snd_soc_component_update_bits(component, BLOCK_EN, I2S_MODE, val);
|
|
|
|
if (((fmt & SND_SOC_DAIFMT_FORMAT_MASK) != SND_SOC_DAIFMT_I2S) &&
|
|
((fmt & SND_SOC_DAIFMT_FORMAT_MASK) != SND_SOC_DAIFMT_LEFT_J))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_soc_dai_ops t9015_dai_ops = {
|
|
.set_fmt = t9015_dai_set_fmt,
|
|
};
|
|
|
|
static struct snd_soc_dai_driver t9015_dai = {
|
|
.name = "t9015-hifi",
|
|
.playback = {
|
|
.stream_name = "Playback",
|
|
.channels_min = 1,
|
|
.channels_max = 2,
|
|
.rates = SNDRV_PCM_RATE_8000_96000,
|
|
.formats = (SNDRV_PCM_FMTBIT_S8 |
|
|
SNDRV_PCM_FMTBIT_S16_LE |
|
|
SNDRV_PCM_FMTBIT_S20_LE |
|
|
SNDRV_PCM_FMTBIT_S24_LE),
|
|
},
|
|
.ops = &t9015_dai_ops,
|
|
};
|
|
|
|
static const DECLARE_TLV_DB_MINMAX_MUTE(dac_vol_tlv, -9525, 0);
|
|
|
|
static const char * const ramp_rate_txt[] = { "Fast", "Slow" };
|
|
static SOC_ENUM_SINGLE_DECL(ramp_rate_enum, VOL_CTRL1, RAMP_RATE,
|
|
ramp_rate_txt);
|
|
|
|
static const char * const dacr_in_txt[] = { "Right", "Left" };
|
|
static SOC_ENUM_SINGLE_DECL(dacr_in_enum, BLOCK_EN, DACR_SRC, dacr_in_txt);
|
|
|
|
static const char * const dacl_in_txt[] = { "Left", "Right" };
|
|
static SOC_ENUM_SINGLE_DECL(dacl_in_enum, BLOCK_EN, DACL_SRC, dacl_in_txt);
|
|
|
|
static const char * const mono_txt[] = { "Stereo", "Mono"};
|
|
static SOC_ENUM_SINGLE_DECL(mono_enum, VOL_CTRL1, DAC_MONO, mono_txt);
|
|
|
|
static const struct snd_kcontrol_new t9015_snd_controls[] = {
|
|
/* Volume Controls */
|
|
SOC_ENUM("Playback Channel Mode", mono_enum),
|
|
SOC_SINGLE("Playback Switch", VOL_CTRL1, DAC_SOFT_MUTE, 1, 1),
|
|
SOC_DOUBLE_TLV("Playback Volume", VOL_CTRL1, DACL_VC, DACR_VC,
|
|
0xff, 0, dac_vol_tlv),
|
|
|
|
/* Ramp Controls */
|
|
SOC_ENUM("Ramp Rate", ramp_rate_enum),
|
|
SOC_SINGLE("Volume Ramp Switch", VOL_CTRL1, VC_RAMP_MODE, 1, 0),
|
|
SOC_SINGLE("Mute Ramp Switch", VOL_CTRL1, MUTE_MODE, 1, 0),
|
|
SOC_SINGLE("Unmute Ramp Switch", VOL_CTRL1, UNMUTE_MODE, 1, 0),
|
|
};
|
|
|
|
static const struct snd_kcontrol_new t9015_right_dac_mux =
|
|
SOC_DAPM_ENUM("Right DAC Source", dacr_in_enum);
|
|
static const struct snd_kcontrol_new t9015_left_dac_mux =
|
|
SOC_DAPM_ENUM("Left DAC Source", dacl_in_enum);
|
|
|
|
static const struct snd_soc_dapm_widget t9015_dapm_widgets[] = {
|
|
SND_SOC_DAPM_AIF_IN("Right IN", NULL, 0, SND_SOC_NOPM, 0, 0),
|
|
SND_SOC_DAPM_AIF_IN("Left IN", NULL, 0, SND_SOC_NOPM, 0, 0),
|
|
SND_SOC_DAPM_MUX("Right DAC Sel", SND_SOC_NOPM, 0, 0,
|
|
&t9015_right_dac_mux),
|
|
SND_SOC_DAPM_MUX("Left DAC Sel", SND_SOC_NOPM, 0, 0,
|
|
&t9015_left_dac_mux),
|
|
SND_SOC_DAPM_DAC("Right DAC", NULL, BLOCK_EN, DACR_EN, 0),
|
|
SND_SOC_DAPM_DAC("Left DAC", NULL, BLOCK_EN, DACL_EN, 0),
|
|
SND_SOC_DAPM_OUT_DRV("Right- Driver", BLOCK_EN, LORN_EN, 0,
|
|
NULL, 0),
|
|
SND_SOC_DAPM_OUT_DRV("Right+ Driver", BLOCK_EN, LORP_EN, 0,
|
|
NULL, 0),
|
|
SND_SOC_DAPM_OUT_DRV("Left- Driver", BLOCK_EN, LOLN_EN, 0,
|
|
NULL, 0),
|
|
SND_SOC_DAPM_OUT_DRV("Left+ Driver", BLOCK_EN, LOLP_EN, 0,
|
|
NULL, 0),
|
|
SND_SOC_DAPM_OUTPUT("LORN"),
|
|
SND_SOC_DAPM_OUTPUT("LORP"),
|
|
SND_SOC_DAPM_OUTPUT("LOLN"),
|
|
SND_SOC_DAPM_OUTPUT("LOLP"),
|
|
};
|
|
|
|
static const struct snd_soc_dapm_route t9015_dapm_routes[] = {
|
|
{ "Right IN", NULL, "Playback" },
|
|
{ "Left IN", NULL, "Playback" },
|
|
{ "Right DAC Sel", "Right", "Right IN" },
|
|
{ "Right DAC Sel", "Left", "Left IN" },
|
|
{ "Left DAC Sel", "Right", "Right IN" },
|
|
{ "Left DAC Sel", "Left", "Left IN" },
|
|
{ "Right DAC", NULL, "Right DAC Sel" },
|
|
{ "Left DAC", NULL, "Left DAC Sel" },
|
|
{ "Right- Driver", NULL, "Right DAC" },
|
|
{ "Right+ Driver", NULL, "Right DAC" },
|
|
{ "Left- Driver", NULL, "Left DAC" },
|
|
{ "Left+ Driver", NULL, "Left DAC" },
|
|
{ "LORN", NULL, "Right- Driver", },
|
|
{ "LORP", NULL, "Right+ Driver", },
|
|
{ "LOLN", NULL, "Left- Driver", },
|
|
{ "LOLP", NULL, "Left+ Driver", },
|
|
};
|
|
|
|
static int t9015_set_bias_level(struct snd_soc_component *component,
|
|
enum snd_soc_bias_level level)
|
|
{
|
|
struct t9015 *priv = snd_soc_component_get_drvdata(component);
|
|
enum snd_soc_bias_level now =
|
|
snd_soc_component_get_bias_level(component);
|
|
int ret;
|
|
|
|
switch (level) {
|
|
case SND_SOC_BIAS_ON:
|
|
snd_soc_component_update_bits(component, BLOCK_EN,
|
|
BIAS_CURRENT_EN,
|
|
BIAS_CURRENT_EN);
|
|
break;
|
|
case SND_SOC_BIAS_PREPARE:
|
|
snd_soc_component_update_bits(component, BLOCK_EN,
|
|
BIAS_CURRENT_EN,
|
|
0);
|
|
break;
|
|
case SND_SOC_BIAS_STANDBY:
|
|
ret = regulator_enable(priv->avdd);
|
|
if (ret) {
|
|
dev_err(component->dev, "AVDD enable failed\n");
|
|
return ret;
|
|
}
|
|
|
|
if (now == SND_SOC_BIAS_OFF) {
|
|
snd_soc_component_update_bits(component, BLOCK_EN,
|
|
VMID_GEN_EN | VMID_GEN_FAST | REFP_BUF_EN,
|
|
VMID_GEN_EN | VMID_GEN_FAST | REFP_BUF_EN);
|
|
|
|
mdelay(200);
|
|
snd_soc_component_update_bits(component, BLOCK_EN,
|
|
VMID_GEN_FAST,
|
|
0);
|
|
}
|
|
|
|
break;
|
|
case SND_SOC_BIAS_OFF:
|
|
snd_soc_component_update_bits(component, BLOCK_EN,
|
|
VMID_GEN_EN | VMID_GEN_FAST | REFP_BUF_EN,
|
|
0);
|
|
|
|
regulator_disable(priv->avdd);
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct snd_soc_component_driver t9015_codec_driver = {
|
|
.set_bias_level = t9015_set_bias_level,
|
|
.controls = t9015_snd_controls,
|
|
.num_controls = ARRAY_SIZE(t9015_snd_controls),
|
|
.dapm_widgets = t9015_dapm_widgets,
|
|
.num_dapm_widgets = ARRAY_SIZE(t9015_dapm_widgets),
|
|
.dapm_routes = t9015_dapm_routes,
|
|
.num_dapm_routes = ARRAY_SIZE(t9015_dapm_routes),
|
|
.suspend_bias_off = 1,
|
|
.endianness = 1,
|
|
.non_legacy_dai_naming = 1,
|
|
};
|
|
|
|
static const struct regmap_config t9015_regmap_config = {
|
|
.reg_bits = 32,
|
|
.reg_stride = 4,
|
|
.val_bits = 32,
|
|
.max_register = POWER_CFG,
|
|
};
|
|
|
|
static int t9015_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct t9015 *priv;
|
|
void __iomem *regs;
|
|
struct regmap *regmap;
|
|
int ret;
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
platform_set_drvdata(pdev, priv);
|
|
|
|
priv->pclk = devm_clk_get(dev, "pclk");
|
|
if (IS_ERR(priv->pclk))
|
|
return dev_err_probe(dev, PTR_ERR(priv->pclk), "failed to get core clock\n");
|
|
|
|
priv->avdd = devm_regulator_get(dev, "AVDD");
|
|
if (IS_ERR(priv->avdd))
|
|
return dev_err_probe(dev, PTR_ERR(priv->avdd), "failed to AVDD\n");
|
|
|
|
ret = clk_prepare_enable(priv->pclk);
|
|
if (ret) {
|
|
dev_err(dev, "core clock enable failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = devm_add_action_or_reset(dev,
|
|
(void(*)(void *))clk_disable_unprepare,
|
|
priv->pclk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = device_reset(dev);
|
|
if (ret) {
|
|
dev_err(dev, "reset failed\n");
|
|
return ret;
|
|
}
|
|
|
|
regs = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(regs)) {
|
|
dev_err(dev, "register map failed\n");
|
|
return PTR_ERR(regs);
|
|
}
|
|
|
|
regmap = devm_regmap_init_mmio(dev, regs, &t9015_regmap_config);
|
|
if (IS_ERR(regmap)) {
|
|
dev_err(dev, "regmap init failed\n");
|
|
return PTR_ERR(regmap);
|
|
}
|
|
|
|
/*
|
|
* Initialize output polarity:
|
|
* ATM the output polarity is fixed but in the future it might useful
|
|
* to add DT property to set this depending on the platform needs
|
|
*/
|
|
regmap_write(regmap, LINEOUT_CFG, 0x1111);
|
|
|
|
return devm_snd_soc_register_component(dev, &t9015_codec_driver,
|
|
&t9015_dai, 1);
|
|
}
|
|
|
|
static const struct of_device_id t9015_ids[] __maybe_unused = {
|
|
{ .compatible = "amlogic,t9015", },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, t9015_ids);
|
|
|
|
static struct platform_driver t9015_driver = {
|
|
.driver = {
|
|
.name = "t9015-codec",
|
|
.of_match_table = of_match_ptr(t9015_ids),
|
|
},
|
|
.probe = t9015_probe,
|
|
};
|
|
|
|
module_platform_driver(t9015_driver);
|
|
|
|
MODULE_DESCRIPTION("ASoC Amlogic T9015 codec driver");
|
|
MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
|
|
MODULE_LICENSE("GPL");
|