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