davinci-mcasp.c 36.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 * ALSA SoC McASP Audio Layer for TI DAVINCI processor
 *
 * Multi-channel Audio Serial Port Driver
 *
 * Author: Nirmal Pandey <n-pandey@ti.com>,
 *         Suresh Rajashekara <suresh.r@ti.com>
 *         Steve Chen <schen@.mvista.com>
 *
 * Copyright:   (C) 2009 MontaVista Software, Inc., <source@mvista.com>
 * Copyright:   (C) 2009  Texas Instruments, India
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/device.h>
21
#include <linux/slab.h>
22 23
#include <linux/delay.h>
#include <linux/io.h>
24
#include <linux/clk.h>
25
#include <linux/pm_runtime.h>
26 27 28
#include <linux/of.h>
#include <linux/of_platform.h>
#include <linux/of_device.h>
29

30
#include <sound/asoundef.h>
31 32 33 34 35
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/initval.h>
#include <sound/soc.h>
36
#include <sound/dmaengine_pcm.h>
37
#include <sound/omap-pcm.h>
38 39

#include "davinci-pcm.h"
40
#include "edma-pcm.h"
41 42
#include "davinci-mcasp.h"

43 44
#define MCASP_MAX_AFIFO_DEPTH	64

45 46 47 48 49 50 51
static u32 context_regs[] = {
	DAVINCI_MCASP_TXFMCTL_REG,
	DAVINCI_MCASP_RXFMCTL_REG,
	DAVINCI_MCASP_TXFMT_REG,
	DAVINCI_MCASP_RXFMT_REG,
	DAVINCI_MCASP_ACLKXCTL_REG,
	DAVINCI_MCASP_ACLKRCTL_REG,
52 53
	DAVINCI_MCASP_AHCLKXCTL_REG,
	DAVINCI_MCASP_AHCLKRCTL_REG,
54
	DAVINCI_MCASP_PDIR_REG,
55 56 57 58
	DAVINCI_MCASP_RXMASK_REG,
	DAVINCI_MCASP_TXMASK_REG,
	DAVINCI_MCASP_RXTDM_REG,
	DAVINCI_MCASP_TXTDM_REG,
59 60
};

61
struct davinci_mcasp_context {
62
	u32	config_regs[ARRAY_SIZE(context_regs)];
63 64
	u32	afifo_regs[2]; /* for read/write fifo control registers */
	u32	*xrsr_regs; /* for serializer configuration */
65 66
};

67
struct davinci_mcasp {
68
	struct davinci_pcm_dma_params dma_params[2];
69
	struct snd_dmaengine_dai_dma_data dma_data[2];
70
	void __iomem *base;
71
	u32 fifo_base;
72 73 74 75 76 77 78 79
	struct device *dev;

	/* McASP specific data */
	int	tdm_slots;
	u8	op_mode;
	u8	num_serializer;
	u8	*serial_dir;
	u8	version;
80
	u8	bclk_div;
81
	u16	bclk_lrclk_ratio;
82
	int	streams;
83

84 85 86
	int	sysclk_freq;
	bool	bclk_master;

87 88 89 90
	/* McASP FIFO related */
	u8	txnumevt;
	u8	rxnumevt;

91 92
	bool	dat_port;

93
#ifdef CONFIG_PM_SLEEP
94
	struct davinci_mcasp_context context;
95 96 97
#endif
};

98 99
static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
100
{
101
	void __iomem *reg = mcasp->base + offset;
102 103 104
	__raw_writel(__raw_readl(reg) | val, reg);
}

105 106
static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
107
{
108
	void __iomem *reg = mcasp->base + offset;
109 110 111
	__raw_writel((__raw_readl(reg) & ~(val)), reg);
}

112 113
static inline void mcasp_mod_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val, u32 mask)
114
{
115
	void __iomem *reg = mcasp->base + offset;
116 117 118
	__raw_writel((__raw_readl(reg) & ~mask) | val, reg);
}

119 120
static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
				 u32 val)
121
{
122
	__raw_writel(val, mcasp->base + offset);
123 124
}

125
static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
126
{
127
	return (u32)__raw_readl(mcasp->base + offset);
128 129
}

130
static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
131 132 133
{
	int i = 0;

134
	mcasp_set_bits(mcasp, ctl_reg, val);
135 136 137 138

	/* programming GBLCTL needs to read back from GBLCTL and verfiy */
	/* loop count is to avoid the lock-up */
	for (i = 0; i < 1000; i++) {
139
		if ((mcasp_get_reg(mcasp, ctl_reg) & val) == val)
140 141 142
			break;
	}

143
	if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
144 145 146
		printk(KERN_ERR "GBLCTL write error\n");
}

147 148
static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
{
149 150
	u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
	u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
151 152 153 154

	return !(aclkxctl & TX_ASYNC) && rxfmctl & AFSRE;
}

155
static void mcasp_start_rx(struct davinci_mcasp *mcasp)
156
{
157
	/* Start clocks */
158 159
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
160 161 162 163 164 165
	/*
	 * When ASYNC == 0 the transmit and receive sections operate
	 * synchronously from the transmit clock and frame sync. We need to make
	 * sure that the TX signlas are enabled when starting reception.
	 */
	if (mcasp_is_synchronous(mcasp)) {
166 167
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
168 169
	}

170
	/* Activate serializer(s) */
171
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
172
	/* Release RX state machine */
173
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
174
	/* Release Frame Sync generator */
175
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
176
	if (mcasp_is_synchronous(mcasp))
177
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
178 179
}

