davinci-mcasp.c 33.6 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

277
	pm_runtime_get_sync(mcasp->dev);
278
	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
279 280 281 282 283 284 285
	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;
286 287
	case SND_SOC_DAIFMT_DSP_B:
	case SND_SOC_DAIFMT_AC97:
288 289
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
290 291 292

		/* No delay after FS */
		data_delay = 0;
293 294 295
		break;
	default:
		/* 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 300
		/* 1st data bit occur one ACLK cycle after the frame sync */
		data_delay = 1;
301 302 303
		break;
	}

304 305 306 307 308
	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));

309 310 311
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBS_CFS:
		/* codec is clock and frame slave */
312 313
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
314

315 316
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
317

318 319
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
320
		mcasp->bclk_master = 1;
321
		break;
322 323
	case SND_SOC_DAIFMT_CBM_CFS:
		/* codec is clock master and frame slave */
324 325
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
326

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

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

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

342 343
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
			       ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
344
		mcasp->bclk_master = 0;
345 346 347
		break;

	default:
348 349
		ret = -EINVAL;
		goto out;
350 351 352 353
	}

	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
	case SND_SOC_DAIFMT_IB_NF:
354
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
355
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
356
		fs_pol_rising = true;
357 358 359
		break;

	case SND_SOC_DAIFMT_NB_IF:
360
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
361
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
362
		fs_pol_rising = false;
363 364 365
		break;

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

	case SND_SOC_DAIFMT_NB_NF:
372 373
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
374
		fs_pol_rising = true;
375 376 377
		break;

	default:
378
		ret = -EINVAL;
379 380 381 382 383 384 385 386 387
		goto out;
	}

	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);
388
	}
389 390 391
out:
	pm_runtime_put_sync(mcasp->dev);
	return ret;
392 393
}

394 395
static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id, int div)
{
396
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
397 398 399

	switch (div_id) {
	case 0:		/* MCLK divider */
400
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
401
			       AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
402
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
403 404 405 406
			       AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
		break;

	case 1:		/* BCLK divider */
407
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
408
			       ACLKXDIV(div - 1), ACLKXDIV_MASK);
409
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
410 411 412
			       ACLKRDIV(div - 1), ACLKRDIV_MASK);
		break;

413
	case 2:		/* BCLK/LRCLK ratio */
414
		mcasp->bclk_lrclk_ratio = div;
415 416
		break;

417 418 419 420 421 422 423
	default:
		return -EINVAL;
	}

	return 0;
}

424 425 426
static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
				    unsigned int freq, int dir)
{
427
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
428 429

	if (dir == SND_SOC_CLOCK_OUT) {
430 431 432
		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);
433
	} else {
434 435 436
		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);
437 438
	}

439 440
	mcasp->sysclk_freq = freq;

441 442 443
	return 0;
}

444
static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
445
				       int word_length)
446
{
447
	u32 fmt;
D
Daniel Mack 已提交
448 449
	u32 tx_rotate = (word_length / 4) & 0x7;
	u32 rx_rotate = (32 - word_length) / 4;
450
	u32 mask = (1ULL << word_length) - 1;
451

452 453 454 455 456
	/*
	 * 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.
457 458 459
	 * 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).
460
	 */
461 462
	if (mcasp->bclk_lrclk_ratio)
		word_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
463

464 465
	/* mapping of the XSSZ bit-field as described in the datasheet */
	fmt = (word_length >> 1) - 1;
466

467
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
468 469 470 471 472 473 474 475 476
		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);
477 478
	}

479
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
480

481 482 483
	return 0;
}

484
static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
485
				 int period_words, int channels)
486
{
487 488
	struct davinci_pcm_dma_params *dma_params = &mcasp->dma_params[stream];
	struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
489
	int i;
490 491
	u8 tx_ser = 0;
	u8 rx_ser = 0;
492
	u8 slots = mcasp->tdm_slots;
493
	u8 max_active_serializers = (channels + slots - 1) / slots;
494
	int active_serializers, numevt, n;
495
	u32 reg;
496
	/* Default configuration */
497
	if (mcasp->version != MCASP_VERSION_4)
498
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
499 500

	/* All PINS as McASP */
501
	mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
502 503

	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
504 505
		mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
506
	} else {
507 508
		mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
509 510
	}

