491 lines
14 KiB
C
491 lines
14 KiB
C
|
/*
|
||
|
|
* Driver of Inno codec for rk3036 by Rockchip Inc.
|
||
|
|
*
|
||
|
|
* Author: Rockchip Inc.
|
||
|
|
* Author: Zheng ShunQian<zhengsq@rock-chips.com>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <sound/soc.h>
|
||
|
|
#include <sound/tlv.h>
|
||
|
|
#include <sound/soc-dapm.h>
|
||
|
|
#include <sound/soc-dai.h>
|
||
|
|
#include <sound/pcm.h>
|
||
|
|
#include <sound/pcm_params.h>
|
||
|
|
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
#include <linux/of.h>
|
||
|
|
#include <linux/clk.h>
|
||
|
|
#include <linux/regmap.h>
|
||
|
|
#include <linux/device.h>
|
||
|
|
#include <linux/mfd/syscon.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
|
||
|
|
#include "inno_rk3036.h"
|
||
|
|
|
||
|
|
struct rk3036_codec_priv {
|
||
|
|
void __iomem *base;
|
||
|
|
struct clk *pclk;
|
||
|
|
struct regmap *regmap;
|
||
|
|
struct device *dev;
|
||
|
|
};
|
||
|
|
|
||
|
|
static const DECLARE_TLV_DB_MINMAX(rk3036_codec_hp_tlv, -39, 0);
|
||
|
|
|
||
|
|
static int rk3036_codec_antipop_info(struct snd_kcontrol *kcontrol,
|
||
|
|
struct snd_ctl_elem_info *uinfo)
|
||
|
|
{
|
||
|
|
uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
|
||
|
|
uinfo->count = 2;
|
||
|
|
uinfo->value.integer.min = 0;
|
||
|
|
uinfo->value.integer.max = 1;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_antipop_get(struct snd_kcontrol *kcontrol,
|
||
|
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
|
{
|
||
|
|
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
|
||
|
|
int val, ret, regval;
|
||
|
|
|
||
|
|
ret = snd_soc_component_read(component, INNO_R09, ®val);
|
||
|
|
if (ret)
|
||
|
|
return ret;
|
||
|
|
val = ((regval >> INNO_R09_HPL_ANITPOP_SHIFT) &
|
||
|
|
INNO_R09_HP_ANTIPOP_MSK) == INNO_R09_HP_ANTIPOP_ON;
|
||
|
|
ucontrol->value.integer.value[0] = val;
|
||
|
|
|
||
|
|
val = ((regval >> INNO_R09_HPR_ANITPOP_SHIFT) &
|
||
|
|
INNO_R09_HP_ANTIPOP_MSK) == INNO_R09_HP_ANTIPOP_ON;
|
||
|
|
ucontrol->value.integer.value[1] = val;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_antipop_put(struct snd_kcontrol *kcontrol,
|
||
|
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
|
{
|
||
|
|
struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
|
||
|
|
int val, ret, regmsk;
|
||
|
|
|
||
|
|
val = (ucontrol->value.integer.value[0] ?
|
||
|
|
INNO_R09_HP_ANTIPOP_ON : INNO_R09_HP_ANTIPOP_OFF) <<
|
||
|
|
INNO_R09_HPL_ANITPOP_SHIFT;
|
||
|
|
val |= (ucontrol->value.integer.value[1] ?
|
||
|
|
INNO_R09_HP_ANTIPOP_ON : INNO_R09_HP_ANTIPOP_OFF) <<
|
||
|
|
INNO_R09_HPR_ANITPOP_SHIFT;
|
||
|
|
|
||
|
|
regmsk = INNO_R09_HP_ANTIPOP_MSK << INNO_R09_HPL_ANITPOP_SHIFT |
|
||
|
|
INNO_R09_HP_ANTIPOP_MSK << INNO_R09_HPR_ANITPOP_SHIFT;
|
||
|
|
|
||
|
|
ret = snd_soc_component_update_bits(component, INNO_R09,
|
||
|
|
regmsk, val);
|
||
|
|
if (ret < 0)
|
||
|
|
return ret;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#define SOC_RK3036_CODEC_ANTIPOP_DECL(xname) \
|
||
|
|
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
|
||
|
|
.info = rk3036_codec_antipop_info, .get = rk3036_codec_antipop_get, \
|
||
|
|
.put = rk3036_codec_antipop_put, }
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new rk3036_codec_dapm_controls[] = {
|
||
|
|
SOC_DOUBLE_R_RANGE_TLV("Headphone Volume", INNO_R07, INNO_R08,
|
||
|
|
INNO_HP_GAIN_SHIFT, INNO_HP_GAIN_N39DB,
|
||
|
|
INNO_HP_GAIN_0DB, 0, rk3036_codec_hp_tlv),
|
||
|
|
SOC_DOUBLE("Zero Cross Switch", INNO_R06, INNO_R06_VOUTL_CZ_SHIFT,
|
||
|
|
INNO_R06_VOUTR_CZ_SHIFT, 1, 0),
|
||
|
|
SOC_DOUBLE("Headphone Switch", INNO_R09, INNO_R09_HPL_MUTE_SHIFT,
|
||
|
|
INNO_R09_HPR_MUTE_SHIFT, 1, 0),
|
||
|
|
SOC_RK3036_CODEC_ANTIPOP_DECL("Anti-pop Switch"),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new rk3036_codec_hpl_mixer_controls[] = {
|
||
|
|
SOC_DAPM_SINGLE("DAC Left Out Switch", INNO_R09,
|
||
|
|
INNO_R09_DACL_SWITCH_SHIFT, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new rk3036_codec_hpr_mixer_controls[] = {
|
||
|
|
SOC_DAPM_SINGLE("DAC Right Out Switch", INNO_R09,
|
||
|
|
INNO_R09_DACR_SWITCH_SHIFT, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new rk3036_codec_hpl_switch_controls[] = {
|
||
|
|
SOC_DAPM_SINGLE("HP Left Out Switch", INNO_R05,
|
||
|
|
INNO_R05_HPL_WORK_SHIFT, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_kcontrol_new rk3036_codec_hpr_switch_controls[] = {
|
||
|
|
SOC_DAPM_SINGLE("HP Right Out Switch", INNO_R05,
|
||
|
|
INNO_R05_HPR_WORK_SHIFT, 1, 0),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_soc_dapm_widget rk3036_codec_dapm_widgets[] = {
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DAC PWR", 1, INNO_R06,
|
||
|
|
INNO_R06_DAC_EN_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACL VREF", 2, INNO_R04,
|
||
|
|
INNO_R04_DACL_VREF_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACR VREF", 2, INNO_R04,
|
||
|
|
INNO_R04_DACR_VREF_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACL HiLo VREF", 3, INNO_R06,
|
||
|
|
INNO_R06_DACL_HILO_VREF_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACR HiLo VREF", 3, INNO_R06,
|
||
|
|
INNO_R06_DACR_HILO_VREF_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACR CLK", 3, INNO_R04,
|
||
|
|
INNO_R04_DACR_CLK_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_SUPPLY_S("DACL CLK", 3, INNO_R04,
|
||
|
|
INNO_R04_DACL_CLK_SHIFT, 0, NULL, 0),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_DAC("DACL", "Left Playback", INNO_R04,
|
||
|
|
INNO_R04_DACL_SW_SHIFT, 0),
|
||
|
|
SND_SOC_DAPM_DAC("DACR", "Right Playback", INNO_R04,
|
||
|
|
INNO_R04_DACR_SW_SHIFT, 0),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
|
||
|
|
rk3036_codec_hpl_mixer_controls,
|
||
|
|
ARRAY_SIZE(rk3036_codec_hpl_mixer_controls)),
|
||
|
|
SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
|
||
|
|
rk3036_codec_hpr_mixer_controls,
|
||
|
|
ARRAY_SIZE(rk3036_codec_hpr_mixer_controls)),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_PGA("HP Left Out", INNO_R05,
|
||
|
|
INNO_R05_HPL_EN_SHIFT, 0, NULL, 0),
|
||
|
|
SND_SOC_DAPM_PGA("HP Right Out", INNO_R05,
|
||
|
|
INNO_R05_HPR_EN_SHIFT, 0, NULL, 0),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_MIXER("HP Left Switch", SND_SOC_NOPM, 0, 0,
|
||
|
|
rk3036_codec_hpl_switch_controls,
|
||
|
|
ARRAY_SIZE(rk3036_codec_hpl_switch_controls)),
|
||
|
|
SND_SOC_DAPM_MIXER("HP Right Switch", SND_SOC_NOPM, 0, 0,
|
||
|
|
rk3036_codec_hpr_switch_controls,
|
||
|
|
ARRAY_SIZE(rk3036_codec_hpr_switch_controls)),
|
||
|
|
|
||
|
|
SND_SOC_DAPM_OUTPUT("HPL"),
|
||
|
|
SND_SOC_DAPM_OUTPUT("HPR"),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct snd_soc_dapm_route rk3036_codec_dapm_routes[] = {
|
||
|
|
{"DACL VREF", NULL, "DAC PWR"},
|
||
|
|
{"DACR VREF", NULL, "DAC PWR"},
|
||
|
|
{"DACL HiLo VREF", NULL, "DAC PWR"},
|
||
|
|
{"DACR HiLo VREF", NULL, "DAC PWR"},
|
||
|
|
{"DACL CLK", NULL, "DAC PWR"},
|
||
|
|
{"DACR CLK", NULL, "DAC PWR"},
|
||
|
|
|
||
|
|
{"DACL", NULL, "DACL VREF"},
|
||
|
|
{"DACL", NULL, "DACL HiLo VREF"},
|
||
|
|
{"DACL", NULL, "DACL CLK"},
|
||
|
|
{"DACR", NULL, "DACR VREF"},
|
||
|
|
{"DACR", NULL, "DACR HiLo VREF"},
|
||
|
|
{"DACR", NULL, "DACR CLK"},
|
||
|
|
|
||
|
|
{"Left Headphone Mixer", "DAC Left Out Switch", "DACL"},
|
||
|
|
{"Right Headphone Mixer", "DAC Right Out Switch", "DACR"},
|
||
|
|
{"HP Left Out", NULL, "Left Headphone Mixer"},
|
||
|
|
{"HP Right Out", NULL, "Right Headphone Mixer"},
|
||
|
|
|
||
|
|
{"HP Left Switch", "HP Left Out Switch", "HP Left Out"},
|
||
|
|
{"HP Right Switch", "HP Right Out Switch", "HP Right Out"},
|
||
|
|
|
||
|
|
{"HPL", NULL, "HP Left Switch"},
|
||
|
|
{"HPR", NULL, "HP Right Switch"},
|
||
|
|
};
|
||
|
|
|
||
|
|
static int rk3036_codec_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
|
||
|
|
{
|
||
|
|
struct snd_soc_codec *codec = dai->codec;
|
||
|
|
unsigned int reg01_val = 0, reg02_val = 0, reg03_val = 0;
|
||
|
|
|
||
|
|
dev_dbg(codec->dev, "rk3036_codec dai set fmt : %08x\n", fmt);
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_CBS_CFS:
|
||
|
|
reg01_val |= INNO_R01_PINDIR_IN_SLAVE |
|
||
|
|
INNO_R01_I2SMODE_SLAVE;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_CBM_CFM:
|
||
|
|
reg01_val |= INNO_R01_PINDIR_OUT_MASTER |
|
||
|
|
INNO_R01_I2SMODE_MASTER;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
dev_err(codec->dev, "invalid fmt\n");
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
|
reg02_val |= INNO_R02_DACM_PCM;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_I2S:
|
||
|
|
reg02_val |= INNO_R02_DACM_I2S;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_RIGHT_J:
|
||
|
|
reg02_val |= INNO_R02_DACM_RJM;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_LEFT_J:
|
||
|
|
reg02_val |= INNO_R02_DACM_LJM;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
dev_err(codec->dev, "set dai format failed\n");
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
||
|
|
case SND_SOC_DAIFMT_NB_NF:
|
||
|
|
reg02_val |= INNO_R02_LRCP_NORMAL;
|
||
|
|
reg03_val |= INNO_R03_BCP_NORMAL;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_IB_IF:
|
||
|
|
reg02_val |= INNO_R02_LRCP_REVERSAL;
|
||
|
|
reg03_val |= INNO_R03_BCP_REVERSAL;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_IB_NF:
|
||
|
|
reg02_val |= INNO_R02_LRCP_REVERSAL;
|
||
|
|
reg03_val |= INNO_R03_BCP_NORMAL;
|
||
|
|
break;
|
||
|
|
case SND_SOC_DAIFMT_NB_IF:
|
||
|
|
reg02_val |= INNO_R02_LRCP_NORMAL;
|
||
|
|
reg03_val |= INNO_R03_BCP_REVERSAL;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
dev_err(codec->dev, "set dai format failed\n");
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
snd_soc_update_bits(codec, INNO_R01, INNO_R01_I2SMODE_MSK |
|
||
|
|
INNO_R01_PINDIR_MSK, reg01_val);
|
||
|
|
snd_soc_update_bits(codec, INNO_R02, INNO_R02_LRCP_MSK |
|
||
|
|
INNO_R02_DACM_MSK, reg02_val);
|
||
|
|
snd_soc_update_bits(codec, INNO_R03, INNO_R03_BCP_MSK, reg03_val);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_dai_hw_params(struct snd_pcm_substream *substream,
|
||
|
|
struct snd_pcm_hw_params *hw_params,
|
||
|
|
struct snd_soc_dai *dai)
|
||
|
|
{
|
||
|
|
struct snd_soc_codec *codec = dai->codec;
|
||
|
|
unsigned int reg02_val = 0, reg03_val = 0;
|
||
|
|
|
||
|
|
switch (params_format(hw_params)) {
|
||
|
|
case SNDRV_PCM_FORMAT_S16_LE:
|
||
|
|
reg02_val |= INNO_R02_VWL_16BIT;
|
||
|
|
break;
|
||
|
|
case SNDRV_PCM_FORMAT_S20_3LE:
|
||
|
|
reg02_val |= INNO_R02_VWL_20BIT;
|
||
|
|
break;
|
||
|
|
case SNDRV_PCM_FORMAT_S24_LE:
|
||
|
|
reg02_val |= INNO_R02_VWL_24BIT;
|
||
|
|
break;
|
||
|
|
case SNDRV_PCM_FORMAT_S32_LE:
|
||
|
|
reg02_val |= INNO_R02_VWL_32BIT;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
reg02_val |= INNO_R02_LRCP_NORMAL;
|
||
|
|
reg03_val |= INNO_R03_FWL_32BIT | INNO_R03_DACR_WORK;
|
||
|
|
|
||
|
|
snd_soc_update_bits(codec, INNO_R02, INNO_R02_LRCP_MSK |
|
||
|
|
INNO_R02_VWL_MSK, reg02_val);
|
||
|
|
snd_soc_update_bits(codec, INNO_R03, INNO_R03_DACR_MSK |
|
||
|
|
INNO_R03_FWL_MSK, reg03_val);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#define RK3036_CODEC_RATES (SNDRV_PCM_RATE_8000 | \
|
||
|
|
SNDRV_PCM_RATE_16000 | \
|
||
|
|
SNDRV_PCM_RATE_32000 | \
|
||
|
|
SNDRV_PCM_RATE_44100 | \
|
||
|
|
SNDRV_PCM_RATE_48000 | \
|
||
|
|
SNDRV_PCM_RATE_96000)
|
||
|
|
|
||
|
|
#define RK3036_CODEC_FMTS (SNDRV_PCM_FMTBIT_S16_LE | \
|
||
|
|
SNDRV_PCM_FMTBIT_S20_3LE | \
|
||
|
|
SNDRV_PCM_FMTBIT_S24_LE | \
|
||
|
|
SNDRV_PCM_FMTBIT_S32_LE)
|
||
|
|
|
||
|
|
static struct snd_soc_dai_ops rk3036_codec_dai_ops = {
|
||
|
|
.set_fmt = rk3036_codec_dai_set_fmt,
|
||
|
|
.hw_params = rk3036_codec_dai_hw_params,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct snd_soc_dai_driver rk3036_codec_dai_driver[] = {
|
||
|
|
{
|
||
|
|
.name = "rk3036-codec-dai",
|
||
|
|
.playback = {
|
||
|
|
.stream_name = "Playback",
|
||
|
|
.channels_min = 1,
|
||
|
|
.channels_max = 2,
|
||
|
|
.rates = RK3036_CODEC_RATES,
|
||
|
|
.formats = RK3036_CODEC_FMTS,
|
||
|
|
},
|
||
|
|
.ops = &rk3036_codec_dai_ops,
|
||
|
|
.symmetric_rates = 1,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static void rk3036_codec_reset(struct snd_soc_codec *codec)
|
||
|
|
{
|
||
|
|
snd_soc_write(codec, INNO_R00,
|
||
|
|
INNO_R00_CSR_RESET | INNO_R00_CDCR_RESET);
|
||
|
|
snd_soc_write(codec, INNO_R00,
|
||
|
|
INNO_R00_CSR_WORK | INNO_R00_CDCR_WORK);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_probe(struct snd_soc_codec *codec)
|
||
|
|
{
|
||
|
|
rk3036_codec_reset(codec);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_remove(struct snd_soc_codec *codec)
|
||
|
|
{
|
||
|
|
rk3036_codec_reset(codec);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_set_bias_level(struct snd_soc_codec *codec,
|
||
|
|
enum snd_soc_bias_level level)
|
||
|
|
{
|
||
|
|
switch (level) {
|
||
|
|
case SND_SOC_BIAS_STANDBY:
|
||
|
|
/* set a big current for capacitor charging. */
|
||
|
|
snd_soc_write(codec, INNO_R10, INNO_R10_MAX_CUR);
|
||
|
|
/* start precharge */
|
||
|
|
snd_soc_write(codec, INNO_R06, INNO_R06_DAC_PRECHARGE);
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case SND_SOC_BIAS_OFF:
|
||
|
|
/* set a big current for capacitor discharging. */
|
||
|
|
snd_soc_write(codec, INNO_R10, INNO_R10_MAX_CUR);
|
||
|
|
/* start discharge. */
|
||
|
|
snd_soc_write(codec, INNO_R06, INNO_R06_DAC_DISCHARGE);
|
||
|
|
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct snd_soc_codec_driver rk3036_codec_driver = {
|
||
|
|
.probe = rk3036_codec_probe,
|
||
|
|
.remove = rk3036_codec_remove,
|
||
|
|
.set_bias_level = rk3036_codec_set_bias_level,
|
||
|
|
.controls = rk3036_codec_dapm_controls,
|
||
|
|
.num_controls = ARRAY_SIZE(rk3036_codec_dapm_controls),
|
||
|
|
.dapm_routes = rk3036_codec_dapm_routes,
|
||
|
|
.num_dapm_routes = ARRAY_SIZE(rk3036_codec_dapm_routes),
|
||
|
|
.dapm_widgets = rk3036_codec_dapm_widgets,
|
||
|
|
.num_dapm_widgets = ARRAY_SIZE(rk3036_codec_dapm_widgets),
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct regmap_config rk3036_codec_regmap_config = {
|
||
|
|
.reg_bits = 32,
|
||
|
|
.reg_stride = 4,
|
||
|
|
.val_bits = 32,
|
||
|
|
};
|
||
|
|
|
||
|
|
#define GRF_SOC_CON0 0x00140
|
||
|
|
#define GRF_ACODEC_SEL (BIT(10) | BIT(16 + 10))
|
||
|
|
|
||
|
|
static int rk3036_codec_platform_probe(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct rk3036_codec_priv *priv;
|
||
|
|
struct device_node *of_node = pdev->dev.of_node;
|
||
|
|
struct resource *res;
|
||
|
|
void __iomem *base;
|
||
|
|
struct regmap *grf;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
|
||
|
|
if (!priv)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||
|
|
base = devm_ioremap_resource(&pdev->dev, res);
|
||
|
|
if (IS_ERR(base))
|
||
|
|
return PTR_ERR(base);
|
||
|
|
|
||
|
|
priv->base = base;
|
||
|
|
priv->regmap = devm_regmap_init_mmio(&pdev->dev, priv->base,
|
||
|
|
&rk3036_codec_regmap_config);
|
||
|
|
if (IS_ERR(priv->regmap)) {
|
||
|
|
dev_err(&pdev->dev, "init regmap failed\n");
|
||
|
|
return PTR_ERR(priv->regmap);
|
||
|
|
}
|
||
|
|
|
||
|
|
grf = syscon_regmap_lookup_by_phandle(of_node, "rockchip,grf");
|
||
|
|
if (IS_ERR(grf)) {
|
||
|
|
dev_err(&pdev->dev, "needs 'rockchip,grf' property\n");
|
||
|
|
return PTR_ERR(grf);
|
||
|
|
}
|
||
|
|
ret = regmap_write(grf, GRF_SOC_CON0, GRF_ACODEC_SEL);
|
||
|
|
if (ret) {
|
||
|
|
dev_err(&pdev->dev, "Could not write to GRF: %d\n", ret);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
priv->pclk = devm_clk_get(&pdev->dev, "acodec_pclk");
|
||
|
|
if (IS_ERR(priv->pclk))
|
||
|
|
return PTR_ERR(priv->pclk);
|
||
|
|
|
||
|
|
ret = clk_prepare_enable(priv->pclk);
|
||
|
|
if (ret < 0) {
|
||
|
|
dev_err(&pdev->dev, "failed to enable clk\n");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
priv->dev = &pdev->dev;
|
||
|
|
dev_set_drvdata(&pdev->dev, priv);
|
||
|
|
|
||
|
|
ret = snd_soc_register_codec(&pdev->dev, &rk3036_codec_driver,
|
||
|
|
rk3036_codec_dai_driver,
|
||
|
|
ARRAY_SIZE(rk3036_codec_dai_driver));
|
||
|
|
if (ret) {
|
||
|
|
clk_disable_unprepare(priv->pclk);
|
||
|
|
dev_set_drvdata(&pdev->dev, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rk3036_codec_platform_remove(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct rk3036_codec_priv *priv = dev_get_drvdata(&pdev->dev);
|
||
|
|
|
||
|
|
snd_soc_unregister_codec(&pdev->dev);
|
||
|
|
clk_disable_unprepare(priv->pclk);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct of_device_id rk3036_codec_of_match[] = {
|
||
|
|
{ .compatible = "rockchip,rk3036-codec", },
|
||
|
|
{}
|
||
|
|
};
|
||
|
|
MODULE_DEVICE_TABLE(of, rk3036_codec_of_match);
|
||
|
|
|
||
|
|
static struct platform_driver rk3036_codec_platform_driver = {
|
||
|
|
.driver = {
|
||
|
|
.name = "rk3036-codec-platform",
|
||
|
|
.of_match_table = of_match_ptr(rk3036_codec_of_match),
|
||
|
|
},
|
||
|
|
.probe = rk3036_codec_platform_probe,
|
||
|
|
.remove = rk3036_codec_platform_remove,
|
||
|
|
};
|
||
|
|
|
||
|
|
module_platform_driver(rk3036_codec_platform_driver);
|
||
|
|
|
||
|
|
MODULE_AUTHOR("Rockchip Inc.");
|
||
|
|
MODULE_DESCRIPTION("Rockchip rk3036 codec driver");
|
||
|
|
MODULE_LICENSE("GPL");
|