davinci-mcasp.c 52.1 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
#include <linux/platform_data/davinci_asp.h>
30
#include <linux/math64.h>
31

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

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

44 45
#define MCASP_MAX_AFIFO_DEPTH	64

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

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

69 70 71 72 73
struct davinci_mcasp_ruledata {
	struct davinci_mcasp *mcasp;
	int serializers;
};

74
struct davinci_mcasp {
75
	struct snd_dmaengine_dai_dma_data dma_data[2];
76
	void __iomem *base;
77
	u32 fifo_base;
78
	struct device *dev;
79
	struct snd_pcm_substream *substreams[2];
80
	unsigned int dai_fmt;
81 82 83

	/* McASP specific data */
	int	tdm_slots;
84 85
	u32	tdm_mask[2];
	int	slot_width;
86 87 88 89
	u8	op_mode;
	u8	num_serializer;
	u8	*serial_dir;
	u8	version;
90
	u8	bclk_div;
91
	int	streams;
92
	u32	irq_request[2];
93
	int	dma_request[2];
94

95 96 97
	int	sysclk_freq;
	bool	bclk_master;

98 99 100 101
	/* McASP FIFO related */
	u8	txnumevt;
	u8	rxnumevt;

102 103
	bool	dat_port;

104 105 106
	/* Used for comstraint setting on the second stream */
	u32	channels;

107
#ifdef CONFIG_PM_SLEEP
108
	struct davinci_mcasp_context context;
109
#endif
110 111

	struct davinci_mcasp_ruledata ruledata[2];
112
	struct snd_pcm_hw_constraint_list chconstr[2];
113 114
};

115 116
static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
117
{
118
	void __iomem *reg = mcasp->base + offset;
119 120 121
	__raw_writel(__raw_readl(reg) | val, reg);
}

122 123
static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val)
124
{
125
	void __iomem *reg = mcasp->base + offset;
126 127 128
	__raw_writel((__raw_readl(reg) & ~(val)), reg);
}

129 130
static inline void mcasp_mod_bits(struct davinci_mcasp *mcasp, u32 offset,
				  u32 val, u32 mask)
131
{
132
	void __iomem *reg = mcasp->base + offset;
133 134 135
	__raw_writel((__raw_readl(reg) & ~mask) | val, reg);
}

136 137
static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
				 u32 val)
138
{
139
	__raw_writel(val, mcasp->base + offset);
140 141
}

142
static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
143
{
144
	return (u32)__raw_readl(mcasp->base + offset);
145 146
}

147
static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
148 149 150
{
	int i = 0;

151
	mcasp_set_bits(mcasp, ctl_reg, val);
152 153 154 155

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

160
	if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
161 162 163
		printk(KERN_ERR "GBLCTL write error\n");
}

164 165
static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
{
166 167
	u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
	u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
168 169 170 171

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

172
static void mcasp_start_rx(struct davinci_mcasp *mcasp)
173
{
174 175 176 177 178 179 180
	if (mcasp->rxnumevt) {	/* enable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;

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

181
	/* Start clocks */
182 183
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
184 185 186 187 188 189
	/*
	 * 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)) {
190 191
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
192 193
	}

194
	/* Activate serializer(s) */
195
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
196
	/* Release RX state machine */
197
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
198
	/* Release Frame Sync generator */
199
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
200
	if (mcasp_is_synchronous(mcasp))
201
		mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
202 203 204 205

	/* enable receive IRQs */
	mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
		       mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);
206 207
}

208
static void mcasp_start_tx(struct davinci_mcasp *mcasp)
209
{
210 211
	u32 cnt;

212 213 214 215 216 217 218
	if (mcasp->txnumevt) {	/* enable FIFO */
		u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;

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

219
	/* Start clocks */
220 221
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
222
	/* Activate serializer(s) */
223
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
224

225
	/* wait for XDATA to be cleared */
226
	cnt = 0;
227 228
	while ((mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG) & XRDATA) &&
	       (cnt < 100000))
229 230
		cnt++;

231 232 233 234
	/* Release TX state machine */
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
	/* Release Frame Sync generator */
	mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
235 236 237 238

	/* enable transmit IRQs */
	mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
		       mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);
239 240
}

241
static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
242
{
243 244
	mcasp->streams++;

245
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
246
		mcasp_start_tx(mcasp);
247
	else
248
		mcasp_start_rx(mcasp);
249 250
}

251
static void mcasp_stop_rx(struct davinci_mcasp *mcasp)
252
{
253 254 255 256
	/* disable IRQ sources */
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
		       mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);

257 258 259 260 261
	/*
	 * In synchronous mode stop the TX clocks if no other stream is
	 * running
	 */
	if (mcasp_is_synchronous(mcasp) && !mcasp->streams)
262
		mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, 0);
263

264 265
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
266 267 268 269 270 271

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

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
	}
272 273
}

274
static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
275
{
276 277
	u32 val = 0;

278 279 280 281
	/* disable IRQ sources */
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
		       mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);

282 283 284 285 286 287 288
	/*
	 * 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;

289 290
	mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
291 292 293 294 295 296

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

		mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
	}
297 298
}

299
static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
300
{
301 302
	mcasp->streams--;

303
	if (stream == SNDRV_PCM_STREAM_PLAYBACK)
304
		mcasp_stop_tx(mcasp);
305
	else
306
		mcasp_stop_rx(mcasp);
307 308
}

309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378
static irqreturn_t davinci_mcasp_tx_irq_handler(int irq, void *data)
{
	struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
	struct snd_pcm_substream *substream;
	u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK];
	u32 handled_mask = 0;
	u32 stat;

	stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG);
	if (stat & XUNDRN & irq_mask) {
		dev_warn(mcasp->dev, "Transmit buffer underflow\n");
		handled_mask |= XUNDRN;

		substream = mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK];
		if (substream) {
			snd_pcm_stream_lock_irq(substream);
			if (snd_pcm_running(substream))
				snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
			snd_pcm_stream_unlock_irq(substream);
		}
	}

	if (!handled_mask)
		dev_warn(mcasp->dev, "unhandled tx event. txstat: 0x%08x\n",
			 stat);

	if (stat & XRERR)
		handled_mask |= XRERR;

	/* Ack the handled event only */
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, handled_mask);

	return IRQ_RETVAL(handled_mask);
}

