davinci-mcasp.c 34.2 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 31 32 33 34

#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/initval.h>
#include <sound/soc.h>
35
#include <sound/dmaengine_pcm.h>
36
#include <sound/omap-pcm.h>
37 38 39 40

#include "davinci-pcm.h"
#include "davinci-mcasp.h"

41 42
#define MCASP_MAX_AFIFO_DEPTH	64

43 44 45 46 47 48 49 50 51 52
struct davinci_mcasp_context {
	u32	txfmtctl;
	u32	rxfmtctl;
	u32	txfmt;
	u32	rxfmt;
	u32	aclkxctl;
	u32	aclkrctl;
	u32	pdir;
};

53
struct davinci_mcasp {
54
	struct davinci_pcm_dma_params dma_params[2];
55
	struct snd_dmaengine_dai_dma_data dma_data[2];
56
	void __iomem *base;
57
	u32 fifo_base;
58 59 60 61 62 63 64 65 66
	struct device *dev;

	/* McASP specific data */
	int	tdm_slots;
	u8	op_mode;
	u8	num_serializer;
	u8	*serial_dir;
	u8	version;
	u16	bclk_lrclk_ratio;
67
	int	streams;
68

69 70 71
	int	sysclk_freq;
	bool	bclk_master;

72 73 74 75
	/* McASP FIFO related */
	u8	txnumevt;
	u8	rxnumevt;

76 77
	bool	dat_port;

78
#ifdef CONFIG_PM_SLEEP
79
	struct davinci_mcasp_context context;
80 81 82
#endif
};

83 84
static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
85
{
86
	void __iomem *reg = mcasp->base + offset;
87 88 89
	__raw_writel(__raw_readl(reg) | val, reg);
}

90 91
static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
92
{
93
	void __iomem *reg = mcasp->base + offset;
94 95 96
	__raw_writel((__raw_readl(reg) & ~(val)), reg);
}

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

104 105
static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
				 u32 val)
106
{
107
	__raw_writel(val, mcasp->base + offset);
108 109
}

110
static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
111
{
112
	return (u32)__raw_readl(mcasp->base + offset);
113 114
}

115
static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
116 117 118
{
	int i = 0;

119
	mcasp_set_bits(mcasp, ctl_reg, val);
120 121 122 123

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

128
	if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
129 130 131
		printk(KERN_ERR "GBLCTL write error\n");
}

132 133
static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
{
134 135
	u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
	u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
136 137 138 139

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

140
static void mcasp_start_rx(struct davinci_mcasp *mcasp)
141
{
142 143
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
144 145 146 147 148 149 150

	/*
	 * 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)) {
151 152
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
153 154
	}

155 156
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXBUF_REG, 0);
157

158 159 160
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXBUF_REG, 0);
161

162 163
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
164 165

	if (mcasp_is_synchronous(mcasp))
166
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
167 168
}

169
static void mcasp_start_tx(struct davinci_mcasp *mcasp)
170
{
171 172 173
	u8 offset = 0, i;
	u32 cnt;

174 175 176 177
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
178

179 180 181
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
182 183
	for (i = 0; i < mcasp->num_serializer; i++) {
		if (mcasp->serial_dir[i] == TX_MODE) {
184 185 186 187 188 189 190
			offset = i;
			break;
		}
	}

	/* wait for TX ready */
	cnt = 0;
191
	while (!(mcasp_get_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(offset)) &
192 193 194
		 TXSTATE) && (cnt < 100000))
		cnt++;

195
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
196 197
}

198
static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
199
{
200 201
	u32 reg;

202 203
	mcasp->streams++;

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

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

230 231
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
232 233
}

234
static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
235
{
236 237 238 239 240 241 242 243 244
	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;

245 246
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
247 248
}

249
static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
250
{
251 252
	u32 reg;

253 254
	mcasp->streams--;

255
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
256
		if (mcasp->txnumevt) {	/* disable FIFO */
257
			reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
258
			mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
259
		}
260
		mcasp_stop_tx(mcasp);
261
	} else {
262
		if (mcasp->rxnumevt) {	/* disable FIFO */
263
			reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
264
			mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
265
		}
266
		mcasp_stop_rx(mcasp);
267
	}
268 269 270 271 272
}

static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
					 unsigned int fmt)
{
273
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
274
	int ret = 0;
275
	u32 data_delay;
276
	bool fs_pol_rising;
277
	bool inv_fs = false;
278

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

315 316 317 318 319
	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));

