mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-05 10:04:12 +08:00
c101ce8883
Now we can use asoc_substream_to_rtd() macro, let's use it. Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Link: https://lore.kernel.org/r/87lfjf0yuf.wl-kuninori.morimoto.gx@renesas.com Signed-off-by: Mark Brown <broonie@kernel.org>
220 lines
4.9 KiB
C
220 lines
4.9 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
//
|
|
// smdk_spdif.c - S/PDIF audio for SMDK
|
|
//
|
|
// Copyright (C) 2010 Samsung Electronics Co., Ltd.
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/module.h>
|
|
|
|
#include <sound/soc.h>
|
|
|
|
#include "spdif.h"
|
|
|
|
/* Audio clock settings are belonged to board specific part. Every
|
|
* board can set audio source clock setting which is matched with H/W
|
|
* like this function-'set_audio_clock_heirachy'.
|
|
*/
|
|
static int set_audio_clock_heirachy(struct platform_device *pdev)
|
|
{
|
|
struct clk *fout_epll, *mout_epll, *sclk_audio0, *sclk_spdif;
|
|
int ret = 0;
|
|
|
|
fout_epll = clk_get(NULL, "fout_epll");
|
|
if (IS_ERR(fout_epll)) {
|
|
printk(KERN_WARNING "%s: Cannot find fout_epll.\n",
|
|
__func__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
mout_epll = clk_get(NULL, "mout_epll");
|
|
if (IS_ERR(mout_epll)) {
|
|
printk(KERN_WARNING "%s: Cannot find mout_epll.\n",
|
|
__func__);
|
|
ret = -EINVAL;
|
|
goto out1;
|
|
}
|
|
|
|
sclk_audio0 = clk_get(&pdev->dev, "sclk_audio");
|
|
if (IS_ERR(sclk_audio0)) {
|
|
printk(KERN_WARNING "%s: Cannot find sclk_audio.\n",
|
|
__func__);
|
|
ret = -EINVAL;
|
|
goto out2;
|
|
}
|
|
|
|
sclk_spdif = clk_get(NULL, "sclk_spdif");
|
|
if (IS_ERR(sclk_spdif)) {
|
|
printk(KERN_WARNING "%s: Cannot find sclk_spdif.\n",
|
|
__func__);
|
|
ret = -EINVAL;
|
|
goto out3;
|
|
}
|
|
|
|
/* Set audio clock hierarchy for S/PDIF */
|
|
clk_set_parent(mout_epll, fout_epll);
|
|
clk_set_parent(sclk_audio0, mout_epll);
|
|
clk_set_parent(sclk_spdif, sclk_audio0);
|
|
|
|
clk_put(sclk_spdif);
|
|
out3:
|
|
clk_put(sclk_audio0);
|
|
out2:
|
|
clk_put(mout_epll);
|
|
out1:
|
|
clk_put(fout_epll);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* We should haved to set clock directly on this part because of clock
|
|
* scheme of Samsudng SoCs did not support to set rates from abstrct
|
|
* clock of it's hierarchy.
|
|
*/
|
|
static int set_audio_clock_rate(unsigned long epll_rate,
|
|
unsigned long audio_rate)
|
|
{
|
|
struct clk *fout_epll, *sclk_spdif;
|
|
|
|
fout_epll = clk_get(NULL, "fout_epll");
|
|
if (IS_ERR(fout_epll)) {
|
|
printk(KERN_ERR "%s: failed to get fout_epll\n", __func__);
|
|
return -ENOENT;
|
|
}
|
|
|
|
clk_set_rate(fout_epll, epll_rate);
|
|
clk_put(fout_epll);
|
|
|
|
sclk_spdif = clk_get(NULL, "sclk_spdif");
|
|
if (IS_ERR(sclk_spdif)) {
|
|
printk(KERN_ERR "%s: failed to get sclk_spdif\n", __func__);
|
|
return -ENOENT;
|
|
}
|
|
|
|
clk_set_rate(sclk_spdif, audio_rate);
|
|
clk_put(sclk_spdif);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int smdk_hw_params(struct snd_pcm_substream *substream,
|
|
struct snd_pcm_hw_params *params)
|
|
{
|
|
struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
|
|
struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
|
|
unsigned long pll_out, rclk_rate;
|
|
int ret, ratio;
|
|
|
|
switch (params_rate(params)) {
|
|
case 44100:
|
|
pll_out = 45158400;
|
|
break;
|
|
case 32000:
|
|
case 48000:
|
|
case 96000:
|
|
pll_out = 49152000;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Setting ratio to 512fs helps to use S/PDIF with HDMI without
|
|
* modify S/PDIF ASoC machine driver.
|
|
*/
|
|
ratio = 512;
|
|
rclk_rate = params_rate(params) * ratio;
|
|
|
|
/* Set audio source clock rates */
|
|
ret = set_audio_clock_rate(pll_out, rclk_rate);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Set S/PDIF uses internal source clock */
|
|
ret = snd_soc_dai_set_sysclk(cpu_dai, SND_SOC_SPDIF_INT_MCLK,
|
|
rclk_rate, SND_SOC_CLOCK_IN);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const struct snd_soc_ops smdk_spdif_ops = {
|
|
.hw_params = smdk_hw_params,
|
|
};
|
|
|
|
SND_SOC_DAILINK_DEFS(spdif,
|
|
DAILINK_COMP_ARRAY(COMP_CPU("samsung-spdif")),
|
|
DAILINK_COMP_ARRAY(COMP_CODEC("spdif-dit", "dit-hifi")),
|
|
DAILINK_COMP_ARRAY(COMP_PLATFORM("samsung-spdif")));
|
|
|
|
static struct snd_soc_dai_link smdk_dai = {
|
|
.name = "S/PDIF",
|
|
.stream_name = "S/PDIF PCM Playback",
|
|
.ops = &smdk_spdif_ops,
|
|
SND_SOC_DAILINK_REG(spdif),
|
|
};
|
|
|
|
static struct snd_soc_card smdk = {
|
|
.name = "SMDK-S/PDIF",
|
|
.owner = THIS_MODULE,
|
|
.dai_link = &smdk_dai,
|
|
.num_links = 1,
|
|
};
|
|
|
|
static struct platform_device *smdk_snd_spdif_dit_device;
|
|
static struct platform_device *smdk_snd_spdif_device;
|
|
|
|
static int __init smdk_init(void)
|
|
{
|
|
int ret;
|
|
|
|
smdk_snd_spdif_dit_device = platform_device_alloc("spdif-dit", -1);
|
|
if (!smdk_snd_spdif_dit_device)
|
|
return -ENOMEM;
|
|
|
|
ret = platform_device_add(smdk_snd_spdif_dit_device);
|
|
if (ret)
|
|
goto err1;
|
|
|
|
smdk_snd_spdif_device = platform_device_alloc("soc-audio", -1);
|
|
if (!smdk_snd_spdif_device) {
|
|
ret = -ENOMEM;
|
|
goto err2;
|
|
}
|
|
|
|
platform_set_drvdata(smdk_snd_spdif_device, &smdk);
|
|
|
|
ret = platform_device_add(smdk_snd_spdif_device);
|
|
if (ret)
|
|
goto err3;
|
|
|
|
/* Set audio clock hierarchy manually */
|
|
ret = set_audio_clock_heirachy(smdk_snd_spdif_device);
|
|
if (ret)
|
|
goto err4;
|
|
|
|
return 0;
|
|
err4:
|
|
platform_device_del(smdk_snd_spdif_device);
|
|
err3:
|
|
platform_device_put(smdk_snd_spdif_device);
|
|
err2:
|
|
platform_device_del(smdk_snd_spdif_dit_device);
|
|
err1:
|
|
platform_device_put(smdk_snd_spdif_dit_device);
|
|
return ret;
|
|
}
|
|
|
|
static void __exit smdk_exit(void)
|
|
{
|
|
platform_device_unregister(smdk_snd_spdif_device);
|
|
platform_device_unregister(smdk_snd_spdif_dit_device);
|
|
}
|
|
|
|
module_init(smdk_init);
|
|
module_exit(smdk_exit);
|
|
|
|
MODULE_AUTHOR("Seungwhan Youn, <sw.youn@samsung.com>");
|
|
MODULE_DESCRIPTION("ALSA SoC SMDK+S/PDIF");
|
|
MODULE_LICENSE("GPL");
|