s3c-i2s-v2.c 17.2 KB
Newer Older
1
/* ALSA Soc Audio Layer - I2S core for newer Samsung SoCs.
2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
 *
 * Copyright (c) 2006 Wolfson Microelectronics PLC.
 *	Graeme Gregory graeme.gregory@wolfsonmicro.com
 *	linux@wolfsonmicro.com
 *
 * Copyright (c) 2008, 2007, 2004-2005 Simtec Electronics
 *	http://armlinux.simtec.co.uk/
 *	Ben Dooks <ben@simtec.co.uk>
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

17
#include <linux/module.h>
18 19 20 21 22
#include <linux/delay.h>
#include <linux/clk.h>
#include <linux/io.h>

#include <sound/soc.h>
23
#include <sound/pcm_params.h>
24

25
#include "regs-i2s-v2.h"
26
#include "s3c-i2s-v2.h"
J
Jassi Brar 已提交
27
#include "dma.h"
28

29 30
#undef S3C_IIS_V2_SUPPORTED

31
#if defined(CONFIG_CPU_S3C2412) || defined(CONFIG_CPU_S3C2413) \
32
	|| defined(CONFIG_ARCH_S3C64XX) || defined(CONFIG_CPU_S5PV210)
33 34 35 36 37 38 39
#define S3C_IIS_V2_SUPPORTED
#endif

#ifndef S3C_IIS_V2_SUPPORTED
#error Unsupported CPU model
#endif

40 41 42 43
#define S3C2412_I2S_DEBUG_CON 0

static inline struct s3c_i2sv2_info *to_info(struct snd_soc_dai *cpu_dai)
{
44
	return snd_soc_dai_get_drvdata(cpu_dai);
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77
}

#define bit_set(v, b) (((v) & (b)) ? 1 : 0)

#if S3C2412_I2S_DEBUG_CON
static void dbg_showcon(const char *fn, u32 con)
{
	printk(KERN_DEBUG "%s: LRI=%d, TXFEMPT=%d, RXFEMPT=%d, TXFFULL=%d, RXFFULL=%d\n", fn,
	       bit_set(con, S3C2412_IISCON_LRINDEX),
	       bit_set(con, S3C2412_IISCON_TXFIFO_EMPTY),
	       bit_set(con, S3C2412_IISCON_RXFIFO_EMPTY),
	       bit_set(con, S3C2412_IISCON_TXFIFO_FULL),
	       bit_set(con, S3C2412_IISCON_RXFIFO_FULL));

	printk(KERN_DEBUG "%s: PAUSE: TXDMA=%d, RXDMA=%d, TXCH=%d, RXCH=%d\n",
	       fn,
	       bit_set(con, S3C2412_IISCON_TXDMA_PAUSE),
	       bit_set(con, S3C2412_IISCON_RXDMA_PAUSE),
	       bit_set(con, S3C2412_IISCON_TXCH_PAUSE),
	       bit_set(con, S3C2412_IISCON_RXCH_PAUSE));
	printk(KERN_DEBUG "%s: ACTIVE: TXDMA=%d, RXDMA=%d, IIS=%d\n", fn,
	       bit_set(con, S3C2412_IISCON_TXDMA_ACTIVE),
	       bit_set(con, S3C2412_IISCON_RXDMA_ACTIVE),
	       bit_set(con, S3C2412_IISCON_IIS_ACTIVE));
}
#else
static inline void dbg_showcon(const char *fn, u32 con)
{
}
#endif


/* Turn on or off the transmission path. */
78
static void s3c2412_snd_txctrl(struct s3c_i2sv2_info *i2s, int on)
79 80 81 82
{
	void __iomem *regs = i2s->regs;
	u32 fic, con, mod;

83
	pr_debug("%s(%d)\n", __func__, on);
84 85 86 87 88

	fic = readl(regs + S3C2412_IISFIC);
	con = readl(regs + S3C2412_IISCON);
	mod = readl(regs + S3C2412_IISMOD);

89
	pr_debug("%s: IIS: CON=%x MOD=%x FIC=%x\n", __func__, con, mod, fic);
90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107

	if (on) {
		con |= S3C2412_IISCON_TXDMA_ACTIVE | S3C2412_IISCON_IIS_ACTIVE;
		con &= ~S3C2412_IISCON_TXDMA_PAUSE;
		con &= ~S3C2412_IISCON_TXCH_PAUSE;

		switch (mod & S3C2412_IISMOD_MODE_MASK) {
		case S3C2412_IISMOD_MODE_TXONLY:
		case S3C2412_IISMOD_MODE_TXRX:
			/* do nothing, we are in the right mode */
			break;

		case S3C2412_IISMOD_MODE_RXONLY:
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			mod |= S3C2412_IISMOD_MODE_TXRX;
			break;

		default:
108 109 110
			dev_err(i2s->dev, "TXEN: Invalid MODE %x in IISMOD\n",
				mod & S3C2412_IISMOD_MODE_MASK);
			break;
111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136
		}

		writel(con, regs + S3C2412_IISCON);
		writel(mod, regs + S3C2412_IISMOD);
	} else {
		/* Note, we do not have any indication that the FIFO problems
		 * tha the S3C2410/2440 had apply here, so we should be able
		 * to disable the DMA and TX without resetting the FIFOS.
		 */

		con |=  S3C2412_IISCON_TXDMA_PAUSE;
		con |=  S3C2412_IISCON_TXCH_PAUSE;
		con &= ~S3C2412_IISCON_TXDMA_ACTIVE;

		switch (mod & S3C2412_IISMOD_MODE_MASK) {
		case S3C2412_IISMOD_MODE_TXRX:
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			mod |= S3C2412_IISMOD_MODE_RXONLY;
			break;

		case S3C2412_IISMOD_MODE_TXONLY:
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			con &= ~S3C2412_IISCON_IIS_ACTIVE;
			break;

		default:
137 138 139
			dev_err(i2s->dev, "TXDIS: Invalid MODE %x in IISMOD\n",
				mod & S3C2412_IISMOD_MODE_MASK);
			break;
140 141 142 143 144 145 146 147
		}

		writel(mod, regs + S3C2412_IISMOD);
		writel(con, regs + S3C2412_IISCON);
	}

	fic = readl(regs + S3C2412_IISFIC);
	dbg_showcon(__func__, con);
148
	pr_debug("%s: IIS: CON=%x MOD=%x FIC=%x\n", __func__, con, mod, fic);
149 150
}