511
	for (i = 0; i < mcasp->num_serializer; i++) {
512 513
		mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			       mcasp->serial_dir[i]);
514
		if (mcasp->serial_dir[i] == TX_MODE &&
515
					tx_ser < max_active_serializers) {
516
			mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
517
			tx_ser++;
518
		} else if (mcasp->serial_dir[i] == RX_MODE &&
519
					rx_ser < max_active_serializers) {
520
			mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
521
			rx_ser++;
522
		} else {
523 524
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
				       SRMOD_INACTIVE, SRMOD_MASK);
525 526 527
		}
	}

528 529 530 531 532 533 534 535 536
	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;
	}
537

538
	if (active_serializers < max_active_serializers) {
539
		dev_warn(mcasp->dev, "stream has more channels (%d) than are "
540 541
			 "enabled in mcasp (%d)\n", channels,
			 active_serializers * slots);
542 543 544
		return -EINVAL;
	}

545
	/* AFIFO is not in use */
546 547
	if (!numevt) {
		/* Configure the burst size for platform drivers */
548 549 550 551 552 553 554 555 556 557 558 559 560
		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;
		}
561
		return 0;
562
	}
563

564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581
	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)
582
		numevt = active_serializers;
583

584 585
	mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
	mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
586

587
	/* Configure the burst size for platform drivers */
588 589
	if (numevt == 1)
		numevt = 0;
590 591 592
	dma_params->fifo_level = numevt;
	dma_data->maxburst = numevt;

593
	return 0;
594 595
}

596
static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream)
597 598 599
{
	int i, active_slots;
	u32 mask = 0;
600
	u32 busel = 0;
601

602 603 604 605 606 607
	if ((mcasp->tdm_slots < 2) || (mcasp->tdm_slots > 32)) {
		dev_err(mcasp->dev, "tdm slot %d not supported\n",
			mcasp->tdm_slots);
		return -EINVAL;
	}

608
	active_slots = (mcasp->tdm_slots > 31) ? 32 : mcasp->tdm_slots;
609 610 611
	for (i = 0; i < active_slots; i++)
		mask |= (1 << i);

612
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
613

614 615 616
	if (!mcasp->dat_port)
		busel = TXSEL;

617 618 619 620 621 622 623 624 625 626 627
	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;
628 629 630
}

/* S/PDIF */
631
static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp)
632 633 634
{
	/* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
	   and LSB first */
635
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
636 637

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

	/* Set the TX tdm : for all the slots */
641
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
642 643

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

646
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
647 648

	/* Only 44100 and 48000 are valid, both have the same setting */
649
	mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
650 651

	/* Enable the DIT */
652
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
653 654

	return 0;
655 656 657 658 659 660
}

static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *params,
					struct snd_soc_dai *cpu_dai)
{
661
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
662
	struct davinci_pcm_dma_params *dma_params =
663
					&mcasp->dma_params[substream->stream];
664
	int word_length;
665
	int channels = params_channels(params);
666
	int period_size = params_period_size(params);
667
	int ret;
668 669 670 671 672

