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