static irqreturn_t davinci_mcasp_rx_irq_handler(int irq, void *data)
{
	struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
	struct snd_pcm_substream *substream;
	u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE];
	u32 handled_mask = 0;
	u32 stat;

	stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG);
	if (stat & ROVRN & irq_mask) {
		dev_warn(mcasp->dev, "Receive buffer overflow\n");
		handled_mask |= ROVRN;

		substream = mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE];
		if (substream) {
			snd_pcm_stream_lock_irq(substream);
			if (snd_pcm_running(substream))
				snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
			snd_pcm_stream_unlock_irq(substream);
		}
	}

	if (!handled_mask)
		dev_warn(mcasp->dev, "unhandled rx event. rxstat: 0x%08x\n",
			 stat);

	if (stat & XRERR)
		handled_mask |= XRERR;

	/* Ack the handled event only */
	mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, handled_mask);

	return IRQ_RETVAL(handled_mask);
}

379 380 381 382 383 384 385 386 387 388 389 390 391 392
static irqreturn_t davinci_mcasp_common_irq_handler(int irq, void *data)
{
	struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
	irqreturn_t ret = IRQ_NONE;

	if (mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK])
		ret = davinci_mcasp_tx_irq_handler(irq, data);

	if (mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE])
		ret |= davinci_mcasp_rx_irq_handler(irq, data);

	return ret;
}

393 394 395
static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
					 unsigned int fmt)
{
396
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
397
	int ret = 0;
398
	u32 data_delay;
399
	bool fs_pol_rising;
400
	bool inv_fs = false;
401

402 403 404
	if (!fmt)
		return 0;

405
	pm_runtime_get_sync(mcasp->dev);
406
	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
407 408 409 410 411 412
	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;
413 414
	case SND_SOC_DAIFMT_DSP_B:
	case SND_SOC_DAIFMT_AC97:
415 416
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
417 418
		/* No delay after FS */
		data_delay = 0;
419
		break;
420
	case SND_SOC_DAIFMT_I2S:
421
		/* configure a full-word SYNC pulse (LRCLK) */
422 423
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
424 425
		/* 1st data bit occur one ACLK cycle after the frame sync */
		data_delay = 1;
426 427
		/* FS need to be inverted */
		inv_fs = true;
428
		break;
429 430 431 432 433 434 435
	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;
436 437 438
	default:
		ret = -EINVAL;
		goto out;
439 440
	}

441 442 443 444 445
	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));

446 447 448
	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
	case SND_SOC_DAIFMT_CBS_CFS:
		/* codec is clock and frame slave */
449 450
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
451

452 453
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
454

455 456
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
457
		mcasp->bclk_master = 1;
458
		break;
459 460 461 462 463 464 465 466 467 468 469 470
	case SND_SOC_DAIFMT_CBS_CFM:
		/* codec is clock slave and frame master */
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);

		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);

		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
		mcasp->bclk_master = 1;
		break;
471 472
	case SND_SOC_DAIFMT_CBM_CFS:
		/* codec is clock master and frame slave */
473 474
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
475

476 477
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
478

479 480
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
481
		mcasp->bclk_master = 0;
482
		break;
483 484
	case SND_SOC_DAIFMT_CBM_CFM:
		/* codec is clock and frame master */
485 486
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
487

488 489
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
490

491 492
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
			       ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
493
		mcasp->bclk_master = 0;
494 495
		break;
	default:
496 497
		ret = -EINVAL;
		goto out;
498 499 500 501
	}

	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
	case SND_SOC_DAIFMT_IB_NF:
502
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
503
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
504
		fs_pol_rising = true;
505 506
		break;
	case SND_SOC_DAIFMT_NB_IF:
507
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
508
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
509
		fs_pol_rising = false;
510 511
		break;
	case SND_SOC_DAIFMT_IB_IF:
512
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
513
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
514
		fs_pol_rising = false;
515 516
		break;
	case SND_SOC_DAIFMT_NB_NF:
517 518
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
		mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
519
		fs_pol_rising = true;
520 521
		break;
	default:
522
		ret = -EINVAL;
523 524 525
		goto out;
	}

526 527 528
	if (inv_fs)
		fs_pol_rising = !fs_pol_rising;

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

	mcasp->dai_fmt = fmt;
538
out:
539
	pm_runtime_put(mcasp->dev);
540
	return ret;
541 542
}

543 544
static int __davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
				      int div, bool explicit)
545
{
546
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
547

548
	pm_runtime_get_sync(mcasp->dev);
549 550
	switch (div_id) {
	case 0:		/* MCLK divider */
551
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
552
			       AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
553
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
554 555 556 557
			       AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
		break;

	case 1:		/* BCLK divider */
558
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
559
			       ACLKXDIV(div - 1), ACLKXDIV_MASK);
560
		mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
561
			       ACLKRDIV(div - 1), ACLKRDIV_MASK);
562 563
		if (explicit)
			mcasp->bclk_div = div;
564 565
		break;

566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
	case 2:	/*
		 * BCLK/LRCLK ratio descries how many bit-clock cycles
		 * fit into one frame. 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).
		 * Instead of storing this ratio, we calculate a new
		 * tdm_slot width by dividing the the ratio by the
		 * number of configured tdm slots.
		 */
		mcasp->slot_width = div / mcasp->tdm_slots;
		if (div % mcasp->tdm_slots)
			dev_warn(mcasp->dev,
				 "%s(): BCLK/LRCLK %d is not divisible by %d tdm slots",
				 __func__, div, mcasp->tdm_slots);
581 582
		break;

583 584 585 586
	default:
		return -EINVAL;
	}

587
	pm_runtime_put(mcasp->dev);
588 589 590
	return 0;
}

591 592 593 594 595 596
static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
				    int div)
{
	return __davinci_mcasp_set_clkdiv(dai, div_id, div, 1);
}

597 598 599
static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
				    unsigned int freq, int dir)
{
600
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
601

602
	pm_runtime_get_sync(mcasp->dev);
603
	if (dir == SND_SOC_CLOCK_OUT) {
604 605 606
		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);
607
	} else {
608 609 610
		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);
611 612
	}

613 614
	mcasp->sysclk_freq = freq;

615
	pm_runtime_put(mcasp->dev);
616 617 618
	return 0;
}

619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
/* All serializers must have equal number of channels */
static int davinci_mcasp_ch_constraint(struct davinci_mcasp *mcasp, int stream,
				       int serializers)
{
	struct snd_pcm_hw_constraint_list *cl = &mcasp->chconstr[stream];
	unsigned int *list = (unsigned int *) cl->list;
	int slots = mcasp->tdm_slots;
	int i, count = 0;

	if (mcasp->tdm_mask[stream])
		slots = hweight32(mcasp->tdm_mask[stream]);

	for (i = 2; i <= slots; i++)
		list[count++] = i;

	for (i = 2; i <= serializers; i++)
		list[count++] = i*slots;

	cl->count = count;

	return 0;
}