320 321 322
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBS_CFS:
		/* codec is clock and frame slave */
323 324
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
325

326 327
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
328

329 330
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
331
		mcasp->bclk_master = 1;
332
		break;
333 334
	case SND_SOC_DAIFMT_CBM_CFS:
		/* codec is clock master and frame slave */
335 336
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
337

338 339
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
340

341 342
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
343
		mcasp->bclk_master = 0;
344
		break;
345 346
	case SND_SOC_DAIFMT_CBM_CFM:
		/* codec is clock and frame master */
347 348
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
349

350 351
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
352

353 354
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
			       ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
355
		mcasp->bclk_master = 0;
356 357
		break;
	default:
358 359
		ret = -EINVAL;
		goto out;
360 361 362 363
	}

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

388 389 390
	if (inv_fs)
		fs_pol_rising = !fs_pol_rising;

391 392 393 394 395 396
	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);
397
	}
398 399 400
out:
	pm_runtime_put_sync(mcasp->dev);
	return ret;
401 402
}

403 404
static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id, int div)
{
405
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
406 407 408

	switch (div_id) {
	case 0:		/* MCLK divider */
409
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
410
			       AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
411
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
412 413 414 415
			       AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
		break;

	case 1:		/* BCLK divider */
416
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
417
			       ACLKXDIV(div - 1), ACLKXDIV_MASK);
418
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
419 420 421
			       ACLKRDIV(div - 1), ACLKRDIV_MASK);
		break;

422
	case 2:		/* BCLK/LRCLK ratio */
423
		mcasp->bclk_lrclk_ratio = div;
424 425
		break;

426 427 428 429 430 431 432
	default:
		return -EINVAL;
	}

	return 0;
}

433 434 435
static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
				    unsigned int freq, int dir)
{
436
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
437 438

	if (dir == SND_SOC_CLOCK_OUT) {
439 440 441
		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);
442
	} else {
443 444 445
		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);
446 447
	}

448 449
	mcasp->sysclk_freq = freq;

450 451 452
	return 0;
}

453
static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
454
				       int word_length)
455
{
456
	u32 fmt;
D
Daniel Mack 已提交
457 458
	u32 tx_rotate = (word_length / 4) & 0x7;
	u32 rx_rotate = (32 - word_length) / 4;
459
	u32 mask = (1ULL << word_length) - 1;
460

461 462 463 464 465
	/*
	 * 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.
466 467 468
	 * 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).
469
	 */
470 471
	if (mcasp->bclk_lrclk_ratio)
		word_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
472

473 474
	/* mapping of the XSSZ bit-field as described in the datasheet */
	fmt = (word_length >> 1) - 1;
475

476
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
477 478 479 480 481 482 483 484 485
		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);
486 487
	}

488
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
489

490 491 492
	return 0;
}

493
static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
494
				 int period_words, int channels)
495
{
496 497
	struct davinci_pcm_dma_params *dma_params = &mcasp->dma_params[stream];
	struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
498
	int i;
499 500
	u8 tx_ser = 0;
	u8 rx_ser = 0;
501
	u8 slots = mcasp->tdm_slots;
502
	u8 max_active_serializers = (channels + slots - 1) / slots;
503
	int active_serializers, numevt, n;
504
	u32 reg;
505
	/* Default configuration */
506
	if (mcasp->version < MCASP_VERSION_3)
507
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
508 509

	/* All PINS as McASP */
510
	mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
511 512

	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
513 514
		mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
515
	} else {
516 517
		mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
518 519
	}

520
	for (i = 0; i < mcasp->num_serializer; i++) {
521 522
		mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			       mcasp->serial_dir[i]);
523
		if (mcasp->serial_dir[i] == TX_MODE &&
524
					tx_ser < max_active_serializers) {
525
			mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
526
			tx_ser++;
527
		} else if (mcasp->serial_dir[i] == RX_MODE &&
528
					rx_ser < max_active_serializers) {
529
			mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
530
			rx_ser++;
531
		} else {
532 533
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
				       SRMOD_INACTIVE, SRMOD_MASK);
534 535 536
		}
	}

537 538 539 540 541 542 543 544 545
	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;
	}
546

547
	if (active_serializers < max_active_serializers) {
548
		dev_warn(mcasp->dev, "stream has more channels (%d) than are "
549 550
			 "enabled in mcasp (%d)\n", channels,
			 active_serializers * slots);
551 552 553
		return -EINVAL;
	}