180
static void mcasp_start_tx(struct davinci_mcasp *mcasp)
181
{
182 183
	u32 cnt;

184
	/* Start clocks */
185 186
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
187
	/* Activate serializer(s) */
188
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
189

190
	/* wait for XDATA to be cleared */
191
	cnt = 0;
192 193
	while (!(mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG) &
		 ~XRDATA) && (cnt < 100000))
194 195
		cnt++;

196 197 198 199
	/* Release TX state machine */
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
	/* Release Frame Sync generator */
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
200 201
}

202
static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
203
{
204 205
	u32 reg;

206 207
	mcasp->streams++;

208
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
209
		if (mcasp->txnumevt) {	/* enable FIFO */
210
			reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
211 212
			mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
			mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
213
		}
214
		mcasp_start_tx(mcasp);
215
	} else {
216
		if (mcasp->rxnumevt) {	/* enable FIFO */
217
			reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
218 219
			mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
			mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
220
		}
221
		mcasp_start_rx(mcasp);
222
	}
223 224
}

225
static void mcasp_stop_rx(struct davinci_mcasp *mcasp)
226
{
227 228 229 230 231
	/*
	 * In synchronous mode stop the TX clocks if no other stream is
	 * running
	 */
	if (mcasp_is_synchronous(mcasp) && !mcasp->streams)
232
		mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, 0);
233

234 235
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
236 237 238 239 240 241

	if (mcasp->rxnumevt) {	/* disable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
	}
242 243
}

244
static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
245
{
246 247 248 249 250 251 252 253 254
	u32 val = 0;

	/*
	 * In synchronous mode keep TX clocks running if the capture stream is
	 * still running.
	 */
	if (mcasp_is_synchronous(mcasp) && mcasp->streams)
		val =  TXHCLKRST | TXCLKRST | TXFSRST;

255 256
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
257 258 259 260 261 262

	if (mcasp->txnumevt) {	/* disable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
	}
263 264
}

265
static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
266
{
267 268
	mcasp->streams--;

269
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
270
		mcasp_stop_tx(mcasp);
271
	else
272
		mcasp_stop_rx(mcasp);
273 274 275 276 277
}

static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
					 unsigned int fmt)
{
278
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
279
	int ret = 0;
280
	u32 data_delay;
281
	bool fs_pol_rising;
282
	bool inv_fs = false;
283

284
	pm_runtime_get_sync(mcasp->dev);
285
	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
286 287 288 289 290 291
	case SND_SOC_DAIFMT_DSP_A:
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
		/* 1st data bit occur one ACLK cycle after the frame sync */
		data_delay = 1;
		break;
292 293
	case SND_SOC_DAIFMT_DSP_B:
	case SND_SOC_DAIFMT_AC97:
294 295
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
296 297
		/* No delay after FS */
		data_delay = 0;
298
		break;
299
	case SND_SOC_DAIFMT_I2S:
300
		/* configure a full-word SYNC pulse (LRCLK) */
301 302
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
303 304
		/* 1st data bit occur one ACLK cycle after the frame sync */
		data_delay = 1;
305 306
		/* FS need to be inverted */
		inv_fs = true;
307
		break;
308 309 310 311 312 313 314
	case SND_SOC_DAIFMT_LEFT_J:
		/* configure a full-word SYNC pulse (LRCLK) */
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
		/* No delay after FS */
		data_delay = 0;
		break;
315 316 317
	default:
		ret = -EINVAL;
		goto out;
318 319
	}

320 321 322 323 324
	mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, FSXDLY(data_delay),
		       FSXDLY(3));
	mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, FSRDLY(data_delay),
		       FSRDLY(3));

325 326 327
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBS_CFS:
		/* codec is clock and frame slave */
328 329
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
330

331 332
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
333

334 335
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
336
		mcasp->bclk_master = 1;
337
		break;
338 339
	case SND_SOC_DAIFMT_CBM_CFS:
		/* codec is clock master and frame slave */
340 341
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
342

343 344
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
345

346 347
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
348
		mcasp->bclk_master = 0;
349
		break;
350 351
	case SND_SOC_DAIFMT_CBM_CFM:
		/* codec is clock and frame master */
352 353
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
354

355 356
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
357

358 359
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
			       ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
360
		mcasp->bclk_master = 0;
361 362
		break;
	default:
363 364
		ret = -EINVAL;
		goto out;
365 366 367 368
	}

	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
	case SND_SOC_DAIFMT_IB_NF:
369
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
370
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
371
		fs_pol_rising = true;
372 373
		break;
	case SND_SOC_DAIFMT_NB_IF:
374
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
375
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
376
		fs_pol_rising = false;
377 378
		break;
	case SND_SOC_DAIFMT_IB_IF:
379
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
380
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
381
		fs_pol_rising = false;
382 383
		break;
	case SND_SOC_DAIFMT_NB_NF:
384 385
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
386
		fs_pol_rising = true;
387 388
		break;
	default:
389
		ret = -EINVAL;
390 391 392
		goto out;
	}

393 394 395
	if (inv_fs)
		fs_pol_rising = !fs_pol_rising;

396 397 398 399 400 401
	if (fs_pol_rising) {
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
	} else {
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
402
	}
403 404 405
out:
	pm_runtime_put_sync(mcasp->dev);
	return ret;
