Quelle  t9015.c   Sprache: 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 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_CBP_CFP:
  val = I2S_MODE;
  break;

 case SND_SOC_DAIFMT_CBC_CFC:
  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,
};

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;
 struct clk *pclk;
 int ret;

 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 if (!priv)
  return -ENOMEM;
 platform_set_drvdata(pdev, priv);

 pclk = devm_clk_get_enabled(dev, "pclk");
 if (IS_ERR(pclk))
  return dev_err_probe(dev, PTR_ERR(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 = 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 ");
MODULE_LICENSE("GPL");