554
	/* AFIFO is not in use */
555 556
	if (!numevt) {
		/* Configure the burst size for platform drivers */
557 558 559 560 561 562 563 564 565 566 567 568 569
		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;
		}
570
		return 0;
571
	}
572

573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590
	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)
591
		numevt = active_serializers;
592

593 594
	mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
	mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
595

596
	/* Configure the burst size for platform drivers */
597 598
	if (numevt == 1)
		numevt = 0;
599 600 601
	dma_params->fifo_level = numevt;
	dma_data->maxburst = numevt;

602
	return 0;
603 604
}

605
static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream)
606 607 608
{
	int i, active_slots;
	u32 mask = 0;
609
	u32 busel = 0;
610

611 612 613 614 615 616
	if ((mcasp->tdm_slots < 2) || (mcasp->tdm_slots > 32)) {
		dev_err(mcasp->dev, "tdm slot %d not supported\n",
			mcasp->tdm_slots);
		return -EINVAL;
	}

617
	active_slots = (mcasp->tdm_slots > 31) ? 32 : mcasp->tdm_slots;
618 619 620
	for (i = 0; i < active_slots; i++)
		mask |= (1 << i);

621
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
622

623 624 625
	if (!mcasp->dat_port)
		busel = TXSEL;

626 627 628 629 630 631 632 633 634 635 636
	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;
637 638 639
}

/* S/PDIF */
640
static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp)
641 642 643
{
	/* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
	   and LSB first */
644
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
645 646

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

	/* Set the TX tdm : for all the slots */
650
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
651 652

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

655
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
656 657

	/* Only 44100 and 48000 are valid, both have the same setting */
658
	mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
659 660

	/* Enable the DIT */
661
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
662 663

	return 0;
664 665 666 667 668 669
}

static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *params,
					struct snd_soc_dai *cpu_dai)
{
670
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
671
	struct davinci_pcm_dma_params *dma_params =
672
					&mcasp->dma_params[substream->stream];
673
	int word_length;
674
	int channels = params_channels(params);
675
	int period_size = params_period_size(params);
676
	int ret;
677 678 679 680 681

	/* If mcasp is BCLK master we need to set BCLK divider */
	if (mcasp->bclk_master) {
		unsigned int bclk_freq = snd_soc_params_to_bclk(params);
		if (mcasp->sysclk_freq % bclk_freq != 0) {
682
			dev_err(mcasp->dev, "Can't produce required BCLK\n");
683 684 685 686 687 688
			return -EINVAL;
		}
		davinci_mcasp_set_clkdiv(
			cpu_dai, 1, mcasp->sysclk_freq / bclk_freq);
	}

689 690
	ret = mcasp_common_hw_param(mcasp, substream->stream,
				    period_size * channels, channels);
691 692 693
	if (ret)
		return ret;

694
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
695
		ret = mcasp_dit_hw_param(mcasp);
696
	else
697 698 699 700
		ret = mcasp_i2s_hw_param(mcasp, substream->stream);

	if (ret)
		return ret;
701 702

	switch (params_format(params)) {
703
	case SNDRV_PCM_FORMAT_U8:
704 705
	case SNDRV_PCM_FORMAT_S8:
		dma_params->data_type = 1;
706
		word_length = 8;
707 708
		break;

709
	case SNDRV_PCM_FORMAT_U16_LE:
710 711
	case SNDRV_PCM_FORMAT_S16_LE:
		dma_params->data_type = 2;
712
		word_length = 16;
713 714
		break;

715 716 717
	case SNDRV_PCM_FORMAT_U24_3LE:
	case SNDRV_PCM_FORMAT_S24_3LE:
		dma_params->data_type = 3;
718
		word_length = 24;
719 720
		break;

721 722
	case SNDRV_PCM_FORMAT_U24_LE:
	case SNDRV_PCM_FORMAT_S24_LE:
723
	case SNDRV_PCM_FORMAT_U32_LE:
724 725
	case SNDRV_PCM_FORMAT_S32_LE:
		dma_params->data_type = 4;
726
		word_length = 32;
727 728 729 730 731 732
		break;

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

734
	if (mcasp->version == MCASP_VERSION_2 && !dma_params->fifo_level)
735 736
		dma_params->acnt = 4;
	else
737 738
		dma_params->acnt = dma_params->data_type;

739
	davinci_config_channel_size(mcasp, word_length);
740 741 742 743 744 745 746

	return 0;
}

static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
				     int cmd, struct snd_soc_dai *cpu_dai)
{
747
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
748 749 750 751
	int ret = 0;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_RESUME:
752 753
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
754
		davinci_mcasp_start(mcasp, substream->stream);
755 756
		break;
	case SNDRV_PCM_TRIGGER_SUSPEND:
757
	case SNDRV_PCM_TRIGGER_STOP:
758
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
759
		davinci_mcasp_stop(mcasp, substream->stream);
760 761 762 763 764 765 766 767 768
		break;

	default:
		ret = -EINVAL;
	}

	return ret;
}