406 407
}

408 409
static int __davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
				      int div, bool explicit)
410
{
411
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
412 413 414

	switch (div_id) {
	case 0:		/* MCLK divider */
415
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
416
			       AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
417
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
418 419 420 421
			       AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
		break;

	case 1:		/* BCLK divider */
422
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
423
			       ACLKXDIV(div - 1), ACLKXDIV_MASK);
424
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
425
			       ACLKRDIV(div - 1), ACLKRDIV_MASK);
426 427
		if (explicit)
			mcasp->bclk_div = div;
428 429
		break;

430
	case 2:		/* BCLK/LRCLK ratio */
431
		mcasp->bclk_lrclk_ratio = div;
432 433
		break;

434 435 436 437 438 439 440
	default:
		return -EINVAL;
	}

	return 0;
}

441 442 443 444 445 446
static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
				    int div)
{
	return __davinci_mcasp_set_clkdiv(dai, div_id, div, 1);
}

447 448 449
static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
				    unsigned int freq, int dir)
{
450
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
451 452

	if (dir == SND_SOC_CLOCK_OUT) {
453 454 455
		mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
456
	} else {
457 458 459
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
460 461
	}

462 463
	mcasp->sysclk_freq = freq;

464 465 466
	return 0;
}

467
static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
468
				       int word_length)
469
{
470
	u32 fmt;
D
Daniel Mack 已提交
471
	u32 tx_rotate = (word_length / 4) & 0x7;
472
	u32 mask = (1ULL << word_length) - 1;
473 474 475 476 477 478 479 480 481 482
	/*
	 * For captured data we should not rotate, inversion and masking is
	 * enoguh to get the data to the right position:
	 * Format	  data from bus		after reverse (XRBUF)
	 * S16_LE:	|LSB|MSB|xxx|xxx|	|xxx|xxx|MSB|LSB|
	 * S24_3LE:	|LSB|DAT|MSB|xxx|	|xxx|MSB|DAT|LSB|
	 * S24_LE:	|LSB|DAT|MSB|xxx|	|xxx|MSB|DAT|LSB|
	 * S32_LE:	|LSB|DAT|DAT|MSB|	|MSB|DAT|DAT|LSB|
	 */
	u32 rx_rotate = 0;
483

484 485 486 487 488
	/*
	 * if s BCLK-to-LRCLK ratio has been configured via the set_clkdiv()
	 * callback, take it into account here. That allows us to for example
	 * send 32 bits per channel to the codec, while only 16 of them carry
	 * audio payload.
489 490 491
	 * The clock ratio is given for a full period of data (for I2S format
	 * both left and right channels), so it has to be divided by number of
	 * tdm-slots (for I2S - divided by 2).
492
	 */
493 494
	if (mcasp->bclk_lrclk_ratio)
		word_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
495

496 497
	/* mapping of the XSSZ bit-field as described in the datasheet */
	fmt = (word_length >> 1) - 1;
498

499
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
500 501 502 503 504 505 506 507 508
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXSSZ(fmt),
			       RXSSZ(0x0F));
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXSSZ(fmt),
			       TXSSZ(0x0F));
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(tx_rotate),
			       TXROT(7));
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXROT(rx_rotate),
			       RXROT(7));
		mcasp_set_reg(mcasp, DAVINCI_MCASP_RXMASK_REG, mask);
509 510
	}

511
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
512

513 514 515
	return 0;
}

516
static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
517
				 int period_words, int channels)
518
{
519 520
	struct davinci_pcm_dma_params *dma_params = &mcasp->dma_params[stream];
	struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
521
	int i;
522 523
	u8 tx_ser = 0;
	u8 rx_ser = 0;
524
	u8 slots = mcasp->tdm_slots;
525
	u8 max_active_serializers = (channels + slots - 1) / slots;
526
	int active_serializers, numevt, n;
527
	u32 reg;
528
	/* Default configuration */
529
	if (mcasp->version < MCASP_VERSION_3)
530
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
531 532

	/* All PINS as McASP */
533
	mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
534 535

	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
536 537
		mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
538
	} else {
539 540
		mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
541 542
	}

543
	for (i = 0; i < mcasp->num_serializer; i++) {
544 545
		mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			       mcasp->serial_dir[i]);
546
		if (mcasp->serial_dir[i] == TX_MODE &&
547
					tx_ser < max_active_serializers) {
548
			mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
549
			tx_ser++;
550
		} else if (mcasp->serial_dir[i] == RX_MODE &&
551
					rx_ser < max_active_serializers) {
552
			mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
553
			rx_ser++;
554
		} else {
555 556
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
				       SRMOD_INACTIVE, SRMOD_MASK);
557 558 559
		}
	}

560 561 562 563 564 565 566 567 568
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
		active_serializers = tx_ser;
		numevt = mcasp->txnumevt;
		reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
	} else {
		active_serializers = rx_ser;
		numevt = mcasp->rxnumevt;
		reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
	}
569

570
	if (active_serializers < max_active_serializers) {
571
		dev_warn(mcasp->dev, "stream has more channels (%d) than are "
572 573
			 "enabled in mcasp (%d)\n", channels,
			 active_serializers * slots);
574 575 576
		return -EINVAL;
	}

577
	/* AFIFO is not in use */
