1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/delay.h>
14#include <linux/slab.h>
15#include <linux/clk.h>
16#include <linux/io.h>
17#include <linux/module.h>
18
19#include <sound/soc.h>
20#include <sound/pcm_params.h>
21
22#include <plat/audio.h>
23
24#include "dma.h"
25#include "idma.h"
26#include "i2s.h"
27#include "i2s-regs.h"
28
29#define msecs_to_loops(t) (loops_per_jiffy / 1000 * HZ * t)
30
31struct i2s_dai {
32
33 struct platform_device *pdev;
34
35 void __iomem *addr;
36
37 u32 base;
38
39 unsigned long rclk_srcrate;
40
41 unsigned frmclk;
42
43
44
45
46 unsigned rfs, bfs;
47
48 struct clk *clk;
49
50 struct clk *op_clk;
51
52 const char **src_clk;
53
54 struct i2s_dai *pri_dai;
55
56 struct i2s_dai *sec_dai;
57#define DAI_OPENED (1 << 0)
58#define DAI_MANAGER (1 << 1)
59 unsigned mode;
60
61 struct snd_soc_dai_driver i2s_dai_drv;
62
63 struct s3c_dma_params dma_playback;
64 struct s3c_dma_params dma_capture;
65 struct s3c_dma_params idma_playback;
66 u32 quirks;
67 u32 suspend_i2smod;
68 u32 suspend_i2scon;
69 u32 suspend_i2spsr;
70};
71
72
73static DEFINE_SPINLOCK(lock);
74
75
76static inline bool is_secondary(struct i2s_dai *i2s)
77{
78 return i2s->pri_dai ? true : false;
79}
80
81
82static inline bool is_slave(struct i2s_dai *i2s)
83{
84 return (readl(i2s->addr + I2SMOD) & MOD_SLAVE) ? true : false;
85}
86
87
88static inline bool tx_active(struct i2s_dai *i2s)
89{
90 u32 active;
91
92 if (!i2s)
93 return false;
94
95 active = readl(i2s->addr + I2SCON);
96
97 if (is_secondary(i2s))
98 active &= CON_TXSDMA_ACTIVE;
99 else
100 active &= CON_TXDMA_ACTIVE;
101
102 return active ? true : false;
103}
104
105
106static inline bool other_tx_active(struct i2s_dai *i2s)
107{
108 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
109
110 return tx_active(other);
111}
112
113
114static inline bool any_tx_active(struct i2s_dai *i2s)
115{
116 return tx_active(i2s) || other_tx_active(i2s);
117}
118
119
120static inline bool rx_active(struct i2s_dai *i2s)
121{
122 u32 active;
123
124 if (!i2s)
125 return false;
126
127 active = readl(i2s->addr + I2SCON) & CON_RXDMA_ACTIVE;
128
129 return active ? true : false;
130}
131
132
133static inline bool other_rx_active(struct i2s_dai *i2s)
134{
135 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
136
137 return rx_active(other);
138}
139
140
141static inline bool any_rx_active(struct i2s_dai *i2s)
142{
143 return rx_active(i2s) || other_rx_active(i2s);
144}
145
146
147static inline bool other_active(struct i2s_dai *i2s)
148{
149 return other_rx_active(i2s) || other_tx_active(i2s);
150}
151
152
153static inline bool this_active(struct i2s_dai *i2s)
154{
155 return tx_active(i2s) || rx_active(i2s);
156}
157
158
159static inline bool any_active(struct i2s_dai *i2s)
160{
161 return this_active(i2s) || other_active(i2s);
162}
163
164static inline struct i2s_dai *to_info(struct snd_soc_dai *dai)
165{
166 return snd_soc_dai_get_drvdata(dai);
167}
168
169static inline bool is_opened(struct i2s_dai *i2s)
170{
171 if (i2s && (i2s->mode & DAI_OPENED))
172 return true;
173 else
174 return false;
175}
176
177static inline bool is_manager(struct i2s_dai *i2s)
178{
179 if (is_opened(i2s) && (i2s->mode & DAI_MANAGER))
180 return true;
181 else
182 return false;
183}
184
185
186static inline unsigned get_rfs(struct i2s_dai *i2s)
187{
188 u32 rfs = (readl(i2s->addr + I2SMOD) >> 3) & 0x3;
189
190 switch (rfs) {
191 case 3: return 768;
192 case 2: return 384;
193 case 1: return 512;
194 default: return 256;
195 }
196}
197
198
199static inline void set_rfs(struct i2s_dai *i2s, unsigned rfs)
200{
201 u32 mod = readl(i2s->addr + I2SMOD);
202
203 mod &= ~MOD_RCLK_MASK;
204
205 switch (rfs) {
206 case 768:
207 mod |= MOD_RCLK_768FS;
208 break;
209 case 512:
210 mod |= MOD_RCLK_512FS;
211 break;
212 case 384:
213 mod |= MOD_RCLK_384FS;
214 break;
215 default:
216 mod |= MOD_RCLK_256FS;
217 break;
218 }
219
220 writel(mod, i2s->addr + I2SMOD);
221}
222
223
224static inline unsigned get_bfs(struct i2s_dai *i2s)
225{
226 u32 bfs = (readl(i2s->addr + I2SMOD) >> 1) & 0x3;
227
228 switch (bfs) {
229 case 3: return 24;
230 case 2: return 16;
231 case 1: return 48;
232 default: return 32;
233 }
234}
235
236
237static inline void set_bfs(struct i2s_dai *i2s, unsigned bfs)
238{
239 u32 mod = readl(i2s->addr + I2SMOD);
240
241 mod &= ~MOD_BCLK_MASK;
242
243 switch (bfs) {
244 case 48:
245 mod |= MOD_BCLK_48FS;
246 break;
247 case 32:
248 mod |= MOD_BCLK_32FS;
249 break;
250 case 24:
251 mod |= MOD_BCLK_24FS;
252 break;
253 case 16:
254 mod |= MOD_BCLK_16FS;
255 break;
256 default:
257 dev_err(&i2s->pdev->dev, "Wrong BCLK Divider!\n");
258 return;
259 }
260
261 writel(mod, i2s->addr + I2SMOD);
262}
263
264
265static inline int get_blc(struct i2s_dai *i2s)
266{
267 int blc = readl(i2s->addr + I2SMOD);
268
269 blc = (blc >> 13) & 0x3;
270
271 switch (blc) {
272 case 2: return 24;
273 case 1: return 8;
274 default: return 16;
275 }
276}
277
278
279static void i2s_txctrl(struct i2s_dai *i2s, int on)
280{
281 void __iomem *addr = i2s->addr;
282 u32 con = readl(addr + I2SCON);
283 u32 mod = readl(addr + I2SMOD) & ~MOD_MASK;
284
285 if (on) {
286 con |= CON_ACTIVE;
287 con &= ~CON_TXCH_PAUSE;
288
289 if (is_secondary(i2s)) {
290 con |= CON_TXSDMA_ACTIVE;
291 con &= ~CON_TXSDMA_PAUSE;
292 } else {
293 con |= CON_TXDMA_ACTIVE;
294 con &= ~CON_TXDMA_PAUSE;
295 }
296
297 if (any_rx_active(i2s))
298 mod |= MOD_TXRX;
299 else
300 mod |= MOD_TXONLY;
301 } else {
302 if (is_secondary(i2s)) {
303 con |= CON_TXSDMA_PAUSE;
304 con &= ~CON_TXSDMA_ACTIVE;
305 } else {
306 con |= CON_TXDMA_PAUSE;
307 con &= ~CON_TXDMA_ACTIVE;
308 }
309
310 if (other_tx_active(i2s)) {
311 writel(con, addr + I2SCON);
312 return;
313 }
314
315 con |= CON_TXCH_PAUSE;
316
317 if (any_rx_active(i2s))
318 mod |= MOD_RXONLY;
319 else
320 con &= ~CON_ACTIVE;
321 }
322
323 writel(mod, addr + I2SMOD);
324 writel(con, addr + I2SCON);
325}
326
327
328static void i2s_rxctrl(struct i2s_dai *i2s, int on)
329{
330 void __iomem *addr = i2s->addr;
331 u32 con = readl(addr + I2SCON);
332 u32 mod = readl(addr + I2SMOD) & ~MOD_MASK;
333
334 if (on) {
335 con |= CON_RXDMA_ACTIVE | CON_ACTIVE;
336 con &= ~(CON_RXDMA_PAUSE | CON_RXCH_PAUSE);
337
338 if (any_tx_active(i2s))
339 mod |= MOD_TXRX;
340 else
341 mod |= MOD_RXONLY;
342 } else {
343 con |= CON_RXDMA_PAUSE | CON_RXCH_PAUSE;
344 con &= ~CON_RXDMA_ACTIVE;
345
346 if (any_tx_active(i2s))
347 mod |= MOD_TXONLY;
348 else
349 con &= ~CON_ACTIVE;
350 }
351
352 writel(mod, addr + I2SMOD);
353 writel(con, addr + I2SCON);
354}
355
356
357static inline void i2s_fifo(struct i2s_dai *i2s, u32 flush)
358{
359 void __iomem *fic;
360 u32 val;
361
362 if (!i2s)
363 return;
364
365 if (is_secondary(i2s))
366 fic = i2s->addr + I2SFICS;
367 else
368 fic = i2s->addr + I2SFIC;
369
370
371 writel(readl(fic) | flush, fic);
372
373
374 val = msecs_to_loops(1) / 1000;
375 while (--val)
376 cpu_relax();
377
378 writel(readl(fic) & ~flush, fic);
379}
380
381static int i2s_set_sysclk(struct snd_soc_dai *dai,
382 int clk_id, unsigned int rfs, int dir)
383{
384 struct i2s_dai *i2s = to_info(dai);
385 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
386 u32 mod = readl(i2s->addr + I2SMOD);
387
388 switch (clk_id) {
389 case SAMSUNG_I2S_CDCLK:
390
391 if (dir == SND_SOC_CLOCK_IN)
392 rfs = 0;
393
394 if ((rfs && other->rfs && (other->rfs != rfs)) ||
395 (any_active(i2s) &&
396 (((dir == SND_SOC_CLOCK_IN)
397 && !(mod & MOD_CDCLKCON)) ||
398 ((dir == SND_SOC_CLOCK_OUT)
399 && (mod & MOD_CDCLKCON))))) {
400 dev_err(&i2s->pdev->dev,
401 "%s:%d Other DAI busy\n", __func__, __LINE__);
402 return -EAGAIN;
403 }
404
405 if (dir == SND_SOC_CLOCK_IN)
406 mod |= MOD_CDCLKCON;
407 else
408 mod &= ~MOD_CDCLKCON;
409
410 i2s->rfs = rfs;
411 break;
412
413 case SAMSUNG_I2S_RCLKSRC_0:
414 case SAMSUNG_I2S_RCLKSRC_1:
415 if ((i2s->quirks & QUIRK_NO_MUXPSR)
416 || (clk_id == SAMSUNG_I2S_RCLKSRC_0))
417 clk_id = 0;
418 else
419 clk_id = 1;
420
421 if (!any_active(i2s)) {
422 if (i2s->op_clk) {
423 if ((clk_id && !(mod & MOD_IMS_SYSMUX)) ||
424 (!clk_id && (mod & MOD_IMS_SYSMUX))) {
425 clk_disable(i2s->op_clk);
426 clk_put(i2s->op_clk);
427 } else {
428 i2s->rclk_srcrate =
429 clk_get_rate(i2s->op_clk);
430 return 0;
431 }
432 }
433
434 i2s->op_clk = clk_get(&i2s->pdev->dev,
435 i2s->src_clk[clk_id]);
436 clk_enable(i2s->op_clk);
437 i2s->rclk_srcrate = clk_get_rate(i2s->op_clk);
438
439
440 if (other) {
441 other->op_clk = i2s->op_clk;
442 other->rclk_srcrate = i2s->rclk_srcrate;
443 }
444 } else if ((!clk_id && (mod & MOD_IMS_SYSMUX))
445 || (clk_id && !(mod & MOD_IMS_SYSMUX))) {
446 dev_err(&i2s->pdev->dev,
447 "%s:%d Other DAI busy\n", __func__, __LINE__);
448 return -EAGAIN;
449 } else {
450
451 i2s->op_clk = other->op_clk;
452 i2s->rclk_srcrate = other->rclk_srcrate;
453 return 0;
454 }
455
456 if (clk_id == 0)
457 mod &= ~MOD_IMS_SYSMUX;
458 else
459 mod |= MOD_IMS_SYSMUX;
460 break;
461
462 default:
463 dev_err(&i2s->pdev->dev, "We don't serve that!\n");
464 return -EINVAL;
465 }
466
467 writel(mod, i2s->addr + I2SMOD);
468
469 return 0;
470}
471
472static int i2s_set_fmt(struct snd_soc_dai *dai,
473 unsigned int fmt)
474{
475 struct i2s_dai *i2s = to_info(dai);
476 u32 mod = readl(i2s->addr + I2SMOD);
477 u32 tmp = 0;
478
479
480 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
481 case SND_SOC_DAIFMT_RIGHT_J:
482 tmp |= MOD_LR_RLOW;
483 tmp |= MOD_SDF_MSB;
484 break;
485 case SND_SOC_DAIFMT_LEFT_J:
486 tmp |= MOD_LR_RLOW;
487 tmp |= MOD_SDF_LSB;
488 break;
489 case SND_SOC_DAIFMT_I2S:
490 tmp |= MOD_SDF_IIS;
491 break;
492 default:
493 dev_err(&i2s->pdev->dev, "Format not supported\n");
494 return -EINVAL;
495 }
496
497
498
499
500
501 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
502 case SND_SOC_DAIFMT_NB_NF:
503 break;
504 case SND_SOC_DAIFMT_NB_IF:
505 if (tmp & MOD_LR_RLOW)
506 tmp &= ~MOD_LR_RLOW;
507 else
508 tmp |= MOD_LR_RLOW;
509 break;
510 default:
511 dev_err(&i2s->pdev->dev, "Polarity not supported\n");
512 return -EINVAL;
513 }
514
515 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
516 case SND_SOC_DAIFMT_CBM_CFM:
517 tmp |= MOD_SLAVE;
518 break;
519 case SND_SOC_DAIFMT_CBS_CFS:
520
521 if (i2s->rclk_srcrate == 0)
522 i2s_set_sysclk(dai, SAMSUNG_I2S_RCLKSRC_0,
523 0, SND_SOC_CLOCK_IN);
524 break;
525 default:
526 dev_err(&i2s->pdev->dev, "master/slave format not supported\n");
527 return -EINVAL;
528 }
529
530 if (any_active(i2s) &&
531 ((mod & (MOD_SDF_MASK | MOD_LR_RLOW
532 | MOD_SLAVE)) != tmp)) {
533 dev_err(&i2s->pdev->dev,
534 "%s:%d Other DAI busy\n", __func__, __LINE__);
535 return -EAGAIN;
536 }
537
538 mod &= ~(MOD_SDF_MASK | MOD_LR_RLOW | MOD_SLAVE);
539 mod |= tmp;
540 writel(mod, i2s->addr + I2SMOD);
541
542 return 0;
543}
544
545static int i2s_hw_params(struct snd_pcm_substream *substream,
546 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
547{
548 struct i2s_dai *i2s = to_info(dai);
549 u32 mod = readl(i2s->addr + I2SMOD);
550
551 if (!is_secondary(i2s))
552 mod &= ~(MOD_DC2_EN | MOD_DC1_EN);
553
554 switch (params_channels(params)) {
555 case 6:
556 mod |= MOD_DC2_EN;
557 case 4:
558 mod |= MOD_DC1_EN;
559 break;
560 case 2:
561 break;
562 default:
563 dev_err(&i2s->pdev->dev, "%d channels not supported\n",
564 params_channels(params));
565 return -EINVAL;
566 }
567
568 if (is_secondary(i2s))
569 mod &= ~MOD_BLCS_MASK;
570 else
571 mod &= ~MOD_BLCP_MASK;
572
573 if (is_manager(i2s))
574 mod &= ~MOD_BLC_MASK;
575
576 switch (params_format(params)) {
577 case SNDRV_PCM_FORMAT_S8:
578 if (is_secondary(i2s))
579 mod |= MOD_BLCS_8BIT;
580 else
581 mod |= MOD_BLCP_8BIT;
582 if (is_manager(i2s))
583 mod |= MOD_BLC_8BIT;
584 break;
585 case SNDRV_PCM_FORMAT_S16_LE:
586 if (is_secondary(i2s))
587 mod |= MOD_BLCS_16BIT;
588 else
589 mod |= MOD_BLCP_16BIT;
590 if (is_manager(i2s))
591 mod |= MOD_BLC_16BIT;
592 break;
593 case SNDRV_PCM_FORMAT_S24_LE:
594 if (is_secondary(i2s))
595 mod |= MOD_BLCS_24BIT;
596 else
597 mod |= MOD_BLCP_24BIT;
598 if (is_manager(i2s))
599 mod |= MOD_BLC_24BIT;
600 break;
601 default:
602 dev_err(&i2s->pdev->dev, "Format(%d) not supported\n",
603 params_format(params));
604 return -EINVAL;
605 }
606 writel(mod, i2s->addr + I2SMOD);
607
608 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
609 snd_soc_dai_set_dma_data(dai, substream,
610 (void *)&i2s->dma_playback);
611 else
612 snd_soc_dai_set_dma_data(dai, substream,
613 (void *)&i2s->dma_capture);
614
615 i2s->frmclk = params_rate(params);
616
617 return 0;
618}
619
620
621static int i2s_startup(struct snd_pcm_substream *substream,
622 struct snd_soc_dai *dai)
623{
624 struct i2s_dai *i2s = to_info(dai);
625 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
626 unsigned long flags;
627
628 spin_lock_irqsave(&lock, flags);
629
630 i2s->mode |= DAI_OPENED;
631
632 if (is_manager(other))
633 i2s->mode &= ~DAI_MANAGER;
634 else
635 i2s->mode |= DAI_MANAGER;
636
637
638 i2s->rclk_srcrate = 0;
639
640 spin_unlock_irqrestore(&lock, flags);
641
642 return 0;
643}
644
645static void i2s_shutdown(struct snd_pcm_substream *substream,
646 struct snd_soc_dai *dai)
647{
648 struct i2s_dai *i2s = to_info(dai);
649 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
650 unsigned long flags;
651
652 spin_lock_irqsave(&lock, flags);
653
654 i2s->mode &= ~DAI_OPENED;
655 i2s->mode &= ~DAI_MANAGER;
656
657 if (is_opened(other))
658 other->mode |= DAI_MANAGER;
659
660
661 i2s->rfs = 0;
662 i2s->bfs = 0;
663
664 spin_unlock_irqrestore(&lock, flags);
665
666
667 if (!is_opened(other))
668 i2s_set_sysclk(dai, SAMSUNG_I2S_CDCLK,
669 0, SND_SOC_CLOCK_IN);
670}
671
672static int config_setup(struct i2s_dai *i2s)
673{
674 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
675 unsigned rfs, bfs, blc;
676 u32 psr;
677
678 blc = get_blc(i2s);
679
680 bfs = i2s->bfs;
681
682 if (!bfs && other)
683 bfs = other->bfs;
684
685
686 if (!bfs)
687 bfs = blc * 2;
688
689 rfs = i2s->rfs;
690
691 if (!rfs && other)
692 rfs = other->rfs;
693
694 if ((rfs == 256 || rfs == 512) && (blc == 24)) {
695 dev_err(&i2s->pdev->dev,
696 "%d-RFS not supported for 24-blc\n", rfs);
697 return -EINVAL;
698 }
699
700 if (!rfs) {
701 if (bfs == 16 || bfs == 32)
702 rfs = 256;
703 else
704 rfs = 384;
705 }
706
707
708 if (any_active(i2s) && (get_rfs(i2s) != rfs || get_bfs(i2s) != bfs)) {
709 dev_err(&i2s->pdev->dev,
710 "%s:%d Other DAI busy\n", __func__, __LINE__);
711 return -EAGAIN;
712 }
713
714
715 if (is_slave(i2s))
716 return 0;
717
718 set_bfs(i2s, bfs);
719 set_rfs(i2s, rfs);
720
721 if (!(i2s->quirks & QUIRK_NO_MUXPSR)) {
722 psr = i2s->rclk_srcrate / i2s->frmclk / rfs;
723 writel(((psr - 1) << 8) | PSR_PSREN, i2s->addr + I2SPSR);
724 dev_dbg(&i2s->pdev->dev,
725 "RCLK_SRC=%luHz PSR=%u, RCLK=%dfs, BCLK=%dfs\n",
726 i2s->rclk_srcrate, psr, rfs, bfs);
727 }
728
729 return 0;
730}
731
732static int i2s_trigger(struct snd_pcm_substream *substream,
733 int cmd, struct snd_soc_dai *dai)
734{
735 int capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
736 struct snd_soc_pcm_runtime *rtd = substream->private_data;
737 struct i2s_dai *i2s = to_info(rtd->cpu_dai);
738 unsigned long flags;
739
740 switch (cmd) {
741 case SNDRV_PCM_TRIGGER_START:
742 case SNDRV_PCM_TRIGGER_RESUME:
743 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
744 local_irq_save(flags);
745
746 if (config_setup(i2s)) {
747 local_irq_restore(flags);
748 return -EINVAL;
749 }
750
751 if (capture)
752 i2s_rxctrl(i2s, 1);
753 else
754 i2s_txctrl(i2s, 1);
755
756 local_irq_restore(flags);
757 break;
758 case SNDRV_PCM_TRIGGER_STOP:
759 case SNDRV_PCM_TRIGGER_SUSPEND:
760 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
761 local_irq_save(flags);
762
763 if (capture)
764 i2s_rxctrl(i2s, 0);
765 else
766 i2s_txctrl(i2s, 0);
767
768 if (capture)
769 i2s_fifo(i2s, FIC_RXFLUSH);
770 else
771 i2s_fifo(i2s, FIC_TXFLUSH);
772
773 local_irq_restore(flags);
774 break;
775 }
776
777 return 0;
778}
779
780static int i2s_set_clkdiv(struct snd_soc_dai *dai,
781 int div_id, int div)
782{
783 struct i2s_dai *i2s = to_info(dai);
784 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
785
786 switch (div_id) {
787 case SAMSUNG_I2S_DIV_BCLK:
788 if ((any_active(i2s) && div && (get_bfs(i2s) != div))
789 || (other && other->bfs && (other->bfs != div))) {
790 dev_err(&i2s->pdev->dev,
791 "%s:%d Other DAI busy\n", __func__, __LINE__);
792 return -EAGAIN;
793 }
794 i2s->bfs = div;
795 break;
796 default:
797 dev_err(&i2s->pdev->dev,
798 "Invalid clock divider(%d)\n", div_id);
799 return -EINVAL;
800 }
801
802 return 0;
803}
804
805static snd_pcm_sframes_t
806i2s_delay(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
807{
808 struct i2s_dai *i2s = to_info(dai);
809 u32 reg = readl(i2s->addr + I2SFIC);
810 snd_pcm_sframes_t delay;
811
812 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
813 delay = FIC_RXCOUNT(reg);
814 else if (is_secondary(i2s))
815 delay = FICS_TXCOUNT(readl(i2s->addr + I2SFICS));
816 else
817 delay = FIC_TXCOUNT(reg);
818
819 return delay;
820}
821
822#ifdef CONFIG_PM
823static int i2s_suspend(struct snd_soc_dai *dai)
824{
825 struct i2s_dai *i2s = to_info(dai);
826
827 if (dai->active) {
828 i2s->suspend_i2smod = readl(i2s->addr + I2SMOD);
829 i2s->suspend_i2scon = readl(i2s->addr + I2SCON);
830 i2s->suspend_i2spsr = readl(i2s->addr + I2SPSR);
831 }
832
833 return 0;
834}
835
836static int i2s_resume(struct snd_soc_dai *dai)
837{
838 struct i2s_dai *i2s = to_info(dai);
839
840 if (dai->active) {
841 writel(i2s->suspend_i2scon, i2s->addr + I2SCON);
842 writel(i2s->suspend_i2smod, i2s->addr + I2SMOD);
843 writel(i2s->suspend_i2spsr, i2s->addr + I2SPSR);
844 }
845
846 return 0;
847}
848#else
849#define i2s_suspend NULL
850#define i2s_resume NULL
851#endif
852
853static int samsung_i2s_dai_probe(struct snd_soc_dai *dai)
854{
855 struct i2s_dai *i2s = to_info(dai);
856 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
857
858 if (other && other->clk)
859 goto probe_exit;
860
861 i2s->addr = ioremap(i2s->base, 0x100);
862 if (i2s->addr == NULL) {
863 dev_err(&i2s->pdev->dev, "cannot ioremap registers\n");
864 return -ENXIO;
865 }
866
867 i2s->clk = clk_get(&i2s->pdev->dev, "iis");
868 if (IS_ERR(i2s->clk)) {
869 dev_err(&i2s->pdev->dev, "failed to get i2s_clock\n");
870 iounmap(i2s->addr);
871 return -ENOENT;
872 }
873 clk_enable(i2s->clk);
874
875 if (other) {
876 other->addr = i2s->addr;
877 other->clk = i2s->clk;
878 }
879
880 if (i2s->quirks & QUIRK_NEED_RSTCLR)
881 writel(CON_RSTCLR, i2s->addr + I2SCON);
882
883 if (i2s->quirks & QUIRK_SEC_DAI)
884 idma_reg_addr_init((void *)i2s->addr,
885 i2s->sec_dai->idma_playback.dma_addr);
886
887probe_exit:
888
889 i2s->rfs = 0;
890 i2s->bfs = 0;
891 i2s_txctrl(i2s, 0);
892 i2s_rxctrl(i2s, 0);
893 i2s_fifo(i2s, FIC_TXFLUSH);
894 i2s_fifo(other, FIC_TXFLUSH);
895 i2s_fifo(i2s, FIC_RXFLUSH);
896
897
898 if (!is_opened(other))
899 i2s_set_sysclk(dai, SAMSUNG_I2S_CDCLK,
900 0, SND_SOC_CLOCK_IN);
901
902 return 0;
903}
904
905static int samsung_i2s_dai_remove(struct snd_soc_dai *dai)
906{
907 struct i2s_dai *i2s = snd_soc_dai_get_drvdata(dai);
908 struct i2s_dai *other = i2s->pri_dai ? : i2s->sec_dai;
909
910 if (!other || !other->clk) {
911
912 if (i2s->quirks & QUIRK_NEED_RSTCLR)
913 writel(0, i2s->addr + I2SCON);
914
915 clk_disable(i2s->clk);
916 clk_put(i2s->clk);
917
918 iounmap(i2s->addr);
919 }
920
921 i2s->clk = NULL;
922
923 return 0;
924}
925
926static struct snd_soc_dai_ops samsung_i2s_dai_ops = {
927 .trigger = i2s_trigger,
928 .hw_params = i2s_hw_params,
929 .set_fmt = i2s_set_fmt,
930 .set_clkdiv = i2s_set_clkdiv,
931 .set_sysclk = i2s_set_sysclk,
932 .startup = i2s_startup,
933 .shutdown = i2s_shutdown,
934 .delay = i2s_delay,
935};
936
937#define SAMSUNG_I2S_RATES SNDRV_PCM_RATE_8000_96000
938
939#define SAMSUNG_I2S_FMTS (SNDRV_PCM_FMTBIT_S8 | \
940 SNDRV_PCM_FMTBIT_S16_LE | \
941 SNDRV_PCM_FMTBIT_S24_LE)
942
943static __devinit
944struct i2s_dai *i2s_alloc_dai(struct platform_device *pdev, bool sec)
945{
946 struct i2s_dai *i2s;
947
948 i2s = kzalloc(sizeof(struct i2s_dai), GFP_KERNEL);
949 if (i2s == NULL)
950 return NULL;
951
952 i2s->pdev = pdev;
953 i2s->pri_dai = NULL;
954 i2s->sec_dai = NULL;
955 i2s->i2s_dai_drv.symmetric_rates = 1;
956 i2s->i2s_dai_drv.probe = samsung_i2s_dai_probe;
957 i2s->i2s_dai_drv.remove = samsung_i2s_dai_remove;
958 i2s->i2s_dai_drv.ops = &samsung_i2s_dai_ops;
959 i2s->i2s_dai_drv.suspend = i2s_suspend;
960 i2s->i2s_dai_drv.resume = i2s_resume;
961 i2s->i2s_dai_drv.playback.channels_min = 2;
962 i2s->i2s_dai_drv.playback.channels_max = 2;
963 i2s->i2s_dai_drv.playback.rates = SAMSUNG_I2S_RATES;
964 i2s->i2s_dai_drv.playback.formats = SAMSUNG_I2S_FMTS;
965
966 if (!sec) {
967 i2s->i2s_dai_drv.capture.channels_min = 2;
968 i2s->i2s_dai_drv.capture.channels_max = 2;
969 i2s->i2s_dai_drv.capture.rates = SAMSUNG_I2S_RATES;
970 i2s->i2s_dai_drv.capture.formats = SAMSUNG_I2S_FMTS;
971 } else {
972 i2s->pdev = platform_device_register_resndata(NULL,
973 pdev->name, pdev->id + SAMSUNG_I2S_SECOFF,
974 NULL, 0, NULL, 0);
975 if (IS_ERR(i2s->pdev)) {
976 kfree(i2s);
977 return NULL;
978 }
979 }
980
981
982 dev_set_drvdata(&i2s->pdev->dev, i2s);
983
984 return i2s;
985}
986
987static __devinit int samsung_i2s_probe(struct platform_device *pdev)
988{
989 u32 dma_pl_chan, dma_cp_chan, dma_pl_sec_chan;
990 struct i2s_dai *pri_dai, *sec_dai = NULL;
991 struct s3c_audio_pdata *i2s_pdata;
992 struct samsung_i2s *i2s_cfg;
993 struct resource *res;
994 u32 regs_base, quirks;
995 int ret = 0;
996
997
998 if (pdev->id >= SAMSUNG_I2S_SECOFF) {
999 sec_dai = dev_get_drvdata(&pdev->dev);
1000 snd_soc_register_dai(&sec_dai->pdev->dev,
1001 &sec_dai->i2s_dai_drv);
1002 return 0;
1003 }
1004
1005 i2s_pdata = pdev->dev.platform_data;
1006 if (i2s_pdata == NULL) {
1007 dev_err(&pdev->dev, "Can't work without s3c_audio_pdata\n");
1008 return -EINVAL;
1009 }
1010
1011 res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1012 if (!res) {
1013 dev_err(&pdev->dev, "Unable to get I2S-TX dma resource\n");
1014 return -ENXIO;
1015 }
1016 dma_pl_chan = res->start;
1017
1018 res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1019 if (!res) {
1020 dev_err(&pdev->dev, "Unable to get I2S-RX dma resource\n");
1021 return -ENXIO;
1022 }
1023 dma_cp_chan = res->start;
1024
1025 res = platform_get_resource(pdev, IORESOURCE_DMA, 2);
1026 if (res)
1027 dma_pl_sec_chan = res->start;
1028 else
1029 dma_pl_sec_chan = 0;
1030
1031 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1032 if (!res) {
1033 dev_err(&pdev->dev, "Unable to get I2S SFR address\n");
1034 return -ENXIO;
1035 }
1036
1037 if (!request_mem_region(res->start, resource_size(res),
1038 "samsung-i2s")) {
1039 dev_err(&pdev->dev, "Unable to request SFR region\n");
1040 return -EBUSY;
1041 }
1042 regs_base = res->start;
1043
1044 i2s_cfg = &i2s_pdata->type.i2s;
1045 quirks = i2s_cfg->quirks;
1046
1047 pri_dai = i2s_alloc_dai(pdev, false);
1048 if (!pri_dai) {
1049 dev_err(&pdev->dev, "Unable to alloc I2S_pri\n");
1050 ret = -ENOMEM;
1051 goto err1;
1052 }
1053
1054 pri_dai->dma_playback.dma_addr = regs_base + I2STXD;
1055 pri_dai->dma_capture.dma_addr = regs_base + I2SRXD;
1056 pri_dai->dma_playback.client =
1057 (struct s3c2410_dma_client *)&pri_dai->dma_playback;
1058 pri_dai->dma_capture.client =
1059 (struct s3c2410_dma_client *)&pri_dai->dma_capture;
1060 pri_dai->dma_playback.channel = dma_pl_chan;
1061 pri_dai->dma_capture.channel = dma_cp_chan;
1062 pri_dai->src_clk = i2s_cfg->src_clk;
1063 pri_dai->dma_playback.dma_size = 4;
1064 pri_dai->dma_capture.dma_size = 4;
1065 pri_dai->base = regs_base;
1066 pri_dai->quirks = quirks;
1067
1068 if (quirks & QUIRK_PRI_6CHAN)
1069 pri_dai->i2s_dai_drv.playback.channels_max = 6;
1070
1071 if (quirks & QUIRK_SEC_DAI) {
1072 sec_dai = i2s_alloc_dai(pdev, true);
1073 if (!sec_dai) {
1074 dev_err(&pdev->dev, "Unable to alloc I2S_sec\n");
1075 ret = -ENOMEM;
1076 goto err2;
1077 }
1078 sec_dai->dma_playback.dma_addr = regs_base + I2STXDS;
1079 sec_dai->dma_playback.client =
1080 (struct s3c2410_dma_client *)&sec_dai->dma_playback;
1081
1082 sec_dai->dma_playback.channel = dma_pl_sec_chan ? : -1;
1083 sec_dai->src_clk = i2s_cfg->src_clk;
1084 sec_dai->dma_playback.dma_size = 4;
1085 sec_dai->base = regs_base;
1086 sec_dai->quirks = quirks;
1087 sec_dai->idma_playback.dma_addr = i2s_cfg->idma_addr;
1088 sec_dai->pri_dai = pri_dai;
1089 pri_dai->sec_dai = sec_dai;
1090 }
1091
1092 if (i2s_pdata->cfg_gpio && i2s_pdata->cfg_gpio(pdev)) {
1093 dev_err(&pdev->dev, "Unable to configure gpio\n");
1094 ret = -EINVAL;
1095 goto err3;
1096 }
1097
1098 snd_soc_register_dai(&pri_dai->pdev->dev, &pri_dai->i2s_dai_drv);
1099
1100 return 0;
1101err3:
1102 kfree(sec_dai);
1103err2:
1104 kfree(pri_dai);
1105err1:
1106 release_mem_region(regs_base, resource_size(res));
1107
1108 return ret;
1109}
1110
1111static __devexit int samsung_i2s_remove(struct platform_device *pdev)
1112{
1113 struct i2s_dai *i2s, *other;
1114
1115 i2s = dev_get_drvdata(&pdev->dev);
1116 other = i2s->pri_dai ? : i2s->sec_dai;
1117
1118 if (other) {
1119 other->pri_dai = NULL;
1120 other->sec_dai = NULL;
1121 } else {
1122 struct resource *res;
1123 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1124 if (res)
1125 release_mem_region(res->start, resource_size(res));
1126 }
1127
1128 i2s->pri_dai = NULL;
1129 i2s->sec_dai = NULL;
1130
1131 kfree(i2s);
1132
1133 snd_soc_unregister_dai(&pdev->dev);
1134
1135 return 0;
1136}
1137
1138static struct platform_driver samsung_i2s_driver = {
1139 .probe = samsung_i2s_probe,
1140 .remove = __devexit_p(samsung_i2s_remove),
1141 .driver = {
1142 .name = "samsung-i2s",
1143 .owner = THIS_MODULE,
1144 },
1145};
1146
1147static int __init samsung_i2s_init(void)
1148{
1149 return platform_driver_register(&samsung_i2s_driver);
1150}
1151module_init(samsung_i2s_init);
1152
1153static void __exit samsung_i2s_exit(void)
1154{
1155 platform_driver_unregister(&samsung_i2s_driver);
1156}
1157module_exit(samsung_i2s_exit);
1158
1159
1160MODULE_AUTHOR("Jaswinder Singh, <jassi.brar@samsung.com>");
1161MODULE_DESCRIPTION("Samsung I2S Interface");
1162MODULE_ALIAS("platform:samsung-i2s");
1163MODULE_LICENSE("GPL");
1164