static int davinci_mcasp_set_ch_constraints(struct davinci_mcasp *mcasp)
{
	int rx_serializers = 0, tx_serializers = 0, ret, i;

	for (i = 0; i < mcasp->num_serializer; i++)
		if (mcasp->serial_dir[i] == TX_MODE)
			tx_serializers++;
		else if (mcasp->serial_dir[i] == RX_MODE)
			rx_serializers++;

	ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_PLAYBACK,
					  tx_serializers);
	if (ret)
		return ret;

	ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_CAPTURE,
					  rx_serializers);

	return ret;
}


static int davinci_mcasp_set_tdm_slot(struct snd_soc_dai *dai,
				      unsigned int tx_mask,
				      unsigned int rx_mask,
				      int slots, int slot_width)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);

	dev_dbg(mcasp->dev,
		 "%s() tx_mask 0x%08x rx_mask 0x%08x slots %d width %d\n",
		 __func__, tx_mask, rx_mask, slots, slot_width);

	if (tx_mask >= (1<<slots) || rx_mask >= (1<<slots)) {
		dev_err(mcasp->dev,
			"Bad tdm mask tx: 0x%08x rx: 0x%08x slots %d\n",
			tx_mask, rx_mask, slots);
		return -EINVAL;
	}

	if (slot_width &&
	    (slot_width < 8 || slot_width > 32 || slot_width % 4 != 0)) {
		dev_err(mcasp->dev, "%s: Unsupported slot_width %d\n",
			__func__, slot_width);
		return -EINVAL;
	}

	mcasp->tdm_slots = slots;
690 691
	mcasp->tdm_mask[SNDRV_PCM_STREAM_PLAYBACK] = tx_mask;
	mcasp->tdm_mask[SNDRV_PCM_STREAM_CAPTURE] = rx_mask;
692 693 694 695 696
	mcasp->slot_width = slot_width;

	return davinci_mcasp_set_ch_constraints(mcasp);
}

697
static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
698
				       int sample_width)
699
{
700
	u32 fmt;
701 702 703 704
	u32 tx_rotate = (sample_width / 4) & 0x7;
	u32 mask = (1ULL << sample_width) - 1;
	u32 slot_width = sample_width;

705 706 707 708 709 710 711 712 713 714
	/*
	 * For captured data we should not rotate, inversion and masking is
	 * enoguh to get the data to the right position:
	 * Format	  data from bus		after reverse (XRBUF)
	 * S16_LE:	|LSB|MSB|xxx|xxx|	|xxx|xxx|MSB|LSB|
	 * S24_3LE:	|LSB|DAT|MSB|xxx|	|xxx|MSB|DAT|LSB|
	 * S24_LE:	|LSB|DAT|MSB|xxx|	|xxx|MSB|DAT|LSB|
	 * S32_LE:	|LSB|DAT|DAT|MSB|	|MSB|DAT|DAT|LSB|
	 */
	u32 rx_rotate = 0;
715

716
	/*
717 718 719 720
	 * Setting the tdm slot width either with set_clkdiv() or
	 * set_tdm_slot() allows us to for example send 32 bits per
	 * channel to the codec, while only 16 of them carry audio
	 * payload.
721
	 */
722
	if (mcasp->slot_width) {
723
		/*
724 725 726
		 * When we have more bclk then it is needed for the
		 * data, we need to use the rotation to move the
		 * received samples to have correct alignment.
727
		 */
728 729
		slot_width = mcasp->slot_width;
		rx_rotate = (slot_width - sample_width) / 4;
730
	}
731

732
	/* mapping of the XSSZ bit-field as described in the datasheet */
733
	fmt = (slot_width >> 1) - 1;
734

735
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
736 737 738 739 740 741 742 743 744
		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);
745 746
	}

747
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
748

749 750 751
	return 0;
}

752
static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
753
				 int period_words, int channels)
754
{
755
	struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
756
	int i;
757 758
	u8 tx_ser = 0;
	u8 rx_ser = 0;
759
	u8 slots = mcasp->tdm_slots;
760
	u8 max_active_serializers = (channels + slots - 1) / slots;
761
	int active_serializers, numevt;
762
	u32 reg;
763
	/* Default configuration */
764
	if (mcasp->version < MCASP_VERSION_3)
765
		mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
766 767

	/* All PINS as McASP */
768
	mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
769 770

	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
771 772
		mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
773
	} else {
774 775
		mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
		mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
776 777
	}

778
	for (i = 0; i < mcasp->num_serializer; i++) {
779 780
		mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			       mcasp->serial_dir[i]);
781
		if (mcasp->serial_dir[i] == TX_MODE &&
782
					tx_ser < max_active_serializers) {
783
			mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
784 785
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
				       DISMOD_LOW, DISMOD_MASK);
786
			tx_ser++;
787
		} else if (mcasp->serial_dir[i] == RX_MODE &&
788
					rx_ser < max_active_serializers) {
789
			mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
790
			rx_ser++;
791
		} else {
792 793
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
				       SRMOD_INACTIVE, SRMOD_MASK);
794 795 796
		}
	}

797 798 799 800 801 802 803 804 805
	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;
	}
806

807
	if (active_serializers < max_active_serializers) {
808
		dev_warn(mcasp->dev, "stream has more channels (%d) than are "
809 810
			 "enabled in mcasp (%d)\n", channels,
			 active_serializers * slots);
811 812 813
		return -EINVAL;
	}

814
	/* AFIFO is not in use */
815 816
	if (!numevt) {
		/* Configure the burst size for platform drivers */
817 818 819 820 821 822 823 824 825 826 827
		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_data->maxburst = active_serializers;
		} else {
			dma_data->maxburst = 0;
		}
828
		return 0;
829
	}
830

831 832 833 834 835 836 837 838 839 840 841 842
	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.
	 */
843 844
	numevt = (numevt / active_serializers) * active_serializers;

845 846 847
	while (period_words % numevt && numevt > 0)
		numevt -= active_serializers;
	if (numevt <= 0)
848
		numevt = active_serializers;
849

850 851
	mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
	mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
852

853
	/* Configure the burst size for platform drivers */
854 855
	if (numevt == 1)
		numevt = 0;
856 857
	dma_data->maxburst = numevt;

858
	return 0;
859 860
}

861 862
static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream,
			      int channels)
