544 lines
14 KiB
C
544 lines
14 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// rk3228_codec.c -- rk3228 ALSA Soc Audio driver
|
|
//
|
|
// Copyright (c) 2018, Fuzhou Rockchip Electronics Co., Ltd All rights reserved.
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/device.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/regmap.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/dmaengine_pcm.h>
|
|
#include "rk3228_codec.h"
|
|
|
|
/*
|
|
* volume setting
|
|
* 0: -39dB
|
|
* 26: 0dB
|
|
* 31: 6dB
|
|
* Step: 1.5dB
|
|
*/
|
|
#define OUT_VOLUME (0x18)
|
|
#define INITIAL_FREQ (11289600)
|
|
|
|
struct rk3228_codec_priv {
|
|
struct regmap *regmap;
|
|
struct clk *mclk;
|
|
struct clk *pclk;
|
|
struct clk *sclk;
|
|
struct gpio_desc *spk_en_gpio;
|
|
int spk_depop_time; /* msec */
|
|
};
|
|
|
|
static const struct reg_default rk3228_codec_reg_defaults[] = {
|
|
{ CODEC_RESET, 0x03 },
|
|
{ DAC_INIT_CTRL1, 0x00 },
|
|
{ DAC_INIT_CTRL2, 0x50 },
|
|
{ DAC_INIT_CTRL3, 0x0e },
|
|
{ DAC_PRECHARGE_CTRL, 0x01 },
|
|
{ DAC_PWR_CTRL, 0x00 },
|
|
{ DAC_CLK_CTRL, 0x00 },
|
|
{ HPMIX_CTRL, 0x00 },
|
|
{ HPOUT_CTRL, 0x00 },
|
|
{ HPOUTL_GAIN_CTRL, 0x00 },
|
|
{ HPOUTR_GAIN_CTRL, 0x00 },
|
|
{ HPOUT_POP_CTRL, 0x11 },
|
|
};
|
|
|
|
static int rk3228_codec_reset(struct snd_soc_component *component)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
|
|
regmap_write(rk3228->regmap, CODEC_RESET, 0);
|
|
mdelay(10);
|
|
regmap_write(rk3228->regmap, CODEC_RESET, 0x03);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rk3228_set_dai_fmt(struct snd_soc_dai *dai,
|
|
unsigned int fmt)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
unsigned int val = 0;
|
|
|
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
|
case SND_SOC_DAIFMT_CBS_CFS:
|
|
val |= PIN_DIRECTION_IN | DAC_I2S_MODE_SLAVE;
|
|
break;
|
|
case SND_SOC_DAIFMT_CBM_CFM:
|
|
val |= PIN_DIRECTION_OUT | DAC_I2S_MODE_MASTER;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_INIT_CTRL1,
|
|
PIN_DIRECTION_MASK | DAC_I2S_MODE_MASK, val);
|
|
|
|
val = 0;
|
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
|
case SND_SOC_DAIFMT_DSP_A:
|
|
case SND_SOC_DAIFMT_DSP_B:
|
|
val |= DAC_MODE_PCM;
|
|
break;
|
|
case SND_SOC_DAIFMT_I2S:
|
|
val |= DAC_MODE_I2S;
|
|
break;
|
|
case SND_SOC_DAIFMT_RIGHT_J:
|
|
val |= DAC_MODE_RJM;
|
|
break;
|
|
case SND_SOC_DAIFMT_LEFT_J:
|
|
val |= DAC_MODE_LJM;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_INIT_CTRL2,
|
|
DAC_MODE_MASK, val);
|
|
return 0;
|
|
}
|
|
|
|
static void rk3228_analog_output(struct rk3228_codec_priv *rk3228, int mute)
|
|
{
|
|
if (rk3228->spk_en_gpio)
|
|
gpiod_set_value(rk3228->spk_en_gpio, mute);
|
|
}
|
|
|
|
static int rk3228_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
unsigned int val = 0;
|
|
|
|
if (mute)
|
|
val = HPOUTL_MUTE | HPOUTR_MUTE;
|
|
else
|
|
val = HPOUTL_UNMUTE | HPOUTR_UNMUTE;
|
|
|
|
regmap_update_bits(rk3228->regmap, HPOUT_CTRL,
|
|
HPOUTL_MUTE_MASK | HPOUTR_MUTE_MASK, val);
|
|
return 0;
|
|
}
|
|
|
|
static int rk3228_codec_power_on(struct snd_soc_component *component, int wait_ms)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_XCHARGE_MASK, DAC_CHARGE_PRECHARGE);
|
|
mdelay(10);
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_CURRENT_ALL_MASK,
|
|
DAC_CHARGE_CURRENT_ALL_ON);
|
|
|
|
mdelay(wait_ms);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rk3228_codec_power_off(struct snd_soc_component *component, int wait_ms)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_XCHARGE_MASK, DAC_CHARGE_DISCHARGE);
|
|
mdelay(10);
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_CURRENT_ALL_MASK,
|
|
DAC_CHARGE_CURRENT_ALL_ON);
|
|
|
|
mdelay(wait_ms);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct rk3228_reg_msk_val playback_open_list[] = {
|
|
{ DAC_PWR_CTRL, DAC_PWR_MASK, DAC_PWR_ON },
|
|
{ DAC_PWR_CTRL, DACL_PATH_REFV_MASK | DACR_PATH_REFV_MASK,
|
|
DACL_PATH_REFV_ON | DACR_PATH_REFV_ON },
|
|
{ DAC_PWR_CTRL, HPOUTL_ZERO_CROSSING_ON | HPOUTR_ZERO_CROSSING_ON,
|
|
HPOUTL_ZERO_CROSSING_ON | HPOUTR_ZERO_CROSSING_ON },
|
|
{ HPOUT_POP_CTRL, HPOUTR_POP_MASK | HPOUTL_POP_MASK,
|
|
HPOUTR_POP_WORK | HPOUTL_POP_WORK },
|
|
{ HPMIX_CTRL, HPMIXL_MASK | HPMIXR_MASK, HPMIXL_EN | HPMIXR_EN },
|
|
{ HPMIX_CTRL, HPMIXL_INIT_MASK | HPMIXR_INIT_MASK,
|
|
HPMIXL_INIT_EN | HPMIXR_INIT_EN },
|
|
{ HPOUT_CTRL, HPOUTL_MASK | HPOUTR_MASK, HPOUTL_EN | HPOUTR_EN },
|
|
{ HPOUT_CTRL, HPOUTL_INIT_MASK | HPOUTR_INIT_MASK,
|
|
HPOUTL_INIT_EN | HPOUTR_INIT_EN },
|
|
{ DAC_CLK_CTRL, DACL_REFV_MASK | DACR_REFV_MASK,
|
|
DACL_REFV_ON | DACR_REFV_ON },
|
|
{ DAC_CLK_CTRL, DACL_CLK_MASK | DACR_CLK_MASK,
|
|
DACL_CLK_ON | DACR_CLK_ON },
|
|
{ DAC_CLK_CTRL, DACL_MASK | DACR_MASK, DACL_ON | DACR_ON },
|
|
{ DAC_CLK_CTRL, DACL_INIT_MASK | DACR_INIT_MASK,
|
|
DACL_INIT_ON | DACR_INIT_ON },
|
|
{ DAC_SELECT, DACL_SELECT_MASK | DACR_SELECT_MASK,
|
|
DACL_SELECT | DACR_SELECT },
|
|
{ HPMIX_CTRL, HPMIXL_INIT2_MASK | HPMIXR_INIT2_MASK,
|
|
HPMIXL_INIT2_EN | HPMIXR_INIT2_EN },
|
|
{ HPOUT_CTRL, HPOUTL_MUTE_MASK | HPOUTR_MUTE_MASK,
|
|
HPOUTL_UNMUTE | HPOUTR_UNMUTE },
|
|
};
|
|
|
|
#define PLAYBACK_OPEN_LIST_LEN ARRAY_SIZE(playback_open_list)
|
|
|
|
static int rk3228_codec_open_playback(struct snd_soc_component *component)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
int i = 0;
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_CURRENT_ALL_MASK,
|
|
DAC_CHARGE_CURRENT_I);
|
|
|
|
for (i = 0; i < PLAYBACK_OPEN_LIST_LEN; i++) {
|
|
regmap_update_bits(rk3228->regmap,
|
|
playback_open_list[i].reg,
|
|
playback_open_list[i].msk,
|
|
playback_open_list[i].val);
|
|
mdelay(1);
|
|
}
|
|
|
|
msleep(rk3228->spk_depop_time);
|
|
rk3228_analog_output(rk3228, 1);
|
|
|
|
regmap_update_bits(rk3228->regmap, HPOUTL_GAIN_CTRL,
|
|
HPOUTL_GAIN_MASK, OUT_VOLUME);
|
|
regmap_update_bits(rk3228->regmap, HPOUTR_GAIN_CTRL,
|
|
HPOUTR_GAIN_MASK, OUT_VOLUME);
|
|
return 0;
|
|
}
|
|
|
|
static struct rk3228_reg_msk_val playback_close_list[] = {
|
|
{ HPMIX_CTRL, HPMIXL_INIT2_MASK | HPMIXR_INIT2_MASK,
|
|
HPMIXL_INIT2_DIS | HPMIXR_INIT2_DIS },
|
|
{ DAC_SELECT, DACL_SELECT_MASK | DACR_SELECT_MASK,
|
|
DACL_DESELECT | DACR_DESELECT },
|
|
{ HPOUT_CTRL, HPOUTL_MUTE_MASK | HPOUTR_MUTE_MASK,
|
|
HPOUTL_MUTE | HPOUTR_MUTE },
|
|
{ HPOUT_CTRL, HPOUTL_INIT_MASK | HPOUTR_INIT_MASK,
|
|
HPOUTL_INIT_DIS | HPOUTR_INIT_DIS },
|
|
{ HPOUT_CTRL, HPOUTL_MASK | HPOUTR_MASK, HPOUTL_DIS | HPOUTR_DIS },
|
|
{ HPMIX_CTRL, HPMIXL_MASK | HPMIXR_MASK, HPMIXL_DIS | HPMIXR_DIS },
|
|
{ DAC_CLK_CTRL, DACL_MASK | DACR_MASK, DACL_OFF | DACR_OFF },
|
|
{ DAC_CLK_CTRL, DACL_CLK_MASK | DACR_CLK_MASK,
|
|
DACL_CLK_OFF | DACR_CLK_OFF },
|
|
{ DAC_CLK_CTRL, DACL_REFV_MASK | DACR_REFV_MASK,
|
|
DACL_REFV_OFF | DACR_REFV_OFF },
|
|
{ HPOUT_POP_CTRL, HPOUTR_POP_MASK | HPOUTL_POP_MASK,
|
|
HPOUTR_POP_XCHARGE | HPOUTL_POP_XCHARGE },
|
|
{ DAC_PWR_CTRL, DACL_PATH_REFV_MASK | DACR_PATH_REFV_MASK,
|
|
DACL_PATH_REFV_OFF | DACR_PATH_REFV_OFF },
|
|
{ DAC_PWR_CTRL, DAC_PWR_MASK, DAC_PWR_OFF },
|
|
{ HPMIX_CTRL, HPMIXL_INIT_MASK | HPMIXR_INIT_MASK,
|
|
HPMIXL_INIT_DIS | HPMIXR_INIT_DIS },
|
|
{ DAC_CLK_CTRL, DACL_INIT_MASK | DACR_INIT_MASK,
|
|
DACL_INIT_OFF | DACR_INIT_OFF },
|
|
};
|
|
|
|
#define PLAYBACK_CLOSE_LIST_LEN ARRAY_SIZE(playback_close_list)
|
|
|
|
static int rk3228_codec_close_playback(struct snd_soc_component *component)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
int i = 0;
|
|
|
|
rk3228_analog_output(rk3228, 0);
|
|
|
|
regmap_update_bits(rk3228->regmap, HPOUTL_GAIN_CTRL,
|
|
HPOUTL_GAIN_MASK, 0);
|
|
regmap_update_bits(rk3228->regmap, HPOUTR_GAIN_CTRL,
|
|
HPOUTR_GAIN_MASK, 0);
|
|
|
|
for (i = 0; i < PLAYBACK_CLOSE_LIST_LEN; i++) {
|
|
regmap_update_bits(rk3228->regmap,
|
|
playback_close_list[i].reg,
|
|
playback_close_list[i].msk,
|
|
playback_close_list[i].val);
|
|
mdelay(1);
|
|
}
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_PRECHARGE_CTRL,
|
|
DAC_CHARGE_CURRENT_ALL_MASK,
|
|
DAC_CHARGE_CURRENT_I);
|
|
return 0;
|
|
}
|
|
|
|
static int rk3228_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
struct rk3228_codec_priv *rk3228 = snd_soc_component_get_drvdata(component);
|
|
unsigned int val = 0;
|
|
|
|
switch (params_format(params)) {
|
|
case SNDRV_PCM_FORMAT_S16_LE:
|
|
val |= DAC_VDL_16BITS;
|
|
break;
|
|
case SNDRV_PCM_FORMAT_S20_3LE:
|
|
val |= DAC_VDL_20BITS;
|
|
break;
|
|
case SNDRV_PCM_FORMAT_S24_LE:
|
|
val |= DAC_VDL_24BITS;
|
|
break;
|
|
case SNDRV_PCM_FORMAT_S32_LE:
|
|
val |= DAC_VDL_32BITS;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
regmap_update_bits(rk3228->regmap, DAC_INIT_CTRL2, DAC_VDL_MASK, val);
|
|
val = DAC_WL_32BITS | DAC_RST_DIS;
|
|
regmap_update_bits(rk3228->regmap, DAC_INIT_CTRL3,
|
|
DAC_WL_MASK | DAC_RST_MASK, val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rk3228_pcm_startup(struct snd_pcm_substream *substream,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
|
|
return rk3228_codec_open_playback(component);
|
|
}
|
|
|
|
static void rk3228_pcm_shutdown(struct snd_pcm_substream *substream,
|
|
struct snd_soc_dai *dai)
|
|
{
|
|
struct snd_soc_component *component = dai->component;
|
|
|
|
rk3228_codec_close_playback(component);
|
|
}
|
|
|
|
static struct snd_soc_dai_ops rk3228_dai_ops = {
|
|
.hw_params = rk3228_hw_params,
|
|
.set_fmt = rk3228_set_dai_fmt,
|
|
.mute_stream = rk3228_digital_mute,
|
|
.startup = rk3228_pcm_startup,
|
|
.shutdown = rk3228_pcm_shutdown,
|
|
.no_capture_mute = 1,
|
|
};
|
|
|
|
static struct snd_soc_dai_driver rk3228_dai[] = {
|
|
{
|
|
.name = "rk3228-hifi",
|
|
.id = RK3228_HIFI,
|
|
.playback = {
|
|
.stream_name = "HIFI Playback",
|
|
.channels_min = 1,
|
|
.channels_max = 2,
|
|
.rates = SNDRV_PCM_RATE_8000_96000,
|
|
.formats = (SNDRV_PCM_FMTBIT_S16_LE |
|
|
SNDRV_PCM_FMTBIT_S20_3LE |
|
|
SNDRV_PCM_FMTBIT_S24_LE |
|
|
SNDRV_PCM_FMTBIT_S32_LE),
|
|
},
|
|
.capture = {
|
|
.stream_name = "HIFI Capture",
|
|
.channels_min = 2,
|
|
.channels_max = 8,
|
|
.rates = SNDRV_PCM_RATE_8000_96000,
|
|
.formats = (SNDRV_PCM_FMTBIT_S16_LE |
|
|
SNDRV_PCM_FMTBIT_S20_3LE |
|
|
SNDRV_PCM_FMTBIT_S24_LE |
|
|
SNDRV_PCM_FMTBIT_S32_LE),
|
|
},
|
|
.ops = &rk3228_dai_ops,
|
|
},
|
|
};
|
|
|
|
static int rk3228_codec_probe(struct snd_soc_component *component)
|
|
{
|
|
rk3228_codec_reset(component);
|
|
rk3228_codec_power_on(component, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void rk3228_codec_remove(struct snd_soc_component *component)
|
|
{
|
|
rk3228_codec_close_playback(component);
|
|
rk3228_codec_power_off(component, 0);
|
|
}
|
|
|
|
static struct snd_soc_component_driver soc_codec_dev_rk3228 = {
|
|
.probe = rk3228_codec_probe,
|
|
.remove = rk3228_codec_remove,
|
|
};
|
|
|
|
static bool rk3228_codec_write_read_reg(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case CODEC_RESET:
|
|
case DAC_INIT_CTRL1:
|
|
case DAC_INIT_CTRL2:
|
|
case DAC_INIT_CTRL3:
|
|
case DAC_PRECHARGE_CTRL:
|
|
case DAC_PWR_CTRL:
|
|
case DAC_CLK_CTRL:
|
|
case HPMIX_CTRL:
|
|
case DAC_SELECT:
|
|
case HPOUT_CTRL:
|
|
case HPOUTL_GAIN_CTRL:
|
|
case HPOUTR_GAIN_CTRL:
|
|
case HPOUT_POP_CTRL:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool rk3228_codec_volatile_reg(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case CODEC_RESET:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static const struct regmap_config rk3228_codec_regmap_config = {
|
|
.reg_bits = 32,
|
|
.reg_stride = 4,
|
|
.val_bits = 32,
|
|
.max_register = HPOUT_POP_CTRL,
|
|
.writeable_reg = rk3228_codec_write_read_reg,
|
|
.readable_reg = rk3228_codec_write_read_reg,
|
|
.volatile_reg = rk3228_codec_volatile_reg,
|
|
.reg_defaults = rk3228_codec_reg_defaults,
|
|
.num_reg_defaults = ARRAY_SIZE(rk3228_codec_reg_defaults),
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id rk3228codec_of_match[] = {
|
|
{ .compatible = "rockchip,rk3228-codec", },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, rk3228codec_of_match);
|
|
#endif
|
|
|
|
static int rk3228_platform_probe(struct platform_device *pdev)
|
|
{
|
|
struct device_node *rk3228_np = pdev->dev.of_node;
|
|
struct rk3228_codec_priv *rk3228;
|
|
struct resource *res;
|
|
void __iomem *base;
|
|
int ret = 0;
|
|
|
|
rk3228 = devm_kzalloc(&pdev->dev, sizeof(*rk3228), GFP_KERNEL);
|
|
if (!rk3228)
|
|
return -ENOMEM;
|
|
|
|
rk3228->mclk = devm_clk_get(&pdev->dev, "mclk");
|
|
if (PTR_ERR(rk3228->mclk) == -EPROBE_DEFER)
|
|
return -EPROBE_DEFER;
|
|
|
|
rk3228->pclk = devm_clk_get(&pdev->dev, "pclk");
|
|
if (IS_ERR(rk3228->pclk))
|
|
return PTR_ERR(rk3228->pclk);
|
|
|
|
rk3228->sclk = devm_clk_get(&pdev->dev, "sclk");
|
|
if (IS_ERR(rk3228->sclk))
|
|
return PTR_ERR(rk3228->sclk);
|
|
|
|
rk3228->spk_en_gpio = devm_gpiod_get_optional(&pdev->dev,
|
|
"spk-en",
|
|
GPIOD_OUT_LOW);
|
|
if (IS_ERR(rk3228->spk_en_gpio))
|
|
return PTR_ERR(rk3228->spk_en_gpio);
|
|
|
|
ret = of_property_read_u32(rk3228_np, "spk-depop-time-ms",
|
|
&rk3228->spk_depop_time);
|
|
if (ret < 0) {
|
|
dev_info(&pdev->dev, "spk_depop_time use default value.\n");
|
|
rk3228->spk_depop_time = 100;
|
|
}
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
base = devm_ioremap_resource(&pdev->dev, res);
|
|
if (IS_ERR(base))
|
|
return PTR_ERR(base);
|
|
|
|
ret = clk_prepare_enable(rk3228->mclk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = clk_prepare_enable(rk3228->pclk);
|
|
if (ret < 0)
|
|
goto err_pclk;
|
|
|
|
ret = clk_prepare_enable(rk3228->sclk);
|
|
if (ret)
|
|
goto err_sclk;
|
|
|
|
clk_set_rate(rk3228->sclk, INITIAL_FREQ);
|
|
|
|
rk3228->regmap = devm_regmap_init_mmio(&pdev->dev, base,
|
|
&rk3228_codec_regmap_config);
|
|
if (IS_ERR(rk3228->regmap)) {
|
|
ret = PTR_ERR(rk3228->regmap);
|
|
goto err_clk;
|
|
}
|
|
|
|
platform_set_drvdata(pdev, rk3228);
|
|
|
|
ret = devm_snd_soc_register_component(&pdev->dev, &soc_codec_dev_rk3228,
|
|
rk3228_dai, ARRAY_SIZE(rk3228_dai));
|
|
if (!ret)
|
|
return 0;
|
|
|
|
err_clk:
|
|
clk_disable_unprepare(rk3228->sclk);
|
|
err_sclk:
|
|
clk_disable_unprepare(rk3228->pclk);
|
|
err_pclk:
|
|
clk_disable_unprepare(rk3228->mclk);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rk3228_platform_remove(struct platform_device *pdev)
|
|
{
|
|
struct rk3228_codec_priv *rk3228 = platform_get_drvdata(pdev);
|
|
|
|
if (!IS_ERR(rk3228->mclk))
|
|
clk_disable_unprepare(rk3228->mclk);
|
|
|
|
if (!IS_ERR(rk3228->pclk))
|
|
clk_disable_unprepare(rk3228->pclk);
|
|
|
|
if (!IS_ERR(rk3228->sclk))
|
|
clk_disable_unprepare(rk3228->sclk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver rk3228_codec_driver = {
|
|
.driver = {
|
|
.name = "rk3228-codec",
|
|
.of_match_table = of_match_ptr(rk3228codec_of_match),
|
|
},
|
|
.probe = rk3228_platform_probe,
|
|
.remove = rk3228_platform_remove,
|
|
};
|
|
module_platform_driver(rk3228_codec_driver);
|
|
|
|
MODULE_AUTHOR("Sugar Zhang <sugar.zhang@rock-chips.com>");
|
|
MODULE_DESCRIPTION("ASoC rk3228 codec driver");
|
|
MODULE_LICENSE("GPL v2");
|