578 579
	if (!numevt) {
		/* Configure the burst size for platform drivers */
580 581 582 583 584 585 586 587 588 589 590 591 592
		if (active_serializers > 1) {
			/*
			 * If more than one serializers are in use we have one
			 * DMA request to provide data for all serializers.
			 * For example if three serializers are enabled the DMA
			 * need to transfer three words per DMA request.
			 */
			dma_params->fifo_level = active_serializers;
			dma_data->maxburst = active_serializers;
		} else {
			dma_params->fifo_level = 0;
			dma_data->maxburst = 0;
		}
593
		return 0;
594
	}
595

596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
	if (period_words % active_serializers) {
		dev_err(mcasp->dev, "Invalid combination of period words and "
			"active serializers: %d, %d\n", period_words,
			active_serializers);
		return -EINVAL;
	}

	/*
	 * Calculate the optimal AFIFO depth for platform side:
	 * The number of words for numevt need to be in steps of active
	 * serializers.
	 */
	n = numevt % active_serializers;
	if (n)
		numevt += (active_serializers - n);
	while (period_words % numevt && numevt > 0)
		numevt -= active_serializers;
	if (numevt <= 0)
614
		numevt = active_serializers;
615

616 617
	mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
	mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
618

619
	/* Configure the burst size for platform drivers */
620 621
	if (numevt == 1)
		numevt = 0;
622 623 624
	dma_params->fifo_level = numevt;
	dma_data->maxburst = numevt;

625
	return 0;
626 627
}

628
static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream)
629 630 631
{
	int i, active_slots;
	u32 mask = 0;
632
	u32 busel = 0;
633

634 635 636 637 638 639
	if ((mcasp->tdm_slots < 2) || (mcasp->tdm_slots > 32)) {
		dev_err(mcasp->dev, "tdm slot %d not supported\n",
			mcasp->tdm_slots);
		return -EINVAL;
	}

640
	active_slots = (mcasp->tdm_slots > 31) ? 32 : mcasp->tdm_slots;
641 642 643
	for (i = 0; i < active_slots; i++)
		mask |= (1 << i);

644
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
645

646 647 648
	if (!mcasp->dat_port)
		busel = TXSEL;

649 650 651 652 653 654 655 656 657 658 659
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, mask);
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, busel | TXORD);
	mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
		       FSXMOD(mcasp->tdm_slots), FSXMOD(0x1FF));

	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXTDM_REG, mask);
	mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, busel | RXORD);
	mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG,
		       FSRMOD(mcasp->tdm_slots), FSRMOD(0x1FF));

	return 0;
660 661 662
}

/* S/PDIF */
663 664
static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp,
			      unsigned int rate)
665
{
666 667 668
	u32 cs_value = 0;
	u8 *cs_bytes = (u8*) &cs_value;

669 670
	/* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
	   and LSB first */
671
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
672 673

	/* Set TX frame synch : DIT Mode, 1 bit width, internal, rising edge */
674
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE | FSXMOD(0x180));
675 676

	/* Set the TX tdm : for all the slots */
677
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
678 679

	/* Set the TX clock controls : div = 1 and internal */
680
	mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE | TX_ASYNC);
681

682
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
683 684

	/* Only 44100 and 48000 are valid, both have the same setting */
685
	mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
686 687

	/* Enable the DIT */
688
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
689

690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729
	/* Set S/PDIF channel status bits */
	cs_bytes[0] = IEC958_AES0_CON_NOT_COPYRIGHT;
	cs_bytes[1] = IEC958_AES1_CON_PCM_CODER;

	switch (rate) {
	case 22050:
		cs_bytes[3] |= IEC958_AES3_CON_FS_22050;
		break;
	case 24000:
		cs_bytes[3] |= IEC958_AES3_CON_FS_24000;
		break;
	case 32000:
		cs_bytes[3] |= IEC958_AES3_CON_FS_32000;
		break;
	case 44100:
		cs_bytes[3] |= IEC958_AES3_CON_FS_44100;
		break;
	case 48000:
		cs_bytes[3] |= IEC958_AES3_CON_FS_48000;
		break;
	case 88200:
		cs_bytes[3] |= IEC958_AES3_CON_FS_88200;
		break;
	case 96000:
		cs_bytes[3] |= IEC958_AES3_CON_FS_96000;
		break;
	case 176400:
		cs_bytes[3] |= IEC958_AES3_CON_FS_176400;
		break;
	case 192000:
		cs_bytes[3] |= IEC958_AES3_CON_FS_192000;
		break;
	default:
		printk(KERN_WARNING "unsupported sampling rate: %d\n", rate);
		return -EINVAL;
	}

	mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRA_REG, cs_value);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRB_REG, cs_value);

730
	return 0;
731 732 733 734 735 736
}

static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *params,
					struct snd_soc_dai *cpu_dai)
{
737
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
738
	struct davinci_pcm_dma_params *dma_params =
739
					&mcasp->dma_params[substream->stream];
740
	int word_length;
741
	int channels = params_channels(params);
742
	int period_size = params_period_size(params);
743
	int ret;
744

745 746 747 748 749
	/*
	 * If mcasp is BCLK master, and a BCLK divider was not provided by
	 * the machine driver, we need to calculate the ratio.
	 */
	if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
750
		unsigned int bclk_freq = snd_soc_params_to_bclk(params);
751
		unsigned int div = mcasp->sysclk_freq / bclk_freq;
752
		if (mcasp->sysclk_freq % bclk_freq != 0) {
753 754 755 756 757 758
			if (((mcasp->sysclk_freq / div) - bclk_freq) >
			    (bclk_freq - (mcasp->sysclk_freq / (div+1))))
				div++;
			dev_warn(mcasp->dev,
				 "Inaccurate BCLK: %u Hz / %u != %u Hz\n",
				 mcasp->sysclk_freq, div, bclk_freq);
759
		}
760
		__davinci_mcasp_set_clkdiv(cpu_dai, 1, div, 0);
761 762
	}