863 864
{
	int i, active_slots;
865 866
	int total_slots;
	int active_serializers;
867
	u32 mask = 0;
868
	u32 busel = 0;
869

870 871 872 873
	total_slots = mcasp->tdm_slots;

	/*
	 * If more than one serializer is needed, then use them with
874 875 876
	 * all the specified tdm_slots. Otherwise, one serializer can
	 * cope with the transaction using just as many slots as there
	 * are channels in the stream.
877
	 */
878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897
	if (mcasp->tdm_mask[stream]) {
		active_slots = hweight32(mcasp->tdm_mask[stream]);
		active_serializers = (channels + active_slots - 1) /
			active_slots;
		if (active_serializers == 1) {
			active_slots = channels;
			for (i = 0; i < total_slots; i++) {
				if ((1 << i) & mcasp->tdm_mask[stream]) {
					mask |= (1 << i);
					if (--active_slots <= 0)
						break;
				}
			}
		}
	} else {
		active_serializers = (channels + total_slots - 1) / total_slots;
		if (active_serializers == 1)
			active_slots = channels;
		else
			active_slots = total_slots;
898

899 900 901
		for (i = 0; i < active_slots; i++)
			mask |= (1 << i);
	}
902
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
903

904 905 906
	if (!mcasp->dat_port)
		busel = TXSEL;

907 908 909 910 911 912 913 914 915 916
	if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
		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(total_slots), FSXMOD(0x1FF));
	} else if (stream == SNDRV_PCM_STREAM_CAPTURE) {
		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(total_slots), FSRMOD(0x1FF));
917 918 919 920 921 922 923 924
		/*
		 * If McASP is set to be TX/RX synchronous and the playback is
		 * not running already we need to configure the TX slots in
		 * order to have correct FSX on the bus
		 */
		if (mcasp_is_synchronous(mcasp) && !mcasp->channels)
			mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
				       FSXMOD(total_slots), FSXMOD(0x1FF));
925
	}
926 927

	return 0;
928 929 930
}

/* S/PDIF */
931 932
static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp,
			      unsigned int rate)
933
{
934 935 936
	u32 cs_value = 0;
	u8 *cs_bytes = (u8*) &cs_value;

937 938
	/* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
	   and LSB first */
939
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
940 941

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

	/* Set the TX tdm : for all the slots */
945
	mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
946 947

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

950
	mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
951 952

	/* Only 44100 and 48000 are valid, both have the same setting */
953
	mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
954 955

	/* Enable the DIT */
956
	mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
957

958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997
	/* Set S/PDIF channel status bits */
	cs_bytes[0] = IEC958_AES0_CON_NOT_COPYRIGHT;
	cs_bytes[1] = IEC958_AES1_CON_PCM_CODER;

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

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

998
	return 0;
999 1000
}

1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
static int davinci_mcasp_calc_clk_div(struct davinci_mcasp *mcasp,
				      unsigned int bclk_freq,
				      int *error_ppm)
{
	int div = mcasp->sysclk_freq / bclk_freq;
	int rem = mcasp->sysclk_freq % bclk_freq;

	if (rem != 0) {
		if (div == 0 ||
		    ((mcasp->sysclk_freq / div) - bclk_freq) >
		    (bclk_freq - (mcasp->sysclk_freq / (div+1)))) {
			div++;
			rem = rem - bclk_freq;
		}
	}
	if (error_ppm)
		*error_ppm =
			(div*1000000 + (int)div64_long(1000000LL*rem,
						       (int)bclk_freq))
			/div - 1000000;

	return div;
}

1025 1026 1027 1028
static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *params,
					struct snd_soc_dai *cpu_dai)
{
1029
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
1030
	int word_length;
1031
	int channels = params_channels(params);
1032
	int period_size = params_period_size(params);
1033
	int ret;
1034

1035 1036 1037 1038
	ret = davinci_mcasp_set_dai_fmt(cpu_dai, mcasp->dai_fmt);
	if (ret)
		return ret;

1039 1040 1041 1042 1043
	/*
	 * If mcasp is BCLK master, and a BCLK divider was not provided by
	 * the machine driver, we need to calculate the ratio.
	 */
	if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
1044
		int slots = mcasp->tdm_slots;
1045 1046 1047 1048
		int rate = params_rate(params);
		int sbits = params_width(params);
		int ppm, div;

1049 1050 1051
		if (mcasp->slot_width)
			sbits = mcasp->slot_width;

1052
		div = davinci_mcasp_calc_clk_div(mcasp, rate*sbits*slots,
1053 1054 1055 1056 1057
						 &ppm);
		if (ppm)
			dev_info(mcasp->dev, "Sample-rate is off by %d PPM\n",
				 ppm);

1058
		__davinci_mcasp_set_clkdiv(cpu_dai, 1, div, 0);
1059 1060
	}

1061 1062
	ret = mcasp_common_hw_param(mcasp, substream->stream,
				    period_size * channels, channels);
1063 1064 1065
	if (ret)
		return ret;

1066
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
1067
		ret = mcasp_dit_hw_param(mcasp, params_rate(params));
1068
	else
1069 1070
		ret = mcasp_i2s_hw_param(mcasp, substream->stream,
					 channels);
1071 1072 1073

	if (ret)
		return ret;
1074 1075

	switch (params_format(params)) {
1076
	case SNDRV_PCM_FORMAT_U8:
1077
	case SNDRV_PCM_FORMAT_S8:
1078
		word_length = 8;
1079 1080
		break;

1081
	case SNDRV_PCM_FORMAT_U16_LE:
1082
	case SNDRV_PCM_FORMAT_S16_LE:
1083
		word_length = 16;
1084 1085
		break;

1086 1087
	case SNDRV_PCM_FORMAT_U24_3LE:
	case SNDRV_PCM_FORMAT_S24_3LE:
1088
		word_length = 24;
1089 1090
		break;

1091 1092
	case SNDRV_PCM_FORMAT_U24_LE:
	case SNDRV_PCM_FORMAT_S24_LE:
1093 1094 1095
		word_length = 24;
		break;

1096
	case SNDRV_PCM_FORMAT_U32_LE:
1097
	case SNDRV_PCM_FORMAT_S32_LE:
1098
		word_length = 32;
1099 1100 1101 1102 1103 1104
		break;

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

1106
	davinci_config_channel_size(mcasp, word_length);
1107

1108 1109 1110
	if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE)
		mcasp->channels = channels;

1111 1112 1113 1114 1115 1116
	return 0;
}

static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
				     int cmd, struct snd_soc_dai *cpu_dai)
{
1117
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
1118 1119 1120 1121
	int ret = 0;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_RESUME:
1122 1123
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1124
		davinci_mcasp_start(mcasp, substream->stream);
1125 1126
		break;
	case SNDRV_PCM_TRIGGER_SUSPEND:
1127
	case SNDRV_PCM_TRIGGER_STOP:
1128
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
1129
		davinci_mcasp_stop(mcasp, substream->stream);
1130 1131 1132 1133 1134 1135 1136 1137 1138
		break;

	default:
		ret = -EINVAL;
	}

	return ret;
}

1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
static const unsigned int davinci_mcasp_dai_rates[] = {
	8000, 11025, 16000, 22050, 32000, 44100, 48000, 64000,
	88200, 96000, 176400, 192000,
};

