ASoC: Fix a typo in jive_wm8750
[linux-2.6.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 <jassi.brar@samsung.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
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
31 struct i2s_dai {
32         /* Platform device for this DAI */
33         struct platform_device *pdev;
34         /* IOREMAP'd SFRs */
35         void __iomem    *addr;
36         /* Physical base address of SFRs */
37         u32     base;
38         /* Rate of RCLK source clock */
39         unsigned long rclk_srcrate;
40         /* Frame Clock */
41         unsigned frmclk;
42         /*
43          * Specifically requested RCLK,BCLK by MACHINE Driver.
44          * 0 indicates CPU driver is free to choose any value.
45          */
46         unsigned rfs, bfs;
47         /* I2S Controller's core clock */
48         struct clk *clk;
49         /* Clock for generating I2S signals */
50         struct clk *op_clk;
51         /* Array of clock names for op_clk */
52         const char **src_clk;
53         /* Pointer to the Primary_Fifo if this is Sec_Fifo, NULL otherwise */
54         struct i2s_dai *pri_dai;
55         /* Pointer to the Secondary_Fifo if it has one, NULL otherwise */
56         struct i2s_dai *sec_dai;
57 #define DAI_OPENED      (1 << 0) /* Dai is opened */
58 #define DAI_MANAGER     (1 << 1) /* Dai is the manager */
59         unsigned mode;
60         /* Driver for this DAI */
61         struct snd_soc_dai_driver i2s_dai_drv;
62         /* DMA parameters */
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 /* Lock for cross i/f checks */
73 static DEFINE_SPINLOCK(lock);
74
75 /* If this is the 'overlay' stereo DAI */
76 static inline bool is_secondary(struct i2s_dai *i2s)
77 {
78         return i2s->pri_dai ? true : false;
79 }
80
81 /* If operating in SoC-Slave mode */
82 static inline bool is_slave(struct i2s_dai *i2s)
83 {
84         return (readl(i2s->addr + I2SMOD) & MOD_SLAVE) ? true : false;
85 }
86
87 /* If this interface of the controller is transmitting data */
88 static 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 /* If the other interface of the controller is transmitting data */
106 static 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 /* If any interface of the controller is transmitting data */
114 static inline bool any_tx_active(struct i2s_dai *i2s)
115 {
116         return tx_active(i2s) || other_tx_active(i2s);
117 }
118
119 /* If this interface of the controller is receiving data */
120 static 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 /* If the other interface of the controller is receiving data */
133 static 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 /* If any interface of the controller is receiving data */
141 static inline bool any_rx_active(struct i2s_dai *i2s)
142 {
143         return rx_active(i2s) || other_rx_active(i2s);
144 }
145
146 /* If the other DAI is transmitting or receiving data */
147 static inline bool other_active(struct i2s_dai *i2s)
148 {
149         return other_rx_active(i2s) || other_tx_active(i2s);
150 }
151
152 /* If this DAI is transmitting or receiving data */
153 static inline bool this_active(struct i2s_dai *i2s)
154 {
155         return tx_active(i2s) || rx_active(i2s);
156 }
157
158 /* If the controller is active anyway */
159 static inline bool any_active(struct i2s_dai *i2s)
160 {
161         return this_active(i2s) || other_active(i2s);
162 }
163
164 static inline struct i2s_dai *to_info(struct snd_soc_dai *dai)
165 {
166         return snd_soc_dai_get_drvdata(dai);
167 }
168
169 static 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
177 static 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 /* Read RCLK of I2S (in multiples of LRCLK) */
186 static 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 /* Write RCLK of I2S (in multiples of LRCLK) */
199 static 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 /* Read Bit-Clock of I2S (in multiples of LRCLK) */
224 static 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 /* Write Bit-Clock of I2S (in multiples of LRCLK) */
237 static 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 /* Sample-Size */
265 static 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 /* TX Channel Control */
279 static 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 /* RX Channel Control */
328 static 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 /* Flush FIFO of an interface */
357 static 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         /* Flush the FIFO */
371         writel(readl(fic) | flush, fic);
372
373         /* Be patient */
374         val = msecs_to_loops(1) / 1000; /* 1 usec */
375         while (--val)
376                 cpu_relax();
377
378         writel(readl(fic) & ~flush, fic);
379 }
380
381 static 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                 /* Shouldn't matter in GATING(CLOCK_IN) mode */
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: /* clock corrsponding to IISMOD[10] := 0 */
414         case SAMSUNG_I2S_RCLKSRC_1: /* clock corrsponding to IISMOD[10] := 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                         /* Over-ride the other's */
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                         /* Call can't be on the active DAI */
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
472 static 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         /* Format is priority */
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          * INV flag is relative to the FORMAT flag - if set it simply
499          * flips the polarity specified by the Standard
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                 /* Set default source clock in Master mode */
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
545 static 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 /* We set constraints on the substream acc to the version of I2S */
621 static 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         /* Enforce set_sysclk in Master mode */
638         i2s->rclk_srcrate = 0;
639
640         spin_unlock_irqrestore(&lock, flags);
641
642         return 0;
643 }
644
645 static 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         /* Reset any constraint on RFS and BFS */
661         i2s->rfs = 0;
662         i2s->bfs = 0;
663
664         spin_unlock_irqrestore(&lock, flags);
665
666         /* Gate CDCLK by default */
667         if (!is_opened(other))
668                 i2s_set_sysclk(dai, SAMSUNG_I2S_CDCLK,
669                                 0, SND_SOC_CLOCK_IN);
670 }
671
672 static 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         /* Select least possible multiple(2) if no constraint set */
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         /* If already setup and running */
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         /* Don't bother RFS, BFS & PSR in Slave mode */
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
732 static 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
780 static 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
805 static snd_pcm_sframes_t
806 i2s_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
823 static 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
836 static 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
853 static 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) /* If this is probe on secondary */
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
887 probe_exit:
888         /* Reset any constraint on RFS and BFS */
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         /* Gate CDCLK by default */
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
905 static 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
926 static 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
943 static __devinit
944 struct 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 {        /* Create a new platform_device for Secondary */
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         /* Pre-assign snd_soc_dai_set_drvdata */
982         dev_set_drvdata(&i2s->pdev->dev, i2s);
983
984         return i2s;
985 }
986
987 static __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         /* Call during Seconday interface registration */
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                 /* Use iDMA always if SysDMA not provided */
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;
1101 err3:
1102         kfree(sec_dai);
1103 err2:
1104         kfree(pri_dai);
1105 err1:
1106         release_mem_region(regs_base, resource_size(res));
1107
1108         return ret;
1109 }
1110
1111 static __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
1138 static 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
1147 static int __init samsung_i2s_init(void)
1148 {
1149         return platform_driver_register(&samsung_i2s_driver);
1150 }
1151 module_init(samsung_i2s_init);
1152
1153 static void __exit samsung_i2s_exit(void)
1154 {
1155         platform_driver_unregister(&samsung_i2s_driver);
1156 }
1157 module_exit(samsung_i2s_exit);
1158
1159 /* Module information */
1160 MODULE_AUTHOR("Jaswinder Singh, <jassi.brar@samsung.com>");
1161 MODULE_DESCRIPTION("Samsung I2S Interface");
1162 MODULE_ALIAS("platform:samsung-i2s");
1163 MODULE_LICENSE("GPL");