763 764
	ret = mcasp_common_hw_param(mcasp, substream->stream,
				    period_size * channels, channels);
765 766 767
	if (ret)
		return ret;

768
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
769
		ret = mcasp_dit_hw_param(mcasp, params_rate(params));
770
	else
771 772 773 774
		ret = mcasp_i2s_hw_param(mcasp, substream->stream);

	if (ret)
		return ret;
775 776

	switch (params_format(params)) {
777
	case SNDRV_PCM_FORMAT_U8:
778 779
	case SNDRV_PCM_FORMAT_S8:
		dma_params->data_type = 1;
780
		word_length = 8;
781 782
		break;

783
	case SNDRV_PCM_FORMAT_U16_LE:
784 785
	case SNDRV_PCM_FORMAT_S16_LE:
		dma_params->data_type = 2;
786
		word_length = 16;
787 788
		break;

789 790 791
	case SNDRV_PCM_FORMAT_U24_3LE:
	case SNDRV_PCM_FORMAT_S24_3LE:
		dma_params->data_type = 3;
792
		word_length = 24;
793 794
		break;

795 796
	case SNDRV_PCM_FORMAT_U24_LE:
	case SNDRV_PCM_FORMAT_S24_LE:
797 798 799 800
		dma_params->data_type = 4;
		word_length = 24;
		break;

801
	case SNDRV_PCM_FORMAT_U32_LE:
802 803
	case SNDRV_PCM_FORMAT_S32_LE:
		dma_params->data_type = 4;
804
		word_length = 32;
805 806 807 808 809 810
		break;

	default:
		printk(KERN_WARNING "davinci-mcasp: unsupported PCM format");
		return -EINVAL;
	}
811

812
	if (mcasp->version == MCASP_VERSION_2 && !dma_params->fifo_level)
813 814
		dma_params->acnt = 4;
	else
815 816
		dma_params->acnt = dma_params->data_type;

817
	davinci_config_channel_size(mcasp, word_length);
818 819 820 821 822 823 824

	return 0;
}

static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
				     int cmd, struct snd_soc_dai *cpu_dai)
{
825
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
826 827 828 829
	int ret = 0;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_RESUME:
830 831
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
832
		davinci_mcasp_start(mcasp, substream->stream);
833 834
		break;
	case SNDRV_PCM_TRIGGER_SUSPEND:
835
	case SNDRV_PCM_TRIGGER_STOP:
836
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
837
		davinci_mcasp_stop(mcasp, substream->stream);
838 839 840 841 842 843 844 845 846
		break;

	default:
		ret = -EINVAL;
	}

	return ret;
}

847
static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
848 849 850
	.trigger	= davinci_mcasp_trigger,
	.hw_params	= davinci_mcasp_hw_params,
	.set_fmt	= davinci_mcasp_set_dai_fmt,
851
	.set_clkdiv	= davinci_mcasp_set_clkdiv,
852
	.set_sysclk	= davinci_mcasp_set_sysclk,
853 854
};

855 856 857 858
static int davinci_mcasp_dai_probe(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);

859
	if (mcasp->version >= MCASP_VERSION_3) {
860 861 862 863 864 865 866 867 868 869 870 871 872 873
		/* Using dmaengine PCM */
		dai->playback_dma_data =
				&mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
		dai->capture_dma_data =
				&mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
	} else {
		/* Using davinci-pcm */
		dai->playback_dma_data = mcasp->dma_params;
		dai->capture_dma_data = mcasp->dma_params;
	}

	return 0;
}

874 875 876 877
#ifdef CONFIG_PM_SLEEP
static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
878
	struct davinci_mcasp_context *context = &mcasp->context;
879
	u32 reg;
880
	int i;
881

882 883
	for (i = 0; i < ARRAY_SIZE(context_regs); i++)
		context->config_regs[i] = mcasp_get_reg(mcasp, context_regs[i]);
884

885 886 887 888 889 890 891 892
	if (mcasp->txnumevt) {
		reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
		context->afifo_regs[0] = mcasp_get_reg(mcasp, reg);
	}
	if (mcasp->rxnumevt) {
		reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
		context->afifo_regs[1] = mcasp_get_reg(mcasp, reg);
	}
893

894 895 896
	for (i = 0; i < mcasp->num_serializer; i++)
		context->xrsr_regs[i] = mcasp_get_reg(mcasp,
						DAVINCI_MCASP_XRSRCTL_REG(i));
897 898 899 900 901 902 903

	return 0;
}

static int davinci_mcasp_resume(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
904
	struct davinci_mcasp_context *context = &mcasp->context;
905
	u32 reg;
906
	int i;
907

908 909
	for (i = 0; i < ARRAY_SIZE(context_regs); i++)
		mcasp_set_reg(mcasp, context_regs[i], context->config_regs[i]);
910

911 912 913 914 915 916 917 918
	if (mcasp->txnumevt) {
		reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
		mcasp_set_reg(mcasp, reg, context->afifo_regs[0]);
	}
	if (mcasp->rxnumevt) {
		reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
		mcasp_set_reg(mcasp, reg, context->afifo_regs[1]);
	}
919

920 921 922
	for (i = 0; i < mcasp->num_serializer; i++)
		mcasp_set_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			      context->xrsr_regs[i]);