#define DAVINCI_MAX_RATE_ERROR_PPM 1000

static int davinci_mcasp_hw_rule_rate(struct snd_pcm_hw_params *params,
				      struct snd_pcm_hw_rule *rule)
{
	struct davinci_mcasp_ruledata *rd = rule->private;
	struct snd_interval *ri =
		hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
	int sbits = params_width(params);
1153
	int slots = rd->mcasp->tdm_slots;
1154 1155
	struct snd_interval range;
	int i;
1156

1157 1158 1159
	if (rd->mcasp->slot_width)
		sbits = rd->mcasp->slot_width;

1160 1161
	snd_interval_any(&range);
	range.empty = 1;
1162 1163

	for (i = 0; i < ARRAY_SIZE(davinci_mcasp_dai_rates); i++) {
1164
		if (snd_interval_test(ri, davinci_mcasp_dai_rates[i])) {
1165
			uint bclk_freq = sbits*slots*
1166 1167 1168 1169
				davinci_mcasp_dai_rates[i];
			int ppm;

			davinci_mcasp_calc_clk_div(rd->mcasp, bclk_freq, &ppm);
1170 1171 1172 1173 1174 1175 1176
			if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
				if (range.empty) {
					range.min = davinci_mcasp_dai_rates[i];
					range.empty = 0;
				}
				range.max = davinci_mcasp_dai_rates[i];
			}
1177 1178
		}
	}
1179

1180
	dev_dbg(rd->mcasp->dev,
1181 1182
		"Frequencies %d-%d -> %d-%d for %d sbits and %d tdm slots\n",
		ri->min, ri->max, range.min, range.max, sbits, slots);
1183

1184 1185
	return snd_interval_refine(hw_param_interval(params, rule->var),
				   &range);
1186 1187 1188 1189 1190 1191 1192 1193 1194
}

static int davinci_mcasp_hw_rule_format(struct snd_pcm_hw_params *params,
					struct snd_pcm_hw_rule *rule)
{
	struct davinci_mcasp_ruledata *rd = rule->private;
	struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
	struct snd_mask nfmt;
	int rate = params_rate(params);
1195
	int slots = rd->mcasp->tdm_slots;
1196 1197 1198 1199 1200 1201
	int i, count = 0;

	snd_mask_none(&nfmt);

	for (i = 0; i < SNDRV_PCM_FORMAT_LAST; i++) {
		if (snd_mask_test(fmt, i)) {
1202
			uint sbits = snd_pcm_format_width(i);
1203 1204
			int ppm;

1205 1206 1207 1208 1209
			if (rd->mcasp->slot_width)
				sbits = rd->mcasp->slot_width;

			davinci_mcasp_calc_clk_div(rd->mcasp, sbits*slots*rate,
						   &ppm);
1210 1211 1212 1213 1214 1215 1216
			if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
				snd_mask_set(&nfmt, i);
				count++;
			}
		}
	}
	dev_dbg(rd->mcasp->dev,
1217 1218
		"%d possible sample format for %d Hz and %d tdm slots\n",
		count, rate, slots);
1219 1220 1221 1222

	return snd_mask_refine(fmt, &nfmt);
}

1223 1224 1225 1226
static int davinci_mcasp_startup(struct snd_pcm_substream *substream,
				 struct snd_soc_dai *cpu_dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
1227 1228
	struct davinci_mcasp_ruledata *ruledata =
					&mcasp->ruledata[substream->stream];
1229 1230
	u32 max_channels = 0;
	int i, dir;
1231 1232
	int tdm_slots = mcasp->tdm_slots;

1233 1234 1235
	/* Do not allow more then one stream per direction */
	if (mcasp->substreams[substream->stream])
		return -EBUSY;
1236

1237 1238
	mcasp->substreams[substream->stream] = substream;

1239 1240 1241
	if (mcasp->tdm_mask[substream->stream])
		tdm_slots = hweight32(mcasp->tdm_mask[substream->stream]);

1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
		return 0;

	/*
	 * Limit the maximum allowed channels for the first stream:
	 * number of serializers for the direction * tdm slots per serializer
	 */
	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
		dir = TX_MODE;
	else
		dir = RX_MODE;

	for (i = 0; i < mcasp->num_serializer; i++) {
		if (mcasp->serial_dir[i] == dir)
			max_channels++;
	}
1258
	ruledata->serializers = max_channels;
1259
	max_channels *= tdm_slots;
1260 1261 1262 1263 1264 1265 1266 1267 1268
	/*
	 * If the already active stream has less channels than the calculated
	 * limnit based on the seirializers * tdm_slots, we need to use that as
	 * a constraint for the second stream.
	 * Otherwise (first stream or less allowed channels) we use the
	 * calculated constraint.
	 */
	if (mcasp->channels && mcasp->channels < max_channels)
		max_channels = mcasp->channels;
1269 1270 1271 1272 1273 1274
	/*
	 * But we can always allow channels upto the amount of
	 * the available tdm_slots.
	 */
	if (max_channels < tdm_slots)
		max_channels = tdm_slots;
1275 1276 1277 1278

	snd_pcm_hw_constraint_minmax(substream->runtime,
				     SNDRV_PCM_HW_PARAM_CHANNELS,
				     2, max_channels);
1279

1280 1281 1282 1283 1284 1285 1286 1287
	snd_pcm_hw_constraint_list(substream->runtime,
				   0, SNDRV_PCM_HW_PARAM_CHANNELS,
				   &mcasp->chconstr[substream->stream]);

	if (mcasp->slot_width)
		snd_pcm_hw_constraint_minmax(substream->runtime,
					     SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
					     8, mcasp->slot_width);
1288

1289 1290 1291 1292 1293 1294 1295
	/*
	 * If we rely on implicit BCLK divider setting we should
	 * set constraints based on what we can provide.
	 */
	if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
		int ret;

1296
		ruledata->mcasp = mcasp;
1297 1298 1299 1300

		ret = snd_pcm_hw_rule_add(substream->runtime, 0,
					  SNDRV_PCM_HW_PARAM_RATE,
					  davinci_mcasp_hw_rule_rate,
1301
					  ruledata,
1302
					  SNDRV_PCM_HW_PARAM_FORMAT, -1);
1303 1304 1305 1306 1307
		if (ret)
			return ret;
		ret = snd_pcm_hw_rule_add(substream->runtime, 0,
					  SNDRV_PCM_HW_PARAM_FORMAT,
					  davinci_mcasp_hw_rule_format,
1308
					  ruledata,
1309
					  SNDRV_PCM_HW_PARAM_RATE, -1);
1310 1311 1312 1313
		if (ret)
			return ret;
	}