	/* 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) {
673
			dev_err(mcasp->dev, "Can't produce required BCLK\n");
674 675 676 677 678 679
			return -EINVAL;
		}
		davinci_mcasp_set_clkdiv(
			cpu_dai, 1, mcasp->sysclk_freq / bclk_freq);
	}

680 681
	ret = mcasp_common_hw_param(mcasp, substream->stream,
				    period_size * channels, channels);
682 683 684
	if (ret)
		return ret;

685
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
686
		ret = mcasp_dit_hw_param(mcasp);
687
	else
688 689 690 691
		ret = mcasp_i2s_hw_param(mcasp, substream->stream);

	if (ret)
		return ret;
692 693

	switch (params_format(params)) {
694
	case SNDRV_PCM_FORMAT_U8:
695 696
	case SNDRV_PCM_FORMAT_S8:
		dma_params->data_type = 1;
697
		word_length = 8;
698 699
		break;

700
	case SNDRV_PCM_FORMAT_U16_LE:
701 702
	case SNDRV_PCM_FORMAT_S16_LE:
		dma_params->data_type = 2;
703
		word_length = 16;
704 705
		break;

706 707 708
	case SNDRV_PCM_FORMAT_U24_3LE:
	case SNDRV_PCM_FORMAT_S24_3LE:
		dma_params->data_type = 3;
709
		word_length = 24;
710 711
		break;

712 713
	case SNDRV_PCM_FORMAT_U24_LE:
	case SNDRV_PCM_FORMAT_S24_LE:
714
	case SNDRV_PCM_FORMAT_U32_LE:
715 716
	case SNDRV_PCM_FORMAT_S32_LE:
		dma_params->data_type = 4;
717
		word_length = 32;
718 719 720 721 722 723
		break;

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

725
	if (mcasp->version == MCASP_VERSION_2 && !dma_params->fifo_level)
726 727
		dma_params->acnt = 4;
	else
728 729
		dma_params->acnt = dma_params->data_type;

730
	davinci_config_channel_size(mcasp, word_length);
731 732 733 734 735 736 737

	return 0;
}

static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
				     int cmd, struct snd_soc_dai *cpu_dai)
{
738
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
739 740 741 742
	int ret = 0;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_RESUME:
743 744
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
745
		davinci_mcasp_start(mcasp, substream->stream);
746 747
		break;
	case SNDRV_PCM_TRIGGER_SUSPEND:
748
	case SNDRV_PCM_TRIGGER_STOP:
749
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
750
		davinci_mcasp_stop(mcasp, substream->stream);
751 752 753 754 755 756 757 758 759
		break;

	default:
		ret = -EINVAL;
	}

	return ret;
}

760
static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
761 762 763
	.trigger	= davinci_mcasp_trigger,
	.hw_params	= davinci_mcasp_hw_params,
	.set_fmt	= davinci_mcasp_set_dai_fmt,
764
	.set_clkdiv	= davinci_mcasp_set_clkdiv,
765
	.set_sysclk	= davinci_mcasp_set_sysclk,
766 767
};

768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786
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;
}

787 788 789 790
#ifdef CONFIG_PM_SLEEP
static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
791
	struct davinci_mcasp_context *context = &mcasp->context;
792

793 794 795 796 797 798 799
	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);
800 801 802 803 804 805 806

	return 0;
}

static int davinci_mcasp_resume(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
807 808 809 810 811 812 813 814 815
	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);
816 817 818 819 820 821 822 823

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

824 825
#define DAVINCI_MCASP_RATES	SNDRV_PCM_RATE_8000_192000

826 827 828 829
#define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
				SNDRV_PCM_FMTBIT_U8 | \
				SNDRV_PCM_FMTBIT_S16_LE | \
				SNDRV_PCM_FMTBIT_U16_LE | \
830 831 832 833
				SNDRV_PCM_FMTBIT_S24_LE | \
				SNDRV_PCM_FMTBIT_U24_LE | \
				SNDRV_PCM_FMTBIT_S24_3LE | \
				SNDRV_PCM_FMTBIT_U24_3LE | \
834 835 836
				SNDRV_PCM_FMTBIT_S32_LE | \
				SNDRV_PCM_FMTBIT_U32_LE)

837
static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
838
	{
839
		.name		= "davinci-mcasp.0",
840
		.probe		= davinci_mcasp_dai_probe,
841 842
		.suspend	= davinci_mcasp_suspend,
		.resume		= davinci_mcasp_resume,
843 844
		.playback	= {
			.channels_min	= 2,
845
			.channels_max	= 32 * 16,
846
			.rates 		= DAVINCI_MCASP_RATES,
847
			.formats	= DAVINCI_MCASP_PCM_FMTS,
848 849 850
		},
		.capture 	= {
			.channels_min 	= 2,
851
			.channels_max	= 32 * 16,
852
			.rates 		= DAVINCI_MCASP_RATES,
853
			.formats	= DAVINCI_MCASP_PCM_FMTS,
854 855 856 857 858
		},
		.ops 		= &davinci_mcasp_dai_ops,

	},
	{
859
		.name		= "davinci-mcasp.1",
860
		.probe		= davinci_mcasp_dai_probe,
861 862 863 864
		.playback 	= {
			.channels_min	= 1,
			.channels_max	= 384,
			.rates		= DAVINCI_MCASP_RATES,
865
			.formats	= DAVINCI_MCASP_PCM_FMTS,
866 867 868 869 870 871
		},
		.ops 		= &davinci_mcasp_dai_ops,
	},

};

872 873 874 875
static const struct snd_soc_component_driver davinci_mcasp_component = {
	.name		= "davinci-mcasp",
};

876
/* Some HW specific values and defaults. The rest is filled in from DT. */
877
static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
878 879 880 881 882 883
	.tx_dma_offset = 0x400,
	.rx_dma_offset = 0x400,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_1,
};

