1
2
3
4
5
6
7
8#include <linux/clk.h>
9#include <linux/io.h>
10#include <linux/module.h>
11
12#include <sound/soc.h>
13#include <sound/pcm_params.h>
14
15#include <linux/platform_data/asoc-s3c.h>
16
17#include "dma.h"
18#include "spdif.h"
19
20
21#define CLKCON 0x00
22#define CON 0x04
23#define BSTAS 0x08
24#define CSTAS 0x0C
25#define DATA_OUTBUF 0x10
26#define DCNT 0x14
27#define BSTAS_S 0x18
28#define DCNT_S 0x1C
29
30#define CLKCTL_MASK 0x7
31#define CLKCTL_MCLK_EXT (0x1 << 2)
32#define CLKCTL_PWR_ON (0x1 << 0)
33
34#define CON_MASK 0x3ffffff
35#define CON_FIFO_TH_SHIFT 19
36#define CON_FIFO_TH_MASK (0x7 << 19)
37#define CON_USERDATA_23RDBIT (0x1 << 12)
38
39#define CON_SW_RESET (0x1 << 5)
40
41#define CON_MCLKDIV_MASK (0x3 << 3)
42#define CON_MCLKDIV_256FS (0x0 << 3)
43#define CON_MCLKDIV_384FS (0x1 << 3)
44#define CON_MCLKDIV_512FS (0x2 << 3)
45
46#define CON_PCM_MASK (0x3 << 1)
47#define CON_PCM_16BIT (0x0 << 1)
48#define CON_PCM_20BIT (0x1 << 1)
49#define CON_PCM_24BIT (0x2 << 1)
50
51#define CON_PCM_DATA (0x1 << 0)
52
53#define CSTAS_MASK 0x3fffffff
54#define CSTAS_SAMP_FREQ_MASK (0xF << 24)
55#define CSTAS_SAMP_FREQ_44 (0x0 << 24)
56#define CSTAS_SAMP_FREQ_48 (0x2 << 24)
57#define CSTAS_SAMP_FREQ_32 (0x3 << 24)
58#define CSTAS_SAMP_FREQ_96 (0xA << 24)
59
60#define CSTAS_CATEGORY_MASK (0xFF << 8)
61#define CSTAS_CATEGORY_CODE_CDP (0x01 << 8)
62
63#define CSTAS_NO_COPYRIGHT (0x1 << 2)
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78struct samsung_spdif_info {
79 spinlock_t lock;
80 struct device *dev;
81 void __iomem *regs;
82 unsigned long clk_rate;
83 struct clk *pclk;
84 struct clk *sclk;
85 u32 saved_clkcon;
86 u32 saved_con;
87 u32 saved_cstas;
88 struct snd_dmaengine_dai_dma_data *dma_playback;
89};
90
91static struct snd_dmaengine_dai_dma_data spdif_stereo_out;
92static struct samsung_spdif_info spdif_info;
93
94static inline struct samsung_spdif_info
95*component_to_info(struct snd_soc_component *component)
96{
97 return snd_soc_component_get_drvdata(component);
98}
99
100static inline struct samsung_spdif_info *to_info(struct snd_soc_dai *cpu_dai)
101{
102 return snd_soc_dai_get_drvdata(cpu_dai);
103}
104
105static void spdif_snd_txctrl(struct samsung_spdif_info *spdif, int on)
106{
107 void __iomem *regs = spdif->regs;
108 u32 clkcon;
109
110 dev_dbg(spdif->dev, "Entered %s\n", __func__);
111
112 clkcon = readl(regs + CLKCON) & CLKCTL_MASK;
113 if (on)
114 writel(clkcon | CLKCTL_PWR_ON, regs + CLKCON);
115 else
116 writel(clkcon & ~CLKCTL_PWR_ON, regs + CLKCON);
117}
118
119static int spdif_set_sysclk(struct snd_soc_dai *cpu_dai,
120 int clk_id, unsigned int freq, int dir)
121{
122 struct samsung_spdif_info *spdif = to_info(cpu_dai);
123 u32 clkcon;
124
125 dev_dbg(spdif->dev, "Entered %s\n", __func__);
126
127 clkcon = readl(spdif->regs + CLKCON);
128
129 if (clk_id == SND_SOC_SPDIF_INT_MCLK)
130 clkcon &= ~CLKCTL_MCLK_EXT;
131 else
132 clkcon |= CLKCTL_MCLK_EXT;
133
134 writel(clkcon, spdif->regs + CLKCON);
135
136 spdif->clk_rate = freq;
137
138 return 0;
139}
140
141static int spdif_trigger(struct snd_pcm_substream *substream, int cmd,
142 struct snd_soc_dai *dai)
143{
144 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
145 struct samsung_spdif_info *spdif = to_info(asoc_rtd_to_cpu(rtd, 0));
146 unsigned long flags;
147
148 dev_dbg(spdif->dev, "Entered %s\n", __func__);
149
150 switch (cmd) {
151 case SNDRV_PCM_TRIGGER_START:
152 case SNDRV_PCM_TRIGGER_RESUME:
153 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
154 spin_lock_irqsave(&spdif->lock, flags);
155 spdif_snd_txctrl(spdif, 1);
156 spin_unlock_irqrestore(&spdif->lock, flags);
157 break;
158 case SNDRV_PCM_TRIGGER_STOP:
159 case SNDRV_PCM_TRIGGER_SUSPEND:
160 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
161 spin_lock_irqsave(&spdif->lock, flags);
162 spdif_snd_txctrl(spdif, 0);
163 spin_unlock_irqrestore(&spdif->lock, flags);
164 break;
165 default:
166 return -EINVAL;
167 }
168
169 return 0;
170}
171
172static int spdif_sysclk_ratios[] = {
173 512, 384, 256,
174};
175
176static int spdif_hw_params(struct snd_pcm_substream *substream,
177 struct snd_pcm_hw_params *params,
178 struct snd_soc_dai *socdai)
179{
180 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
181 struct samsung_spdif_info *spdif = to_info(asoc_rtd_to_cpu(rtd, 0));
182 void __iomem *regs = spdif->regs;
183 struct snd_dmaengine_dai_dma_data *dma_data;
184 u32 con, clkcon, cstas;
185 unsigned long flags;
186 int i, ratio;
187
188 dev_dbg(spdif->dev, "Entered %s\n", __func__);
189
190 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
191 dma_data = spdif->dma_playback;
192 else {
193 dev_err(spdif->dev, "Capture is not supported\n");
194 return -EINVAL;
195 }
196
197 snd_soc_dai_set_dma_data(asoc_rtd_to_cpu(rtd, 0), substream, dma_data);
198
199 spin_lock_irqsave(&spdif->lock, flags);
200
201 con = readl(regs + CON) & CON_MASK;
202 cstas = readl(regs + CSTAS) & CSTAS_MASK;
203 clkcon = readl(regs + CLKCON) & CLKCTL_MASK;
204
205 con &= ~CON_FIFO_TH_MASK;
206 con |= (0x7 << CON_FIFO_TH_SHIFT);
207 con |= CON_USERDATA_23RDBIT;
208 con |= CON_PCM_DATA;
209
210 con &= ~CON_PCM_MASK;
211 switch (params_width(params)) {
212 case 16:
213 con |= CON_PCM_16BIT;
214 break;
215 default:
216 dev_err(spdif->dev, "Unsupported data size.\n");
217 goto err;
218 }
219
220 ratio = spdif->clk_rate / params_rate(params);
221 for (i = 0; i < ARRAY_SIZE(spdif_sysclk_ratios); i++)
222 if (ratio == spdif_sysclk_ratios[i])
223 break;
224 if (i == ARRAY_SIZE(spdif_sysclk_ratios)) {
225 dev_err(spdif->dev, "Invalid clock ratio %ld/%d\n",
226 spdif->clk_rate, params_rate(params));
227 goto err;
228 }
229
230 con &= ~CON_MCLKDIV_MASK;
231 switch (ratio) {
232 case 256:
233 con |= CON_MCLKDIV_256FS;
234 break;
235 case 384:
236 con |= CON_MCLKDIV_384FS;
237 break;
238 case 512:
239 con |= CON_MCLKDIV_512FS;
240 break;
241 }
242
243 cstas &= ~CSTAS_SAMP_FREQ_MASK;
244 switch (params_rate(params)) {
245 case 44100:
246 cstas |= CSTAS_SAMP_FREQ_44;
247 break;
248 case 48000:
249 cstas |= CSTAS_SAMP_FREQ_48;
250 break;
251 case 32000:
252 cstas |= CSTAS_SAMP_FREQ_32;
253 break;
254 case 96000:
255 cstas |= CSTAS_SAMP_FREQ_96;
256 break;
257 default:
258 dev_err(spdif->dev, "Invalid sampling rate %d\n",
259 params_rate(params));
260 goto err;
261 }
262
263 cstas &= ~CSTAS_CATEGORY_MASK;
264 cstas |= CSTAS_CATEGORY_CODE_CDP;
265 cstas |= CSTAS_NO_COPYRIGHT;
266
267 writel(con, regs + CON);
268 writel(cstas, regs + CSTAS);
269 writel(clkcon, regs + CLKCON);
270
271 spin_unlock_irqrestore(&spdif->lock, flags);
272
273 return 0;
274err:
275 spin_unlock_irqrestore(&spdif->lock, flags);
276 return -EINVAL;
277}
278
279static void spdif_shutdown(struct snd_pcm_substream *substream,
280 struct snd_soc_dai *dai)
281{
282 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
283 struct samsung_spdif_info *spdif = to_info(asoc_rtd_to_cpu(rtd, 0));
284 void __iomem *regs = spdif->regs;
285 u32 con, clkcon;
286
287 dev_dbg(spdif->dev, "Entered %s\n", __func__);
288
289 con = readl(regs + CON) & CON_MASK;
290 clkcon = readl(regs + CLKCON) & CLKCTL_MASK;
291
292 writel(con | CON_SW_RESET, regs + CON);
293 cpu_relax();
294
295 writel(clkcon & ~CLKCTL_PWR_ON, regs + CLKCON);
296}
297
298#ifdef CONFIG_PM
299static int spdif_suspend(struct snd_soc_component *component)
300{
301 struct samsung_spdif_info *spdif = component_to_info(component);
302 u32 con = spdif->saved_con;
303
304 dev_dbg(spdif->dev, "Entered %s\n", __func__);
305
306 spdif->saved_clkcon = readl(spdif->regs + CLKCON) & CLKCTL_MASK;
307 spdif->saved_con = readl(spdif->regs + CON) & CON_MASK;
308 spdif->saved_cstas = readl(spdif->regs + CSTAS) & CSTAS_MASK;
309
310 writel(con | CON_SW_RESET, spdif->regs + CON);
311 cpu_relax();
312
313 return 0;
314}
315
316static int spdif_resume(struct snd_soc_component *component)
317{
318 struct samsung_spdif_info *spdif = component_to_info(component);
319
320 dev_dbg(spdif->dev, "Entered %s\n", __func__);
321
322 writel(spdif->saved_clkcon, spdif->regs + CLKCON);
323 writel(spdif->saved_con, spdif->regs + CON);
324 writel(spdif->saved_cstas, spdif->regs + CSTAS);
325
326 return 0;
327}
328#else
329#define spdif_suspend NULL
330#define spdif_resume NULL
331#endif
332
333static const struct snd_soc_dai_ops spdif_dai_ops = {
334 .set_sysclk = spdif_set_sysclk,
335 .trigger = spdif_trigger,
336 .hw_params = spdif_hw_params,
337 .shutdown = spdif_shutdown,
338};
339
340static struct snd_soc_dai_driver samsung_spdif_dai = {
341 .name = "samsung-spdif",
342 .playback = {
343 .stream_name = "S/PDIF Playback",
344 .channels_min = 2,
345 .channels_max = 2,
346 .rates = (SNDRV_PCM_RATE_32000 |
347 SNDRV_PCM_RATE_44100 |
348 SNDRV_PCM_RATE_48000 |
349 SNDRV_PCM_RATE_96000),
350 .formats = SNDRV_PCM_FMTBIT_S16_LE, },
351 .ops = &spdif_dai_ops,
352};
353
354static const struct snd_soc_component_driver samsung_spdif_component = {
355 .name = "samsung-spdif",
356 .suspend = spdif_suspend,
357 .resume = spdif_resume,
358};
359
360static int spdif_probe(struct platform_device *pdev)
361{
362 struct s3c_audio_pdata *spdif_pdata;
363 struct resource *mem_res;
364 struct samsung_spdif_info *spdif;
365 dma_filter_fn filter;
366 int ret;
367
368 spdif_pdata = pdev->dev.platform_data;
369
370 dev_dbg(&pdev->dev, "Entered %s\n", __func__);
371
372 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
373 if (!mem_res) {
374 dev_err(&pdev->dev, "Unable to get register resource.\n");
375 return -ENXIO;
376 }
377
378 if (spdif_pdata && spdif_pdata->cfg_gpio
379 && spdif_pdata->cfg_gpio(pdev)) {
380 dev_err(&pdev->dev, "Unable to configure GPIO pins\n");
381 return -EINVAL;
382 }
383
384 spdif = &spdif_info;
385 spdif->dev = &pdev->dev;
386
387 spin_lock_init(&spdif->lock);
388
389 spdif->pclk = devm_clk_get(&pdev->dev, "spdif");
390 if (IS_ERR(spdif->pclk)) {
391 dev_err(&pdev->dev, "failed to get peri-clock\n");
392 ret = -ENOENT;
393 goto err0;
394 }
395 ret = clk_prepare_enable(spdif->pclk);
396 if (ret)
397 goto err0;
398
399 spdif->sclk = devm_clk_get(&pdev->dev, "sclk_spdif");
400 if (IS_ERR(spdif->sclk)) {
401 dev_err(&pdev->dev, "failed to get internal source clock\n");
402 ret = -ENOENT;
403 goto err1;
404 }
405 ret = clk_prepare_enable(spdif->sclk);
406 if (ret)
407 goto err1;
408
409
410 if (!request_mem_region(mem_res->start,
411 resource_size(mem_res), "samsung-spdif")) {
412 dev_err(&pdev->dev, "Unable to request register region\n");
413 ret = -EBUSY;
414 goto err2;
415 }
416
417 spdif->regs = ioremap(mem_res->start, 0x100);
418 if (spdif->regs == NULL) {
419 dev_err(&pdev->dev, "Cannot ioremap registers\n");
420 ret = -ENXIO;
421 goto err3;
422 }
423
424 spdif_stereo_out.addr_width = 2;
425 spdif_stereo_out.addr = mem_res->start + DATA_OUTBUF;
426 filter = NULL;
427 if (spdif_pdata) {
428 spdif_stereo_out.filter_data = spdif_pdata->dma_playback;
429 filter = spdif_pdata->dma_filter;
430 }
431 spdif->dma_playback = &spdif_stereo_out;
432
433 ret = samsung_asoc_dma_platform_register(&pdev->dev, filter,
434 NULL, NULL, NULL);
435 if (ret) {
436 dev_err(&pdev->dev, "failed to register DMA: %d\n", ret);
437 goto err4;
438 }
439
440 dev_set_drvdata(&pdev->dev, spdif);
441
442 ret = devm_snd_soc_register_component(&pdev->dev,
443 &samsung_spdif_component, &samsung_spdif_dai, 1);
444 if (ret != 0) {
445 dev_err(&pdev->dev, "fail to register dai\n");
446 goto err4;
447 }
448
449 return 0;
450err4:
451 iounmap(spdif->regs);
452err3:
453 release_mem_region(mem_res->start, resource_size(mem_res));
454err2:
455 clk_disable_unprepare(spdif->sclk);
456err1:
457 clk_disable_unprepare(spdif->pclk);
458err0:
459 return ret;
460}
461
462static int spdif_remove(struct platform_device *pdev)
463{
464 struct samsung_spdif_info *spdif = &spdif_info;
465 struct resource *mem_res;
466
467 iounmap(spdif->regs);
468
469 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
470 if (mem_res)
471 release_mem_region(mem_res->start, resource_size(mem_res));
472
473 clk_disable_unprepare(spdif->sclk);
474 clk_disable_unprepare(spdif->pclk);
475
476 return 0;
477}
478
479static struct platform_driver samsung_spdif_driver = {
480 .probe = spdif_probe,
481 .remove = spdif_remove,
482 .driver = {
483 .name = "samsung-spdif",
484 },
485};
486
487module_platform_driver(samsung_spdif_driver);
488
489MODULE_AUTHOR("Seungwhan Youn, <sw.youn@samsung.com>");
490MODULE_DESCRIPTION("Samsung S/PDIF Controller Driver");
491MODULE_LICENSE("GPL");
492MODULE_ALIAS("platform:samsung-spdif");
493
