?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86, cpufeature: If we disable CLFLUSH, we should disable CLFLUSHOPT
[linux/fpc-iii.git] / sound / soc / davinci / davinci-mcasp.c
blobb7858bfa0295357bc5d3ca6d1328932595167b9e
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>
21 #include <linux/slab.h>
22 #include <linux/delay.h>
23 #include <linux/io.h>
24 #include <linux/clk.h>
25 #include <linux/pm_runtime.h>
26 #include <linux/of.h>
27 #include <linux/of_platform.h>
28 #include <linux/of_device.h>
29
30 #include <sound/core.h>
31 #include <sound/pcm.h>
32 #include <sound/pcm_params.h>
33 #include <sound/initval.h>
34 #include <sound/soc.h>
35 #include <sound/dmaengine_pcm.h>
36
37 #include "davinci-pcm.h"
38 #include "davinci-mcasp.h"
39
40 struct davinci_mcasp {
41 struct davinci_pcm_dma_params dma_params[2];
42 struct snd_dmaengine_dai_dma_data dma_data[2];
43 void __iomem *base;
44 u32 fifo_base;
45 struct device *dev;
46
47 /* McASP specific data */
48 int tdm_slots;
49 u8 op_mode;
50 u8 num_serializer;
51 u8 *serial_dir;
52 u8 version;
53 u16 bclk_lrclk_ratio;
54 int streams;
55
56 /* McASP FIFO related */
57 u8 txnumevt;
58 u8 rxnumevt;
59
60 bool dat_port;
61
62 #ifdef CONFIG_PM_SLEEP
63 struct {
64 u32 txfmtctl;
65 u32 rxfmtctl;
66 u32 txfmt;
67 u32 rxfmt;
68 u32 aclkxctl;
69 u32 aclkrctl;
70 u32 pdir;
71 } context;
72 #endif
73 };
74
75 static inline void mcasp_set_bits(struct davinci_mcasp *mcasp, u32 offset,
76 u32 val)
77 {
78 void __iomem *reg = mcasp->base + offset;
79 __raw_writel(__raw_readl(reg) | val, reg);
80 }
81
82 static inline void mcasp_clr_bits(struct davinci_mcasp *mcasp, u32 offset,
83 u32 val)
84 {
85 void __iomem *reg = mcasp->base + offset;
86 __raw_writel((__raw_readl(reg) & ~(val)), reg);
87 }
88
89 static inline void mcasp_mod_bits(struct davinci_mcasp *mcasp, u32 offset,
90 u32 val, u32 mask)
91 {
92 void __iomem *reg = mcasp->base + offset;
93 __raw_writel((__raw_readl(reg) & ~mask) | val, reg);
94 }
95
96 static inline void mcasp_set_reg(struct davinci_mcasp *mcasp, u32 offset,
97 u32 val)
98 {
99 __raw_writel(val, mcasp->base + offset);
100 }
101
102 static inline u32 mcasp_get_reg(struct davinci_mcasp *mcasp, u32 offset)
103 {
104 return (u32)__raw_readl(mcasp->base + offset);
105 }
106
107 static void mcasp_set_ctl_reg(struct davinci_mcasp *mcasp, u32 ctl_reg, u32 val)
108 {
109 int i = 0;
110
111 mcasp_set_bits(mcasp, ctl_reg, val);
112
113 /* programming GBLCTL needs to read back from GBLCTL and verfiy */
114 /* loop count is to avoid the lock-up */
115 for (i = 0; i < 1000; i++) {
116 if ((mcasp_get_reg(mcasp, ctl_reg) & val) == val)
117 break;
118 }
119
120 if (i == 1000 && ((mcasp_get_reg(mcasp, ctl_reg) & val) != val))
121 printk(KERN_ERR "GBLCTL write error\n");
122 }
123
124 static bool mcasp_is_synchronous(struct davinci_mcasp *mcasp)
125 {
126 u32 rxfmctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
127 u32 aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
128
129 return !(aclkxctl & TX_ASYNC) && rxfmctl & AFSRE;
130 }
131
132 static void mcasp_start_rx(struct davinci_mcasp *mcasp)
133 {
134 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXHCLKRST);
135 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXCLKRST);
136
137 /*
138 * When ASYNC == 0 the transmit and receive sections operate
139 * synchronously from the transmit clock and frame sync. We need to make
140 * sure that the TX signlas are enabled when starting reception.
141 */
142 if (mcasp_is_synchronous(mcasp)) {
143 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
144 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
145 }
146
147 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSERCLR);
148 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXBUF_REG, 0);
149
150 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
151 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
152 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXBUF_REG, 0);
153
154 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXSMRST);
155 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, RXFSRST);
156
157 if (mcasp_is_synchronous(mcasp))
158 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
159 }
160
161 static void mcasp_start_tx(struct davinci_mcasp *mcasp)
162 {
163 u8 offset = 0, i;
164 u32 cnt;
165
166 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXHCLKRST);
167 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXCLKRST);
168 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSERCLR);
169 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
170
171 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXSMRST);
172 mcasp_set_ctl_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, TXFSRST);
173 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
174 for (i = 0; i < mcasp->num_serializer; i++) {
175 if (mcasp->serial_dir[i] == TX_MODE) {
176 offset = i;
177 break;
178 }
179 }
180
181 /* wait for TX ready */
182 cnt = 0;
183 while (!(mcasp_get_reg(mcasp, DAVINCI_MCASP_XRSRCTL_REG(offset)) &
184 TXSTATE) && (cnt < 100000))
185 cnt++;
186
187 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXBUF_REG, 0);
188 }
189
190 static void davinci_mcasp_start(struct davinci_mcasp *mcasp, int stream)
191 {
192 u32 reg;
193
194 mcasp->streams++;
195
196 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
197 if (mcasp->txnumevt) { /* enable FIFO */
198 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
199 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
200 mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
201 }
202 mcasp_start_tx(mcasp);
203 } else {
204 if (mcasp->rxnumevt) { /* enable FIFO */
205 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
206 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
207 mcasp_set_bits(mcasp, reg, FIFO_ENABLE);
208 }
209 mcasp_start_rx(mcasp);
210 }
211 }
212
213 static void mcasp_stop_rx(struct davinci_mcasp *mcasp)
214 {
215 /*
216 * In synchronous mode stop the TX clocks if no other stream is
217 * running
218 */
219 if (mcasp_is_synchronous(mcasp) && !mcasp->streams)
220 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, 0);
221
222 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLR_REG, 0);
223 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
224 }
225
226 static void mcasp_stop_tx(struct davinci_mcasp *mcasp)
227 {
228 u32 val = 0;
229
230 /*
231 * In synchronous mode keep TX clocks running if the capture stream is
232 * still running.
233 */
234 if (mcasp_is_synchronous(mcasp) && mcasp->streams)
235 val = TXHCLKRST | TXCLKRST | TXFSRST;
236
237 mcasp_set_reg(mcasp, DAVINCI_MCASP_GBLCTLX_REG, val);
238 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
239 }
240
241 static void davinci_mcasp_stop(struct davinci_mcasp *mcasp, int stream)
242 {
243 u32 reg;
244
245 mcasp->streams--;
246
247 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
248 if (mcasp->txnumevt) { /* disable FIFO */
249 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
250 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
251 }
252 mcasp_stop_tx(mcasp);
253 } else {
254 if (mcasp->rxnumevt) { /* disable FIFO */
255 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
256 mcasp_clr_bits(mcasp, reg, FIFO_ENABLE);
257 }
258 mcasp_stop_rx(mcasp);
259 }
260 }
261
262 static int davinci_mcasp_set_dai_fmt(struct snd_soc_dai *cpu_dai,
263 unsigned int fmt)
264 {
265 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
266
267 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
268 case SND_SOC_DAIFMT_DSP_B:
269 case SND_SOC_DAIFMT_AC97:
270 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
271 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
272 break;
273 default:
274 /* configure a full-word SYNC pulse (LRCLK) */
275 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXDUR);
276 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRDUR);
277
278 /* make 1st data bit occur one ACLK cycle after the frame sync */
279 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, FSXDLY(1));
280 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, FSRDLY(1));
281 break;
282 }
283
284 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
285 case SND_SOC_DAIFMT_CBS_CFS:
286 /* codec is clock and frame slave */
287 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
288 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
289
290 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
291 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
292
293 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
294 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
295 break;
296 case SND_SOC_DAIFMT_CBM_CFS:
297 /* codec is clock master and frame slave */
298 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
299 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
300
301 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
302 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
303
304 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, ACLKX | ACLKR);
305 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AFSX | AFSR);
306 break;
307 case SND_SOC_DAIFMT_CBM_CFM:
308 /* codec is clock and frame master */
309 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE);
310 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE);
311
312 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRE);
313 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, AFSRE);
314
315 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG,
316 ACLKX | AHCLKX | AFSX | ACLKR | AHCLKR | AFSR);
317 break;
318
319 default:
320 return -EINVAL;
321 }
322
323 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
324 case SND_SOC_DAIFMT_IB_NF:
325 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
326 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
327
328 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
329 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
330 break;
331
332 case SND_SOC_DAIFMT_NB_IF:
333 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
334 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
335
336 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
337 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
338 break;
339
340 case SND_SOC_DAIFMT_IB_IF:
341 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
342 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
343
344 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
345 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
346 break;
347
348 case SND_SOC_DAIFMT_NB_NF:
349 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXPOL);
350 mcasp_clr_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG, FSXPOL);
351
352 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, ACLKRPOL);
353 mcasp_clr_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG, FSRPOL);
354 break;
355
356 default:
357 return -EINVAL;
358 }
359
360 return 0;
361 }
362
363 static int davinci_mcasp_set_clkdiv(struct snd_soc_dai *dai, int div_id, int div)
364 {
365 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
366
367 switch (div_id) {
368 case 0: /* MCLK divider */
369 mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG,
370 AHCLKXDIV(div - 1), AHCLKXDIV_MASK);
371 mcasp_mod_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG,
372 AHCLKRDIV(div - 1), AHCLKRDIV_MASK);
373 break;
374
375 case 1: /* BCLK divider */
376 mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG,
377 ACLKXDIV(div - 1), ACLKXDIV_MASK);
378 mcasp_mod_bits(mcasp, DAVINCI_MCASP_ACLKRCTL_REG,
379 ACLKRDIV(div - 1), ACLKRDIV_MASK);
380 break;
381
382 case 2: /* BCLK/LRCLK ratio */
383 mcasp->bclk_lrclk_ratio = div;
384 break;
385
386 default:
387 return -EINVAL;
388 }
389
390 return 0;
391 }
392
393 static int davinci_mcasp_set_sysclk(struct snd_soc_dai *dai, int clk_id,
394 unsigned int freq, int dir)
395 {
396 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
397
398 if (dir == SND_SOC_CLOCK_OUT) {
399 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
400 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
401 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
402 } else {
403 mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXE);
404 mcasp_clr_bits(mcasp, DAVINCI_MCASP_AHCLKRCTL_REG, AHCLKRE);
405 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AHCLKX);
406 }
407
408 return 0;
409 }
410
411 static int davinci_config_channel_size(struct davinci_mcasp *mcasp,
412 int word_length)
413 {
414 u32 fmt;
415 u32 tx_rotate = (word_length / 4) & 0x7;
416 u32 rx_rotate = (32 - word_length) / 4;
417 u32 mask = (1ULL << word_length) - 1;
418
419 /*
420 * if s BCLK-to-LRCLK ratio has been configured via the set_clkdiv()
421 * callback, take it into account here. That allows us to for example
422 * send 32 bits per channel to the codec, while only 16 of them carry
423 * audio payload.
424 * The clock ratio is given for a full period of data (for I2S format
425 * both left and right channels), so it has to be divided by number of
426 * tdm-slots (for I2S - divided by 2).
427 */
428 if (mcasp->bclk_lrclk_ratio)
429 word_length = mcasp->bclk_lrclk_ratio / mcasp->tdm_slots;
430
431 /* mapping of the XSSZ bit-field as described in the datasheet */
432 fmt = (word_length >> 1) - 1;
433
434 if (mcasp->op_mode != DAVINCI_MCASP_DIT_MODE) {
435 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXSSZ(fmt),
436 RXSSZ(0x0F));
437 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXSSZ(fmt),
438 TXSSZ(0x0F));
439 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(tx_rotate),
440 TXROT(7));
441 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, RXROT(rx_rotate),
442 RXROT(7));
443 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXMASK_REG, mask);
444 }
445
446 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXMASK_REG, mask);
447
448 return 0;
449 }
450
451 static int davinci_hw_common_param(struct davinci_mcasp *mcasp, int stream,
452 int channels)
453 {
454 int i;
455 u8 tx_ser = 0;
456 u8 rx_ser = 0;
457 u8 ser;
458 u8 slots = mcasp->tdm_slots;
459 u8 max_active_serializers = (channels + slots - 1) / slots;
460 u32 reg;
461 /* Default configuration */
462 if (mcasp->version != MCASP_VERSION_4)
463 mcasp_set_bits(mcasp, DAVINCI_MCASP_PWREMUMGT_REG, MCASP_SOFT);
464
465 /* All PINS as McASP */
466 mcasp_set_reg(mcasp, DAVINCI_MCASP_PFUNC_REG, 0x00000000);
467
468 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
469 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXSTAT_REG, 0xFFFFFFFF);
470 mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
471 } else {
472 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXSTAT_REG, 0xFFFFFFFF);
473 mcasp_clr_bits(mcasp, DAVINCI_MCASP_REVTCTL_REG, RXDATADMADIS);
474 }
475
476 for (i = 0; i < mcasp->num_serializer; i++) {
477 mcasp_set_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
478 mcasp->serial_dir[i]);
479 if (mcasp->serial_dir[i] == TX_MODE &&
480 tx_ser < max_active_serializers) {
481 mcasp_set_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
482 tx_ser++;
483 } else if (mcasp->serial_dir[i] == RX_MODE &&
484 rx_ser < max_active_serializers) {
485 mcasp_clr_bits(mcasp, DAVINCI_MCASP_PDIR_REG, AXR(i));
486 rx_ser++;
487 } else {
488 mcasp_mod_bits(mcasp, DAVINCI_MCASP_XRSRCTL_REG(i),
489 SRMOD_INACTIVE, SRMOD_MASK);
490 }
491 }
492
493 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
494 ser = tx_ser;
495 else
496 ser = rx_ser;
497
498 if (ser < max_active_serializers) {
499 dev_warn(mcasp->dev, "stream has more channels (%d) than are "
500 "enabled in mcasp (%d)\n", channels, ser * slots);
501 return -EINVAL;
502 }
503
504 if (mcasp->txnumevt && stream == SNDRV_PCM_STREAM_PLAYBACK) {
505 if (mcasp->txnumevt * tx_ser > 64)
506 mcasp->txnumevt = 1;
507
508 reg = mcasp->fifo_base + MCASP_WFIFOCTL_OFFSET;
509 mcasp_mod_bits(mcasp, reg, tx_ser, NUMDMA_MASK);
510 mcasp_mod_bits(mcasp, reg, ((mcasp->txnumevt * tx_ser) << 8),
511 NUMEVT_MASK);
512 }
513
514 if (mcasp->rxnumevt && stream == SNDRV_PCM_STREAM_CAPTURE) {
515 if (mcasp->rxnumevt * rx_ser > 64)
516 mcasp->rxnumevt = 1;
517
518 reg = mcasp->fifo_base + MCASP_RFIFOCTL_OFFSET;
519 mcasp_mod_bits(mcasp, reg, rx_ser, NUMDMA_MASK);
520 mcasp_mod_bits(mcasp, reg, ((mcasp->rxnumevt * rx_ser) << 8),
521 NUMEVT_MASK);
522 }
523
524 return 0;
525 }
526
527 static void davinci_hw_param(struct davinci_mcasp *mcasp, int stream)
528 {
529 int i, active_slots;
530 u32 mask = 0;
531 u32 busel = 0;
532
533 active_slots = (mcasp->tdm_slots > 31) ? 32 : mcasp->tdm_slots;
534 for (i = 0; i < active_slots; i++)
535 mask |= (1 << i);
536
537 mcasp_clr_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, TX_ASYNC);
538
539 if (!mcasp->dat_port)
540 busel = TXSEL;
541
542 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
543 /* bit stream is MSB first with no delay */
544 /* DSP_B mode */
545 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, mask);
546 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, busel | TXORD);
547
548 if ((mcasp->tdm_slots >= 2) && (mcasp->tdm_slots <= 32))
549 mcasp_mod_bits(mcasp, DAVINCI_MCASP_TXFMCTL_REG,
550 FSXMOD(mcasp->tdm_slots), FSXMOD(0x1FF));
551 else
552 printk(KERN_ERR "playback tdm slot %d not supported\n",
553 mcasp->tdm_slots);
554 } else {
555 /* bit stream is MSB first with no delay */
556 /* DSP_B mode */
557 mcasp_set_bits(mcasp, DAVINCI_MCASP_RXFMT_REG, busel | RXORD);
558 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXTDM_REG, mask);
559
560 if ((mcasp->tdm_slots >= 2) && (mcasp->tdm_slots <= 32))
561 mcasp_mod_bits(mcasp, DAVINCI_MCASP_RXFMCTL_REG,
562 FSRMOD(mcasp->tdm_slots), FSRMOD(0x1FF));
563 else
564 printk(KERN_ERR "capture tdm slot %d not supported\n",
565 mcasp->tdm_slots);
566 }
567 }
568
569 /* S/PDIF */
570 static void davinci_hw_dit_param(struct davinci_mcasp *mcasp)
571 {
572 /* Set the TX format : 24 bit right rotation, 32 bit slot, Pad 0
573 and LSB first */
574 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXFMT_REG, TXROT(6) | TXSSZ(15));
575
576 /* Set TX frame synch : DIT Mode, 1 bit width, internal, rising edge */
577 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, AFSXE | FSXMOD(0x180));
578
579 /* Set the TX tdm : for all the slots */
580 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXTDM_REG, 0xFFFFFFFF);
581
582 /* Set the TX clock controls : div = 1 and internal */
583 mcasp_set_bits(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, ACLKXE | TX_ASYNC);
584
585 mcasp_clr_bits(mcasp, DAVINCI_MCASP_XEVTCTL_REG, TXDATADMADIS);
586
587 /* Only 44100 and 48000 are valid, both have the same setting */
588 mcasp_set_bits(mcasp, DAVINCI_MCASP_AHCLKXCTL_REG, AHCLKXDIV(3));
589
590 /* Enable the DIT */
591 mcasp_set_bits(mcasp, DAVINCI_MCASP_TXDITCTL_REG, DITEN);
592 }
593
594 static int davinci_mcasp_hw_params(struct snd_pcm_substream *substream,
595 struct snd_pcm_hw_params *params,
596 struct snd_soc_dai *cpu_dai)
597 {
598 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
599 struct davinci_pcm_dma_params *dma_params =
600 &mcasp->dma_params[substream->stream];
601 struct snd_dmaengine_dai_dma_data *dma_data =
602 &mcasp->dma_data[substream->stream];
603 int word_length;
604 u8 fifo_level;
605 u8 slots = mcasp->tdm_slots;
606 u8 active_serializers;
607 int channels;
608 struct snd_interval *pcm_channels = hw_param_interval(params,
609 SNDRV_PCM_HW_PARAM_CHANNELS);
610 channels = pcm_channels->min;
611
612 active_serializers = (channels + slots - 1) / slots;
613
614 if (davinci_hw_common_param(mcasp, substream->stream, channels) == -EINVAL)
615 return -EINVAL;
616 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
617 fifo_level = mcasp->txnumevt * active_serializers;
618 else
619 fifo_level = mcasp->rxnumevt * active_serializers;
620
621 if (mcasp->op_mode == DAVINCI_MCASP_DIT_MODE)
622 davinci_hw_dit_param(mcasp);
623 else
624 davinci_hw_param(mcasp, substream->stream);
625
626 switch (params_format(params)) {
627 case SNDRV_PCM_FORMAT_U8:
628 case SNDRV_PCM_FORMAT_S8:
629 dma_params->data_type = 1;
630 word_length = 8;
631 break;
632
633 case SNDRV_PCM_FORMAT_U16_LE:
634 case SNDRV_PCM_FORMAT_S16_LE:
635 dma_params->data_type = 2;
636 word_length = 16;
637 break;
638
639 case SNDRV_PCM_FORMAT_U24_3LE:
640 case SNDRV_PCM_FORMAT_S24_3LE:
641 dma_params->data_type = 3;
642 word_length = 24;
643 break;
644
645 case SNDRV_PCM_FORMAT_U24_LE:
646 case SNDRV_PCM_FORMAT_S24_LE:
647 case SNDRV_PCM_FORMAT_U32_LE:
648 case SNDRV_PCM_FORMAT_S32_LE:
649 dma_params->data_type = 4;
650 word_length = 32;
651 break;
652
653 default:
654 printk(KERN_WARNING "davinci-mcasp: unsupported PCM format");
655 return -EINVAL;
656 }
657
658 if (mcasp->version == MCASP_VERSION_2 && !fifo_level)
659 dma_params->acnt = 4;
660 else
661 dma_params->acnt = dma_params->data_type;
662
663 dma_params->fifo_level = fifo_level;
664 dma_data->maxburst = fifo_level;
665
666 davinci_config_channel_size(mcasp, word_length);
667
668 return 0;
669 }
670
671 static int davinci_mcasp_trigger(struct snd_pcm_substream *substream,
672 int cmd, struct snd_soc_dai *cpu_dai)
673 {
674 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(cpu_dai);
675 int ret = 0;
676
677 switch (cmd) {
678 case SNDRV_PCM_TRIGGER_RESUME:
679 case SNDRV_PCM_TRIGGER_START:
680 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
681 ret = pm_runtime_get_sync(mcasp->dev);
682 if (IS_ERR_VALUE(ret))
683 dev_err(mcasp->dev, "pm_runtime_get_sync() failed\n");
684 davinci_mcasp_start(mcasp, substream->stream);
685 break;
686
687 case SNDRV_PCM_TRIGGER_SUSPEND:
688 davinci_mcasp_stop(mcasp, substream->stream);
689 ret = pm_runtime_put_sync(mcasp->dev);
690 if (IS_ERR_VALUE(ret))
691 dev_err(mcasp->dev, "pm_runtime_put_sync() failed\n");
692 break;
693
694 case SNDRV_PCM_TRIGGER_STOP:
695 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
696 davinci_mcasp_stop(mcasp, substream->stream);
697 break;
698
699 default:
700 ret = -EINVAL;
701 }
702
703 return ret;
704 }
705
706 static int davinci_mcasp_startup(struct snd_pcm_substream *substream,
707 struct snd_soc_dai *dai)
708 {
709 struct davinci_mcasp *mcasp = snd_soc_dai_get_drvdata(dai);
710
711 if (mcasp->version == MCASP_VERSION_4)
712 snd_soc_dai_set_dma_data(dai, substream,
713 &mcasp->dma_data[substream->stream]);
714 else
715 snd_soc_dai_set_dma_data(dai, substream, mcasp->dma_params);
716
717 return 0;
718 }
719
720 static const struct snd_soc_dai_ops davinci_mcasp_dai_ops = {
721 .startup = davinci_mcasp_startup,
722 .trigger = davinci_mcasp_trigger,
723 .hw_params = davinci_mcasp_hw_params,
724 .set_fmt = davinci_mcasp_set_dai_fmt,
725 .set_clkdiv = davinci_mcasp_set_clkdiv,
726 .set_sysclk = davinci_mcasp_set_sysclk,
727 };
728
729 #define DAVINCI_MCASP_RATES SNDRV_PCM_RATE_8000_192000
730
731 #define DAVINCI_MCASP_PCM_FMTS (SNDRV_PCM_FMTBIT_S8 | \
732 SNDRV_PCM_FMTBIT_U8 | \
733 SNDRV_PCM_FMTBIT_S16_LE | \
734 SNDRV_PCM_FMTBIT_U16_LE | \
735 SNDRV_PCM_FMTBIT_S24_LE | \
736 SNDRV_PCM_FMTBIT_U24_LE | \
737 SNDRV_PCM_FMTBIT_S24_3LE | \
738 SNDRV_PCM_FMTBIT_U24_3LE | \
739 SNDRV_PCM_FMTBIT_S32_LE | \
740 SNDRV_PCM_FMTBIT_U32_LE)
741
742 static struct snd_soc_dai_driver davinci_mcasp_dai[] = {
743 {
744 .name = "davinci-mcasp.0",
745 .playback = {
746 .channels_min = 2,
747 .channels_max = 32 * 16,
748 .rates = DAVINCI_MCASP_RATES,
749 .formats = DAVINCI_MCASP_PCM_FMTS,
750 },
751 .capture = {
752 .channels_min = 2,
753 .channels_max = 32 * 16,
754 .rates = DAVINCI_MCASP_RATES,
755 .formats = DAVINCI_MCASP_PCM_FMTS,
756 },
757 .ops = &davinci_mcasp_dai_ops,
758
759 },
760 {
761 .name = "davinci-mcasp.1",
762 .playback = {
763 .channels_min = 1,
764 .channels_max = 384,
765 .rates = DAVINCI_MCASP_RATES,
766 .formats = DAVINCI_MCASP_PCM_FMTS,
767 },
768 .ops = &davinci_mcasp_dai_ops,
769 },
770
771 };
772
773 static const struct snd_soc_component_driver davinci_mcasp_component = {
774 .name = "davinci-mcasp",
775 };
776
777 /* Some HW specific values and defaults. The rest is filled in from DT. */
778 static struct snd_platform_data dm646x_mcasp_pdata = {
779 .tx_dma_offset = 0x400,
780 .rx_dma_offset = 0x400,
781 .asp_chan_q = EVENTQ_0,
782 .version = MCASP_VERSION_1,
783 };
784
785 static struct snd_platform_data da830_mcasp_pdata = {
786 .tx_dma_offset = 0x2000,
787 .rx_dma_offset = 0x2000,
788 .asp_chan_q = EVENTQ_0,
789 .version = MCASP_VERSION_2,
790 };
791
792 static struct snd_platform_data am33xx_mcasp_pdata = {
793 .tx_dma_offset = 0,
794 .rx_dma_offset = 0,
795 .asp_chan_q = EVENTQ_0,
796 .version = MCASP_VERSION_3,
797 };
798
799 static struct snd_platform_data dra7_mcasp_pdata = {
800 .tx_dma_offset = 0x200,
801 .rx_dma_offset = 0x284,
802 .asp_chan_q = EVENTQ_0,
803 .version = MCASP_VERSION_4,
804 };
805
806 static const struct of_device_id mcasp_dt_ids[] = {
807 {
808 .compatible = "ti,dm646x-mcasp-audio",
809 .data = &dm646x_mcasp_pdata,
810 },
811 {
812 .compatible = "ti,da830-mcasp-audio",
813 .data = &da830_mcasp_pdata,
814 },
815 {
816 .compatible = "ti,am33xx-mcasp-audio",
817 .data = &am33xx_mcasp_pdata,
818 },
819 {
820 .compatible = "ti,dra7-mcasp-audio",
821 .data = &dra7_mcasp_pdata,
822 },
823 { /* sentinel */ }
824 };
825 MODULE_DEVICE_TABLE(of, mcasp_dt_ids);
826
827 static int mcasp_reparent_fck(struct platform_device *pdev)
828 {
829 struct device_node *node = pdev->dev.of_node;
830 struct clk *gfclk, *parent_clk;
831 const char *parent_name;
832 int ret;
833
834 if (!node)
835 return 0;
836
837 parent_name = of_get_property(node, "fck_parent", NULL);
838 if (!parent_name)
839 return 0;
840
841 gfclk = clk_get(&pdev->dev, "fck");
842 if (IS_ERR(gfclk)) {
843 dev_err(&pdev->dev, "failed to get fck\n");
844 return PTR_ERR(gfclk);
845 }
846
847 parent_clk = clk_get(NULL, parent_name);
848 if (IS_ERR(parent_clk)) {
849 dev_err(&pdev->dev, "failed to get parent clock\n");
850 ret = PTR_ERR(parent_clk);
851 goto err1;
852 }
853
854 ret = clk_set_parent(gfclk, parent_clk);
855 if (ret) {
856 dev_err(&pdev->dev, "failed to reparent fck\n");
857 goto err2;
858 }
859
860 err2:
861 clk_put(parent_clk);
862 err1:
863 clk_put(gfclk);
864 return ret;
865 }
866
867 static struct snd_platform_data *davinci_mcasp_set_pdata_from_of(
868 struct platform_device *pdev)
869 {
870 struct device_node *np = pdev->dev.of_node;
871 struct snd_platform_data *pdata = NULL;
872 const struct of_device_id *match =
873 of_match_device(mcasp_dt_ids, &pdev->dev);
874 struct of_phandle_args dma_spec;
875
876 const u32 *of_serial_dir32;
877 u32 val;
878 int i, ret = 0;
879
880 if (pdev->dev.platform_data) {
881 pdata = pdev->dev.platform_data;
882 return pdata;
883 } else if (match) {
884 pdata = (struct snd_platform_data *) match->data;
885 } else {
886 /* control shouldn't reach here. something is wrong */
887 ret = -EINVAL;
888 goto nodata;
889 }
890
891 ret = of_property_read_u32(np, "op-mode", &val);
892 if (ret >= 0)
893 pdata->op_mode = val;
894
895 ret = of_property_read_u32(np, "tdm-slots", &val);
896 if (ret >= 0) {
897 if (val < 2 || val > 32) {
898 dev_err(&pdev->dev,
899 "tdm-slots must be in rage [2-32]\n");
900 ret = -EINVAL;
901 goto nodata;
902 }
903
904 pdata->tdm_slots = val;
905 }
906
907 of_serial_dir32 = of_get_property(np, "serial-dir", &val);
908 val /= sizeof(u32);
909 if (of_serial_dir32) {
910 u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
911 (sizeof(*of_serial_dir) * val),
912 GFP_KERNEL);
913 if (!of_serial_dir) {
914 ret = -ENOMEM;
915 goto nodata;
916 }
917
918 for (i = 0; i < val; i++)
919 of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);
920
921 pdata->num_serializer = val;
922 pdata->serial_dir = of_serial_dir;
923 }
924
925 ret = of_property_match_string(np, "dma-names", "tx");
926 if (ret < 0)
927 goto nodata;
928
929 ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
930 &dma_spec);
931 if (ret < 0)
932 goto nodata;
933
934 pdata->tx_dma_channel = dma_spec.args[0];
935
936 ret = of_property_match_string(np, "dma-names", "rx");
937 if (ret < 0)
938 goto nodata;
939
940 ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
941 &dma_spec);
942 if (ret < 0)
943 goto nodata;
944
945 pdata->rx_dma_channel = dma_spec.args[0];
946
947 ret = of_property_read_u32(np, "tx-num-evt", &val);
948 if (ret >= 0)
949 pdata->txnumevt = val;
950
951 ret = of_property_read_u32(np, "rx-num-evt", &val);
952 if (ret >= 0)
953 pdata->rxnumevt = val;
954
955 ret = of_property_read_u32(np, "sram-size-playback", &val);
956 if (ret >= 0)
957 pdata->sram_size_playback = val;
958
959 ret = of_property_read_u32(np, "sram-size-capture", &val);
960 if (ret >= 0)
961 pdata->sram_size_capture = val;
962
963 return pdata;
964
965 nodata:
966 if (ret < 0) {
967 dev_err(&pdev->dev, "Error populating platform data, err %d\n",
968 ret);
969 pdata = NULL;
970 }
971 return pdata;
972 }
973
974 static int davinci_mcasp_probe(struct platform_device *pdev)
975 {
976 struct davinci_pcm_dma_params *dma_data;
977 struct resource *mem, *ioarea, *res, *dat;
978 struct snd_platform_data *pdata;
979 struct davinci_mcasp *mcasp;
980 int ret;
981
982 if (!pdev->dev.platform_data && !pdev->dev.of_node) {
983 dev_err(&pdev->dev, "No platform data supplied\n");
984 return -EINVAL;
985 }
986
987 mcasp = devm_kzalloc(&pdev->dev, sizeof(struct davinci_mcasp),
988 GFP_KERNEL);
989 if (!mcasp)
990 return -ENOMEM;
991
992 pdata = davinci_mcasp_set_pdata_from_of(pdev);
993 if (!pdata) {
994 dev_err(&pdev->dev, "no platform data\n");
995 return -EINVAL;
996 }
997
998 mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
999 if (!mem) {
1000 dev_warn(mcasp->dev,
1001 "\"mpu\" mem resource not found, using index 0\n");
1002 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1003 if (!mem) {
1004 dev_err(&pdev->dev, "no mem resource?\n");
1005 return -ENODEV;
1006 }
1007 }
1008
1009 ioarea = devm_request_mem_region(&pdev->dev, mem->start,
1010 resource_size(mem), pdev->name);
1011 if (!ioarea) {
1012 dev_err(&pdev->dev, "Audio region already claimed\n");
1013 return -EBUSY;
1014 }
1015
1016 pm_runtime_enable(&pdev->dev);
1017
1018 ret = pm_runtime_get_sync(&pdev->dev);
1019 if (IS_ERR_VALUE(ret)) {
1020 dev_err(&pdev->dev, "pm_runtime_get_sync() failed\n");
1021 return ret;
1022 }
1023
1024 mcasp->base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
1025 if (!mcasp->base) {
1026 dev_err(&pdev->dev, "ioremap failed\n");
1027 ret = -ENOMEM;
1028 goto err_release_clk;
1029 }
1030
1031 mcasp->op_mode = pdata->op_mode;
1032 mcasp->tdm_slots = pdata->tdm_slots;
1033 mcasp->num_serializer = pdata->num_serializer;
1034 mcasp->serial_dir = pdata->serial_dir;
1035 mcasp->version = pdata->version;
1036 mcasp->txnumevt = pdata->txnumevt;
1037 mcasp->rxnumevt = pdata->rxnumevt;
1038
1039 mcasp->dev = &pdev->dev;
1040
1041 dat = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
1042 if (dat)
1043 mcasp->dat_port = true;
1044
1045 dma_data = &mcasp->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
1046 dma_data->asp_chan_q = pdata->asp_chan_q;
1047 dma_data->ram_chan_q = pdata->ram_chan_q;
1048 dma_data->sram_pool = pdata->sram_pool;
1049 dma_data->sram_size = pdata->sram_size_playback;
1050 if (dat)
1051 dma_data->dma_addr = dat->start;
1052 else
1053 dma_data->dma_addr = mem->start + pdata->tx_dma_offset;
1054
1055 /* Unconditional dmaengine stuff */
1056 mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK].addr = dma_data->dma_addr;
1057
1058 res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1059 if (res)
1060 dma_data->channel = res->start;
1061 else
1062 dma_data->channel = pdata->tx_dma_channel;
1063
1064 dma_data = &mcasp->dma_params[SNDRV_PCM_STREAM_CAPTURE];
1065 dma_data->asp_chan_q = pdata->asp_chan_q;
1066 dma_data->ram_chan_q = pdata->ram_chan_q;
1067 dma_data->sram_pool = pdata->sram_pool;
1068 dma_data->sram_size = pdata->sram_size_capture;
1069 if (dat)
1070 dma_data->dma_addr = dat->start;
1071 else
1072 dma_data->dma_addr = mem->start + pdata->rx_dma_offset;
1073
1074 /* Unconditional dmaengine stuff */
1075 mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE].addr = dma_data->dma_addr;
1076
1077 if (mcasp->version < MCASP_VERSION_3) {
1078 mcasp->fifo_base = DAVINCI_MCASP_V2_AFIFO_BASE;
1079 /* dma_data->dma_addr is pointing to the data port address */
1080 mcasp->dat_port = true;
1081 } else {
1082 mcasp->fifo_base = DAVINCI_MCASP_V3_AFIFO_BASE;
1083 }
1084
1085 res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1086 if (res)
1087 dma_data->channel = res->start;
1088 else
1089 dma_data->channel = pdata->rx_dma_channel;
1090
1091 /* Unconditional dmaengine stuff */
1092 mcasp->dma_data[SNDRV_PCM_STREAM_PLAYBACK].filter_data = "tx";
1093 mcasp->dma_data[SNDRV_PCM_STREAM_CAPTURE].filter_data = "rx";
1094
1095 dev_set_drvdata(&pdev->dev, mcasp);
1096
1097 mcasp_reparent_fck(pdev);
1098
1099 ret = snd_soc_register_component(&pdev->dev, &davinci_mcasp_component,
1100 &davinci_mcasp_dai[pdata->op_mode], 1);
1101
1102 if (ret != 0)
1103 goto err_release_clk;
1104
1105 if (mcasp->version != MCASP_VERSION_4) {
1106 ret = davinci_soc_platform_register(&pdev->dev);
1107 if (ret) {
1108 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
1109 goto err_unregister_component;
1110 }
1111 }
1112
1113 return 0;
1114
1115 err_unregister_component:
1116 snd_soc_unregister_component(&pdev->dev);
1117 err_release_clk:
1118 pm_runtime_put_sync(&pdev->dev);
1119 pm_runtime_disable(&pdev->dev);
1120 return ret;
1121 }
1122
1123 static int davinci_mcasp_remove(struct platform_device *pdev)
1124 {
1125 struct davinci_mcasp *mcasp = dev_get_drvdata(&pdev->dev);
1126
1127 snd_soc_unregister_component(&pdev->dev);
1128 if (mcasp->version != MCASP_VERSION_4)
1129 davinci_soc_platform_unregister(&pdev->dev);
1130
1131 pm_runtime_put_sync(&pdev->dev);
1132 pm_runtime_disable(&pdev->dev);
1133
1134 return 0;
1135 }
1136
1137 #ifdef CONFIG_PM_SLEEP
1138 static int davinci_mcasp_suspend(struct device *dev)
1139 {
1140 struct davinci_mcasp *mcasp = dev_get_drvdata(dev);
1141
1142 mcasp->context.txfmtctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG);
1143 mcasp->context.rxfmtctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG);
1144 mcasp->context.txfmt = mcasp_get_reg(mcasp, DAVINCI_MCASP_TXFMT_REG);
1145 mcasp->context.rxfmt = mcasp_get_reg(mcasp, DAVINCI_MCASP_RXFMT_REG);
1146 mcasp->context.aclkxctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG);
1147 mcasp->context.aclkrctl = mcasp_get_reg(mcasp, DAVINCI_MCASP_ACLKRCTL_REG);
1148 mcasp->context.pdir = mcasp_get_reg(mcasp, DAVINCI_MCASP_PDIR_REG);
1149
1150 return 0;
1151 }
1152
1153 static int davinci_mcasp_resume(struct device *dev)
1154 {
1155 struct davinci_mcasp *mcasp = dev_get_drvdata(dev);
1156
1157 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMCTL_REG, mcasp->context.txfmtctl);
1158 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXFMCTL_REG, mcasp->context.rxfmtctl);
1159 mcasp_set_reg(mcasp, DAVINCI_MCASP_TXFMT_REG, mcasp->context.txfmt);
1160 mcasp_set_reg(mcasp, DAVINCI_MCASP_RXFMT_REG, mcasp->context.rxfmt);
1161 mcasp_set_reg(mcasp, DAVINCI_MCASP_ACLKXCTL_REG, mcasp->context.aclkxctl);
1162 mcasp_set_reg(mcasp, DAVINCI_MCASP_ACLKRCTL_REG, mcasp->context.aclkrctl);
1163 mcasp_set_reg(mcasp, DAVINCI_MCASP_PDIR_REG, mcasp->context.pdir);
1164
1165 return 0;
1166 }
1167 #endif
1168
1169 SIMPLE_DEV_PM_OPS(davinci_mcasp_pm_ops,
1170 davinci_mcasp_suspend,
1171 davinci_mcasp_resume);
1172
1173 static struct platform_driver davinci_mcasp_driver = {
1174 .probe = davinci_mcasp_probe,
1175 .remove = davinci_mcasp_remove,
1176 .driver = {
1177 .name = "davinci-mcasp",
1178 .owner = THIS_MODULE,
1179 .pm = &davinci_mcasp_pm_ops,
1180 .of_match_table = mcasp_dt_ids,
1181 },
1182 };
1183
1184 module_platform_driver(davinci_mcasp_driver);
1185
1186 MODULE_AUTHOR("Steve Chen");
1187 MODULE_DESCRIPTION("TI DAVINCI McASP SoC Interface");
1188 MODULE_LICENSE("GPL");
Linux with added FPC-III support