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 158 159 160 161 162 163
	if (mcasp->rxnumevt) {	/* enable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
		mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
	}

164
	/* Start clocks */
165 166
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
167 168 169 170 171 172
	/*
	 * 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)) {
173 174
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
175 176
	}

177
	/* Activate serializer(s) */
178
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
179
	/* Release RX state machine */
180
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
181
	/* Release Frame Sync generator */
182
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
183
	if (mcasp_is_synchronous(mcasp))
184
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
185 186
}

187
static void mcasp_start_tx(struct davinci_mcasp *mcasp)
188
{
189 190
	u32 cnt;

191 192 193 194 195 196 197
	if (mcasp->txnumevt) {	/* enable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
		mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
	}

198
	/* Start clocks */
199 200
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
201
	/* Activate serializer(s) */
202
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
203

204
	/* wait for XDATA to be cleared */
205
	cnt = 0;
206 207
	while (!(mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG) &
		 ~XRDATA) && (cnt < 100000))
208 209
		cnt++;

210 211 212 213
	/* 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);
214 215
}

216
static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
217
{
218 219
	mcasp->streams++;

220
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
221
		mcasp_start_tx(mcasp);
222
	else
223
		mcasp_start_rx(mcasp);
224 225
}

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

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

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

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

245
static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
246
{
247 248 249 250 251 252 253 254 255
	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;

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

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

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

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

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

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

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

321 322 323 324 325
	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));

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

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

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

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

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

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

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

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

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

397 398 399 400 401 402
	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);
403
	}
404 405 406
out:
	pm_runtime_put_sync(mcasp->dev);
	return ret;
407 408
}

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

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

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

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

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

	return 0;
}

442 443 444 445 446 447
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);
}

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

	if (dir == SND_SOC_CLOCK_OUT) {
454 455 456
		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);
457
	} else {
458 459 460
		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);
461 462
	}

463 464
	mcasp->sysclk_freq = freq;

465 466 467
	return 0;
}

468
static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
469
				       int word_length)
470
{
471
	u32 fmt;
D
Daniel Mack 已提交
472
	u32 tx_rotate = (word_length / 4) & 0x7;
473
	u32 mask = (1ULL << word_length) - 1;
474 475 476 477 478 479 480 481 482 483
	/*
	 * 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;
484

485 486 487 488 489
	/*
	 * 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.
490 491 492
	 * 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).
493
	 */
494 495
	if (mcasp->bclk_lrclk_ratio)
		word_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
496

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

500
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
501 502 503 504 505 506 507 508 509
		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);
510 511
	}

512
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
513

514 515 516
	return 0;
}

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

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

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

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

561 562 563 564 565 566 567 568 569
	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;
	}
570

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

578
	/* AFIFO is not in use */
579 580
	if (!numevt) {
		/* Configure the burst size for platform drivers */
581 582 583 584 585 586 587 588 589 590 591 592 593
		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;
		}
594
		return 0;
595
	}
596

597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614
	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)
615
		numevt = active_serializers;
616

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

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

626
	return 0;
627 628
}

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

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

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

645
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
646

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

650 651 652 653 654 655 656 657 658 659 660
	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;
661 662 663
}

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

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

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

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

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

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

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

	/* Enable the DIT */
689
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
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 730
	/* 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);

731
	return 0;
732 733 734 735 736 737
}

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

746 747 748 749 750
	/*
	 * 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) {
751
		unsigned int bclk_freq = snd_soc_params_to_bclk(params);
752
		unsigned int div = mcasp->sysclk_freq / bclk_freq;
753
		if (mcasp->sysclk_freq % bclk_freq != 0) {
754 755 756 757 758 759
			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);
760
		}
761
		__davinci_mcasp_set_clkdiv(cpu_dai, 1, div, 0);
762 763
	}

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

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

	if (ret)
		return ret;
776 777

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

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

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

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

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

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

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

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

	return 0;
}

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

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

	default:
		ret = -EINVAL;
	}

	return ret;
}

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

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

860
	if (mcasp->version >= MCASP_VERSION_3) {
861 862 863 864 865 866 867 868 869 870 871 872 873 874
		/* 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;
}

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

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

886 887 888 889 890 891 892 893
	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);
	}
894

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

	return 0;
}

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

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

912 913 914 915 916 917 918 919
	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]);
	}
920

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

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

932 933
#define DAVINCI_MCASP_RATES	SNDRV_PCM_RATE_8000_192000

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

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

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

};

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

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

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

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

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

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

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 1073
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;
}

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

	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) {
1091
		pdata = (struct davinci_mcasp_pdata*) match->data;
1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102
	} 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);
1103 1104 1105 1106 1107 1108 1109 1110
	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;
		}

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

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

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

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

1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153
	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];

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 1180
	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;
}

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

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

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

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

1206
	mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1207
	if (!mem) {
1208
		dev_warn(mcasp->dev,
1209 1210 1211 1212 1213 1214
			 "\"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;
		}
1215 1216
	}

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

1224
	pm_runtime_enable(&pdev->dev);
1225

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

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

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

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

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

1258
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
1259
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1260 1261 1262 1263
	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;
1264
	if (dat)
1265
		dma_params->dma_addr = dat->start;
1266
	else
1267
		dma_params->dma_addr = mem->start + pdata->tx_dma_offset;
1268

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

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

1278 1279 1280 1281 1282 1283
	/* 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;

1284
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_CAPTURE];
1285
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
1286 1287 1288 1289
	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;
1290
	if (dat)
1291
		dma_params->dma_addr = dat->start;
1292
	else
1293
		dma_params->dma_addr = mem->start + pdata->rx_dma_offset;
1294

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

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

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

1312 1313 1314 1315 1316
	/* 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;
1317

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

	mcasp_reparent_fck(pdev);

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

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

1329
	switch (mcasp->version) {
1330 1331 1332
#if IS_BUILTIN(CONFIG_SND_DAVINCI_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_DAVINCI_SOC))
1333 1334
	case MCASP_VERSION_1:
	case MCASP_VERSION_2:
1335
		ret = davinci_soc_platform_register(&pdev->dev);
1336
		break;
1337
#endif
1338 1339 1340 1341 1342 1343 1344
#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
1345 1346 1347
#if IS_BUILTIN(CONFIG_SND_OMAP_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_OMAP_SOC))
1348 1349 1350
	case MCASP_VERSION_4:
		ret = omap_pcm_platform_register(&pdev->dev);
		break;
1351
#endif
1352 1353 1354 1355 1356 1357 1358 1359 1360
	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);
1361
		goto err;
1362 1363
	}

1364 1365
	return 0;

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

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

	return 0;
}

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

1390
module_platform_driver(davinci_mcasp_driver);
1391 1392 1393 1394

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