923 924 925 926 927 928 929 930

	return 0;
}
#else
#define davinci_mcasp_suspend NULL
#define davinci_mcasp_resume NULL
#endif

931 932
#define DAVINCI_MCASP_RATES	SNDRV_PCM_RATE_8000_192000

933 934 935 936
#define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
				SNDRV_PCM_FMTBIT_U8 | \
				SNDRV_PCM_FMTBIT_S16_LE | \
				SNDRV_PCM_FMTBIT_U16_LE | \
937 938 939 940
				SNDRV_PCM_FMTBIT_S24_LE | \
				SNDRV_PCM_FMTBIT_U24_LE | \
				SNDRV_PCM_FMTBIT_S24_3LE | \
				SNDRV_PCM_FMTBIT_U24_3LE | \
941 942 943
				SNDRV_PCM_FMTBIT_S32_LE | \
				SNDRV_PCM_FMTBIT_U32_LE)

944
static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
945
	{
946
		.name		= "davinci-mcasp.0",
947
		.probe		= davinci_mcasp_dai_probe,
948 949
		.suspend	= davinci_mcasp_suspend,
		.resume		= davinci_mcasp_resume,
950 951
		.playback	= {
			.channels_min	= 2,
952
			.channels_max	= 32 * 16,
953
			.rates 		= DAVINCI_MCASP_RATES,
954
			.formats	= DAVINCI_MCASP_PCM_FMTS,
955 956 957
		},
		.capture 	= {
			.channels_min 	= 2,
958
			.channels_max	= 32 * 16,
959
			.rates 		= DAVINCI_MCASP_RATES,
960
			.formats	= DAVINCI_MCASP_PCM_FMTS,
961 962 963 964 965
		},
		.ops 		= &davinci_mcasp_dai_ops,

	},
	{
966
		.name		= "davinci-mcasp.1",
967
		.probe		= davinci_mcasp_dai_probe,
968 969 970 971
		.playback 	= {
			.channels_min	= 1,
			.channels_max	= 384,
			.rates		= DAVINCI_MCASP_RATES,
972
			.formats	= DAVINCI_MCASP_PCM_FMTS,
973 974 975 976 977 978
		},
		.ops 		= &davinci_mcasp_dai_ops,
	},

};

979 980 981 982
static const struct snd_soc_component_driver davinci_mcasp_component = {
	.name		= "davinci-mcasp",
};

983
/* Some HW specific values and defaults. The rest is filled in from DT. */
984
static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
985 986 987 988 989 990
	.tx_dma_offset = 0x400,
	.rx_dma_offset = 0x400,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_1,
};

991
static struct davinci_mcasp_pdata da830_mcasp_pdata = {
992 993 994 995 996 997
	.tx_dma_offset = 0x2000,
	.rx_dma_offset = 0x2000,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_2,
};

998
static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
999 1000 1001 1002 1003 1004
	.tx_dma_offset = 0,
	.rx_dma_offset = 0,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_3,
};

1005
static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
1006 1007 1008 1009 1010 1011
	.tx_dma_offset = 0x200,
	.rx_dma_offset = 0x284,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_4,
};

1012 1013 1014
static const struct of_device_id mcasp_dt_ids[] = {
	{
		.compatible = "ti,dm646x-mcasp-audio",
1015
		.data = &dm646x_mcasp_pdata,
1016 1017 1018
	},
	{
		.compatible = "ti,da830-mcasp-audio",
1019
		.data = &da830_mcasp_pdata,
1020
	},
1021
	{
1022
		.compatible = "ti,am33xx-mcasp-audio",
1023
		.data = &am33xx_mcasp_pdata,
1024
	},
1025 1026 1027 1028
	{
		.compatible = "ti,dra7-mcasp-audio",
		.data = &dra7_mcasp_pdata,
	},
1029 1030 1031 1032
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, mcasp_dt_ids);

1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072
static int mcasp_reparent_fck(struct platform_device *pdev)
{
	struct device_node *node = pdev->dev.of_node;
	struct clk *gfclk, *parent_clk;
	const char *parent_name;
	int ret;

	if (!node)
		return 0;

	parent_name = of_get_property(node, "fck_parent", NULL);
	if (!parent_name)
		return 0;

	gfclk = clk_get(&pdev->dev, "fck");
	if (IS_ERR(gfclk)) {
		dev_err(&pdev->dev, "failed to get fck\n");
		return PTR_ERR(gfclk);
	}

	parent_clk = clk_get(NULL, parent_name);
	if (IS_ERR(parent_clk)) {
		dev_err(&pdev->dev, "failed to get parent clock\n");
		ret = PTR_ERR(parent_clk);
		goto err1;
	}

	ret = clk_set_parent(gfclk, parent_clk);
	if (ret) {
		dev_err(&pdev->dev, "failed to reparent fck\n");
		goto err2;
	}

err2:
	clk_put(parent_clk);
err1:
	clk_put(gfclk);
	return ret;
}

1073
static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
1074 1075 1076
						struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
1077
	struct davinci_mcasp_pdata *pdata = NULL;