884
static struct davinci_mcasp_pdata da830_mcasp_pdata = {
885 886 887 888 889 890
	.tx_dma_offset = 0x2000,
	.rx_dma_offset = 0x2000,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_2,
};

891
static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
892 893 894 895 896 897
	.tx_dma_offset = 0,
	.rx_dma_offset = 0,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_3,
};

898
static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
899 900 901 902 903 904
	.tx_dma_offset = 0x200,
	.rx_dma_offset = 0x284,
	.asp_chan_q = EVENTQ_0,
	.version = MCASP_VERSION_4,
};

905 906 907
static const struct of_device_id mcasp_dt_ids[] = {
	{
		.compatible = "ti,dm646x-mcasp-audio",
908
		.data = &dm646x_mcasp_pdata,
909 910 911
	},
	{
		.compatible = "ti,da830-mcasp-audio",
912
		.data = &da830_mcasp_pdata,
913
	},
914
	{
915
		.compatible = "ti,am33xx-mcasp-audio",
916
		.data = &am33xx_mcasp_pdata,
917
	},
918 919 920 921
	{
		.compatible = "ti,dra7-mcasp-audio",
		.data = &dra7_mcasp_pdata,
	},
922 923 924 925
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, mcasp_dt_ids);

926 927 928 929 930 931 932 933 934 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
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;
}

966
static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
967 968 969
						struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
970
	struct davinci_mcasp_pdata *pdata = NULL;
971
	const struct of_device_id *match =
972
			of_match_device(mcasp_dt_ids, &pdev->dev);
973
	struct of_phandle_args dma_spec;
974 975 976 977 978 979 980 981 982

	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) {
983
		pdata = (struct davinci_mcasp_pdata*) match->data;
984 985 986 987 988 989 990 991 992 993 994
	} 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);
995 996 997 998 999 1000 1001 1002
	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;
		}

1003
		pdata->tdm_slots = val;
1004
	}
1005 1006 1007 1008

	of_serial_dir32 = of_get_property(np, "serial-dir", &val);
	val /= sizeof(u32);
	if (of_serial_dir32) {
1009 1010 1011
		u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
						 (sizeof(*of_serial_dir) * val),
						 GFP_KERNEL);
1012 1013 1014 1015 1016
		if (!of_serial_dir) {
			ret = -ENOMEM;
			goto nodata;
		}

1017
		for (i = 0; i < val; i++)
1018 1019
			of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);

1020
		pdata->num_serializer = val;
1021 1022 1023
		pdata->serial_dir = of_serial_dir;
	}

1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045
	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];

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

1073 1074
static int davinci_mcasp_probe(struct platform_device *pdev)
{
1075
	struct davinci_pcm_dma_params *dma_params;
1076
	struct snd_dmaengine_dai_dma_data *dma_data;
1077
	struct resource *mem, *ioarea, *res, *dat;
1078
	struct davinci_mcasp_pdata *pdata;
1079
	struct davinci_mcasp *mcasp;
1080
	int ret;
1081

1082 1083 1084 1085 1086
	if (!pdev->dev.platform_data && !pdev->dev.of_node) {
		dev_err(&pdev->dev, "No platform data supplied\n");
		return -EINVAL;
	}

1087
	mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
1088
			   GFP_KERNEL);
1089
	if (!mcasp)
1090 1091
		return	-ENOMEM;

1092 1093 1094 1095 1096 1097
	pdata = davinci_mcasp_set_pdata_from_of(pdev);
	if (!pdata) {
		dev_err(&pdev->dev, "no platform data\n");
		return -EINVAL;
	}

1098
	mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1099
	if (!mem) {
1100
		dev_warn(mcasp->dev,
1101 1102 1103 1104 1105 1106
			 "\"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;
		}
1107 1108
	}

