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> |
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); |
197 | if (ret) | |
d482337e | 198 | goto err4; |
b67089e4 SY |
199 | |
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); |
205 | err2: | |
d482337e AL |
206 | platform_device_del(smdk_snd_spdif_dit_device); |
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"); |