1078
	const struct of_device_id *match =
1079
			of_match_device(mcasp_dt_ids, &pdev->dev);
1080
	struct of_phandle_args dma_spec;
1081 1082 1083 1084 1085 1086 1087 1088 1089

	const u32 *of_serial_dir32;
	u32 val;
	int i, ret = 0;

	if (pdev->dev.platform_data) {
		pdata = pdev->dev.platform_data;
		return pdata;
	} else if (match) {
1090
		pdata = (struct davinci_mcasp_pdata*) match->data;
1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101
	} else {
		/* control shouldn't reach here. something is wrong */
		ret = -EINVAL;
		goto nodata;
	}

	ret = of_property_read_u32(np, "op-mode", &val);
	if (ret >= 0)
		pdata->op_mode = val;

	ret = of_property_read_u32(np, "tdm-slots", &val);
1102 1103 1104 1105 1106 1107 1108 1109
	if (ret >= 0) {
		if (val < 2 || val > 32) {
			dev_err(&pdev->dev,
				"tdm-slots must be in rage [2-32]\n");
			ret = -EINVAL;
			goto nodata;
		}

1110
		pdata->tdm_slots = val;
1111
	}
1112 1113 1114 1115

	of_serial_dir32 = of_get_property(np, "serial-dir", &val);
	val /= sizeof(u32);
	if (of_serial_dir32) {
1116 1117 1118
		u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
						 (sizeof(*of_serial_dir) * val),
						 GFP_KERNEL);
1119 1120 1121 1122 1123
		if (!of_serial_dir) {
			ret = -ENOMEM;
			goto nodata;
		}

1124
		for (i = 0; i < val; i++)
1125 1126
			of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);

1127
		pdata->num_serializer = val;
1128 1129 1130
		pdata->serial_dir = of_serial_dir;
	}

1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
	ret = of_property_match_string(np, "dma-names", "tx");
	if (ret < 0)
		goto nodata;

	ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
					 &dma_spec);
	if (ret < 0)
		goto nodata;

	pdata->tx_dma_channel = dma_spec.args[0];

	ret = of_property_match_string(np, "dma-names", "rx");
	if (ret < 0)
		goto nodata;

	ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
					 &dma_spec);
	if (ret < 0)
		goto nodata;

	pdata->rx_dma_channel = dma_spec.args[0];

1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
	ret = of_property_read_u32(np, "tx-num-evt", &val);
	if (ret >= 0)
		pdata->txnumevt = val;

	ret = of_property_read_u32(np, "rx-num-evt", &val);
	if (ret >= 0)
		pdata->rxnumevt = val;

	ret = of_property_read_u32(np, "sram-size-playback", &val);
	if (ret >= 0)
		pdata->sram_size_playback = val;

	ret = of_property_read_u32(np, "sram-size-capture", &val);
	if (ret >= 0)
		pdata->sram_size_capture = val;

	return  pdata;

nodata:
	if (ret < 0) {
		dev_err(&pdev->dev, "Error populating platform data, err %d\n",
			ret);
		pdata = NULL;
	}
	return  pdata;
}

1180 1181
static int davinci_mcasp_probe(struct platform_device *pdev)
{
1182
	struct davinci_pcm_dma_params *dma_params;
1183
	struct snd_dmaengine_dai_dma_data *dma_data;
1184
	struct resource *mem, *ioarea, *res, *dat;
1185
	struct davinci_mcasp_pdata *pdata;
1186
	struct davinci_mcasp *mcasp;
1187
	int ret;
1188

1189 1190 1191 1192 1193
	if (!pdev->dev.platform_data && !pdev->dev.of_node) {
		dev_err(&pdev->dev, "No platform data supplied\n");
		return -EINVAL;
	}

1194
	mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
1195
			   GFP_KERNEL);
1196
	if (!mcasp)
1197 1198
		return	-ENOMEM;

1199 1200 1201 1202 1203 1204
	pdata = davinci_mcasp_set_pdata_from_of(pdev);
	if (!pdata) {
		dev_err(&pdev->dev, "no platform data\n");
		return -EINVAL;
	}

1205
	mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1206
	if (!mem) {
1207
		dev_warn(mcasp->dev,
1208 1209 1210 1211 1212 1213
			 "\"mpu\" mem resource not found, using index 0\n");
		mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
		if (!mem) {
			dev_err(&pdev->dev, "no mem resource?\n");
			return -ENODEV;
		}
1214 1215
	}

1216
	ioarea = devm_request_mem_region(&pdev->dev, mem->start,
1217
			resource_size(mem), pdev->name);
1218 1219
	if (!ioarea) {
		dev_err(&pdev->dev, "Audio region already claimed\n");
1220
		return -EBUSY;
1221 1222
	}

1223
	pm_runtime_enable(&pdev->dev);
1224

1225 1226 1227 1228 1229
	ret = pm_runtime_get_sync(&pdev->dev);
	if (IS_ERR_VALUE(ret)) {
		dev_err(&pdev->dev, "pm_runtime_get_sync() failed\n");
		return ret;
	}
1230

1231 1232
	mcasp->base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
	if (!mcasp->base) {
1233 1234
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
1235
		goto err;
1236 1237
	}

1238 1239 1240
	mcasp->op_mode = pdata->op_mode;
	mcasp->tdm_slots = pdata->tdm_slots;
	mcasp->num_serializer = pdata->num_serializer;