151
static void s3c2412_snd_rxctrl(struct s3c_i2sv2_info *i2s, int on)
152 153 154 155
{
	void __iomem *regs = i2s->regs;
	u32 fic, con, mod;

156
	pr_debug("%s(%d)\n", __func__, on);
157 158 159 160 161

	fic = readl(regs + S3C2412_IISFIC);
	con = readl(regs + S3C2412_IISCON);
	mod = readl(regs + S3C2412_IISMOD);

162
	pr_debug("%s: IIS: CON=%x MOD=%x FIC=%x\n", __func__, con, mod, fic);
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180

	if (on) {
		con |= S3C2412_IISCON_RXDMA_ACTIVE | S3C2412_IISCON_IIS_ACTIVE;
		con &= ~S3C2412_IISCON_RXDMA_PAUSE;
		con &= ~S3C2412_IISCON_RXCH_PAUSE;

		switch (mod & S3C2412_IISMOD_MODE_MASK) {
		case S3C2412_IISMOD_MODE_TXRX:
		case S3C2412_IISMOD_MODE_RXONLY:
			/* do nothing, we are in the right mode */
			break;

		case S3C2412_IISMOD_MODE_TXONLY:
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			mod |= S3C2412_IISMOD_MODE_TXRX;
			break;

		default:
181 182
			dev_err(i2s->dev, "RXEN: Invalid MODE %x in IISMOD\n",
				mod & S3C2412_IISMOD_MODE_MASK);
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205
		}

		writel(mod, regs + S3C2412_IISMOD);
		writel(con, regs + S3C2412_IISCON);
	} else {
		/* See txctrl notes on FIFOs. */

		con &= ~S3C2412_IISCON_RXDMA_ACTIVE;
		con |=  S3C2412_IISCON_RXDMA_PAUSE;
		con |=  S3C2412_IISCON_RXCH_PAUSE;

		switch (mod & S3C2412_IISMOD_MODE_MASK) {
		case S3C2412_IISMOD_MODE_RXONLY:
			con &= ~S3C2412_IISCON_IIS_ACTIVE;
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			break;

		case S3C2412_IISMOD_MODE_TXRX:
			mod &= ~S3C2412_IISMOD_MODE_MASK;
			mod |= S3C2412_IISMOD_MODE_TXONLY;
			break;

		default:
206 207
			dev_err(i2s->dev, "RXDIS: Invalid MODE %x in IISMOD\n",
				mod & S3C2412_IISMOD_MODE_MASK);
208 209 210 211 212 213 214
		}

		writel(con, regs + S3C2412_IISCON);
		writel(mod, regs + S3C2412_IISMOD);
	}

	fic = readl(regs + S3C2412_IISFIC);
215
	pr_debug("%s: IIS: CON=%x MOD=%x FIC=%x\n", __func__, con, mod, fic);
216 217
}

