1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/delay.h>
18#include <linux/clk.h>
19#include <linux/io.h>
20#include <linux/gpio.h>
21#include <linux/module.h>
22
23#include <sound/soc.h>
24#include <sound/pcm_params.h>
25
26#include <mach/gpio-samsung.h>
27#include <plat/gpio-cfg.h>
28#include "regs-iis.h"
29
30#include "dma.h"
31#include "s3c24xx-i2s.h"
32
33#include <linux/platform_data/asoc-s3c.h>
34
35static struct s3c_dma_params s3c24xx_i2s_pcm_stereo_out = {
36 .ch_name = "tx",
37 .dma_size = 2,
38};
39
40static struct s3c_dma_params s3c24xx_i2s_pcm_stereo_in = {
41 .ch_name = "rx",
42 .dma_size = 2,
43};
44
45struct s3c24xx_i2s_info {
46 void __iomem *regs;
47 struct clk *iis_clk;
48 u32 iiscon;
49 u32 iismod;
50 u32 iisfcon;
51 u32 iispsr;
52};
53static struct s3c24xx_i2s_info s3c24xx_i2s;
54
55static void s3c24xx_snd_txctrl(int on)
56{
57 u32 iisfcon;
58 u32 iiscon;
59 u32 iismod;
60
61 pr_debug("Entered %s\n", __func__);
62
63 iisfcon = readl(s3c24xx_i2s.regs + S3C2410_IISFCON);
64 iiscon = readl(s3c24xx_i2s.regs + S3C2410_IISCON);
65 iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
66
67 pr_debug("r: IISCON: %x IISMOD: %x IISFCON: %x\n", iiscon, iismod, iisfcon);
68
69 if (on) {
70 iisfcon |= S3C2410_IISFCON_TXDMA | S3C2410_IISFCON_TXENABLE;
71 iiscon |= S3C2410_IISCON_TXDMAEN | S3C2410_IISCON_IISEN;
72 iiscon &= ~S3C2410_IISCON_TXIDLE;
73 iismod |= S3C2410_IISMOD_TXMODE;
74
75 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
76 writel(iisfcon, s3c24xx_i2s.regs + S3C2410_IISFCON);
77 writel(iiscon, s3c24xx_i2s.regs + S3C2410_IISCON);
78 } else {
79
80
81
82
83
84
85
86 iisfcon &= ~S3C2410_IISFCON_TXENABLE;
87 iisfcon &= ~S3C2410_IISFCON_TXDMA;
88 iiscon |= S3C2410_IISCON_TXIDLE;
89 iiscon &= ~S3C2410_IISCON_TXDMAEN;
90 iismod &= ~S3C2410_IISMOD_TXMODE;
91
92 writel(iiscon, s3c24xx_i2s.regs + S3C2410_IISCON);
93 writel(iisfcon, s3c24xx_i2s.regs + S3C2410_IISFCON);
94 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
95 }
96
97 pr_debug("w: IISCON: %x IISMOD: %x IISFCON: %x\n", iiscon, iismod, iisfcon);
98}
99
100static void s3c24xx_snd_rxctrl(int on)
101{
102 u32 iisfcon;
103 u32 iiscon;
104 u32 iismod;
105
106 pr_debug("Entered %s\n", __func__);
107
108 iisfcon = readl(s3c24xx_i2s.regs + S3C2410_IISFCON);
109 iiscon = readl(s3c24xx_i2s.regs + S3C2410_IISCON);
110 iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
111
112 pr_debug("r: IISCON: %x IISMOD: %x IISFCON: %x\n", iiscon, iismod, iisfcon);
113
114 if (on) {
115 iisfcon |= S3C2410_IISFCON_RXDMA | S3C2410_IISFCON_RXENABLE;
116 iiscon |= S3C2410_IISCON_RXDMAEN | S3C2410_IISCON_IISEN;
117 iiscon &= ~S3C2410_IISCON_RXIDLE;
118 iismod |= S3C2410_IISMOD_RXMODE;
119
120 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
121 writel(iisfcon, s3c24xx_i2s.regs + S3C2410_IISFCON);
122 writel(iiscon, s3c24xx_i2s.regs + S3C2410_IISCON);
123 } else {
124
125
126
127
128
129
130
131 iisfcon &= ~S3C2410_IISFCON_RXENABLE;
132 iisfcon &= ~S3C2410_IISFCON_RXDMA;
133 iiscon |= S3C2410_IISCON_RXIDLE;
134 iiscon &= ~S3C2410_IISCON_RXDMAEN;
135 iismod &= ~S3C2410_IISMOD_RXMODE;
136
137 writel(iisfcon, s3c24xx_i2s.regs + S3C2410_IISFCON);
138 writel(iiscon, s3c24xx_i2s.regs + S3C2410_IISCON);
139 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
140 }
141
142 pr_debug("w: IISCON: %x IISMOD: %x IISFCON: %x\n", iiscon, iismod, iisfcon);
143}
144
145
146
147
148
149static int s3c24xx_snd_lrsync(void)
150{
151 u32 iiscon;
152 int timeout = 50;
153
154 pr_debug("Entered %s\n", __func__);
155
156 while (1) {
157 iiscon = readl(s3c24xx_i2s.regs + S3C2410_IISCON);
158 if (iiscon & S3C2410_IISCON_LRINDEX)
159 break;
160
161 if (!timeout--)
162 return -ETIMEDOUT;
163 udelay(100);
164 }
165
166 return 0;
167}
168
169
170
171
172static inline int s3c24xx_snd_is_clkmaster(void)
173{
174 pr_debug("Entered %s\n", __func__);
175
176 return (readl(s3c24xx_i2s.regs + S3C2410_IISMOD) & S3C2410_IISMOD_SLAVE) ? 0:1;
177}
178
179
180
181
182static int s3c24xx_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
183 unsigned int fmt)
184{
185 u32 iismod;
186
187 pr_debug("Entered %s\n", __func__);
188
189 iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
190 pr_debug("hw_params r: IISMOD: %x \n", iismod);
191
192 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
193 case SND_SOC_DAIFMT_CBM_CFM:
194 iismod |= S3C2410_IISMOD_SLAVE;
195 break;
196 case SND_SOC_DAIFMT_CBS_CFS:
197 iismod &= ~S3C2410_IISMOD_SLAVE;
198 break;
199 default:
200 return -EINVAL;
201 }
202
203 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
204 case SND_SOC_DAIFMT_LEFT_J:
205 iismod |= S3C2410_IISMOD_MSB;
206 break;
207 case SND_SOC_DAIFMT_I2S:
208 iismod &= ~S3C2410_IISMOD_MSB;
209 break;
210 default:
211 return -EINVAL;
212 }
213
214 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
215 pr_debug("hw_params w: IISMOD: %x \n", iismod);
216 return 0;
217}
218
219static int s3c24xx_i2s_hw_params(struct snd_pcm_substream *substream,
220 struct snd_pcm_hw_params *params,
221 struct snd_soc_dai *dai)
222{
223 struct snd_dmaengine_dai_dma_data *dma_data;
224 u32 iismod;
225
226 pr_debug("Entered %s\n", __func__);
227
228 dma_data = snd_soc_dai_get_dma_data(dai, substream);
229
230
231 iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
232 pr_debug("hw_params r: IISMOD: %x\n", iismod);
233
234 switch (params_width(params)) {
235 case 8:
236 iismod &= ~S3C2410_IISMOD_16BIT;
237 dma_data->addr_width = 1;
238 break;
239 case 16:
240 iismod |= S3C2410_IISMOD_16BIT;
241 dma_data->addr_width = 2;
242 break;
243 default:
244 return -EINVAL;
245 }
246
247 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
248 pr_debug("hw_params w: IISMOD: %x\n", iismod);
249 return 0;
250}
251
252static int s3c24xx_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
253 struct snd_soc_dai *dai)
254{
255 int ret = 0;
256
257 pr_debug("Entered %s\n", __func__);
258
259 switch (cmd) {
260 case SNDRV_PCM_TRIGGER_START:
261 case SNDRV_PCM_TRIGGER_RESUME:
262 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
263 if (!s3c24xx_snd_is_clkmaster()) {
264 ret = s3c24xx_snd_lrsync();
265 if (ret)
266 goto exit_err;
267 }
268
269 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
270 s3c24xx_snd_rxctrl(1);
271 else
272 s3c24xx_snd_txctrl(1);
273
274 break;
275 case SNDRV_PCM_TRIGGER_STOP:
276 case SNDRV_PCM_TRIGGER_SUSPEND:
277 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
278 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
279 s3c24xx_snd_rxctrl(0);
280 else
281 s3c24xx_snd_txctrl(0);
282 break;
283 default:
284 ret = -EINVAL;
285 break;
286 }
287
288exit_err:
289 return ret;
290}
291
292
293
294
295static int s3c24xx_i2s_set_sysclk(struct snd_soc_dai *cpu_dai,
296 int clk_id, unsigned int freq, int dir)
297{
298 u32 iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
299
300 pr_debug("Entered %s\n", __func__);
301
302 iismod &= ~S3C2440_IISMOD_MPLL;
303
304 switch (clk_id) {
305 case S3C24XX_CLKSRC_PCLK:
306 break;
307 case S3C24XX_CLKSRC_MPLL:
308 iismod |= S3C2440_IISMOD_MPLL;
309 break;
310 default:
311 return -EINVAL;
312 }
313
314 writel(iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
315 return 0;
316}
317
318
319
320
321static int s3c24xx_i2s_set_clkdiv(struct snd_soc_dai *cpu_dai,
322 int div_id, int div)
323{
324 u32 reg;
325
326 pr_debug("Entered %s\n", __func__);
327
328 switch (div_id) {
329 case S3C24XX_DIV_BCLK:
330 reg = readl(s3c24xx_i2s.regs + S3C2410_IISMOD) & ~S3C2410_IISMOD_FS_MASK;
331 writel(reg | div, s3c24xx_i2s.regs + S3C2410_IISMOD);
332 break;
333 case S3C24XX_DIV_MCLK:
334 reg = readl(s3c24xx_i2s.regs + S3C2410_IISMOD) & ~(S3C2410_IISMOD_384FS);
335 writel(reg | div, s3c24xx_i2s.regs + S3C2410_IISMOD);
336 break;
337 case S3C24XX_DIV_PRESCALER:
338 writel(div, s3c24xx_i2s.regs + S3C2410_IISPSR);
339 reg = readl(s3c24xx_i2s.regs + S3C2410_IISCON);
340 writel(reg | S3C2410_IISCON_PSCEN, s3c24xx_i2s.regs + S3C2410_IISCON);
341 break;
342 default:
343 return -EINVAL;
344 }
345
346 return 0;
347}
348
349
350
351
352
353u32 s3c24xx_i2s_get_clockrate(void)
354{
355 return clk_get_rate(s3c24xx_i2s.iis_clk);
356}
357EXPORT_SYMBOL_GPL(s3c24xx_i2s_get_clockrate);
358
359static int s3c24xx_i2s_probe(struct snd_soc_dai *dai)
360{
361 pr_debug("Entered %s\n", __func__);
362
363 samsung_asoc_init_dma_data(dai, &s3c24xx_i2s_pcm_stereo_out,
364 &s3c24xx_i2s_pcm_stereo_in);
365
366 s3c24xx_i2s.iis_clk = devm_clk_get(dai->dev, "iis");
367 if (IS_ERR(s3c24xx_i2s.iis_clk)) {
368 pr_err("failed to get iis_clock\n");
369 return PTR_ERR(s3c24xx_i2s.iis_clk);
370 }
371 clk_prepare_enable(s3c24xx_i2s.iis_clk);
372
373
374 s3c_gpio_cfgall_range(S3C2410_GPE(0), 5, S3C_GPIO_SFN(2),
375 S3C_GPIO_PULL_NONE);
376
377 writel(S3C2410_IISCON_IISEN, s3c24xx_i2s.regs + S3C2410_IISCON);
378
379 s3c24xx_snd_txctrl(0);
380 s3c24xx_snd_rxctrl(0);
381
382 return 0;
383}
384
385#ifdef CONFIG_PM
386static int s3c24xx_i2s_suspend(struct snd_soc_dai *cpu_dai)
387{
388 pr_debug("Entered %s\n", __func__);
389
390 s3c24xx_i2s.iiscon = readl(s3c24xx_i2s.regs + S3C2410_IISCON);
391 s3c24xx_i2s.iismod = readl(s3c24xx_i2s.regs + S3C2410_IISMOD);
392 s3c24xx_i2s.iisfcon = readl(s3c24xx_i2s.regs + S3C2410_IISFCON);
393 s3c24xx_i2s.iispsr = readl(s3c24xx_i2s.regs + S3C2410_IISPSR);
394
395 clk_disable_unprepare(s3c24xx_i2s.iis_clk);
396
397 return 0;
398}
399
400static int s3c24xx_i2s_resume(struct snd_soc_dai *cpu_dai)
401{
402 pr_debug("Entered %s\n", __func__);
403 clk_prepare_enable(s3c24xx_i2s.iis_clk);
404
405 writel(s3c24xx_i2s.iiscon, s3c24xx_i2s.regs + S3C2410_IISCON);
406 writel(s3c24xx_i2s.iismod, s3c24xx_i2s.regs + S3C2410_IISMOD);
407 writel(s3c24xx_i2s.iisfcon, s3c24xx_i2s.regs + S3C2410_IISFCON);
408 writel(s3c24xx_i2s.iispsr, s3c24xx_i2s.regs + S3C2410_IISPSR);
409
410 return 0;
411}
412#else
413#define s3c24xx_i2s_suspend NULL
414#define s3c24xx_i2s_resume NULL
415#endif
416
417
418#define S3C24XX_I2S_RATES \
419 (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 | SNDRV_PCM_RATE_16000 | \
420 SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | \
421 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
422
423static const struct snd_soc_dai_ops s3c24xx_i2s_dai_ops = {
424 .trigger = s3c24xx_i2s_trigger,
425 .hw_params = s3c24xx_i2s_hw_params,
426 .set_fmt = s3c24xx_i2s_set_fmt,
427 .set_clkdiv = s3c24xx_i2s_set_clkdiv,
428 .set_sysclk = s3c24xx_i2s_set_sysclk,
429};
430
431static struct snd_soc_dai_driver s3c24xx_i2s_dai = {
432 .probe = s3c24xx_i2s_probe,
433 .suspend = s3c24xx_i2s_suspend,
434 .resume = s3c24xx_i2s_resume,
435 .playback = {
436 .channels_min = 2,
437 .channels_max = 2,
438 .rates = S3C24XX_I2S_RATES,
439 .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE,},
440 .capture = {
441 .channels_min = 2,
442 .channels_max = 2,
443 .rates = S3C24XX_I2S_RATES,
444 .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE,},
445 .ops = &s3c24xx_i2s_dai_ops,
446};
447
448static const struct snd_soc_component_driver s3c24xx_i2s_component = {
449 .name = "s3c24xx-i2s",
450};
451
452static int s3c24xx_iis_dev_probe(struct platform_device *pdev)
453{
454 int ret = 0;
455 struct resource *res;
456 struct s3c_audio_pdata *pdata = dev_get_platdata(&pdev->dev);
457
458 if (!pdata) {
459 dev_err(&pdev->dev, "missing platform data");
460 return -ENXIO;
461 }
462
463 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
464 if (!res) {
465 dev_err(&pdev->dev, "Can't get IO resource.\n");
466 return -ENOENT;
467 }
468 s3c24xx_i2s.regs = devm_ioremap_resource(&pdev->dev, res);
469 if (IS_ERR(s3c24xx_i2s.regs))
470 return PTR_ERR(s3c24xx_i2s.regs);
471
472 s3c24xx_i2s_pcm_stereo_out.dma_addr = res->start + S3C2410_IISFIFO;
473 s3c24xx_i2s_pcm_stereo_out.slave = pdata->dma_playback;
474 s3c24xx_i2s_pcm_stereo_in.dma_addr = res->start + S3C2410_IISFIFO;
475 s3c24xx_i2s_pcm_stereo_in.slave = pdata->dma_capture;
476
477 ret = devm_snd_soc_register_component(&pdev->dev,
478 &s3c24xx_i2s_component, &s3c24xx_i2s_dai, 1);
479 if (ret) {
480 pr_err("failed to register the dai\n");
481 return ret;
482 }
483
484 ret = samsung_asoc_dma_platform_register(&pdev->dev,
485 pdata->dma_filter,
486 NULL, NULL);
487 if (ret)
488 pr_err("failed to register the dma: %d\n", ret);
489
490 return ret;
491}
492
493static struct platform_driver s3c24xx_iis_driver = {
494 .probe = s3c24xx_iis_dev_probe,
495 .driver = {
496 .name = "s3c24xx-iis",
497 },
498};
499
500module_platform_driver(s3c24xx_iis_driver);
501
502
503MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
504MODULE_DESCRIPTION("s3c24xx I2S SoC Interface");
505MODULE_LICENSE("GPL");
506MODULE_ALIAS("platform:s3c24xx-iis");
507
