davinci-mcasp.c 33.7 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 37 38 39

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

40 41
#define MCASP_MAX_AFIFO_DEPTH	64

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

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

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

68 69 70
	int	sysclk_freq;
	bool	bclk_master;

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

75 76
	bool	dat_port;

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

157 158 159
	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);
160

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

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

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

173 174 175 176
	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);
177

178 179 180
	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);
181 182
	for (i = 0; i < mcasp->num_serializer; i++) {
		if (mcasp->serial_dir[i] == TX_MODE) {
183 184 185 186 187 188 189
			offset = i;
			break;
		}
	}

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

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

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

201 202
	mcasp->streams++;

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

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

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

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

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

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

252 253
	mcasp->streams--;

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

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

278
	pm_runtime_get_sync(mcasp->dev);
279
	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
280 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 293

		/* No delay after FS */
		data_delay = 0;
294
		break;
295
	case SND_SOC_DAIFMT_I2S:
296
		/* configure a full-word SYNC pulse (LRCLK) */
297 298
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
299

300 301
		/* 1st data bit occur one ACLK cycle after the frame sync */
		data_delay = 1;
302 303
		/* FS need to be inverted */
		inv_fs = true;
304
		break;
305 306 307
	default:
		ret = -EINVAL;
		goto out;
308 309
	}

310 311 312 313 314
	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));

315 316 317
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBS_CFS:
		/* codec is clock and frame slave */
318 319
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
320

321 322
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
323

324 325
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
326
		mcasp->bclk_master = 1;
327
		break;
328 329
	case SND_SOC_DAIFMT_CBM_CFS:
		/* codec is clock master and frame slave */
330 331
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
332

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

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

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

348 349
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
			       ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
350
		mcasp->bclk_master = 0;
351 352 353
		break;

	default:
354 355
		ret = -EINVAL;
		goto out;
356 357 358 359
	}

	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
	case SND_SOC_DAIFMT_IB_NF:
360
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
361
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
362
		fs_pol_rising = true;
363 364 365
		break;

	case SND_SOC_DAIFMT_NB_IF:
366
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
367
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
368
		fs_pol_rising = false;
369 370 371
		break;

	case SND_SOC_DAIFMT_IB_IF:
372
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
373
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
374
		fs_pol_rising = false;
375 376 377
		break;

	case SND_SOC_DAIFMT_NB_NF:
378 379
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
380
		fs_pol_rising = true;
381 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_4)
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 1137 1138 1139
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
		goto err_release_clk;
	}

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
	ret = snd_soc_register_component(&pdev->dev, &davinci_mcasp_component,
					 &davinci_mcasp_dai[pdata->op_mode], 1);
1220 1221

	if (ret != 0)
1222
		goto err_release_clk;
1223

1224 1225 1226 1227 1228 1229
	if (mcasp->version != MCASP_VERSION_4) {
		ret = davinci_soc_platform_register(&pdev->dev);
		if (ret) {
			dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
			goto err_unregister_component;
		}
1230 1231
	}

1232 1233
	return 0;

1234 1235
err_unregister_component:
	snd_soc_unregister_component(&pdev->dev);
1236
err_release_clk:
1237 1238
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1239 1240 1241 1242 1243
	return ret;
}

static int davinci_mcasp_remove(struct platform_device *pdev)
{
1244
	struct davinci_mcasp *mcasp = dev_get_drvdata(&pdev->dev);
1245

1246
	snd_soc_unregister_component(&pdev->dev);
1247 1248
	if (mcasp->version != MCASP_VERSION_4)
		davinci_soc_platform_unregister(&pdev->dev);
1249 1250 1251

	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261

	return 0;
}

static struct platform_driver davinci_mcasp_driver = {
	.probe		= davinci_mcasp_probe,
	.remove		= davinci_mcasp_remove,
	.driver		= {
		.name	= "davinci-mcasp",
		.owner	= THIS_MODULE,
1262
		.of_match_table = mcasp_dt_ids,
1263 1264 1265
	},
};

1266
module_platform_driver(davinci_mcasp_driver);
1267 1268 1269 1270

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