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