1314 1315 1316 1317 1318 1319 1320 1321
	return 0;
}

static void davinci_mcasp_shutdown(struct snd_pcm_substream *substream,
				   struct snd_soc_dai *cpu_dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);

1322 1323
	mcasp->substreams[substream->stream] = NULL;

1324 1325 1326 1327 1328 1329 1330
	if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
		return;

	if (!cpu_dai->active)
		mcasp->channels = 0;
}

1331
static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
1332 1333
	.startup	= davinci_mcasp_startup,
	.shutdown	= davinci_mcasp_shutdown,
1334 1335 1336
	.trigger	= davinci_mcasp_trigger,
	.hw_params	= davinci_mcasp_hw_params,
	.set_fmt	= davinci_mcasp_set_dai_fmt,
1337
	.set_clkdiv	= davinci_mcasp_set_clkdiv,
1338
	.set_sysclk	= davinci_mcasp_set_sysclk,
1339
	.set_tdm_slot	= davinci_mcasp_set_tdm_slot,
1340 1341
};

1342 1343 1344 1345
static int davinci_mcasp_dai_probe(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);

1346 1347
	dai->playback_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
	dai->capture_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
1348 1349 1350 1351

	return 0;
}

1352 1353 1354 1355
#ifdef CONFIG_PM_SLEEP
static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
1356
	struct davinci_mcasp_context *context = &mcasp->context;
1357
	u32 reg;
1358
	int i;
1359

1360
	context->pm_state = pm_runtime_active(mcasp->dev);
1361 1362 1363
	if (!context->pm_state)
		pm_runtime_get_sync(mcasp->dev);

1364 1365
	for (i = 0; i < ARRAY_SIZE(context_regs); i++)
		context->config_regs[i] = mcasp_get_reg(mcasp, context_regs[i]);
1366

1367 1368 1369 1370 1371 1372 1373 1374
	if (mcasp->txnumevt) {
		reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
		context->afifo_regs[0] = mcasp_get_reg(mcasp, reg);
	}
	if (mcasp->rxnumevt) {
		reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
		context->afifo_regs[1] = mcasp_get_reg(mcasp, reg);
	}
1375

1376 1377 1378
	for (i = 0; i < mcasp->num_serializer; i++)
		context->xrsr_regs[i] = mcasp_get_reg(mcasp,
						DAVINCI_MCASP_XRSRCTL_REG(i));
1379

1380 1381
	pm_runtime_put_sync(mcasp->dev);

1382 1383 1384 1385 1386 1387
	return 0;
}

static int davinci_mcasp_resume(struct snd_soc_dai *dai)
{
	struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
1388
	struct davinci_mcasp_context *context = &mcasp->context;
1389
	u32 reg;
1390
	int i;
1391

1392 1393
	pm_runtime_get_sync(mcasp->dev);

1394 1395
	for (i = 0; i < ARRAY_SIZE(context_regs); i++)
		mcasp_set_reg(mcasp, context_regs[i], context->config_regs[i]);
1396

1397 1398 1399 1400 1401 1402 1403 1404
	if (mcasp->txnumevt) {
		reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
		mcasp_set_reg(mcasp, reg, context->afifo_regs[0]);
	}
	if (mcasp->rxnumevt) {
		reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
		mcasp_set_reg(mcasp, reg, context->afifo_regs[1]);
	}
1405

1406 1407 1408
	for (i = 0; i < mcasp->num_serializer; i++)
		mcasp_set_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
			      context->xrsr_regs[i]);
1409

1410 1411 1412
	if (!context->pm_state)
		pm_runtime_put_sync(mcasp->dev);

1413 1414 1415 1416 1417 1418 1419
	return 0;
}
#else
#define davinci_mcasp_suspend NULL
#define davinci_mcasp_resume NULL
#endif

1420 1421
#define DAVINCI_MCASP_RATES	SNDRV_PCM_RATE_8000_192000

1422 1423 1424 1425
#define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
				SNDRV_PCM_FMTBIT_U8 | \
				SNDRV_PCM_FMTBIT_S16_LE | \
				SNDRV_PCM_FMTBIT_U16_LE | \
1426 1427 1428 1429
				SNDRV_PCM_FMTBIT_S24_LE | \
				SNDRV_PCM_FMTBIT_U24_LE | \
				SNDRV_PCM_FMTBIT_S24_3LE | \
				SNDRV_PCM_FMTBIT_U24_3LE | \
1430 1431 1432
				SNDRV_PCM_FMTBIT_S32_LE | \
				SNDRV_PCM_FMTBIT_U32_LE)

1433
static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
1434
	{
1435
		.name		= "davinci-mcasp.0",
1436
		.probe		= davinci_mcasp_dai_probe,
1437 1438
		.suspend	= davinci_mcasp_suspend,
		.resume		= davinci_mcasp_resume,
1439 1440
		.playback	= {
			.channels_min	= 2,
1441
			.channels_max	= 32 * 16,
1442
			.rates 		= DAVINCI_MCASP_RATES,
1443
			.formats	= DAVINCI_MCASP_PCM_FMTS,
1444 1445 1446
		},
		.capture 	= {
			.channels_min 	= 2,
1447
			.channels_max	= 32 * 16,
1448
			.rates 		= DAVINCI_MCASP_RATES,
1449
			.formats	= DAVINCI_MCASP_PCM_FMTS,
1450 1451 1452
		},
		.ops 		= &davinci_mcasp_dai_ops,

1453
		.symmetric_samplebits	= 1,
1454
		.symmetric_rates	= 1,
1455 1456
	},
	{
1457
		.name		= "davinci-mcasp.1",
1458
		.probe		= davinci_mcasp_dai_probe,
1459 1460 1461 1462
		.playback 	= {
			.channels_min	= 1,
			.channels_max	= 384,
			.rates		= DAVINCI_MCASP_RATES,
1463
			.formats	= DAVINCI_MCASP_PCM_FMTS,
1464 1465 1466 1467 1468 1469
		},
		.ops 		= &davinci_mcasp_dai_ops,
	},

};

1470 1471 1472 1473
static const struct snd_soc_component_driver davinci_mcasp_component = {
	.name		= "davinci-mcasp",
};

1474
/* Some HW specific values and defaults. The rest is filled in from DT. */
1475
static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
1476 1477 1478 1479 1480
	.tx_dma_offset = 0x400,
	.rx_dma_offset = 0x400,
	.version = MCASP_VERSION_1,
};

1481
static struct davinci_mcasp_pdata da830_mcasp_pdata = {
1482 1483 1484 1485 1486
	.tx_dma_offset = 0x2000,
	.rx_dma_offset = 0x2000,
	.version = MCASP_VERSION_2,
};

