]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - sound/soc/davinci/davinci-mcasp.c
ASoC: davinci-mcasp: Add set_tdm_slots() support
[mirror_ubuntu-bionic-kernel.git] / sound / soc / davinci / davinci-mcasp.c
CommitLineData
b67f4487
C
1/*
2 * ALSA SoC McASP Audio Layer for TI DAVINCI processor
3 *
4 * Multi-channel Audio Serial Port Driver
5 *
6 * Author: Nirmal Pandey <n-pandey@ti.com>,
7 * Suresh Rajashekara <suresh.r@ti.com>
8 * Steve Chen <schen@.mvista.com>
9 *
10 * Copyright: (C) 2009 MontaVista Software, Inc., <source@mvista.com>
11 * Copyright: (C) 2009 Texas Instruments, India
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License version 2 as
15 * published by the Free Software Foundation.
16 */
17
18#include <linux/init.h>
19#include <linux/module.h>
20#include <linux/device.h>
5a0e3ad6 21#include <linux/slab.h>
b67f4487
C
22#include <linux/delay.h>
23#include <linux/io.h>
ae726e93 24#include <linux/clk.h>
10884347 25#include <linux/pm_runtime.h>
3e3b8c34
HG
26#include <linux/of.h>
27#include <linux/of_platform.h>
28#include <linux/of_device.h>
9759e7ef 29#include <linux/platform_data/davinci_asp.h>
a75a053f 30#include <linux/math64.h>
b67f4487 31
6479285d 32#include <sound/asoundef.h>
b67f4487
C
33#include <sound/core.h>
34#include <sound/pcm.h>
35#include <sound/pcm_params.h>
36#include <sound/initval.h>
37#include <sound/soc.h>
453c4990 38#include <sound/dmaengine_pcm.h>
87c19364 39#include <sound/omap-pcm.h>
b67f4487 40
f3f9cfa8 41#include "edma-pcm.h"
b67f4487
C
42#include "davinci-mcasp.h"
43
0bf0e8ae
PU
44#define MCASP_MAX_AFIFO_DEPTH 64
45
1cc0c054
PU
46static u32 context_regs[] = {
47 DAVINCI_MCASP_TXFMCTL_REG,
48 DAVINCI_MCASP_RXFMCTL_REG,
49 DAVINCI_MCASP_TXFMT_REG,
50 DAVINCI_MCASP_RXFMT_REG,
51 DAVINCI_MCASP_ACLKXCTL_REG,
52 DAVINCI_MCASP_ACLKRCTL_REG,
f114ce60
PU
53 DAVINCI_MCASP_AHCLKXCTL_REG,
54 DAVINCI_MCASP_AHCLKRCTL_REG,
1cc0c054 55 DAVINCI_MCASP_PDIR_REG,
f114ce60
PU
56 DAVINCI_MCASP_RXMASK_REG,
57 DAVINCI_MCASP_TXMASK_REG,
58 DAVINCI_MCASP_RXTDM_REG,
59 DAVINCI_MCASP_TXTDM_REG,
1cc0c054
PU
60};
61
790bb94b 62struct davinci_mcasp_context {
1cc0c054 63 u32 config_regs[ARRAY_SIZE(context_regs)];
f114ce60
PU
64 u32 afifo_regs[2]; /* for read/write fifo control registers */
65 u32 *xrsr_regs; /* for serializer configuration */
6afda7f5 66 bool pm_state;
790bb94b
PU
67};
68
a75a053f
JS
69struct davinci_mcasp_ruledata {
70 struct davinci_mcasp *mcasp;
71 int serializers;
72};
73
70091a3e 74struct davinci_mcasp {
453c4990 75 struct snd_dmaengine_dai_dma_data dma_data[2];
21400a72 76 void __iomem *base;
487dce88 77 u32 fifo_base;
21400a72 78 struct device *dev;
a7a3324a 79 struct snd_pcm_substream *substreams[2];
21400a72
PU
80
81 /* McASP specific data */
82 int tdm_slots;
dd55ff83
JS
83 u32 tdm_mask[2];
84 int slot_width;
21400a72
PU
85 u8 op_mode;
86 u8 num_serializer;
87 u8 *serial_dir;
88 u8 version;
8267525c 89 u8 bclk_div;
21400a72 90 u16 bclk_lrclk_ratio;
4dcb5a0b 91 int streams;
a7a3324a 92 u32 irq_request[2];
9759e7ef 93 int dma_request[2];
21400a72 94
ab8b14b6
JS
95 int sysclk_freq;
96 bool bclk_master;
97
21400a72
PU
98 /* McASP FIFO related */
99 u8 txnumevt;
100 u8 rxnumevt;
101
cbc7956c
PU
102 bool dat_port;
103
11277833
PU
104 /* Used for comstraint setting on the second stream */
105 u32 channels;
106
21400a72 107#ifdef CONFIG_PM_SLEEP
790bb94b 108 struct davinci_mcasp_context context;
21400a72 109#endif
a75a053f
JS
110
111 struct davinci_mcasp_ruledata ruledata[2];
5935a056 112 struct snd_pcm_hw_constraint_list chconstr[2];
21400a72
PU
113};
114
f68205a7
PU
115static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
116 u32 val)
b67f4487 117{
f68205a7 118 void __iomem *reg = mcasp->base + offset;
b67f4487
C
119 __raw_writel(__raw_readl(reg) | val, reg);
120}
121
f68205a7
PU
122static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
123 u32 val)
b67f4487 124{
f68205a7 125 void __iomem *reg = mcasp->base + offset;
b67f4487
C
126 __raw_writel((__raw_readl(reg) & ~(val)), reg);
127}
128
f68205a7
PU
129static inline void mcasp_mod_bits(struct davinci_mcasp *mcasp, u32 offset,
130 u32 val, u32 mask)
b67f4487 131{
f68205a7 132 void __iomem *reg = mcasp->base + offset;
b67f4487
C
133 __raw_writel((__raw_readl(reg) & ~mask) | val, reg);
134}
135
f68205a7
PU
136static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
137 u32 val)
b67f4487 138{
f68205a7 139 __raw_writel(val, mcasp->base + offset);
b67f4487
C
140}
141
f68205a7 142static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
b67f4487 143{
f68205a7 144 return (u32)__raw_readl(mcasp->base + offset);
b67f4487
C
145}
146
f68205a7 147static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
b67f4487
C
148{
149 int i = 0;
150
f68205a7 151 mcasp_set_bits(mcasp, ctl_reg, val);
b67f4487
C
152
153 /* programming GBLCTL needs to read back from GBLCTL and verfiy */
154 /* loop count is to avoid the lock-up */
155 for (i = 0; i < 1000; i++) {
f68205a7 156 if ((mcasp_get_reg(mcasp, ctl_reg) & val) == val)
b67f4487
C
157 break;
158 }
159
f68205a7 160 if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
b67f4487
C
161 printk(KERN_ERR "GBLCTL write error\n");
162}
163
4dcb5a0b
PU
164static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
165{
f68205a7
PU
166 u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
167 u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
4dcb5a0b
PU
168
169 return !(aclkxctl & TX_ASYNC) && rxfmctl & AFSRE;
170}
171
70091a3e 172static void mcasp_start_rx(struct davinci_mcasp *mcasp)
b67f4487 173{
bb372af0
PU
174 if (mcasp->rxnumevt) { /* enable FIFO */
175 u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
176
177 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
178 mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
179 }
180
44982735 181 /* Start clocks */
f68205a7
PU
182 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
183 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
4dcb5a0b
PU
184 /*
185 * When ASYNC == 0 the transmit and receive sections operate
186 * synchronously from the transmit clock and frame sync. We need to make
187 * sure that the TX signlas are enabled when starting reception.
188 */
189 if (mcasp_is_synchronous(mcasp)) {
f68205a7
PU
190 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
191 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
4dcb5a0b
PU
192 }
193
44982735 194 /* Activate serializer(s) */
f68205a7 195 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
44982735 196 /* Release RX state machine */
f68205a7 197 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
44982735 198 /* Release Frame Sync generator */
f68205a7 199 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
4dcb5a0b 200 if (mcasp_is_synchronous(mcasp))
f68205a7 201 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
a7a3324a
MLC
202
203 /* enable receive IRQs */
204 mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
205 mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);
b67f4487
C
206}
207
70091a3e 208static void mcasp_start_tx(struct davinci_mcasp *mcasp)
b67f4487 209{
6a99fb5f
C
210 u32 cnt;
211
bb372af0
PU
212 if (mcasp->txnumevt) { /* enable FIFO */
213 u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
214
215 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
216 mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
217 }
218
36bcecd0 219 /* Start clocks */
f68205a7
PU
220 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
221 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
36bcecd0 222 /* Activate serializer(s) */
f68205a7 223 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
b67f4487 224
36bcecd0 225 /* wait for XDATA to be cleared */
6a99fb5f 226 cnt = 0;
36bcecd0
PU
227 while (!(mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG) &
228 ~XRDATA) && (cnt < 100000))
6a99fb5f
C
229 cnt++;
230
36bcecd0
PU
231 /* Release TX state machine */
232 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
233 /* Release Frame Sync generator */
234 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
a7a3324a
MLC
235
236 /* enable transmit IRQs */
237 mcasp_set_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
238 mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);
b67f4487
C
239}
240
70091a3e 241static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
b67f4487 242{
4dcb5a0b
PU
243 mcasp->streams++;
244
bb372af0 245 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
70091a3e 246 mcasp_start_tx(mcasp);
bb372af0 247 else
70091a3e 248 mcasp_start_rx(mcasp);
b67f4487
C
249}
250
70091a3e 251static void mcasp_stop_rx(struct davinci_mcasp *mcasp)
b67f4487 252{
a7a3324a
MLC
253 /* disable IRQ sources */
254 mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLR_REG,
255 mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE]);
256
4dcb5a0b
PU
257 /*
258 * In synchronous mode stop the TX clocks if no other stream is
259 * running
260 */
261 if (mcasp_is_synchronous(mcasp) && !mcasp->streams)
f68205a7 262 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, 0);
4dcb5a0b 263
f68205a7
PU
264 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
265 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
0380866a
PU
266
267 if (mcasp->rxnumevt) { /* disable FIFO */
268 u32 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
269
270 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
271 }
b67f4487
C
272}
273
70091a3e 274static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
b67f4487 275{
4dcb5a0b
PU
276 u32 val = 0;
277
a7a3324a
MLC
278 /* disable IRQ sources */
279 mcasp_clr_bits(mcasp, DAVINCI_MCASP_EVTCTLX_REG,
280 mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK]);
281
4dcb5a0b
PU
282 /*
283 * In synchronous mode keep TX clocks running if the capture stream is
284 * still running.
285 */
286 if (mcasp_is_synchronous(mcasp) && mcasp->streams)
287 val = TXHCLKRST | TXCLKRST | TXFSRST;
288
f68205a7
PU
289 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
290 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
0380866a
PU
291
292 if (mcasp->txnumevt) { /* disable FIFO */
293 u32 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
294
295 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
296 }
b67f4487
C
297}
298
70091a3e 299static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
b67f4487 300{
4dcb5a0b
PU
301 mcasp->streams--;
302
0380866a 303 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
70091a3e 304 mcasp_stop_tx(mcasp);
0380866a 305 else
70091a3e 306 mcasp_stop_rx(mcasp);
b67f4487
C
307}
308
a7a3324a
MLC
309static irqreturn_t davinci_mcasp_tx_irq_handler(int irq, void *data)
310{
311 struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
312 struct snd_pcm_substream *substream;
313 u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK];
314 u32 handled_mask = 0;
315 u32 stat;
316
317 stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG);
318 if (stat & XUNDRN & irq_mask) {
319 dev_warn(mcasp->dev, "Transmit buffer underflow\n");
320 handled_mask |= XUNDRN;
321
322 substream = mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK];
323 if (substream) {
324 snd_pcm_stream_lock_irq(substream);
325 if (snd_pcm_running(substream))
326 snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
327 snd_pcm_stream_unlock_irq(substream);
328 }
329 }
330
331 if (!handled_mask)
332 dev_warn(mcasp->dev, "unhandled tx event. txstat: 0x%08x\n",
333 stat);
334
335 if (stat & XRERR)
336 handled_mask |= XRERR;
337
338 /* Ack the handled event only */
339 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, handled_mask);
340
341 return IRQ_RETVAL(handled_mask);
342}
343
344static irqreturn_t davinci_mcasp_rx_irq_handler(int irq, void *data)
345{
346 struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
347 struct snd_pcm_substream *substream;
348 u32 irq_mask = mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE];
349 u32 handled_mask = 0;
350 u32 stat;
351
352 stat = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG);
353 if (stat & ROVRN & irq_mask) {
354 dev_warn(mcasp->dev, "Receive buffer overflow\n");
355 handled_mask |= ROVRN;
356
357 substream = mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE];
358 if (substream) {
359 snd_pcm_stream_lock_irq(substream);
360 if (snd_pcm_running(substream))
361 snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN);
362 snd_pcm_stream_unlock_irq(substream);
363 }
364 }
365
366 if (!handled_mask)
367 dev_warn(mcasp->dev, "unhandled rx event. rxstat: 0x%08x\n",
368 stat);
369
370 if (stat & XRERR)
371 handled_mask |= XRERR;
372
373 /* Ack the handled event only */
374 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, handled_mask);
375
376 return IRQ_RETVAL(handled_mask);
377}
378
5a1b8a80
PU
379static irqreturn_t davinci_mcasp_common_irq_handler(int irq, void *data)
380{
381 struct davinci_mcasp *mcasp = (struct davinci_mcasp *)data;
382 irqreturn_t ret = IRQ_NONE;
383
384 if (mcasp->substreams[SNDRV_PCM_STREAM_PLAYBACK])
385 ret = davinci_mcasp_tx_irq_handler(irq, data);
386
387 if (mcasp->substreams[SNDRV_PCM_STREAM_CAPTURE])
388 ret |= davinci_mcasp_rx_irq_handler(irq, data);
389
390 return ret;
391}
392
b67f4487
C
393static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
394 unsigned int fmt)
395{
70091a3e 396 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
1d17a04e 397 int ret = 0;
6dfa9a4e 398 u32 data_delay;
83f12503 399 bool fs_pol_rising;
ffd950f7 400 bool inv_fs = false;
b67f4487 401
1d17a04e 402 pm_runtime_get_sync(mcasp->dev);
5296cf2d 403 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
188edc59
PU
404 case SND_SOC_DAIFMT_DSP_A:
405 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
406 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
188edc59
PU
407 /* 1st data bit occur one ACLK cycle after the frame sync */
408 data_delay = 1;
409 break;
5296cf2d
DM
410 case SND_SOC_DAIFMT_DSP_B:
411 case SND_SOC_DAIFMT_AC97:
f68205a7
PU
412 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
413 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
6dfa9a4e
PU
414 /* No delay after FS */
415 data_delay = 0;
5296cf2d 416 break;
ffd950f7 417 case SND_SOC_DAIFMT_I2S:
5296cf2d 418 /* configure a full-word SYNC pulse (LRCLK) */
f68205a7
PU
419 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
420 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
6dfa9a4e
PU
421 /* 1st data bit occur one ACLK cycle after the frame sync */
422 data_delay = 1;
ffd950f7
PU
423 /* FS need to be inverted */
424 inv_fs = true;
5296cf2d 425 break;
423761e0
PU
426 case SND_SOC_DAIFMT_LEFT_J:
427 /* configure a full-word SYNC pulse (LRCLK) */
428 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
429 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
430 /* No delay after FS */
431 data_delay = 0;
432 break;
ffd950f7
PU
433 default:
434 ret = -EINVAL;
435 goto out;
5296cf2d
DM
436 }
437
6dfa9a4e
PU
438 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, FSXDLY(data_delay),
439 FSXDLY(3));
440 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, FSRDLY(data_delay),
441 FSRDLY(3));
442
b67f4487
C
443 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
444 case SND_SOC_DAIFMT_CBS_CFS:
445 /* codec is clock and frame slave */
f68205a7
PU
446 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
447 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
b67f4487 448
f68205a7
PU
449 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
450 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
b67f4487 451
f68205a7
PU
452 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
453 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
ab8b14b6 454 mcasp->bclk_master = 1;
b67f4487 455 break;
226e2f1b
PU
456 case SND_SOC_DAIFMT_CBS_CFM:
457 /* codec is clock slave and frame master */
458 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
459 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
460
461 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
462 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
463
464 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
465 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
466 mcasp->bclk_master = 1;
467 break;
517ee6cf
C
468 case SND_SOC_DAIFMT_CBM_CFS:
469 /* codec is clock master and frame slave */
f68205a7
PU
470 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
471 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
517ee6cf 472
f68205a7
PU
473 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
474 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
517ee6cf 475
f68205a7
PU
476 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
477 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
ab8b14b6 478 mcasp->bclk_master = 0;
517ee6cf 479 break;
b67f4487
C
480 case SND_SOC_DAIFMT_CBM_CFM:
481 /* codec is clock and frame master */
f68205a7
PU
482 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
483 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
b67f4487 484
f68205a7
PU
485 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
486 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
b67f4487 487
f68205a7
PU
488 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
489 ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
ab8b14b6 490 mcasp->bclk_master = 0;
b67f4487 491 break;
b67f4487 492 default:
1d17a04e
PU
493 ret = -EINVAL;
494 goto out;
b67f4487
C
495 }
496
497 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
498 case SND_SOC_DAIFMT_IB_NF:
f68205a7 499 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
74ddd8c4 500 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
83f12503 501 fs_pol_rising = true;
b67f4487 502 break;
b67f4487 503 case SND_SOC_DAIFMT_NB_IF:
f68205a7 504 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
74ddd8c4 505 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
83f12503 506 fs_pol_rising = false;
b67f4487 507 break;
b67f4487 508 case SND_SOC_DAIFMT_IB_IF:
f68205a7 509 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
74ddd8c4 510 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
83f12503 511 fs_pol_rising = false;
b67f4487 512 break;
b67f4487 513 case SND_SOC_DAIFMT_NB_NF:
f68205a7 514 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
f68205a7 515 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
83f12503 516 fs_pol_rising = true;
b67f4487 517 break;
b67f4487 518 default:
1d17a04e 519 ret = -EINVAL;
83f12503
PU
520 goto out;
521 }
522
ffd950f7
PU
523 if (inv_fs)
524 fs_pol_rising = !fs_pol_rising;
525
83f12503
PU
526 if (fs_pol_rising) {
527 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
528 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
529 } else {
530 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
531 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
b67f4487 532 }
1d17a04e 533out:
6afda7f5 534 pm_runtime_put(mcasp->dev);
1d17a04e 535 return ret;
b67f4487
C
536}
537
8813543e
JS
538static int __davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
539 int div, bool explicit)
4ed8c9b7 540{
70091a3e 541 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
4ed8c9b7 542
6afda7f5 543 pm_runtime_get_sync(mcasp->dev);
4ed8c9b7
DM
544 switch (div_id) {
545 case 0: /* MCLK divider */
f68205a7 546 mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
4ed8c9b7 547 AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
f68205a7 548 mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
4ed8c9b7
DM
549 AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
550 break;
551
552 case 1: /* BCLK divider */
f68205a7 553 mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
4ed8c9b7 554 ACLKXDIV(div - 1), ACLKXDIV_MASK);
f68205a7 555 mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
4ed8c9b7 556 ACLKRDIV(div - 1), ACLKRDIV_MASK);
8813543e
JS
557 if (explicit)
558 mcasp->bclk_div = div;
4ed8c9b7
DM
559 break;
560
1b3bc060 561 case 2: /* BCLK/LRCLK ratio */
70091a3e 562 mcasp->bclk_lrclk_ratio = div;
1b3bc060
DM
563 break;
564
4ed8c9b7
DM
565 default:
566 return -EINVAL;
567 }
568
6afda7f5 569 pm_runtime_put(mcasp->dev);
4ed8c9b7
DM
570 return 0;
571}
572
8813543e
JS
573static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id,
574 int div)
575{
576 return __davinci_mcasp_set_clkdiv(dai, div_id, div, 1);
577}
578
5b66aa2d
DM
579static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
580 unsigned int freq, int dir)
581{
70091a3e 582 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
5b66aa2d 583
6afda7f5 584 pm_runtime_get_sync(mcasp->dev);
5b66aa2d 585 if (dir == SND_SOC_CLOCK_OUT) {
f68205a7
PU
586 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
587 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
588 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
5b66aa2d 589 } else {
f68205a7
PU
590 mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
591 mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
592 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
5b66aa2d
DM
593 }
594
ab8b14b6
JS
595 mcasp->sysclk_freq = freq;
596
6afda7f5 597 pm_runtime_put(mcasp->dev);
5b66aa2d
DM
598 return 0;
599}
600
dd55ff83
JS
601/* All serializers must have equal number of channels */
602static int davinci_mcasp_ch_constraint(struct davinci_mcasp *mcasp, int stream,
603 int serializers)
604{
605 struct snd_pcm_hw_constraint_list *cl = &mcasp->chconstr[stream];
606 unsigned int *list = (unsigned int *) cl->list;
607 int slots = mcasp->tdm_slots;
608 int i, count = 0;
609
610 if (mcasp->tdm_mask[stream])
611 slots = hweight32(mcasp->tdm_mask[stream]);
612
613 for (i = 2; i <= slots; i++)
614 list[count++] = i;
615
616 for (i = 2; i <= serializers; i++)
617 list[count++] = i*slots;
618
619 cl->count = count;
620
621 return 0;
622}
623
624static int davinci_mcasp_set_ch_constraints(struct davinci_mcasp *mcasp)
625{
626 int rx_serializers = 0, tx_serializers = 0, ret, i;
627
628 for (i = 0; i < mcasp->num_serializer; i++)
629 if (mcasp->serial_dir[i] == TX_MODE)
630 tx_serializers++;
631 else if (mcasp->serial_dir[i] == RX_MODE)
632 rx_serializers++;
633
634 ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_PLAYBACK,
635 tx_serializers);
636 if (ret)
637 return ret;
638
639 ret = davinci_mcasp_ch_constraint(mcasp, SNDRV_PCM_STREAM_CAPTURE,
640 rx_serializers);
641
642 return ret;
643}
644
645
646static int davinci_mcasp_set_tdm_slot(struct snd_soc_dai *dai,
647 unsigned int tx_mask,
648 unsigned int rx_mask,
649 int slots, int slot_width)
650{
651 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
652
653 dev_dbg(mcasp->dev,
654 "%s() tx_mask 0x%08x rx_mask 0x%08x slots %d width %d\n",
655 __func__, tx_mask, rx_mask, slots, slot_width);
656
657 if (tx_mask >= (1<<slots) || rx_mask >= (1<<slots)) {
658 dev_err(mcasp->dev,
659 "Bad tdm mask tx: 0x%08x rx: 0x%08x slots %d\n",
660 tx_mask, rx_mask, slots);
661 return -EINVAL;
662 }
663
664 if (slot_width &&
665 (slot_width < 8 || slot_width > 32 || slot_width % 4 != 0)) {
666 dev_err(mcasp->dev, "%s: Unsupported slot_width %d\n",
667 __func__, slot_width);
668 return -EINVAL;
669 }
670
671 mcasp->tdm_slots = slots;
672 mcasp->tdm_mask[SNDRV_PCM_STREAM_PLAYBACK] = rx_mask;
673 mcasp->tdm_mask[SNDRV_PCM_STREAM_CAPTURE] = tx_mask;
674 mcasp->slot_width = slot_width;
675
676 return davinci_mcasp_set_ch_constraints(mcasp);
677}
678
70091a3e 679static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
ba764b3d 680 int word_length)
b67f4487 681{
ba764b3d 682 u32 fmt;
79671892 683 u32 tx_rotate = (word_length / 4) & 0x7;
ba764b3d 684 u32 mask = (1ULL << word_length) - 1;
fe0a29e1
PU
685 /*
686 * For captured data we should not rotate, inversion and masking is
687 * enoguh to get the data to the right position:
688 * Format data from bus after reverse (XRBUF)
689 * S16_LE: |LSB|MSB|xxx|xxx| |xxx|xxx|MSB|LSB|
690 * S24_3LE: |LSB|DAT|MSB|xxx| |xxx|MSB|DAT|LSB|
691 * S24_LE: |LSB|DAT|MSB|xxx| |xxx|MSB|DAT|LSB|
692 * S32_LE: |LSB|DAT|DAT|MSB| |MSB|DAT|DAT|LSB|
693 */
694 u32 rx_rotate = 0;
b67f4487 695
1b3bc060
DM
696 /*
697 * if s BCLK-to-LRCLK ratio has been configured via the set_clkdiv()
698 * callback, take it into account here. That allows us to for example
699 * send 32 bits per channel to the codec, while only 16 of them carry
700 * audio payload.
d486fea6
MB
701 * The clock ratio is given for a full period of data (for I2S format
702 * both left and right channels), so it has to be divided by number of
703 * tdm-slots (for I2S - divided by 2).
1b3bc060 704 */
d742b925
PU
705 if (mcasp->bclk_lrclk_ratio) {
706 u32 slot_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
707
708 /*
709 * When we have more bclk then it is needed for the data, we
710 * need to use the rotation to move the received samples to have
711 * correct alignment.
712 */
713 rx_rotate = (slot_length - word_length) / 4;
714 word_length = slot_length;
dd55ff83
JS
715 } else if (mcasp->slot_width) {
716 rx_rotate = (mcasp->slot_width - word_length) / 4;
717 word_length = mcasp->slot_width;
d742b925 718 }
1b3bc060 719
ba764b3d
DM
720 /* mapping of the XSSZ bit-field as described in the datasheet */
721 fmt = (word_length >> 1) - 1;
b67f4487 722
70091a3e 723 if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
f68205a7
PU
724 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXSSZ(fmt),
725 RXSSZ(0x0F));
726 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXSSZ(fmt),
727 TXSSZ(0x0F));
728 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(tx_rotate),
729 TXROT(7));
730 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXROT(rx_rotate),
731 RXROT(7));
732 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXMASK_REG, mask);
f5023af6
YY
733 }
734
f68205a7 735 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
0c31cf3e 736
b67f4487
C
737 return 0;
738}
739
662ffae9 740static int mcasp_common_hw_param(struct davinci_mcasp *mcasp, int stream,
dd093a0f 741 int period_words, int channels)
b67f4487 742{
5f04c603 743 struct snd_dmaengine_dai_dma_data *dma_data = &mcasp->dma_data[stream];
b67f4487 744 int i;
6a99fb5f
C
745 u8 tx_ser = 0;
746 u8 rx_ser = 0;
70091a3e 747 u8 slots = mcasp->tdm_slots;
2952b27e 748 u8 max_active_serializers = (channels + slots - 1) / slots;
dd093a0f 749 int active_serializers, numevt, n;
487dce88 750 u32 reg;
b67f4487 751 /* Default configuration */
40448e5e 752 if (mcasp->version < MCASP_VERSION_3)
f68205a7 753 mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
b67f4487
C
754
755 /* All PINS as McASP */
f68205a7 756 mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
b67f4487
C
757
758 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
f68205a7
PU
759 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
760 mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
b67f4487 761 } else {
f68205a7
PU
762 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
763 mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
b67f4487
C
764 }
765
70091a3e 766 for (i = 0; i < mcasp->num_serializer; i++) {
f68205a7
PU
767 mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
768 mcasp->serial_dir[i]);
70091a3e 769 if (mcasp->serial_dir[i] == TX_MODE &&
2952b27e 770 tx_ser < max_active_serializers) {
f68205a7 771 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
19db62ea
MLC
772 mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
773 DISMOD_LOW, DISMOD_MASK);
6a99fb5f 774 tx_ser++;
70091a3e 775 } else if (mcasp->serial_dir[i] == RX_MODE &&
2952b27e 776 rx_ser < max_active_serializers) {
f68205a7 777 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
6a99fb5f 778 rx_ser++;
2952b27e 779 } else {
f68205a7
PU
780 mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
781 SRMOD_INACTIVE, SRMOD_MASK);
6a99fb5f
C
782 }
783 }
784
0bf0e8ae
PU
785 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
786 active_serializers = tx_ser;
787 numevt = mcasp->txnumevt;
788 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
789 } else {
790 active_serializers = rx_ser;
791 numevt = mcasp->rxnumevt;
792 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
793 }
ecf327c7 794
0bf0e8ae 795 if (active_serializers < max_active_serializers) {
70091a3e 796 dev_warn(mcasp->dev, "stream has more channels (%d) than are "
0bf0e8ae
PU
797 "enabled in mcasp (%d)\n", channels,
798 active_serializers * slots);
ecf327c7
DM
799 return -EINVAL;
800 }
801
0bf0e8ae 802 /* AFIFO is not in use */
5f04c603
PU
803 if (!numevt) {
804 /* Configure the burst size for platform drivers */
33445643
PU
805 if (active_serializers > 1) {
806 /*
807 * If more than one serializers are in use we have one
808 * DMA request to provide data for all serializers.
809 * For example if three serializers are enabled the DMA
810 * need to transfer three words per DMA request.
811 */
33445643
PU
812 dma_data->maxburst = active_serializers;
813 } else {
33445643
PU
814 dma_data->maxburst = 0;
815 }
0bf0e8ae 816 return 0;
5f04c603 817 }
6a99fb5f 818
dd093a0f
PU
819 if (period_words % active_serializers) {
820 dev_err(mcasp->dev, "Invalid combination of period words and "
821 "active serializers: %d, %d\n", period_words,
822 active_serializers);
823 return -EINVAL;
824 }
825
826 /*
827 * Calculate the optimal AFIFO depth for platform side:
828 * The number of words for numevt need to be in steps of active
829 * serializers.
830 */
831 n = numevt % active_serializers;
832 if (n)
833 numevt += (active_serializers - n);
834 while (period_words % numevt && numevt > 0)
835 numevt -= active_serializers;
836 if (numevt <= 0)
0bf0e8ae 837 numevt = active_serializers;
487dce88 838
0bf0e8ae
PU
839 mcasp_mod_bits(mcasp, reg, active_serializers, NUMDMA_MASK);
840 mcasp_mod_bits(mcasp, reg, NUMEVT(numevt), NUMEVT_MASK);
2952b27e 841
5f04c603 842 /* Configure the burst size for platform drivers */
33445643
PU
843 if (numevt == 1)
844 numevt = 0;
5f04c603
PU
845 dma_data->maxburst = numevt;
846
2952b27e 847 return 0;
b67f4487
C
848}
849
18a4f557
MLC
850static int mcasp_i2s_hw_param(struct davinci_mcasp *mcasp, int stream,
851 int channels)
b67f4487
C
852{
853 int i, active_slots;
18a4f557
MLC
854 int total_slots;
855 int active_serializers;
b67f4487 856 u32 mask = 0;
cbc7956c 857 u32 busel = 0;
b67f4487 858
18a4f557
MLC
859 total_slots = mcasp->tdm_slots;
860
861 /*
862 * If more than one serializer is needed, then use them with
dd55ff83
JS
863 * all the specified tdm_slots. Otherwise, one serializer can
864 * cope with the transaction using just as many slots as there
865 * are channels in the stream.
18a4f557 866 */
dd55ff83
JS
867 if (mcasp->tdm_mask[stream]) {
868 active_slots = hweight32(mcasp->tdm_mask[stream]);
869 active_serializers = (channels + active_slots - 1) /
870 active_slots;
871 if (active_serializers == 1) {
872 active_slots = channels;
873 for (i = 0; i < total_slots; i++) {
874 if ((1 << i) & mcasp->tdm_mask[stream]) {
875 mask |= (1 << i);
876 if (--active_slots <= 0)
877 break;
878 }
879 }
880 }
881 } else {
882 active_serializers = (channels + total_slots - 1) / total_slots;
883 if (active_serializers == 1)
884 active_slots = channels;
885 else
886 active_slots = total_slots;
b67f4487 887
dd55ff83
JS
888 for (i = 0; i < active_slots; i++)
889 mask |= (1 << i);
890 }
f68205a7 891 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
6a99fb5f 892
cbc7956c
PU
893 if (!mcasp->dat_port)
894 busel = TXSEL;
895
dd55ff83
JS
896 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
897 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, mask);
898 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, busel | TXORD);
899 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
900 FSXMOD(total_slots), FSXMOD(0x1FF));
901 } else if (stream == SNDRV_PCM_STREAM_CAPTURE) {
902 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXTDM_REG, mask);
903 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, busel | RXORD);
904 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG,
905 FSRMOD(total_slots), FSRMOD(0x1FF));
906 }
2c56c4c2
PU
907
908 return 0;
b67f4487
C
909}
910
911/* S/PDIF */
6479285d
DM
912static int mcasp_dit_hw_param(struct davinci_mcasp *mcasp,
913 unsigned int rate)
b67f4487 914{
6479285d
DM
915 u32 cs_value = 0;
916 u8 *cs_bytes = (u8*) &cs_value;
917
b67f4487
C
918 /* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
919 and LSB first */
f68205a7 920 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
b67f4487
C
921
922 /* Set TX frame synch : DIT Mode, 1 bit width, internal, rising edge */
f68205a7 923 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE | FSXMOD(0x180));
b67f4487
C
924
925 /* Set the TX tdm : for all the slots */
f68205a7 926 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
b67f4487
C
927
928 /* Set the TX clock controls : div = 1 and internal */
f68205a7 929 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE | TX_ASYNC);
b67f4487 930
f68205a7 931 mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
b67f4487
C
932
933 /* Only 44100 and 48000 are valid, both have the same setting */
f68205a7 934 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
b67f4487
C
935
936 /* Enable the DIT */
f68205a7 937 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
2c56c4c2 938
6479285d
DM
939 /* Set S/PDIF channel status bits */
940 cs_bytes[0] = IEC958_AES0_CON_NOT_COPYRIGHT;
941 cs_bytes[1] = IEC958_AES1_CON_PCM_CODER;
942
943 switch (rate) {
944 case 22050:
945 cs_bytes[3] |= IEC958_AES3_CON_FS_22050;
946 break;
947 case 24000:
948 cs_bytes[3] |= IEC958_AES3_CON_FS_24000;
949 break;
950 case 32000:
951 cs_bytes[3] |= IEC958_AES3_CON_FS_32000;
952 break;
953 case 44100:
954 cs_bytes[3] |= IEC958_AES3_CON_FS_44100;
955 break;
956 case 48000:
957 cs_bytes[3] |= IEC958_AES3_CON_FS_48000;
958 break;
959 case 88200:
960 cs_bytes[3] |= IEC958_AES3_CON_FS_88200;
961 break;
962 case 96000:
963 cs_bytes[3] |= IEC958_AES3_CON_FS_96000;
964 break;
965 case 176400:
966 cs_bytes[3] |= IEC958_AES3_CON_FS_176400;
967 break;
968 case 192000:
969 cs_bytes[3] |= IEC958_AES3_CON_FS_192000;
970 break;
971 default:
972 printk(KERN_WARNING "unsupported sampling rate: %d\n", rate);
973 return -EINVAL;
974 }
975
976 mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRA_REG, cs_value);
977 mcasp_set_reg(mcasp, DAVINCI_MCASP_DITCSRB_REG, cs_value);
978
2c56c4c2 979 return 0;
b67f4487
C
980}
981
a75a053f
JS
982static int davinci_mcasp_calc_clk_div(struct davinci_mcasp *mcasp,
983 unsigned int bclk_freq,
984 int *error_ppm)
985{
986 int div = mcasp->sysclk_freq / bclk_freq;
987 int rem = mcasp->sysclk_freq % bclk_freq;
988
989 if (rem != 0) {
990 if (div == 0 ||
991 ((mcasp->sysclk_freq / div) - bclk_freq) >
992 (bclk_freq - (mcasp->sysclk_freq / (div+1)))) {
993 div++;
994 rem = rem - bclk_freq;
995 }
996 }
997 if (error_ppm)
998 *error_ppm =
999 (div*1000000 + (int)div64_long(1000000LL*rem,
1000 (int)bclk_freq))
1001 /div - 1000000;
1002
1003 return div;
1004}
1005
b67f4487
C
1006static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
1007 struct snd_pcm_hw_params *params,
1008 struct snd_soc_dai *cpu_dai)
1009{
70091a3e 1010 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
b67f4487 1011 int word_length;
a7e46bd9 1012 int channels = params_channels(params);
dd093a0f 1013 int period_size = params_period_size(params);
2c56c4c2 1014 int ret;
ab8b14b6 1015
8267525c
DM
1016 /*
1017 * If mcasp is BCLK master, and a BCLK divider was not provided by
1018 * the machine driver, we need to calculate the ratio.
1019 */
1020 if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
1f114f77 1021 int slots = mcasp->tdm_slots;
a75a053f
JS
1022 int rate = params_rate(params);
1023 int sbits = params_width(params);
1024 int ppm, div;
1025
dd55ff83
JS
1026 if (mcasp->slot_width)
1027 sbits = mcasp->slot_width;
1028
1f114f77 1029 div = davinci_mcasp_calc_clk_div(mcasp, rate*sbits*slots,
a75a053f
JS
1030 &ppm);
1031 if (ppm)
1032 dev_info(mcasp->dev, "Sample-rate is off by %d PPM\n",
1033 ppm);
1034
8813543e 1035 __davinci_mcasp_set_clkdiv(cpu_dai, 1, div, 0);
ab8b14b6
JS
1036 }
1037
dd093a0f
PU
1038 ret = mcasp_common_hw_param(mcasp, substream->stream,
1039 period_size * channels, channels);
0f7d9a63
PU
1040 if (ret)
1041 return ret;
1042
70091a3e 1043 if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
6479285d 1044 ret = mcasp_dit_hw_param(mcasp, params_rate(params));
b67f4487 1045 else
18a4f557
MLC
1046 ret = mcasp_i2s_hw_param(mcasp, substream->stream,
1047 channels);
2c56c4c2
PU
1048
1049 if (ret)
1050 return ret;
b67f4487
C
1051
1052 switch (params_format(params)) {
0a9d1385 1053 case SNDRV_PCM_FORMAT_U8:
b67f4487 1054 case SNDRV_PCM_FORMAT_S8:
ba764b3d 1055 word_length = 8;
b67f4487
C
1056 break;
1057
0a9d1385 1058 case SNDRV_PCM_FORMAT_U16_LE:
b67f4487 1059 case SNDRV_PCM_FORMAT_S16_LE:
ba764b3d 1060 word_length = 16;
b67f4487
C
1061 break;
1062
21eb24d8
DM
1063 case SNDRV_PCM_FORMAT_U24_3LE:
1064 case SNDRV_PCM_FORMAT_S24_3LE:
ba764b3d 1065 word_length = 24;
21eb24d8
DM
1066 break;
1067
6b7fa011
DM
1068 case SNDRV_PCM_FORMAT_U24_LE:
1069 case SNDRV_PCM_FORMAT_S24_LE:
182bef86
PU
1070 word_length = 24;
1071 break;
1072
0a9d1385 1073 case SNDRV_PCM_FORMAT_U32_LE:
b67f4487 1074 case SNDRV_PCM_FORMAT_S32_LE:
ba764b3d 1075 word_length = 32;
b67f4487
C
1076 break;
1077
1078 default:
1079 printk(KERN_WARNING "davinci-mcasp: unsupported PCM format");
1080 return -EINVAL;
1081 }
6a99fb5f 1082
70091a3e 1083 davinci_config_channel_size(mcasp, word_length);
b67f4487 1084
11277833
PU
1085 if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE)
1086 mcasp->channels = channels;
1087
b67f4487
C
1088 return 0;
1089}
1090
1091static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
1092 int cmd, struct snd_soc_dai *cpu_dai)
1093{
70091a3e 1094 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
b67f4487
C
1095 int ret = 0;
1096
1097 switch (cmd) {
b67f4487 1098 case SNDRV_PCM_TRIGGER_RESUME:
e473b847
C
1099 case SNDRV_PCM_TRIGGER_START:
1100 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
70091a3e 1101 davinci_mcasp_start(mcasp, substream->stream);
b67f4487 1102 break;
b67f4487 1103 case SNDRV_PCM_TRIGGER_SUSPEND:
a47979b5 1104 case SNDRV_PCM_TRIGGER_STOP:
b67f4487 1105 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
70091a3e 1106 davinci_mcasp_stop(mcasp, substream->stream);
b67f4487
C
1107 break;
1108
1109 default:
1110 ret = -EINVAL;
1111 }
1112
1113 return ret;
1114}
1115
a75a053f
JS
1116static const unsigned int davinci_mcasp_dai_rates[] = {
1117 8000, 11025, 16000, 22050, 32000, 44100, 48000, 64000,
1118 88200, 96000, 176400, 192000,
1119};
1120
1121#define DAVINCI_MAX_RATE_ERROR_PPM 1000
1122
1123static int davinci_mcasp_hw_rule_rate(struct snd_pcm_hw_params *params,
1124 struct snd_pcm_hw_rule *rule)
1125{
1126 struct davinci_mcasp_ruledata *rd = rule->private;
1127 struct snd_interval *ri =
1128 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
1129 int sbits = params_width(params);
1f114f77 1130 int slots = rd->mcasp->tdm_slots;
518f6bab
JS
1131 struct snd_interval range;
1132 int i;
a75a053f 1133
dd55ff83
JS
1134 if (rd->mcasp->slot_width)
1135 sbits = rd->mcasp->slot_width;
1136
518f6bab
JS
1137 snd_interval_any(&range);
1138 range.empty = 1;
a75a053f
JS
1139
1140 for (i = 0; i < ARRAY_SIZE(davinci_mcasp_dai_rates); i++) {
518f6bab 1141 if (snd_interval_test(ri, davinci_mcasp_dai_rates[i])) {
1f114f77 1142 uint bclk_freq = sbits*slots*
a75a053f
JS
1143 davinci_mcasp_dai_rates[i];
1144 int ppm;
1145
1146 davinci_mcasp_calc_clk_div(rd->mcasp, bclk_freq, &ppm);
518f6bab
JS
1147 if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
1148 if (range.empty) {
1149 range.min = davinci_mcasp_dai_rates[i];
1150 range.empty = 0;
1151 }
1152 range.max = davinci_mcasp_dai_rates[i];
1153 }
a75a053f
JS
1154 }
1155 }
518f6bab 1156
a75a053f 1157 dev_dbg(rd->mcasp->dev,
518f6bab
JS
1158 "Frequencies %d-%d -> %d-%d for %d sbits and %d tdm slots\n",
1159 ri->min, ri->max, range.min, range.max, sbits, slots);
a75a053f 1160
518f6bab
JS
1161 return snd_interval_refine(hw_param_interval(params, rule->var),
1162 &range);
a75a053f
JS
1163}
1164
1165static int davinci_mcasp_hw_rule_format(struct snd_pcm_hw_params *params,
1166 struct snd_pcm_hw_rule *rule)
1167{
1168 struct davinci_mcasp_ruledata *rd = rule->private;
1169 struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
1170 struct snd_mask nfmt;
1171 int rate = params_rate(params);
1f114f77 1172 int slots = rd->mcasp->tdm_slots;
a75a053f
JS
1173 int i, count = 0;
1174
1175 snd_mask_none(&nfmt);
1176
a75a053f
JS
1177 for (i = 0; i < SNDRV_PCM_FORMAT_LAST; i++) {
1178 if (snd_mask_test(fmt, i)) {
dd55ff83 1179 uint sbits = snd_pcm_format_width(i);
a75a053f
JS
1180 int ppm;
1181
dd55ff83
JS
1182 if (rd->mcasp->slot_width)
1183 sbits = rd->mcasp->slot_width;
1184
1185 davinci_mcasp_calc_clk_div(rd->mcasp, sbits*slots*rate,
1186 &ppm);
a75a053f
JS
1187 if (abs(ppm) < DAVINCI_MAX_RATE_ERROR_PPM) {
1188 snd_mask_set(&nfmt, i);
1189 count++;
1190 }
1191 }
1192 }
1193 dev_dbg(rd->mcasp->dev,
1f114f77
JS
1194 "%d possible sample format for %d Hz and %d tdm slots\n",
1195 count, rate, slots);
a75a053f
JS
1196
1197 return snd_mask_refine(fmt, &nfmt);
1198}
1199
11277833
PU
1200static int davinci_mcasp_startup(struct snd_pcm_substream *substream,
1201 struct snd_soc_dai *cpu_dai)
1202{
1203 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
4cd9db08
PU
1204 struct davinci_mcasp_ruledata *ruledata =
1205 &mcasp->ruledata[substream->stream];
11277833
PU
1206 u32 max_channels = 0;
1207 int i, dir;
dd55ff83
JS
1208 int tdm_slots = mcasp->tdm_slots;
1209
1210 if (mcasp->tdm_mask[substream->stream])
1211 tdm_slots = hweight32(mcasp->tdm_mask[substream->stream]);
11277833 1212
a7a3324a
MLC
1213 mcasp->substreams[substream->stream] = substream;
1214
11277833
PU
1215 if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
1216 return 0;
1217
1218 /*
1219 * Limit the maximum allowed channels for the first stream:
1220 * number of serializers for the direction * tdm slots per serializer
1221 */
1222 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1223 dir = TX_MODE;
1224 else
1225 dir = RX_MODE;
1226
1227 for (i = 0; i < mcasp->num_serializer; i++) {
1228 if (mcasp->serial_dir[i] == dir)
1229 max_channels++;
1230 }
4cd9db08 1231 ruledata->serializers = max_channels;
dd55ff83 1232 max_channels *= tdm_slots;
11277833
PU
1233 /*
1234 * If the already active stream has less channels than the calculated
1235 * limnit based on the seirializers * tdm_slots, we need to use that as
1236 * a constraint for the second stream.
1237 * Otherwise (first stream or less allowed channels) we use the
1238 * calculated constraint.
1239 */
1240 if (mcasp->channels && mcasp->channels < max_channels)
1241 max_channels = mcasp->channels;
dd55ff83
JS
1242 /*
1243 * But we can always allow channels upto the amount of
1244 * the available tdm_slots.
1245 */
1246 if (max_channels < tdm_slots)
1247 max_channels = tdm_slots;
11277833
PU
1248
1249 snd_pcm_hw_constraint_minmax(substream->runtime,
1250 SNDRV_PCM_HW_PARAM_CHANNELS,
1251 2, max_channels);
a75a053f 1252
dd55ff83
JS
1253 snd_pcm_hw_constraint_list(substream->runtime,
1254 0, SNDRV_PCM_HW_PARAM_CHANNELS,
1255 &mcasp->chconstr[substream->stream]);
1256
1257 if (mcasp->slot_width)
1258 snd_pcm_hw_constraint_minmax(substream->runtime,
1259 SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1260 8, mcasp->slot_width);
5935a056 1261
a75a053f
JS
1262 /*
1263 * If we rely on implicit BCLK divider setting we should
1264 * set constraints based on what we can provide.
1265 */
1266 if (mcasp->bclk_master && mcasp->bclk_div == 0 && mcasp->sysclk_freq) {
1267 int ret;
1268
4cd9db08 1269 ruledata->mcasp = mcasp;
a75a053f
JS
1270
1271 ret = snd_pcm_hw_rule_add(substream->runtime, 0,
1272 SNDRV_PCM_HW_PARAM_RATE,
1273 davinci_mcasp_hw_rule_rate,
4cd9db08 1274 ruledata,
1f114f77 1275 SNDRV_PCM_HW_PARAM_FORMAT, -1);
a75a053f
JS
1276 if (ret)
1277 return ret;
1278 ret = snd_pcm_hw_rule_add(substream->runtime, 0,
1279 SNDRV_PCM_HW_PARAM_FORMAT,
1280 davinci_mcasp_hw_rule_format,
4cd9db08 1281 ruledata,
1f114f77 1282 SNDRV_PCM_HW_PARAM_RATE, -1);
a75a053f
JS
1283 if (ret)
1284 return ret;
1285 }
1286
11277833
PU
1287 return 0;
1288}
1289
1290static void davinci_mcasp_shutdown(struct snd_pcm_substream *substream,
1291 struct snd_soc_dai *cpu_dai)
1292{
1293 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
1294
a7a3324a
MLC
1295 mcasp->substreams[substream->stream] = NULL;
1296
11277833
PU
1297 if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
1298 return;
1299
1300 if (!cpu_dai->active)
1301 mcasp->channels = 0;
1302}
1303
85e7652d 1304static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
11277833
PU
1305 .startup = davinci_mcasp_startup,
1306 .shutdown = davinci_mcasp_shutdown,
b67f4487
C
1307 .trigger = davinci_mcasp_trigger,
1308 .hw_params = davinci_mcasp_hw_params,
1309 .set_fmt = davinci_mcasp_set_dai_fmt,
4ed8c9b7 1310 .set_clkdiv = davinci_mcasp_set_clkdiv,
5b66aa2d 1311 .set_sysclk = davinci_mcasp_set_sysclk,
dd55ff83 1312 .set_tdm_slot = davinci_mcasp_set_tdm_slot,
b67f4487
C
1313};
1314
d5902f69
PU
1315static int davinci_mcasp_dai_probe(struct snd_soc_dai *dai)
1316{
1317 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
1318
9759e7ef
PU
1319 dai->playback_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
1320 dai->capture_dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
d5902f69
PU
1321
1322 return 0;
1323}
1324
135014ad
PU
1325#ifdef CONFIG_PM_SLEEP
1326static int davinci_mcasp_suspend(struct snd_soc_dai *dai)
1327{
1328 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
790bb94b 1329 struct davinci_mcasp_context *context = &mcasp->context;
f114ce60 1330 u32 reg;
1cc0c054 1331 int i;
135014ad 1332
27796e75 1333 context->pm_state = pm_runtime_active(mcasp->dev);
6afda7f5
PU
1334 if (!context->pm_state)
1335 pm_runtime_get_sync(mcasp->dev);
1336
1cc0c054
PU
1337 for (i = 0; i < ARRAY_SIZE(context_regs); i++)
1338 context->config_regs[i] = mcasp_get_reg(mcasp, context_regs[i]);
135014ad 1339
f114ce60
PU
1340 if (mcasp->txnumevt) {
1341 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
1342 context->afifo_regs[0] = mcasp_get_reg(mcasp, reg);
1343 }
1344 if (mcasp->rxnumevt) {
1345 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
1346 context->afifo_regs[1] = mcasp_get_reg(mcasp, reg);
1347 }
135014ad 1348
f114ce60
PU
1349 for (i = 0; i < mcasp->num_serializer; i++)
1350 context->xrsr_regs[i] = mcasp_get_reg(mcasp,
1351 DAVINCI_MCASP_XRSRCTL_REG(i));
135014ad 1352
6afda7f5
PU
1353 pm_runtime_put_sync(mcasp->dev);
1354
135014ad
PU
1355 return 0;
1356}
1357
1358static int davinci_mcasp_resume(struct snd_soc_dai *dai)
1359{
1360 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
790bb94b 1361 struct davinci_mcasp_context *context = &mcasp->context;
f114ce60 1362 u32 reg;
1cc0c054 1363 int i;
790bb94b 1364
6afda7f5
PU
1365 pm_runtime_get_sync(mcasp->dev);
1366
1cc0c054
PU
1367 for (i = 0; i < ARRAY_SIZE(context_regs); i++)
1368 mcasp_set_reg(mcasp, context_regs[i], context->config_regs[i]);
135014ad 1369
f114ce60
PU
1370 if (mcasp->txnumevt) {
1371 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
1372 mcasp_set_reg(mcasp, reg, context->afifo_regs[0]);
1373 }
1374 if (mcasp->rxnumevt) {
1375 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
1376 mcasp_set_reg(mcasp, reg, context->afifo_regs[1]);
1377 }
790bb94b 1378
f114ce60
PU
1379 for (i = 0; i < mcasp->num_serializer; i++)
1380 mcasp_set_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
1381 context->xrsr_regs[i]);
135014ad 1382
6afda7f5
PU
1383 if (!context->pm_state)
1384 pm_runtime_put_sync(mcasp->dev);
1385
135014ad
PU
1386 return 0;
1387}
1388#else
1389#define davinci_mcasp_suspend NULL
1390#define davinci_mcasp_resume NULL
1391#endif
1392
ed29cd5e
PU
1393#define DAVINCI_MCASP_RATES SNDRV_PCM_RATE_8000_192000
1394
0a9d1385
BG
1395#define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
1396 SNDRV_PCM_FMTBIT_U8 | \
1397 SNDRV_PCM_FMTBIT_S16_LE | \
1398 SNDRV_PCM_FMTBIT_U16_LE | \
21eb24d8
DM
1399 SNDRV_PCM_FMTBIT_S24_LE | \
1400 SNDRV_PCM_FMTBIT_U24_LE | \
1401 SNDRV_PCM_FMTBIT_S24_3LE | \
1402 SNDRV_PCM_FMTBIT_U24_3LE | \
0a9d1385
BG
1403 SNDRV_PCM_FMTBIT_S32_LE | \
1404 SNDRV_PCM_FMTBIT_U32_LE)
1405
f0fba2ad 1406static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
b67f4487 1407 {
f0fba2ad 1408 .name = "davinci-mcasp.0",
d5902f69 1409 .probe = davinci_mcasp_dai_probe,
135014ad
PU
1410 .suspend = davinci_mcasp_suspend,
1411 .resume = davinci_mcasp_resume,
b67f4487
C
1412 .playback = {
1413 .channels_min = 2,
2952b27e 1414 .channels_max = 32 * 16,
b67f4487 1415 .rates = DAVINCI_MCASP_RATES,
0a9d1385 1416 .formats = DAVINCI_MCASP_PCM_FMTS,
b67f4487
C
1417 },
1418 .capture = {
1419 .channels_min = 2,
2952b27e 1420 .channels_max = 32 * 16,
b67f4487 1421 .rates = DAVINCI_MCASP_RATES,
0a9d1385 1422 .formats = DAVINCI_MCASP_PCM_FMTS,
b67f4487
C
1423 },
1424 .ops = &davinci_mcasp_dai_ops,
1425
d75249f5 1426 .symmetric_samplebits = 1,
b67f4487
C
1427 },
1428 {
58e48d97 1429 .name = "davinci-mcasp.1",
d5902f69 1430 .probe = davinci_mcasp_dai_probe,
b67f4487
C
1431 .playback = {
1432 .channels_min = 1,
1433 .channels_max = 384,
1434 .rates = DAVINCI_MCASP_RATES,
0a9d1385 1435 .formats = DAVINCI_MCASP_PCM_FMTS,
b67f4487
C
1436 },
1437 .ops = &davinci_mcasp_dai_ops,
1438 },
1439
1440};
b67f4487 1441
eeef0eda
KM
1442static const struct snd_soc_component_driver davinci_mcasp_component = {
1443 .name = "davinci-mcasp",
1444};
1445
256ba181 1446/* Some HW specific values and defaults. The rest is filled in from DT. */
d1debafc 1447static struct davinci_mcasp_pdata dm646x_mcasp_pdata = {
256ba181
JS
1448 .tx_dma_offset = 0x400,
1449 .rx_dma_offset = 0x400,
256ba181
JS
1450 .version = MCASP_VERSION_1,
1451};
1452
d1debafc 1453static struct davinci_mcasp_pdata da830_mcasp_pdata = {
256ba181
JS
1454 .tx_dma_offset = 0x2000,
1455 .rx_dma_offset = 0x2000,
256ba181
JS
1456 .version = MCASP_VERSION_2,
1457};
1458
d1debafc 1459static struct davinci_mcasp_pdata am33xx_mcasp_pdata = {
256ba181
JS
1460 .tx_dma_offset = 0,
1461 .rx_dma_offset = 0,
256ba181
JS
1462 .version = MCASP_VERSION_3,
1463};
1464
d1debafc 1465static struct davinci_mcasp_pdata dra7_mcasp_pdata = {
453c4990
PU
1466 .tx_dma_offset = 0x200,
1467 .rx_dma_offset = 0x284,
453c4990
PU
1468 .version = MCASP_VERSION_4,
1469};
1470
3e3b8c34
HG
1471static const struct of_device_id mcasp_dt_ids[] = {
1472 {
1473 .compatible = "ti,dm646x-mcasp-audio",
256ba181 1474 .data = &dm646x_mcasp_pdata,
3e3b8c34
HG
1475 },
1476 {
1477 .compatible = "ti,da830-mcasp-audio",
256ba181 1478 .data = &da830_mcasp_pdata,
3e3b8c34 1479 },
e5ec69da 1480 {
3af9e031 1481 .compatible = "ti,am33xx-mcasp-audio",
b14899da 1482 .data = &am33xx_mcasp_pdata,
e5ec69da 1483 },
453c4990
PU
1484 {
1485 .compatible = "ti,dra7-mcasp-audio",
1486 .data = &dra7_mcasp_pdata,
1487 },
3e3b8c34
HG
1488 { /* sentinel */ }
1489};
1490MODULE_DEVICE_TABLE(of, mcasp_dt_ids);
1491
ae726e93
PU
1492static int mcasp_reparent_fck(struct platform_device *pdev)
1493{
1494 struct device_node *node = pdev->dev.of_node;
1495 struct clk *gfclk, *parent_clk;
1496 const char *parent_name;
1497 int ret;
1498
1499 if (!node)
1500 return 0;
1501
1502 parent_name = of_get_property(node, "fck_parent", NULL);
1503 if (!parent_name)
1504 return 0;
1505
1506 gfclk = clk_get(&pdev->dev, "fck");
1507 if (IS_ERR(gfclk)) {
1508 dev_err(&pdev->dev, "failed to get fck\n");
1509 return PTR_ERR(gfclk);
1510 }
1511
1512 parent_clk = clk_get(NULL, parent_name);
1513 if (IS_ERR(parent_clk)) {
1514 dev_err(&pdev->dev, "failed to get parent clock\n");
1515 ret = PTR_ERR(parent_clk);
1516 goto err1;
1517 }
1518
1519 ret = clk_set_parent(gfclk, parent_clk);
1520 if (ret) {
1521 dev_err(&pdev->dev, "failed to reparent fck\n");
1522 goto err2;
1523 }
1524
1525err2:
1526 clk_put(parent_clk);
1527err1:
1528 clk_put(gfclk);
1529 return ret;
1530}
1531
d1debafc 1532static struct davinci_mcasp_pdata *davinci_mcasp_set_pdata_from_of(
3e3b8c34
HG
1533 struct platform_device *pdev)
1534{
1535 struct device_node *np = pdev->dev.of_node;
d1debafc 1536 struct davinci_mcasp_pdata *pdata = NULL;
3e3b8c34 1537 const struct of_device_id *match =
ea421eb1 1538 of_match_device(mcasp_dt_ids, &pdev->dev);
4023fe6f 1539 struct of_phandle_args dma_spec;
3e3b8c34
HG
1540
1541 const u32 *of_serial_dir32;
3e3b8c34
HG
1542 u32 val;
1543 int i, ret = 0;
1544
1545 if (pdev->dev.platform_data) {
1546 pdata = pdev->dev.platform_data;
1547 return pdata;
1548 } else if (match) {
d1debafc 1549 pdata = (struct davinci_mcasp_pdata*) match->data;
3e3b8c34
HG
1550 } else {
1551 /* control shouldn't reach here. something is wrong */
1552 ret = -EINVAL;
1553 goto nodata;
1554 }
1555
3e3b8c34
HG
1556 ret = of_property_read_u32(np, "op-mode", &val);
1557 if (ret >= 0)
1558 pdata->op_mode = val;
1559
1560 ret = of_property_read_u32(np, "tdm-slots", &val);
2952b27e
MB
1561 if (ret >= 0) {
1562 if (val < 2 || val > 32) {
1563 dev_err(&pdev->dev,
1564 "tdm-slots must be in rage [2-32]\n");
1565 ret = -EINVAL;
1566 goto nodata;
1567 }
1568
3e3b8c34 1569 pdata->tdm_slots = val;
2952b27e 1570 }
3e3b8c34 1571
3e3b8c34
HG
1572 of_serial_dir32 = of_get_property(np, "serial-dir", &val);
1573 val /= sizeof(u32);
3e3b8c34 1574 if (of_serial_dir32) {
1427e660
PU
1575 u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
1576 (sizeof(*of_serial_dir) * val),
1577 GFP_KERNEL);
3e3b8c34
HG
1578 if (!of_serial_dir) {
1579 ret = -ENOMEM;
1580 goto nodata;
1581 }
1582
1427e660 1583 for (i = 0; i < val; i++)
3e3b8c34
HG
1584 of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);
1585
1427e660 1586 pdata->num_serializer = val;
3e3b8c34
HG
1587 pdata->serial_dir = of_serial_dir;
1588 }
1589
4023fe6f
JS
1590 ret = of_property_match_string(np, "dma-names", "tx");
1591 if (ret < 0)
1592 goto nodata;
1593
1594 ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
1595 &dma_spec);
1596 if (ret < 0)
1597 goto nodata;
1598
1599 pdata->tx_dma_channel = dma_spec.args[0];
1600
caa1d794
PU
1601 /* RX is not valid in DIT mode */
1602 if (pdata->op_mode != DAVINCI_MCASP_DIT_MODE) {
1603 ret = of_property_match_string(np, "dma-names", "rx");
1604 if (ret < 0)
1605 goto nodata;
4023fe6f 1606
caa1d794
PU
1607 ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
1608 &dma_spec);
1609 if (ret < 0)
1610 goto nodata;
4023fe6f 1611
caa1d794
PU
1612 pdata->rx_dma_channel = dma_spec.args[0];
1613 }
4023fe6f 1614
3e3b8c34
HG
1615 ret = of_property_read_u32(np, "tx-num-evt", &val);
1616 if (ret >= 0)
1617 pdata->txnumevt = val;
1618
1619 ret = of_property_read_u32(np, "rx-num-evt", &val);
1620 if (ret >= 0)
1621 pdata->rxnumevt = val;
1622
1623 ret = of_property_read_u32(np, "sram-size-playback", &val);
1624 if (ret >= 0)
1625 pdata->sram_size_playback = val;
1626
1627 ret = of_property_read_u32(np, "sram-size-capture", &val);
1628 if (ret >= 0)
1629 pdata->sram_size_capture = val;
1630
1631 return pdata;
1632
1633nodata:
1634 if (ret < 0) {
1635 dev_err(&pdev->dev, "Error populating platform data, err %d\n",
1636 ret);
1637 pdata = NULL;
1638 }
1639 return pdata;
1640}
1641
9fbd58cf
JS
1642enum {
1643 PCM_EDMA,
1644 PCM_SDMA,
1645};
1646static const char *sdma_prefix = "ti,omap";
1647
1648static int davinci_mcasp_get_dma_type(struct davinci_mcasp *mcasp)
1649{
1650 struct dma_chan *chan;
1651 const char *tmp;
1652 int ret = PCM_EDMA;
1653
1654 if (!mcasp->dev->of_node)
1655 return PCM_EDMA;
1656
1657 tmp = mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK].filter_data;
1658 chan = dma_request_slave_channel_reason(mcasp->dev, tmp);
1659 if (IS_ERR(chan)) {
1660 if (PTR_ERR(chan) != -EPROBE_DEFER)
1661 dev_err(mcasp->dev,
1662 "Can't verify DMA configuration (%ld)\n",
1663 PTR_ERR(chan));
1664 return PTR_ERR(chan);
1665 }
1666 BUG_ON(!chan->device || !chan->device->dev);
1667
1668 if (chan->device->dev->of_node)
1669 ret = of_property_read_string(chan->device->dev->of_node,
1670 "compatible", &tmp);
1671 else
1672 dev_dbg(mcasp->dev, "DMA controller has no of-node\n");
1673
1674 dma_release_channel(chan);
1675 if (ret)
1676 return ret;
1677
1678 dev_dbg(mcasp->dev, "DMA controller compatible = \"%s\"\n", tmp);
1679 if (!strncmp(tmp, sdma_prefix, strlen(sdma_prefix)))
1680 return PCM_SDMA;
1681
1682 return PCM_EDMA;
1683}
1684
b67f4487
C
1685static int davinci_mcasp_probe(struct platform_device *pdev)
1686{
8de131f2 1687 struct snd_dmaengine_dai_dma_data *dma_data;
508a43fd 1688 struct resource *mem, *res, *dat;
d1debafc 1689 struct davinci_mcasp_pdata *pdata;
70091a3e 1690 struct davinci_mcasp *mcasp;
a7a3324a 1691 char *irq_name;
9759e7ef 1692 int *dma;
a7a3324a 1693 int irq;
96d31e2b 1694 int ret;
b67f4487 1695
3e3b8c34
HG
1696 if (!pdev->dev.platform_data && !pdev->dev.of_node) {
1697 dev_err(&pdev->dev, "No platform data supplied\n");
1698 return -EINVAL;
1699 }
1700
70091a3e 1701 mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
96d31e2b 1702 GFP_KERNEL);
70091a3e 1703 if (!mcasp)
b67f4487
C
1704 return -ENOMEM;
1705
3e3b8c34
HG
1706 pdata = davinci_mcasp_set_pdata_from_of(pdev);
1707 if (!pdata) {
1708 dev_err(&pdev->dev, "no platform data\n");
1709 return -EINVAL;
1710 }
1711
256ba181 1712 mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
b67f4487 1713 if (!mem) {
70091a3e 1714 dev_warn(mcasp->dev,
256ba181
JS
1715 "\"mpu\" mem resource not found, using index 0\n");
1716 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1717 if (!mem) {
1718 dev_err(&pdev->dev, "no mem resource?\n");
1719 return -ENODEV;
1720 }
b67f4487
C
1721 }
1722
508a43fd
AL
1723 mcasp->base = devm_ioremap_resource(&pdev->dev, mem);
1724 if (IS_ERR(mcasp->base))
1725 return PTR_ERR(mcasp->base);
b67f4487 1726
10884347 1727 pm_runtime_enable(&pdev->dev);
b67f4487 1728
70091a3e 1729 mcasp->op_mode = pdata->op_mode;
1a5923da
PU
1730 /* sanity check for tdm slots parameter */
1731 if (mcasp->op_mode == DAVINCI_MCASP_IIS_MODE) {
1732 if (pdata->tdm_slots < 2) {
1733 dev_err(&pdev->dev, "invalid tdm slots: %d\n",
1734 pdata->tdm_slots);
1735 mcasp->tdm_slots = 2;
1736 } else if (pdata->tdm_slots > 32) {
1737 dev_err(&pdev->dev, "invalid tdm slots: %d\n",
1738 pdata->tdm_slots);
1739 mcasp->tdm_slots = 32;
1740 } else {
1741 mcasp->tdm_slots = pdata->tdm_slots;
1742 }
1743 }
1744
70091a3e 1745 mcasp->num_serializer = pdata->num_serializer;
f114ce60
PU
1746#ifdef CONFIG_PM_SLEEP
1747 mcasp->context.xrsr_regs = devm_kzalloc(&pdev->dev,
1748 sizeof(u32) * mcasp->num_serializer,
1749 GFP_KERNEL);
1750#endif
70091a3e
PU
1751 mcasp->serial_dir = pdata->serial_dir;
1752 mcasp->version = pdata->version;
1753 mcasp->txnumevt = pdata->txnumevt;
1754 mcasp->rxnumevt = pdata->rxnumevt;
487dce88 1755
70091a3e 1756 mcasp->dev = &pdev->dev;
b67f4487 1757
5a1b8a80
PU
1758 irq = platform_get_irq_byname(pdev, "common");
1759 if (irq >= 0) {
1760 irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_common\n",
1761 dev_name(&pdev->dev));
1762 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
1763 davinci_mcasp_common_irq_handler,
8f511ffb
PU
1764 IRQF_ONESHOT | IRQF_SHARED,
1765 irq_name, mcasp);
5a1b8a80
PU
1766 if (ret) {
1767 dev_err(&pdev->dev, "common IRQ request failed\n");
1768 goto err;
1769 }
1770
1771 mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
1772 mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
1773 }
1774
a7a3324a
MLC
1775 irq = platform_get_irq_byname(pdev, "rx");
1776 if (irq >= 0) {
1777 irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_rx\n",
1778 dev_name(&pdev->dev));
1779 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
1780 davinci_mcasp_rx_irq_handler,
1781 IRQF_ONESHOT, irq_name, mcasp);
1782 if (ret) {
1783 dev_err(&pdev->dev, "RX IRQ request failed\n");
1784 goto err;
1785 }
1786
1787 mcasp->irq_request[SNDRV_PCM_STREAM_CAPTURE] = ROVRN;
1788 }
1789
1790 irq = platform_get_irq_byname(pdev, "tx");
1791 if (irq >= 0) {
1792 irq_name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%s_tx\n",
1793 dev_name(&pdev->dev));
1794 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
1795 davinci_mcasp_tx_irq_handler,
1796 IRQF_ONESHOT, irq_name, mcasp);
1797 if (ret) {
1798 dev_err(&pdev->dev, "TX IRQ request failed\n");
1799 goto err;
1800 }
1801
1802 mcasp->irq_request[SNDRV_PCM_STREAM_PLAYBACK] = XUNDRN;
1803 }
1804
256ba181 1805 dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
cbc7956c
PU
1806 if (dat)
1807 mcasp->dat_port = true;
256ba181 1808
8de131f2 1809 dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK];
cbc7956c 1810 if (dat)
9759e7ef 1811 dma_data->addr = dat->start;
cbc7956c 1812 else
9759e7ef 1813 dma_data->addr = mem->start + pdata->tx_dma_offset;
453c4990 1814
9759e7ef 1815 dma = &mcasp->dma_request[SNDRV_PCM_STREAM_PLAYBACK];
b67f4487 1816 res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
4023fe6f 1817 if (res)
9759e7ef 1818 *dma = res->start;
4023fe6f 1819 else
9759e7ef 1820 *dma = pdata->tx_dma_channel;
92e2a6f6 1821
8de131f2
PU
1822 /* dmaengine filter data for DT and non-DT boot */
1823 if (pdev->dev.of_node)
1824 dma_data->filter_data = "tx";
1825 else
9759e7ef 1826 dma_data->filter_data = dma;
8de131f2 1827
caa1d794
PU
1828 /* RX is not valid in DIT mode */
1829 if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
caa1d794 1830 dma_data = &mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE];
caa1d794 1831 if (dat)
9759e7ef 1832 dma_data->addr = dat->start;
caa1d794 1833 else
9759e7ef 1834 dma_data->addr = mem->start + pdata->rx_dma_offset;
caa1d794 1835
9759e7ef 1836 dma = &mcasp->dma_request[SNDRV_PCM_STREAM_CAPTURE];
caa1d794
PU
1837 res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1838 if (res)
9759e7ef 1839 *dma = res->start;
caa1d794 1840 else
9759e7ef 1841 *dma = pdata->rx_dma_channel;
caa1d794
PU
1842
1843 /* dmaengine filter data for DT and non-DT boot */
1844 if (pdev->dev.of_node)
1845 dma_data->filter_data = "rx";
1846 else
9759e7ef 1847 dma_data->filter_data = dma;
caa1d794 1848 }
453c4990 1849
cbc7956c
PU
1850 if (mcasp->version < MCASP_VERSION_3) {
1851 mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
64ebdec3 1852 /* dma_params->dma_addr is pointing to the data port address */
cbc7956c
PU
1853 mcasp->dat_port = true;
1854 } else {
1855 mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
1856 }
b67f4487 1857
dd55ff83
JS
1858 /* Allocate memory for long enough list for all possible
1859 * scenarios. Maximum number tdm slots is 32 and there cannot
1860 * be more serializers than given in the configuration. The
1861 * serializer directions could be taken into account, but it
1862 * would make code much more complex and save only couple of
1863 * bytes.
1864 */
1865 mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list =
1866 devm_kzalloc(mcasp->dev, sizeof(unsigned int) *
1867 (32 + mcasp->num_serializer - 2),
1868 GFP_KERNEL);
1869
1870 mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list =
1871 devm_kzalloc(mcasp->dev, sizeof(unsigned int) *
1872 (32 + mcasp->num_serializer - 2),
1873 GFP_KERNEL);
1874
1875 if (!mcasp->chconstr[SNDRV_PCM_STREAM_PLAYBACK].list ||
1876 !mcasp->chconstr[SNDRV_PCM_STREAM_CAPTURE].list)
1877 return -ENOMEM;
1878
1879 ret = davinci_mcasp_set_ch_constraints(mcasp);
5935a056
JS
1880 if (ret)
1881 goto err;
1882
70091a3e 1883 dev_set_drvdata(&pdev->dev, mcasp);
ae726e93
PU
1884
1885 mcasp_reparent_fck(pdev);
1886
b6bb3709
PU
1887 ret = devm_snd_soc_register_component(&pdev->dev,
1888 &davinci_mcasp_component,
1889 &davinci_mcasp_dai[pdata->op_mode], 1);
b67f4487
C
1890
1891 if (ret != 0)
b6bb3709 1892 goto err;
f08095a4 1893
9fbd58cf
JS
1894 ret = davinci_mcasp_get_dma_type(mcasp);
1895 switch (ret) {
1896 case PCM_EDMA:
f3f9cfa8
PU
1897#if IS_BUILTIN(CONFIG_SND_EDMA_SOC) || \
1898 (IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
1899 IS_MODULE(CONFIG_SND_EDMA_SOC))
f3f9cfa8 1900 ret = edma_pcm_platform_register(&pdev->dev);
9fbd58cf
JS
1901#else
1902 dev_err(&pdev->dev, "Missing SND_EDMA_SOC\n");
1903 ret = -EINVAL;
1904 goto err;
f3f9cfa8 1905#endif
9fbd58cf
JS
1906 break;
1907 case PCM_SDMA:
7f28f357
JS
1908#if IS_BUILTIN(CONFIG_SND_OMAP_SOC) || \
1909 (IS_MODULE(CONFIG_SND_DAVINCI_SOC_MCASP) && \
1910 IS_MODULE(CONFIG_SND_OMAP_SOC))
d5c6c59a 1911 ret = omap_pcm_platform_register(&pdev->dev);
9fbd58cf
JS
1912#else
1913 dev_err(&pdev->dev, "Missing SND_SDMA_SOC\n");
1914 ret = -EINVAL;
1915 goto err;
7f28f357 1916#endif
9fbd58cf 1917 break;
d5c6c59a 1918 default:
9fbd58cf
JS
1919 dev_err(&pdev->dev, "No DMA controller found (%d)\n", ret);
1920 case -EPROBE_DEFER:
1921 goto err;
d5c6c59a
PU
1922 break;
1923 }
1924
1925 if (ret) {
1926 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
b6bb3709 1927 goto err;
f08095a4
HG
1928 }
1929
b67f4487
C
1930 return 0;
1931
b6bb3709 1932err:
10884347 1933 pm_runtime_disable(&pdev->dev);
b67f4487
C
1934 return ret;
1935}
1936
1937static int davinci_mcasp_remove(struct platform_device *pdev)
1938{
10884347 1939 pm_runtime_disable(&pdev->dev);
b67f4487 1940
b67f4487
C
1941 return 0;
1942}
1943
1944static struct platform_driver davinci_mcasp_driver = {
1945 .probe = davinci_mcasp_probe,
1946 .remove = davinci_mcasp_remove,
1947 .driver = {
1948 .name = "davinci-mcasp",
ea421eb1 1949 .of_match_table = mcasp_dt_ids,
b67f4487
C
1950 },
1951};
1952
f9b8a514 1953module_platform_driver(davinci_mcasp_driver);
b67f4487
C
1954
1955MODULE_AUTHOR("Steve Chen");
1956MODULE_DESCRIPTION("TI DAVINCI McASP SoC Interface");
1957MODULE_LICENSE("GPL");