218 219
#define msecs_to_loops(t) (loops_per_jiffy / 1000 * HZ * t)

220 221 222 223 224 225 226
/*
 * Wait for the LR signal to allow synchronisation to the L/R clock
 * from the codec. May only be needed for slave mode.
 */
static int s3c2412_snd_lrsync(struct s3c_i2sv2_info *i2s)
{
	u32 iiscon;
227
	unsigned long loops = msecs_to_loops(5);
228

229
	pr_debug("Entered %s\n", __func__);
230

231
	while (--loops) {
232 233 234 235
		iiscon = readl(i2s->regs + S3C2412_IISCON);
		if (iiscon & S3C2412_IISCON_LRINDEX)
			break;

236 237 238 239 240 241
		cpu_relax();
	}

	if (!loops) {
		printk(KERN_ERR "%s: timeout\n", __func__);
		return -ETIMEDOUT;
242 243 244 245 246 247 248 249 250 251 252 253 254 255
	}

	return 0;
}

/*
 * Set S3C2412 I2S DAI format
 */
static int s3c2412_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
			       unsigned int fmt)
{
	struct s3c_i2sv2_info *i2s = to_info(cpu_dai);
	u32 iismod;

256
	pr_debug("Entered %s\n", __func__);
257 258

	iismod = readl(i2s->regs + S3C2412_IISMOD);
259
	pr_debug("hw_params r: IISMOD: %x \n", iismod);
260 261 262 263

	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBM_CFM:
		i2s->master = 0;
J
Jassi Brar 已提交
264
		iismod |= S3C2412_IISMOD_SLAVE;
265 266 267
		break;
	case SND_SOC_DAIFMT_CBS_CFS:
		i2s->master = 1;
J
Jassi Brar 已提交
268
		iismod &= ~S3C2412_IISMOD_SLAVE;
269 270
		break;
	default:
271
		pr_err("unknwon master/slave format\n");
272 273 274 275 276 277 278
		return -EINVAL;
	}

	iismod &= ~S3C2412_IISMOD_SDF_MASK;

	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
	case SND_SOC_DAIFMT_RIGHT_J:
J
Jassi 已提交
279
		iismod |= S3C2412_IISMOD_LR_RLOW;
280 281 282
		iismod |= S3C2412_IISMOD_SDF_MSB;
		break;
	case SND_SOC_DAIFMT_LEFT_J:
J
Jassi 已提交
283
		iismod |= S3C2412_IISMOD_LR_RLOW;
284 285 286
		iismod |= S3C2412_IISMOD_SDF_LSB;
		break;
	case SND_SOC_DAIFMT_I2S:
J
Jassi 已提交
287
		iismod &= ~S3C2412_IISMOD_LR_RLOW;