1487
static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
1488 1489 1490 1491 1492
	.tx_dma_offset = 0,
	.rx_dma_offset = 0,
	.version = MCASP_VERSION_3,
};

1493
static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
1494 1495 1496 1497 1498
	.tx_dma_offset = 0x200,
	.rx_dma_offset = 0x284,
	.version = MCASP_VERSION_4,
};

1499 1500 1501
static const struct of_device_id mcasp_dt_ids[] = {
	{
		.compatible = "ti,dm646x-mcasp-audio",
1502
		.data = &dm646x_mcasp_pdata,
1503 1504 1505
	},
	{
		.compatible = "ti,da830-mcasp-audio",
1506
		.data = &da830_mcasp_pdata,
1507
	},
1508
	{
1509
		.compatible = "ti,am33xx-mcasp-audio",
1510
		.data = &am33xx_mcasp_pdata,
1511
	},
1512 1513 1514 1515
	{
		.compatible = "ti,dra7-mcasp-audio",
		.data = &dra7_mcasp_pdata,
	},
1516 1517 1518 1519
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, mcasp_dt_ids);

1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533
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;

1534 1535
	dev_warn(&pdev->dev, "Update the bindings to use assigned-clocks!\n");

1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
	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;
}

1562
static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
1563 1564 1565
						struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
1566
	struct davinci_mcasp_pdata *pdata = NULL;
1567
	const struct of_device_id *match =
1568
			of_match_device(mcasp_dt_ids, &pdev->dev);
1569
	struct of_phandle_args dma_spec;
1570 1571 1572 1573 1574 1575 1576 1577 1578

	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) {
1579
		pdata = (struct davinci_mcasp_pdata*) match->data;
1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590
	} 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);
1591 1592 1593 1594 1595 1596 1597 1598
	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;
		}

1599
		pdata->tdm_slots = val;
1600
	}
1601 1602 1603 1604

	of_serial_dir32 = of_get_property(np, "serial-dir", &val);
	val /= sizeof(u32);
	if (of_serial_dir32) {
1605 1606 1607
		u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
						 (sizeof(*of_serial_dir) * val),
						 GFP_KERNEL);
1608 1609 1610 1611 1612
		if (!of_serial_dir) {
			ret = -ENOMEM;
			goto nodata;
		}

1613
		for (i = 0; i < val; i++)
1614 1615
			of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);

1616
		pdata->num_serializer = val;
1617 1618 1619
		pdata->serial_dir = of_serial_dir;
	}

1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630
	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];

1631 1632 1633 1634 1635
	/* RX is not valid in DIT mode */
	if (pdata->op_mode != DAVINCI_MCASP_DIT_MODE) {
		ret = of_property_match_string(np, "dma-names", "rx");
		if (ret < 0)
			goto nodata;
1636

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

1642 1643
		pdata->rx_dma_channel = dma_spec.args[0];
	}
1644

1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671
	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;
}

1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714
enum {
	PCM_EDMA,
	PCM_SDMA,
};
static const char *sdma_prefix = "ti,omap";

static int davinci_mcasp_get_dma_type(struct davinci_mcasp *mcasp)
{
	struct dma_chan *chan;
	const char *tmp;
	int ret = PCM_EDMA;

	if (!mcasp->dev->of_node)
		return PCM_EDMA;

	tmp = mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK].filter_data;
	chan = dma_request_slave_channel_reason(mcasp->dev, tmp);
	if (IS_ERR(chan)) {
		if (PTR_ERR(chan) != -EPROBE_DEFER)
			dev_err(mcasp->dev,
				"Can't verify DMA configuration (%ld)\n",
				PTR_ERR(chan));
		return PTR_ERR(chan);
	}
	BUG_ON(!chan->device || !chan->device->dev);

	if (chan->device->dev->of_node)
		ret = of_property_read_string(chan->device->dev->of_node,
					      "compatible", &tmp);
	else
		dev_dbg(mcasp->dev, "DMA controller has no of-node\n");

	dma_release_channel(chan);
	if (ret)
		return ret;

	dev_dbg(mcasp->dev, "DMA controller compatible = \"%s\"\n", tmp);
	if (!strncmp(tmp, sdma_prefix, strlen(sdma_prefix)))
		return PCM_SDMA;

	return PCM_EDMA;
}

1715 1716
static int davinci_mcasp_probe(struct platform_device *pdev)
{
1717
	struct snd_dmaengine_dai_dma_data *dma_data;
1718
	struct resource *mem, *res, *dat;
1719
	struct davinci_mcasp_pdata *pdata;
1720
	struct davinci_mcasp *mcasp;
1721
	char *irq_name;
1722
	int *dma;
1723
	int irq;
1724
	int ret;
1725

1726 1727 1728 1729 1730
	if (!pdev->dev.platform_data && !pdev->dev.of_node) {
		dev_err(&pdev->dev, "No platform data supplied\n");
		return -EINVAL;
	}

1731
	mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
1732
			   GFP_KERNEL);
1733
	if (!mcasp)
1734 1735
		return	-ENOMEM;

1736 1737 1738 1739 1740 1741
	pdata = davinci_mcasp_set_pdata_from_of(pdev);
	if (!pdata) {
		dev_err(&pdev->dev, "no platform data\n");
		return -EINVAL;
	}

1742
	mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1743
	if (!mem) {
1744
		dev_warn(mcasp->dev,
1745 1746 1747 1748 1749 1750
			 "\"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;
		}
1751 1752
	}

1753 1754 1755
	mcasp->base = devm_ioremap_resource(&pdev->dev, mem);
	if (IS_ERR(mcasp->base))
		return PTR_ERR(mcasp->base);
1756

1757
	pm_runtime_enable(&pdev->dev);
1758

1759
	mcasp->op_mode = pdata->op_mode;
1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774
	/* sanity check for tdm slots parameter */
	if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE) {
		if (pdata->tdm_slots < 2) {
			dev_err(&pdev->dev, "invalid tdm slots: %d\n",
				pdata->tdm_slots);
			mcasp->tdm_slots = 2;
		} else if (pdata->tdm_slots > 32) {
			dev_err(&pdev->dev, "invalid tdm slots: %d\n",
				pdata->tdm_slots);
			mcasp->tdm_slots = 32;
		} else {
			mcasp->tdm_slots = pdata->tdm_slots;
		}
	}

1775
	mcasp->num_serializer = pdata->num_serializer;
1776 1777 1778 1779 1780
#ifdef CONFIG_PM_SLEEP
	mcasp->context.xrsr_regs = devm_kzalloc(&pdev->dev,
					sizeof(u32) * mcasp->num_serializer,
					GFP_KERNEL);
