[deliverable/linux.git] / sound / soc / samsung / smdk_spdif.c

/*
 * smdk_spdif.c  --  S/PDIF audio for SMDK
 *
 * Copyright 2010 Samsung Electronics Co. Ltd.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of the
 * License, or (at your option) any later version.
 *
 */

#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 = substream->private_data;
	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	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 struct snd_soc_ops smdk_spdif_ops = {
	.hw_params = smdk_hw_params,
};

static struct snd_soc_dai_link smdk_dai = {
	.name = "S/PDIF",
	.stream_name = "S/PDIF PCM Playback",
	.platform_name = "samsung-spdif",
	.cpu_dai_name = "samsung-spdif",
	.codec_dai_name = "dit-hifi",
	.codec_name = "spdif-dit",
	.ops = &smdk_spdif_ops,
};

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");
Commit	Line	Data
b67089e4 SY	1	/*
	2	* smdk_spdif.c -- S/PDIF audio for SMDK
	3	*
	4	* Copyright 2010 Samsung Electronics Co. Ltd.
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU General Public License as
	8	* published by the Free Software Foundation; either version 2 of the
	9	* License, or (at your option) any later version.
	10	*
	11	*/
	12
b67089e4	13	#include <linux/clk.h>
da155d5b	14	#include <linux/module.h>
b67089e4	15
b67089e4 SY	16	#include <sound/soc.h>
b67089e4 SY	17
b67089e4 SY	18	#include "spdif.h"
	19
	20	/* Audio clock settings are belonged to board specific part. Every
	21	* board can set audio source clock setting which is matched with H/W
	22	* like this function-'set_audio_clock_heirachy'.
	23	*/
	24	static int set_audio_clock_heirachy(struct platform_device *pdev)
	25	{
	26	struct clk fout_epll, mout_epll, sclk_audio0, sclk_spdif;
b0d8bef4	27	int ret = 0;
b67089e4 SY	28
	29	fout_epll = clk_get(NULL, "fout_epll");
	30	if (IS_ERR(fout_epll)) {
	31	printk(KERN_WARNING "%s: Cannot find fout_epll.\n",
	32	__func__);
	33	return -EINVAL;
	34	}
	35
	36	mout_epll = clk_get(NULL, "mout_epll");
8575d933	37	if (IS_ERR(mout_epll)) {
b67089e4 SY	38	printk(KERN_WARNING "%s: Cannot find mout_epll.\n",
	39	__func__);
	40	ret = -EINVAL;
	41	goto out1;
	42	}
	43
	44	sclk_audio0 = clk_get(&pdev->dev, "sclk_audio");
	45	if (IS_ERR(sclk_audio0)) {
	46	printk(KERN_WARNING "%s: Cannot find sclk_audio.\n",
	47	__func__);
	48	ret = -EINVAL;
	49	goto out2;
	50	}
	51
	52	sclk_spdif = clk_get(NULL, "sclk_spdif");
8575d933	53	if (IS_ERR(sclk_spdif)) {
b67089e4 SY	54	printk(KERN_WARNING "%s: Cannot find sclk_spdif.\n",
	55	__func__);
	56	ret = -EINVAL;
	57	goto out3;
	58	}
	59
b595076a	60	/* Set audio clock hierarchy for S/PDIF */
b67089e4 SY	61	clk_set_parent(mout_epll, fout_epll);
	62	clk_set_parent(sclk_audio0, mout_epll);
	63	clk_set_parent(sclk_spdif, sclk_audio0);
	64
	65	clk_put(sclk_spdif);
	66	out3:
	67	clk_put(sclk_audio0);
	68	out2:
	69	clk_put(mout_epll);
	70	out1:
	71	clk_put(fout_epll);
	72
	73	return ret;
	74	}
	75
	76	/* We should haved to set clock directly on this part because of clock
	77	* scheme of Samsudng SoCs did not support to set rates from abstrct
b595076a	78	* clock of it's hierarchy.
b67089e4 SY	79	*/
	80	static int set_audio_clock_rate(unsigned long epll_rate,
	81	unsigned long audio_rate)
	82	{
	83	struct clk fout_epll, sclk_spdif;
	84
	85	fout_epll = clk_get(NULL, "fout_epll");
	86	if (IS_ERR(fout_epll)) {
	87	printk(KERN_ERR "%s: failed to get fout_epll\n", __func__);
	88	return -ENOENT;
	89	}
	90
	91	clk_set_rate(fout_epll, epll_rate);
	92	clk_put(fout_epll);
	93
	94	sclk_spdif = clk_get(NULL, "sclk_spdif");
	95	if (IS_ERR(sclk_spdif)) {
	96	printk(KERN_ERR "%s: failed to get sclk_spdif\n", __func__);
	97	return -ENOENT;
	98	}
	99
	100	clk_set_rate(sclk_spdif, audio_rate);
	101	clk_put(sclk_spdif);
	102
	103	return 0;
	104	}
	105
	106	static int smdk_hw_params(struct snd_pcm_substream *substream,
	107	struct snd_pcm_hw_params *params)
	108	{
	109	struct snd_soc_pcm_runtime *rtd = substream->private_data;
	110	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
	111	unsigned long pll_out, rclk_rate;
	112	int ret, ratio;
	113
	114	switch (params_rate(params)) {
	115	case 44100:
	116	pll_out = 45158400;
	117	break;
	118	case 32000:
	119	case 48000:
	120	case 96000:
	121	pll_out = 49152000;
	122	break;
	123	default:
	124	return -EINVAL;
	125	}
	126
	127	/* Setting ratio to 512fs helps to use S/PDIF with HDMI without
	128	* modify S/PDIF ASoC machine driver.
	129	*/
	130	ratio = 512;
	131	rclk_rate = params_rate(params) * ratio;
	132
	133	/* Set audio source clock rates */
	134	ret = set_audio_clock_rate(pll_out, rclk_rate);
	135	if (ret < 0)
	136	return ret;
	137
	138	/* Set S/PDIF uses internal source clock */
	139	ret = snd_soc_dai_set_sysclk(cpu_dai, SND_SOC_SPDIF_INT_MCLK,
	140	rclk_rate, SND_SOC_CLOCK_IN);
	141	if (ret < 0)
	142	return ret;
143
144	return ret;
145	}
146
147	static struct snd_soc_ops smdk_spdif_ops = {
148	.hw_params = smdk_hw_params,
149	};
150
b67089e4 SY	151	static struct snd_soc_dai_link smdk_dai = {
	152	.name = "S/PDIF",
	153	.stream_name = "S/PDIF PCM Playback",
a08485d8	154	.platform_name = "samsung-spdif",
b67089e4 SY	155	.cpu_dai_name = "samsung-spdif",
	156	.codec_dai_name = "dit-hifi",
	157	.codec_name = "spdif-dit",
	158	.ops = &smdk_spdif_ops,
	159	};
	160
	161	static struct snd_soc_card smdk = {
	162	.name = "SMDK-S/PDIF",
095d79dc	163	.owner = THIS_MODULE,
b67089e4 SY	164	.dai_link = &smdk_dai,
	165	.num_links = 1,
	166	};
	167
	168	static struct platform_device *smdk_snd_spdif_dit_device;
	169	static struct platform_device *smdk_snd_spdif_device;
	170
	171	static int __init smdk_init(void)
	172	{
	173	int ret;
	174
	175	smdk_snd_spdif_dit_device = platform_device_alloc("spdif-dit", -1);
	176	if (!smdk_snd_spdif_dit_device)
	177	return -ENOMEM;
	178
	179	ret = platform_device_add(smdk_snd_spdif_dit_device);
	180	if (ret)
d482337e	181	goto err1;
b67089e4 SY	182
	183	smdk_snd_spdif_device = platform_device_alloc("soc-audio", -1);
	184	if (!smdk_snd_spdif_device) {
	185	ret = -ENOMEM;
	186	goto err2;
	187	}
	188
	189	platform_set_drvdata(smdk_snd_spdif_device, &smdk);
	190
	191	ret = platform_device_add(smdk_snd_spdif_device);
	192	if (ret)
d482337e	193	goto err3;
b67089e4	194
b595076a	195	/* Set audio clock hierarchy manually */
b67089e4 SY	196	ret = set_audio_clock_heirachy(smdk_snd_spdif_device);
b67089e4 SY	197	if (ret)
d482337e	198	goto err4;
b67089e4 SY	199
b67089e4 SY	200	return 0;
d482337e AL	201	err4:
	202	platform_device_del(smdk_snd_spdif_device);
	203	err3:
b67089e4 SY	204	platform_device_put(smdk_snd_spdif_device);
b67089e4 SY	205	err2:
d482337e AL	206	platform_device_del(smdk_snd_spdif_dit_device);
d482337e AL	207	err1:
b67089e4 SY	208	platform_device_put(smdk_snd_spdif_dit_device);
	209	return ret;
	210	}
	211
	212	static void __exit smdk_exit(void)
	213	{
	214	platform_device_unregister(smdk_snd_spdif_device);
d482337e	215	platform_device_unregister(smdk_snd_spdif_dit_device);
b67089e4 SY	216	}
	217
	218	module_init(smdk_init);
	219	module_exit(smdk_exit);
	220
	221	MODULE_AUTHOR("Seungwhan Youn, <sw.youn@samsung.com>");
	222	MODULE_DESCRIPTION("ALSA SoC SMDK+S/PDIF");
	223	MODULE_LICENSE("GPL");