288 289 290
		iismod |= S3C2412_IISMOD_SDF_IIS;
		break;
	default:
291
		pr_err("Unknown data format\n");
292 293 294 295
		return -EINVAL;
	}

	writel(iismod, i2s->regs + S3C2412_IISMOD);
296
	pr_debug("hw_params w: IISMOD: %x \n", iismod);
297 298 299
	return 0;
}

300
static int s3c_i2sv2_hw_params(struct snd_pcm_substream *substream,
301
				 struct snd_pcm_hw_params *params,
302
				 struct snd_soc_dai *dai)
303
{
304
	struct s3c_i2sv2_info *i2s = to_info(dai);
305
	struct s3c_dma_params *dma_data;
306 307
	u32 iismod;

308
	pr_debug("Entered %s\n", __func__);
309 310

	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
311
		dma_data = i2s->dma_playback;
312
	else
313 314
		dma_data = i2s->dma_capture;

315
	snd_soc_dai_set_dma_data(dai, substream, dma_data);
316 317 318

	/* Working copies of register */
	iismod = readl(i2s->regs + S3C2412_IISMOD);
319
	pr_debug("%s: r: IISMOD: %x\n", __func__, iismod);
320

321
	iismod &= ~S3C64XX_IISMOD_BLC_MASK;
322
	/* Sample size */
323 324
	switch (params_width(params)) {
	case 8:
325
		iismod |= S3C64XX_IISMOD_BLC_8BIT;
326
		break;
327
	case 16:
328
		break;
329
	case 24:
330
		iismod |= S3C64XX_IISMOD_BLC_24BIT;
331 332
		break;
	}
333 334

	writel(iismod, i2s->regs + S3C2412_IISMOD);
335
	pr_debug("%s: w: IISMOD: %x\n", __func__, iismod);
336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381

	return 0;
}

static int s3c_i2sv2_set_sysclk(struct snd_soc_dai *cpu_dai,
				  int clk_id, unsigned int freq, int dir)
{
	struct s3c_i2sv2_info *i2s = to_info(cpu_dai);
	u32 iismod = readl(i2s->regs + S3C2412_IISMOD);

	pr_debug("Entered %s\n", __func__);
	pr_debug("%s r: IISMOD: %x\n", __func__, iismod);

	switch (clk_id) {
	case S3C_I2SV2_CLKSRC_PCLK:
		iismod &= ~S3C2412_IISMOD_IMS_SYSMUX;
		break;

	case S3C_I2SV2_CLKSRC_AUDIOBUS:
		iismod |= S3C2412_IISMOD_IMS_SYSMUX;
		break;

	case S3C_I2SV2_CLKSRC_CDCLK:
		/* Error if controller doesn't have the CDCLKCON bit */
		if (!(i2s->feature & S3C_FEATURE_CDCLKCON))
			return -EINVAL;

		switch (dir) {
		case SND_SOC_CLOCK_IN:
			iismod |= S3C64XX_IISMOD_CDCLKCON;
			break;
		case SND_SOC_CLOCK_OUT:
			iismod &= ~S3C64XX_IISMOD_CDCLKCON;
			break;
		default:
			return -EINVAL;
		}
		break;

	default:
		return -EINVAL;
	}

	writel(iismod, i2s->regs + S3C2412_IISMOD);
	pr_debug("%s w: IISMOD: %x\n", __func__, iismod);

382 383 384 385 386 387 388
	return 0;
}

static int s3c2412_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
			       struct snd_soc_dai *dai)
{
	struct snd_soc_pcm_runtime *rtd = substream->private_data;
389
	struct s3c_i2sv2_info *i2s = to_info(rtd->cpu_dai);
390 391 392 393
	int capture = (substream->stream == SNDRV_PCM_STREAM_CAPTURE);
	unsigned long irqs;
	int ret = 0;

394
	pr_debug("Entered %s\n", __func__);
395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		/* On start, ensure that the FIFOs are cleared and reset. */