#endif
1781 1782 1783 1784
	mcasp->serial_dir = pdata->serial_dir;
	mcasp->version = pdata->version;
	mcasp->txnumevt = pdata->txnumevt;
	mcasp->rxnumevt = pdata->rxnumevt;
1785

1786
	mcasp->dev = &pdev->dev;
1787

1788 1789
	irq = platform_get_irq_byname(pdev, "common");
	if (irq >= 0) {
1790
		irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_common",
1791 1792 1793
					  dev_name(&pdev->dev));
		ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
						davinci_mcasp_common_irq_handler,
1794 1795
						IRQF_ONESHOT | IRQF_SHARED,
						irq_name, mcasp);
1796 1797 1798 1799 1800 1801 1802 1803 1804
		if (ret) {
			dev_err(&pdev->dev, "common IRQ request failed\n");
			goto err;
		}

		mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
		mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
	}

1805 1806
	irq = platform_get_irq_byname(pdev, "rx");
	if (irq >= 0) {
1807
		irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_rx",
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821
					  dev_name(&pdev->dev));
		ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
						davinci_mcasp_rx_irq_handler,
						IRQF_ONESHOT, irq_name, mcasp);
		if (ret) {
			dev_err(&pdev->dev, "RX IRQ request failed\n");
			goto err;
		}

		mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
	}

	irq = platform_get_irq_byname(pdev, "tx");
	if (irq >= 0) {
1822
		irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_tx",
1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834
					  dev_name(&pdev->dev));
		ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
						davinci_mcasp_tx_irq_handler,
						IRQF_ONESHOT, irq_name, mcasp);
		if (ret) {
			dev_err(&pdev->dev, "TX IRQ request failed\n");
			goto err;
		}

		mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
	}

1835
	dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
1836 1837
	if (dat)
		mcasp->dat_port = true;
1838

1839
	dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1840
	if (dat)
1841
		dma_data->addr = dat->start;
1842
	else
1843
		dma_data->addr = mem->start + pdata->tx_dma_offset;
1844

1845
	dma = &mcasp->dma_request[SNDRV_PCM_STREAM_PLAYBACK];
1846
	res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1847
	if (res)
1848
		*dma = res->start;
1849
	else
1850
		*dma = pdata->tx_dma_channel;
1851

1852 1853 1854 1855
	/* dmaengine filter data for DT and non-DT boot */
	if (pdev->dev.of_node)
		dma_data->filter_data = "tx";
	else
1856
		dma_data->filter_data = dma;
1857

1858 1859 1860 1861
	/* RX is not valid in DIT mode */
	if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
		dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
		if (dat)
1862
			dma_data->addr = dat->start;
1863
		else
1864
			dma_data->addr = mem->start + pdata->rx_dma_offset;
1865

1866
		dma = &mcasp->dma_request[SNDRV_PCM_STREAM_CAPTURE];
1867 1868
		res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
		if (res)
1869
			*dma = res->start;
1870
		else
1871
			*dma = pdata->rx_dma_channel;
1872 1873 1874 1875 1876

		/* dmaengine filter data for DT and non-DT boot */
		if (pdev->dev.of_node)
			dma_data->filter_data = "rx";
		else
1877
			dma_data->filter_data = dma;
1878
	}
1879

1880 1881
	if (mcasp->version < MCASP_VERSION_3) {
		mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
1882
		/* dma_params->dma_addr is pointing to the data port address */
1883 1884 1885 1886
		mcasp->dat_port = true;
	} else {
		mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
	}
1887

1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909
	/* Allocate memory for long enough list for all possible
	 * scenarios. Maximum number tdm slots is 32 and there cannot
	 * be more serializers than given in the configuration.  The
	 * serializer directions could be taken into account, but it
	 * would make code much more complex and save only couple of
	 * bytes.
	 */
	mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list =
		devm_kzalloc(mcasp->dev, sizeof(unsigned int) *
			     (32 + mcasp->num_serializer - 2),
			     GFP_KERNEL);

	mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list =
		devm_kzalloc(mcasp->dev, sizeof(unsigned int) *
			     (32 + mcasp->num_serializer - 2),
			     GFP_KERNEL);

	if (!mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list ||
	    !mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list)
		return -ENOMEM;

	ret = davinci_mcasp_set_ch_constraints(mcasp);
1910 1911 1912
	if (ret)
		goto err;

1913
	dev_set_drvdata(&pdev->dev, mcasp);
1914 1915 1916

	mcasp_reparent_fck(pdev);

1917 1918 1919
	ret = devm_snd_soc_register_component(&pdev->dev,
					&davinci_mcasp_component,
					&davinci_mcasp_dai[pdata->op_mode], 1);
1920 1921

	if (ret != 0)
1922
		goto err;
1923

1924 1925 1926
	ret = davinci_mcasp_get_dma_type(mcasp);
	switch (ret) {
	case PCM_EDMA:
1927 1928 1929 1930
#if IS_BUILTIN(CONFIG_SND_EDMA_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_EDMA_SOC))
		ret = edma_pcm_platform_register(&pdev->dev);
1931 1932 1933 1934
#else
		dev_err(&pdev->dev, "Missing SND_EDMA_SOC\n");
		ret = -EINVAL;
		goto err;
1935
#endif
1936 1937
		break;
	case PCM_SDMA:
1938 1939 1940
#if IS_BUILTIN(CONFIG_SND_OMAP_SOC) || \
	(IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
	 IS_MODULE(CONFIG_SND_OMAP_SOC))
1941
		ret = omap_pcm_platform_register(&pdev->dev);
1942 1943 1944 1945
#else
		dev_err(&pdev->dev, "Missing SND_SDMA_SOC\n");
		ret = -EINVAL;
		goto err;
1946
#endif
1947
		break;
1948
	default:
1949 1950 1951
		dev_err(&pdev->dev, "No DMA controller found (%d)\n", ret);
	case -EPROBE_DEFER:
		goto err;
1952 1953 1954 1955 1956
		break;
	}

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

1960 1961
	return 0;

1962
err:
1963
	pm_runtime_disable(&pdev->dev);
1964 1965 1966 1967 1968
	return ret;
}

static int davinci_mcasp_remove(struct platform_device *pdev)
{
1969
	pm_runtime_disable(&pdev->dev);
1970 1971 1972 1973 1974 1975 1976 1977 1978

	return 0;
}

static struct platform_driver davinci_mcasp_driver = {
	.probe		= davinci_mcasp_probe,
	.remove		= davinci_mcasp_remove,
	.driver		= {
		.name	= "davinci-mcasp",
1979
		.of_match_table = mcasp_dt_ids,
1980 1981 1982
	},
};

1983
module_platform_driver(davinci_mcasp_driver);
1984 1985 1986 1987

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