1109
	ioarea = devm_request_mem_region(&pdev->dev, mem->start,
1110
			resource_size(mem), pdev->name);
1111 1112
	if (!ioarea) {
		dev_err(&pdev->dev, "Audio region already claimed\n");
1113
		return -EBUSY;
1114 1115
	}

1116
	pm_runtime_enable(&pdev->dev);
1117

1118 1119 1120 1121 1122
	ret = pm_runtime_get_sync(&pdev->dev);
	if (IS_ERR_VALUE(ret)) {
		dev_err(&pdev->dev, "pm_runtime_get_sync() failed\n");
		return ret;
	}
1123

1124 1125
	mcasp->base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
	if (!mcasp->base) {
1126 1127 1128 1129 1130
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
		goto err_release_clk;
	}

1131 1132 1133 1134 1135 1136 1137
	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;
1138

1139
	mcasp->dev = &pdev->dev;
1140

1141
	dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
1142 1143
	if (dat)
		mcasp->dat_port = true;
1144

1145
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
1146
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1147 1148 1149 1150
	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;
1151
	if (dat)
1152
		dma_params->dma_addr = dat->start;
1153
	else
1154
		dma_params->dma_addr = mem->start + pdata->tx_dma_offset;
1155

1156
	/* Unconditional dmaengine stuff */
1157
	dma_data->addr = dma_params->dma_addr;
1158

1159
	res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1160
	if (res)
1161
		dma_params->channel = res->start;
1162
	else
1163
		dma_params->channel = pdata->tx_dma_channel;
1164

1165 1166 1167 1168 1169 1170
	/* 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;

1171
	dma_params = &mcasp->dma_params[SNDRV_PCM_STREAM_CAPTURE];
1172
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
1173 1174 1175 1176
	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;
1177
	if (dat)
1178
		dma_params->dma_addr = dat->start;
1179
	else
1180
		dma_params->dma_addr = mem->start + pdata->rx_dma_offset;
1181

1182
	/* Unconditional dmaengine stuff */
1183
	dma_data->addr = dma_params->dma_addr;
1184

1185 1186
	if (mcasp->version < MCASP_VERSION_3) {
		mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
1187
		/* dma_params->dma_addr is pointing to the data port address */
1188 1189 1190 1191
		mcasp->dat_port = true;
	} else {
		mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
	}
1192 1193

	res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1194
	if (res)
1195
		dma_params->channel = res->start;
1196
	else
1197
		dma_params->channel = pdata->rx_dma_channel;
1198

1199 1200 1201 1202 1203
	/* 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;
1204

1205
	dev_set_drvdata(&pdev->dev, mcasp);
1206 1207 1208

	mcasp_reparent_fck(pdev);

1209 1210
	ret = snd_soc_register_component(&pdev->dev, &davinci_mcasp_component,
					 &davinci_mcasp_dai[pdata->op_mode], 1);
1211 1212

	if (ret != 0)
1213
		goto err_release_clk;
1214

1215 1216 1217 1218 1219 1220
	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;
		}
1221 1222
	}

1223 1224
	return 0;

1225 1226
err_unregister_component:
	snd_soc_unregister_component(&pdev->dev);
1227
err_release_clk:
1228 1229
	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1230 1231 1232 1233 1234
	return ret;
}

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

1237
	snd_soc_unregister_component(&pdev->dev);
1238 1239
	if (mcasp->version != MCASP_VERSION_4)
		davinci_soc_platform_unregister(&pdev->dev);
1240 1241 1242

	pm_runtime_put_sync(&pdev->dev);
	pm_runtime_disable(&pdev->dev);
1243 1244 1245 1246 1247 1248 1249 1250 1251 1252

	return 0;
}

static struct platform_driver davinci_mcasp_driver = {
	.probe		= davinci_mcasp_probe,
	.remove		= davinci_mcasp_remove,
	.driver		= {
		.name	= "davinci-mcasp",
		.owner	= THIS_MODULE,
1253
		.of_match_table = mcasp_dt_ids,
1254 1255 1256
	},
};

1257
module_platform_driver(davinci_mcasp_driver);
1258 1259 1260 1261

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