		writel(capture ? S3C2412_IISFIC_RXFLUSH : S3C2412_IISFIC_TXFLUSH,
		       i2s->regs + S3C2412_IISFIC);

		/* clear again, just in case */
		writel(0x0, i2s->regs + S3C2412_IISFIC);

	case SNDRV_PCM_TRIGGER_RESUME:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
		if (!i2s->master) {
			ret = s3c2412_snd_lrsync(i2s);
			if (ret)
				goto exit_err;
		}

		local_irq_save(irqs);

		if (capture)
			s3c2412_snd_rxctrl(i2s, 1);
		else
			s3c2412_snd_txctrl(i2s, 1);

		local_irq_restore(irqs);
422

423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454
		break;

	case SNDRV_PCM_TRIGGER_STOP:
	case SNDRV_PCM_TRIGGER_SUSPEND:
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
		local_irq_save(irqs);

		if (capture)
			s3c2412_snd_rxctrl(i2s, 0);
		else
			s3c2412_snd_txctrl(i2s, 0);

		local_irq_restore(irqs);
		break;
	default:
		ret = -EINVAL;
		break;
	}

exit_err:
	return ret;
}

/*
 * Set S3C2412 Clock dividers
 */
static int s3c2412_i2s_set_clkdiv(struct snd_soc_dai *cpu_dai,
				  int div_id, int div)
{
	struct s3c_i2sv2_info *i2s = to_info(cpu_dai);
	u32 reg;

455
	pr_debug("%s(%p, %d, %d)\n", __func__, cpu_dai, div_id, div);
456 457 458

	switch (div_id) {
	case S3C_I2SV2_DIV_BCLK:
459 460 461 462
		switch (div) {
		case 16:
			div = S3C2412_IISMOD_BCLK_16FS;
			break;
J
Jassi 已提交
463

464 465 466
		case 32:
			div = S3C2412_IISMOD_BCLK_32FS;
			break;
J
Jassi 已提交
467

468 469 470
		case 24:
			div = S3C2412_IISMOD_BCLK_24FS;
			break;
J
Jassi 已提交
471

472 473 474
		case 48:
			div = S3C2412_IISMOD_BCLK_48FS;
			break;
J
Jassi 已提交
475

476 477
		default:
			return -EINVAL;
J
Jassi 已提交
478 479
		}

480 481 482 483
		reg = readl(i2s->regs + S3C2412_IISMOD);
		reg &= ~S3C2412_IISMOD_BCLK_MASK;
		writel(reg | div, i2s->regs + S3C2412_IISMOD);

484
		pr_debug("%s: MOD=%08x\n", __func__, readl(i2s->regs + S3C2412_IISMOD));
485 486 487
		break;

	case S3C_I2SV2_DIV_RCLK:
488 489 490 491
		switch (div) {
		case 256:
			div = S3C2412_IISMOD_RCLK_256FS;
			break;
492

493 494 495
		case 384:
			div = S3C2412_IISMOD_RCLK_384FS;
			break;
496

497 498 499
		case 512:
			div = S3C2412_IISMOD_RCLK_512FS;
			break;
500

501 502 503
		case 768:
			div = S3C2412_IISMOD_RCLK_768FS;
			break;
504

505 506
		default:
			return -EINVAL;
507 508 509 510 511
		}

		reg = readl(i2s->regs + S3C2412_IISMOD);
		reg &= ~S3C2412_IISMOD_RCLK_MASK;
		writel(reg | div, i2s->regs + S3C2412_IISMOD);
512
		pr_debug("%s: MOD=%08x\n", __func__, readl(i2s->regs + S3C2412_IISMOD));
513 514 515 516 517 518 519 520 521
		break;

	case S3C_I2SV2_DIV_PRESCALER:
		if (div >= 0) {
			writel((div << 8) | S3C2412_IISPSR_PSREN,
			       i2s->regs + S3C2412_IISPSR);
		} else {
			writel(0x0, i2s->regs + S3C2412_IISPSR);
		}
522
		pr_debug("%s: PSR=%08x\n", __func__, readl(i2s->regs + S3C2412_IISPSR));
523 524 525 526 527 528 529 530 531
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

532 533 534 535 536 537 538 539 540 541 542 543 544 545 546
static snd_pcm_sframes_t s3c2412_i2s_delay(struct snd_pcm_substream *substream,
					   struct snd_soc_dai *dai)
{
	struct s3c_i2sv2_info *i2s = to_info(dai);
	u32 reg = readl(i2s->regs + S3C2412_IISFIC);
	snd_pcm_sframes_t delay;

	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
		delay = S3C2412_IISFIC_TXCOUNT(reg);
	else
		delay = S3C2412_IISFIC_RXCOUNT(reg);

	return delay;
}

547 548 549 550 551 552 553 554 555 556 557 558
struct clk *s3c_i2sv2_get_clock(struct snd_soc_dai *cpu_dai)
{
	struct s3c_i2sv2_info *i2s = to_info(cpu_dai);
	u32 iismod = readl(i2s->regs + S3C2412_IISMOD);

	if (iismod & S3C2412_IISMOD_IMS_SYSMUX)
		return i2s->iis_cclk;
	else
		return i2s->iis_pclk;
}
EXPORT_SYMBOL_GPL(s3c_i2sv2_get_clock);

559 560 561
/* default table of all avaialable root fs divisors */
static unsigned int iis_fs_tab[] = { 256, 512, 384, 768 };

562 563 564
int s3c_i2sv2_iis_calc_rate(struct s3c_i2sv2_rate_calc *info,
			    unsigned int *fstab,
			    unsigned int rate, struct clk *clk)
565 566 567 568 569 570 571 572 573 574 575 576 577
{
	unsigned long clkrate = clk_get_rate(clk);
	unsigned int div;
	unsigned int fsclk;
	unsigned int actual;
	unsigned int fs;
	unsigned int fsdiv;
	signed int deviation = 0;
	unsigned int best_fs = 0;
	unsigned int best_div = 0;
	unsigned int best_rate = 0;
	unsigned int best_deviation = INT_MAX;

578 579
	pr_debug("Input clock rate %ldHz\n", clkrate);

580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
	if (fstab == NULL)
		fstab = iis_fs_tab;

	for (fs = 0; fs < ARRAY_SIZE(iis_fs_tab); fs++) {
		fsdiv = iis_fs_tab[fs];

		fsclk = clkrate / fsdiv;
		div = fsclk / rate;

		if ((fsclk % rate) > (rate / 2))
			div++;

		if (div <= 1)
			continue;

		actual = clkrate / (fsdiv * div);
		deviation = actual - rate;

598
		printk(KERN_DEBUG "%ufs: div %u => result %u, deviation %d\n",
599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
		       fsdiv, div, actual, deviation);

		deviation = abs(deviation);

		if (deviation < best_deviation) {
			best_fs = fsdiv;
			best_div = div;
			best_rate = actual;
			best_deviation = deviation;
		}

		if (deviation == 0)
			break;
	}

614
	printk(KERN_DEBUG "best: fs=%u, div=%u, rate=%u\n",
615 616 617 618 619 620 621
	       best_fs, best_div, best_rate);

	info->fs_div = best_fs;
	info->clk_div = best_div;

	return 0;
}
622
EXPORT_SYMBOL_GPL(s3c_i2sv2_iis_calc_rate);
623

624
int s3c_i2sv2_probe(struct snd_soc_dai *dai,
625 626 627
		    struct s3c_i2sv2_info *i2s,
		    unsigned long base)
{
628
	struct device *dev = dai->dev;
629
	unsigned int iismod;
630 631 632 633

	i2s->dev = dev;

	/* record our i2s structure for later use in the callbacks */
634
	snd_soc_dai_set_drvdata(dai, i2s);
635

636
	i2s->iis_pclk = clk_get(dev, "iis");
J
Jassi 已提交
637
	if (IS_ERR(i2s->iis_pclk)) {
638
		dev_err(dev, "failed to get iis_clock\n");
639 640 641 642 643 644
		iounmap(i2s->regs);
		return -ENOENT;
	}

	clk_enable(i2s->iis_pclk);

645 646 647 648 649
	/* Mark ourselves as in TXRX mode so we can run through our cleanup
	 * process without warnings. */
	iismod = readl(i2s->regs + S3C2412_IISMOD);
	iismod |= S3C2412_IISMOD_MODE_TXRX;
	writel(iismod, i2s->regs + S3C2412_IISMOD);
650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710
	s3c2412_snd_txctrl(i2s, 0);
	s3c2412_snd_rxctrl(i2s, 0);

	return 0;
}
EXPORT_SYMBOL_GPL(s3c_i2sv2_probe);

#ifdef CONFIG_PM
static int s3c2412_i2s_suspend(struct snd_soc_dai *dai)
{
	struct s3c_i2sv2_info *i2s = to_info(dai);
	u32 iismod;

	if (dai->active) {
		i2s->suspend_iismod = readl(i2s->regs + S3C2412_IISMOD);
		i2s->suspend_iiscon = readl(i2s->regs + S3C2412_IISCON);
		i2s->suspend_iispsr = readl(i2s->regs + S3C2412_IISPSR);

		/* some basic suspend checks */

		iismod = readl(i2s->regs + S3C2412_IISMOD);

		if (iismod & S3C2412_IISCON_RXDMA_ACTIVE)
			pr_warning("%s: RXDMA active?\n", __func__);

		if (iismod & S3C2412_IISCON_TXDMA_ACTIVE)
			pr_warning("%s: TXDMA active?\n", __func__);

		if (iismod & S3C2412_IISCON_IIS_ACTIVE)
			pr_warning("%s: IIS active\n", __func__);
	}

	return 0;
}

static int s3c2412_i2s_resume(struct snd_soc_dai *dai)
{
	struct s3c_i2sv2_info *i2s = to_info(dai);

	pr_info("dai_active %d, IISMOD %08x, IISCON %08x\n",
		dai->active, i2s->suspend_iismod, i2s->suspend_iiscon);

	if (dai->active) {
		writel(i2s->suspend_iiscon, i2s->regs + S3C2412_IISCON);
		writel(i2s->suspend_iismod, i2s->regs + S3C2412_IISMOD);
		writel(i2s->suspend_iispsr, i2s->regs + S3C2412_IISPSR);

		writel(S3C2412_IISFIC_RXFLUSH | S3C2412_IISFIC_TXFLUSH,
		       i2s->regs + S3C2412_IISFIC);

		ndelay(250);
		writel(0x0, i2s->regs + S3C2412_IISFIC);
	}

	return 0;
}
#else
#define s3c2412_i2s_suspend NULL
#define s3c2412_i2s_resume  NULL
#endif

711
int s3c_i2sv2_register_component(struct device *dev, int id,
712
			   const struct snd_soc_component_driver *cmp_drv,
713
			   struct snd_soc_dai_driver *dai_drv)
714
{
715
	struct snd_soc_dai_ops *ops = (struct snd_soc_dai_ops *)dai_drv->ops;
716 717

	ops->trigger = s3c2412_i2s_trigger;
718 719
	if (!ops->hw_params)
		ops->hw_params = s3c_i2sv2_hw_params;
720 721
	ops->set_fmt = s3c2412_i2s_set_fmt;
	ops->set_clkdiv = s3c2412_i2s_set_clkdiv;
722
	ops->set_sysclk = s3c_i2sv2_set_sysclk;
723

724 725
	/* Allow overriding by (for example) IISv4 */
	if (!ops->delay)
726
		ops->delay = s3c2412_i2s_delay;
727

728 729
	dai_drv->suspend = s3c2412_i2s_suspend;
	dai_drv->resume = s3c2412_i2s_resume;
730

731
	return devm_snd_soc_register_component(dev, cmp_drv, dai_drv, 1);
732
}
733
EXPORT_SYMBOL_GPL(s3c_i2sv2_register_component);
734 735

MODULE_LICENSE("GPL");