769
static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
770 771 772
	.trigger	= davinci_mcasp_trigger,
	.hw_params	= davinci_mcasp_hw_params,
	.set_fmt	= davinci_mcasp_set_dai_fmt,
773
	.set_clkdiv	= davinci_mcasp_set_clkdiv,
774
	.set_sysclk	= davinci_mcasp_set_sysclk,
775 776
};

777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795
static int davinci_mcasp_dai_probe(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);

	if (mcasp->version == MCASP_VERSION_4) {
		/* 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;
}

796 797 798 799
#ifdef CONFIG_PM_SLEEP
static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
800
	struct davinci_mcasp_context *context = &mcasp->context;
801

802 803 804 805 806 807 808
	context->txfmtctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG);
	context->rxfmtctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
	context->txfmt = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXFMT_REG);
	context->rxfmt = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMT_REG);
	context->aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
	context->aclkrctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKRCTL_REG);
	context->pdir = mcasp_get_reg(mcasp, DAVINCI_MCASP_PDIR_REG);
809 810 811 812 813 814 815

	return 0;
}

static int davinci_mcasp_resume(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
816 817 818 819 820 821 822 823 824
	struct davinci_mcasp_context *context = &mcasp->context;

	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, context->txfmtctl);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG, context->rxfmtctl);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMT_REG, context->txfmt);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXFMT_REG, context->rxfmt);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, context->aclkxctl);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, context->aclkrctl);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_PDIR_REG, context->pdir);
825 826 827 828 829 830 831 832

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

833 834
#define DAVINCI_MCASP_RATES	SNDRV_PCM_RATE_8000_192000

835 836 837 838
#define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
				SNDRV_PCM_FMTBIT_U8 | \
				SNDRV_PCM_FMTBIT_S16_LE | \
				SNDRV_PCM_FMTBIT_U16_LE | \
839 840 841 842
				SNDRV_PCM_FMTBIT_S24_LE | \
				SNDRV_PCM_FMTBIT_U24_LE | \
				SNDRV_PCM_FMTBIT_S24_3LE | \
				SNDRV_PCM_FMTBIT_U24_3LE | \
843 844 845
				SNDRV_PCM_FMTBIT_S32_LE | \
				SNDRV_PCM_FMTBIT_U32_LE)

846
static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
847
	{
848
		.name		= "davinci-mcasp.0",
849
		.probe		= davinci_mcasp_dai_probe,
850 851
		.suspend	= davinci_mcasp_suspend,
		.resume		= davinci_mcasp_resume,
852 853
		.playback	= {
			.channels_min	= 2,
854
			.channels_max	= 32 * 16,
855
			.rates 		= DAVINCI_MCASP_RATES,
856
			.formats	= DAVINCI_MCASP_PCM_FMTS,
857 858 859
		},
		.capture 	= {
			.channels_min 	= 2,
860
			.channels_max	= 32 * 16,
861
			.rates 		= DAVINCI_MCASP_RATES,
862
			.formats	= DAVINCI_MCASP_PCM_FMTS,
863 864 865 866 867
		},
		.ops 		= &davinci_mcasp_dai_ops,

	},
	{
868
		.name		= "davinci-mcasp.1",
869
		.probe		= davinci_mcasp_dai_probe,
870 871 872 873
		.playback 	= {
			.channels_min	= 1,
			.channels_max	= 384,
			.rates		= DAVINCI_MCASP_RATES,
874
			.formats	= DAVINCI_MCASP_PCM_FMTS,
875 876 877 878 879 880
		},
		.ops 		= &davinci_mcasp_dai_ops,
	},

};

881 882 883 884
static const struct snd_soc_component_driver davinci_mcasp_component = {
	.name		= "davinci-mcasp",
};

885
/* Some HW specific values and defaults. The rest is filled in from DT. */
886
static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
887 888 889 890 891 892
	.tx_dma_offset = 0x400,
	.rx_dma_offset = 0x400,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_1,
};