1241 1242 1243 1244 1245
#ifdef CONFIG_PM_SLEEP
	mcasp->context.xrsr_regs = devm_kzalloc(&pdev->dev,
					sizeof(u32) * mcasp->num_serializer,
					GFP_KERNEL);
#endif
1246 1247 1248 1249
	mcasp->serial_dir = pdata->serial_dir;
	mcasp->version = pdata->version;
	mcasp->txnumevt = pdata->txnumevt;
	mcasp->rxnumevt = pdata->rxnumevt;
1250

1251
	mcasp->dev = &pdev->dev;
1252

1253
	dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
1254 1255
	if (dat)
		mcasp->dat_port = true;
1256

1257
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
1258
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1259 1260 1261 1262
	dma_params->asp_chan_q = pdata->asp_chan_q;
	dma_params->ram_chan_q = pdata->ram_chan_q;
	dma_params->sram_pool = pdata->sram_pool;
	dma_params->sram_size = pdata->sram_size_playback;
1263
	if (dat)
1264
		dma_params->dma_addr = dat->start;
1265
	else
1266
		dma_params->dma_addr = mem->start + pdata->tx_dma_offset;
1267

1268
	/* Unconditional dmaengine stuff */
1269
	dma_data->addr = dma_params->dma_addr;
1270

1271
	res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1272
	if (res)
1273
		dma_params->channel = res->start;
1274
	else
1275
		dma_params->channel = pdata->tx_dma_channel;
1276

1277 1278 1279 1280 1281 1282
	/* dmaengine filter data for DT and non-DT boot */
	if (pdev->dev.of_node)
		dma_data->filter_data = "tx";
	else
		dma_data->filter_data = &dma_params->channel;

1283
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_CAPTURE];
1284
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
1285 1286 1287 1288
	dma_params->asp_chan_q = pdata->asp_chan_q;
	dma_params->ram_chan_q = pdata->ram_chan_q;
	dma_params->sram_pool = pdata->sram_pool;
	dma_params->sram_size = pdata->sram_size_capture;
1289
	if (dat)
1290
		dma_params->dma_addr = dat->start;
1291
	else
1292
		dma_params->dma_addr = mem->start + pdata->rx_dma_offset;
1293

1294
	/* Unconditional dmaengine stuff */
1295
	dma_data->addr = dma_params->dma_addr;
1296

1297 1298
	if (mcasp->version < MCASP_VERSION_3) {
		mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
1299
		/* dma_params->dma_addr is pointing to the data port address */
1300 1301 1302 1303
		mcasp->dat_port = true;
	} else {
		mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
	}
1304 1305

	res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1306
	if (res)
1307
		dma_params->channel = res->start;
1308
	else
1309
		dma_params->channel = pdata->rx_dma_channel;
1310

1311 1312 1313 1314 1315
	/* dmaengine filter data for DT and non-DT boot */
	if (pdev->dev.of_node)
		dma_data->filter_data = "rx";
	else
		dma_data->filter_data = &dma_params->channel;
1316

1317
	dev_set_drvdata(&pdev->dev, mcasp);
1318 1319 1320

	mcasp_reparent_fck(pdev);

1321 1322 1323
	ret = devm_snd_soc_register_component(&pdev->dev,
					&davinci_mcasp_component,
					&davinci_mcasp_dai[pdata->op_mode], 1);
1324 1325

	if (ret != 0)
1326
		goto err;
1327

1328
	switch (mcasp->version) {
1329 1330 1331
#if IS_BUILTIN(CONFIG_SND_DAVINCI_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_DAVINCI_SOC))
1332 1333
	case MCASP_VERSION_1:
	case MCASP_VERSION_2:
1334
		ret = davinci_soc_platform_register(&pdev->dev);
1335
		break;
1336
#endif
1337 1338 1339 1340 1341 1342 1343
#if IS_BUILTIN(CONFIG_SND_EDMA_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_EDMA_SOC))
	case MCASP_VERSION_3:
		ret = edma_pcm_platform_register(&pdev->dev);
		break;
#endif
1344 1345 1346
#if IS_BUILTIN(CONFIG_SND_OMAP_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_OMAP_SOC))
1347 1348 1349
	case MCASP_VERSION_4:
		ret = omap_pcm_platform_register(&pdev->dev);
		break;
1350
#endif
1351 1352 1353 1354 1355 1356 1357 1358 1359
	default:
		dev_err(&pdev->dev, "Invalid McASP version: %d\n",
			mcasp->version);
		ret = -EINVAL;
		break;
	}

	if (ret) {
		dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
1360
		goto err;
1361 1362
	}

1363 1364
	return 0;

1365
err:
1366 1367
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1368 1369 1370 1371 1372
	return ret;
}

static int davinci_mcasp_remove(struct platform_device *pdev)
{
1373 1374
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384

	return 0;
}

static struct platform_driver davinci_mcasp_driver = {
	.probe		= davinci_mcasp_probe,
	.remove		= davinci_mcasp_remove,
	.driver		= {
		.name	= "davinci-mcasp",
		.owner	= THIS_MODULE,
1385
		.of_match_table = mcasp_dt_ids,
1386 1387 1388
	},
};

1389
module_platform_driver(davinci_mcasp_driver);
1390 1391 1392 1393

MODULE_AUTHOR("Steve Chen");
MODULE_DESCRIPTION("TI DAVINCI McASP SoC Interface");
MODULE_LICENSE("GPL");