893
static struct davinci_mcasp_pdata da830_mcasp_pdata = {
894 895 896 897 898 899
	.tx_dma_offset = 0x2000,
	.rx_dma_offset = 0x2000,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_2,
};

900
static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
901 902 903 904 905 906
	.tx_dma_offset = 0,
	.rx_dma_offset = 0,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_3,
};

907
static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
908 909 910 911 912 913
	.tx_dma_offset = 0x200,
	.rx_dma_offset = 0x284,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_4,
};

914 915 916
static const struct of_device_id mcasp_dt_ids[] = {
	{
		.compatible = "ti,dm646x-mcasp-audio",
917
		.data = &dm646x_mcasp_pdata,
918 919 920
	},
	{
		.compatible = "ti,da830-mcasp-audio",
921
		.data = &da830_mcasp_pdata,
922
	},
923
	{
924
		.compatible = "ti,am33xx-mcasp-audio",
925
		.data = &am33xx_mcasp_pdata,
926
	},
927 928 929 930
	{
		.compatible = "ti,dra7-mcasp-audio",
		.data = &dra7_mcasp_pdata,
	},
931 932 933 934
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, mcasp_dt_ids);

935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974
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;
}

975
static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
976 977 978
						struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
979
	struct davinci_mcasp_pdata *pdata = NULL;
980
	const struct of_device_id *match =
981
			of_match_device(mcasp_dt_ids, &pdev->dev);
982
	struct of_phandle_args dma_spec;
983 984 985 986 987 988 989 990 991

	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) {
992
		pdata = (struct davinci_mcasp_pdata*) match->data;
993 994 995 996 997 998 999 1000 1001 1002 1003
	} 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);
1004 1005 1006 1007 1008 1009 1010 1011
	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;
		}

1012
		pdata->tdm_slots = val;
1013
	}
1014 1015 1016 1017

	of_serial_dir32 = of_get_property(np, "serial-dir", &val);
	val /= sizeof(u32);
	if (of_serial_dir32) {
1018 1019 1020
		u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
						 (sizeof(*of_serial_dir) * val),
						 GFP_KERNEL);
1021 1022 1023 1024 1025
		if (!of_serial_dir) {
			ret = -ENOMEM;
			goto nodata;
		}

1026
		for (i = 0; i < val; i++)
1027 1028
			of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);

1029
		pdata->num_serializer = val;
1030 1031 1032
		pdata->serial_dir = of_serial_dir;
	}

1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054
	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];

1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081
	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;
}

1082 1083
static int davinci_mcasp_probe(struct platform_device *pdev)
{
1084
	struct davinci_pcm_dma_params *dma_params;
1085
	struct snd_dmaengine_dai_dma_data *dma_data;
1086
	struct resource *mem, *ioarea, *res, *dat;
1087
	struct davinci_mcasp_pdata *pdata;
1088
	struct davinci_mcasp *mcasp;
1089
	int ret;
1090

1091 1092 1093 1094 1095
	if (!pdev->dev.platform_data && !pdev->dev.of_node) {
		dev_err(&pdev->dev, "No platform data supplied\n");
		return -EINVAL;
	}

1096
	mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
1097
			   GFP_KERNEL);
1098
	if (!mcasp)
1099 1100
		return	-ENOMEM;

1101 1102 1103 1104 1105 1106
	pdata = davinci_mcasp_set_pdata_from_of(pdev);
	if (!pdata) {
		dev_err(&pdev->dev, "no platform data\n");
		return -EINVAL;
	}

1107
	mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1108
	if (!mem) {
1109
		dev_warn(mcasp->dev,
1110 1111 1112 1113 1114 1115
			 "\"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;
		}
1116 1117
	}

1118
	ioarea = devm_request_mem_region(&pdev->dev, mem->start,
1119
			resource_size(mem), pdev->name);
1120 1121
	if (!ioarea) {
		dev_err(&pdev->dev, "Audio region already claimed\n");
1122
		return -EBUSY;
1123 1124
	}

1125
	pm_runtime_enable(&pdev->dev);
1126

1127 1128 1129 1130 1131
	ret = pm_runtime_get_sync(&pdev->dev);
	if (IS_ERR_VALUE(ret)) {
		dev_err(&pdev->dev, "pm_runtime_get_sync() failed\n");
		return ret;
	}
1132

1133 1134
	mcasp->base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
	if (!mcasp->base) {
1135 1136
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
1137
		goto err;
1138 1139
	}

1140 1141 1142 1143 1144 1145 1146
	mcasp->op_mode = pdata->op_mode;
	mcasp->tdm_slots = pdata->tdm_slots;
	mcasp->num_serializer = pdata->num_serializer;
	mcasp->serial_dir = pdata->serial_dir;
	mcasp->version = pdata->version;
	mcasp->txnumevt = pdata->txnumevt;
	mcasp->rxnumevt = pdata->rxnumevt;
1147

1148
	mcasp->dev = &pdev->dev;
1149

1150
	dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
1151 1152
	if (dat)
		mcasp->dat_port = true;
1153

1154
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
1155
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1156 1157 1158 1159
	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;
1160
	if (dat)
1161
		dma_params->dma_addr = dat->start;
1162
	else
1163
		dma_params->dma_addr = mem->start + pdata->tx_dma_offset;
1164

1165
	/* Unconditional dmaengine stuff */
1166
	dma_data->addr = dma_params->dma_addr;
1167

1168
	res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1169
	if (res)
1170
		dma_params->channel = res->start;
1171
	else
1172
		dma_params->channel = pdata->tx_dma_channel;
1173

1174 1175 1176 1177 1178 1179
	/* 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;

1180
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_CAPTURE];
1181
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
1182 1183 1184 1185
	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;
1186
	if (dat)
1187
		dma_params->dma_addr = dat->start;
1188
	else
1189
		dma_params->dma_addr = mem->start + pdata->rx_dma_offset;
1190

1191
	/* Unconditional dmaengine stuff */
1192
	dma_data->addr = dma_params->dma_addr;
1193

1194 1195
	if (mcasp->version < MCASP_VERSION_3) {
		mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
1196
		/* dma_params->dma_addr is pointing to the data port address */
1197 1198 1199 1200
		mcasp->dat_port = true;
	} else {
		mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
	}
1201 1202

	res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1203
	if (res)
1204
		dma_params->channel = res->start;
1205
	else
1206
		dma_params->channel = pdata->rx_dma_channel;
1207

1208 1209 1210 1211 1212
	/* 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;
1213

1214
	dev_set_drvdata(&pdev->dev, mcasp);
1215 1216 1217

	mcasp_reparent_fck(pdev);

1218 1219 1220
	ret = devm_snd_soc_register_component(&pdev->dev,
					&davinci_mcasp_component,
					&davinci_mcasp_dai[pdata->op_mode], 1);
1221 1222

	if (ret != 0)
1223
		goto err;
1224

1225
	switch (mcasp->version) {
1226 1227 1228
#if IS_BUILTIN(CONFIG_SND_DAVINCI_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_DAVINCI_SOC))
1229 1230 1231
	case MCASP_VERSION_1:
	case MCASP_VERSION_2:
	case MCASP_VERSION_3:
1232
		ret = davinci_soc_platform_register(&pdev->dev);
1233
		break;
1234 1235 1236 1237
#endif
#if IS_BUILTIN(CONFIG_SND_OMAP_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_OMAP_SOC))
1238 1239 1240
	case MCASP_VERSION_4:
		ret = omap_pcm_platform_register(&pdev->dev);
		break;
1241
#endif
1242 1243 1244 1245 1246 1247 1248 1249 1250
	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);
1251
		goto err;
1252 1253
	}

1254 1255
	return 0;

1256
err:
1257 1258
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1259 1260 1261 1262 1263
	return ret;
}

static int davinci_mcasp_remove(struct platform_device *pdev)
{
1264 1265
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1266 1267 1268 1269 1270 1271 1272 1273 1274 1275

	return 0;
}

static struct platform_driver davinci_mcasp_driver = {
	.probe		= davinci_mcasp_probe,
	.remove		= davinci_mcasp_remove,
	.driver		= {
		.name	= "davinci-mcasp",
		.owner	= THIS_MODULE,
1276
		.of_match_table = mcasp_dt_ids,
1277 1278 1279
	},
};

1280
module_platform_driver(davinci_mcasp_driver);
1281 1282 1283 1284

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