]> www.pilppa.org Git - linux-2.6-omap-h63xx.git/blob - sound/soc/davinci/davinci-i2s.c
ASoC: DaVinci: Audio: Fix swapping of channels at start of stereo playback
[linux-2.6-omap-h63xx.git] / sound / soc / davinci / davinci-i2s.c
1 /*
2  * ALSA SoC I2S (McBSP) Audio Layer for TI DAVINCI processor
3  *
4  * Author:      Vladimir Barinov, <vbarinov@embeddedalley.com>
5  * Copyright:   (C) 2007 MontaVista Software, Inc., <source@mvista.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11
12 #include <linux/init.h>
13 #include <linux/module.h>
14 #include <linux/device.h>
15 #include <linux/delay.h>
16 #include <linux/io.h>
17 #include <linux/clk.h>
18
19 #include <sound/core.h>
20 #include <sound/pcm.h>
21 #include <sound/pcm_params.h>
22 #include <sound/initval.h>
23 #include <sound/soc.h>
24
25 #include "davinci-pcm.h"
26
27 #define DAVINCI_MCBSP_DRR_REG   0x00
28 #define DAVINCI_MCBSP_DXR_REG   0x04
29 #define DAVINCI_MCBSP_SPCR_REG  0x08
30 #define DAVINCI_MCBSP_RCR_REG   0x0c
31 #define DAVINCI_MCBSP_XCR_REG   0x10
32 #define DAVINCI_MCBSP_SRGR_REG  0x14
33 #define DAVINCI_MCBSP_PCR_REG   0x24
34
35 #define DAVINCI_MCBSP_SPCR_RRST         (1 << 0)
36 #define DAVINCI_MCBSP_SPCR_RINTM(v)     ((v) << 4)
37 #define DAVINCI_MCBSP_SPCR_XRST         (1 << 16)
38 #define DAVINCI_MCBSP_SPCR_XINTM(v)     ((v) << 20)
39 #define DAVINCI_MCBSP_SPCR_GRST         (1 << 22)
40 #define DAVINCI_MCBSP_SPCR_FRST         (1 << 23)
41 #define DAVINCI_MCBSP_SPCR_FREE         (1 << 25)
42
43 #define DAVINCI_MCBSP_RCR_RWDLEN1(v)    ((v) << 5)
44 #define DAVINCI_MCBSP_RCR_RFRLEN1(v)    ((v) << 8)
45 #define DAVINCI_MCBSP_RCR_RDATDLY(v)    ((v) << 16)
46 #define DAVINCI_MCBSP_RCR_RWDLEN2(v)    ((v) << 21)
47
48 #define DAVINCI_MCBSP_XCR_XWDLEN1(v)    ((v) << 5)
49 #define DAVINCI_MCBSP_XCR_XFRLEN1(v)    ((v) << 8)
50 #define DAVINCI_MCBSP_XCR_XDATDLY(v)    ((v) << 16)
51 #define DAVINCI_MCBSP_XCR_XFIG          (1 << 18)
52 #define DAVINCI_MCBSP_XCR_XWDLEN2(v)    ((v) << 21)
53
54 #define DAVINCI_MCBSP_SRGR_FWID(v)      ((v) << 8)
55 #define DAVINCI_MCBSP_SRGR_FPER(v)      ((v) << 16)
56 #define DAVINCI_MCBSP_SRGR_FSGM         (1 << 28)
57
58 #define DAVINCI_MCBSP_PCR_CLKRP         (1 << 0)
59 #define DAVINCI_MCBSP_PCR_CLKXP         (1 << 1)
60 #define DAVINCI_MCBSP_PCR_FSRP          (1 << 2)
61 #define DAVINCI_MCBSP_PCR_FSXP          (1 << 3)
62 #define DAVINCI_MCBSP_PCR_SCLKME        (1 << 7)
63 #define DAVINCI_MCBSP_PCR_CLKRM         (1 << 8)
64 #define DAVINCI_MCBSP_PCR_CLKXM         (1 << 9)
65 #define DAVINCI_MCBSP_PCR_FSRM          (1 << 10)
66 #define DAVINCI_MCBSP_PCR_FSXM          (1 << 11)
67
68 #define MOD_REG_BIT(val, mask, set) do { \
69         if (set) { \
70                 val |= mask; \
71         } else { \
72                 val &= ~mask; \
73         } \
74 } while (0)
75
76 enum {
77         DAVINCI_MCBSP_WORD_8 = 0,
78         DAVINCI_MCBSP_WORD_12,
79         DAVINCI_MCBSP_WORD_16,
80         DAVINCI_MCBSP_WORD_20,
81         DAVINCI_MCBSP_WORD_24,
82         DAVINCI_MCBSP_WORD_32,
83 };
84
85 static struct davinci_pcm_dma_params davinci_i2s_pcm_out = {
86         .name = "I2S PCM Stereo out",
87 };
88
89 static struct davinci_pcm_dma_params davinci_i2s_pcm_in = {
90         .name = "I2S PCM Stereo in",
91 };
92
93 struct davinci_mcbsp_dev {
94         void __iomem                    *base;
95         struct clk                      *clk;
96         struct davinci_pcm_dma_params   *dma_params[2];
97 };
98
99 static inline void davinci_mcbsp_write_reg(struct davinci_mcbsp_dev *dev,
100                                            int reg, u32 val)
101 {
102         __raw_writel(val, dev->base + reg);
103 }
104
105 static inline u32 davinci_mcbsp_read_reg(struct davinci_mcbsp_dev *dev, int reg)
106 {
107         return __raw_readl(dev->base + reg);
108 }
109
110 static void davinci_mcbsp_start(struct snd_pcm_substream *substream)
111 {
112         struct snd_soc_pcm_runtime *rtd = substream->private_data;
113         struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data;
114         struct snd_soc_device *socdev = rtd->socdev;
115         struct snd_soc_platform *platform = socdev->platform;
116         u32 w;
117         int ret;
118
119         /* Start the sample generator and enable transmitter/receiver */
120         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
121         MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_GRST, 1);
122         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
123
124         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
125                 /* Stop the DMA to avoid data loss */
126                 /* while the transmitter is out of reset to handle XSYNCERR */
127                 if (platform->pcm_ops->trigger) {
128                         ret = platform->pcm_ops->trigger(substream,
129                                 SNDRV_PCM_TRIGGER_STOP);
130                         if (ret < 0)
131                                 printk(KERN_DEBUG "Playback DMA stop failed\n");
132                 }
133
134                 /* Enable the transmitter */
135                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
136                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 1);
137                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
138
139                 /* wait for any unexpected frame sync error to occur */
140                 udelay(100);
141
142                 /* Disable the transmitter to clear any outstanding XSYNCERR */
143                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
144                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 0);
145                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
146
147                 /* Restart the DMA */
148                 if (platform->pcm_ops->trigger) {
149                         ret = platform->pcm_ops->trigger(substream,
150                                 SNDRV_PCM_TRIGGER_START);
151                         if (ret < 0)
152                                 printk(KERN_DEBUG "Playback DMA start failed\n");
153                 }
154                 /* Enable the transmitter */
155                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
156                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 1);
157                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
158
159         } else {
160
161                 /* Enable the reciever */
162                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
163                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_RRST, 1);
164                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
165         }
166
167
168         /* Start frame sync */
169         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
170         MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_FRST, 1);
171         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
172 }
173
174 static void davinci_mcbsp_stop(struct snd_pcm_substream *substream)
175 {
176         struct snd_soc_pcm_runtime *rtd = substream->private_data;
177         struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data;
178         u32 w;
179
180         /* Reset transmitter/receiver and sample rate/frame sync generators */
181         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SPCR_REG);
182         MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_GRST |
183                        DAVINCI_MCBSP_SPCR_FRST, 0);
184         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
185                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_XRST, 0);
186         else
187                 MOD_REG_BIT(w, DAVINCI_MCBSP_SPCR_RRST, 0);
188         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG, w);
189 }
190
191 static int davinci_i2s_startup(struct snd_pcm_substream *substream)
192 {
193         struct snd_soc_pcm_runtime *rtd = substream->private_data;
194         struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
195         struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data;
196
197         cpu_dai->dma_data = dev->dma_params[substream->stream];
198
199         return 0;
200 }
201
202 static int davinci_i2s_set_dai_fmt(struct snd_soc_dai *cpu_dai,
203                                    unsigned int fmt)
204 {
205         struct davinci_mcbsp_dev *dev = cpu_dai->private_data;
206         u32 w;
207
208         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
209         case SND_SOC_DAIFMT_CBS_CFS:
210                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG,
211                                         DAVINCI_MCBSP_PCR_FSXM |
212                                         DAVINCI_MCBSP_PCR_FSRM |
213                                         DAVINCI_MCBSP_PCR_CLKXM |
214                                         DAVINCI_MCBSP_PCR_CLKRM);
215                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG,
216                                         DAVINCI_MCBSP_SRGR_FSGM);
217                 break;
218         case SND_SOC_DAIFMT_CBM_CFS:
219                 /* McBSP CLKR pin is the input for the Sample Rate Generator.
220                  * McBSP FSR and FSX are driven by the Sample Rate Generator. */
221                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG,
222                                         DAVINCI_MCBSP_PCR_SCLKME |
223                                         DAVINCI_MCBSP_PCR_FSXM |
224                                         DAVINCI_MCBSP_PCR_FSRM);
225                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG,
226                                         DAVINCI_MCBSP_SRGR_FSGM);
227                 break;
228         case SND_SOC_DAIFMT_CBM_CFM:
229                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG, 0);
230                 break;
231         default:
232                 return -EINVAL;
233         }
234
235         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
236         case SND_SOC_DAIFMT_IB_NF:
237                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_PCR_REG);
238                 MOD_REG_BIT(w, DAVINCI_MCBSP_PCR_CLKXP |
239                                DAVINCI_MCBSP_PCR_CLKRP, 1);
240                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG, w);
241                 break;
242         case SND_SOC_DAIFMT_NB_IF:
243                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_PCR_REG);
244                 MOD_REG_BIT(w, DAVINCI_MCBSP_PCR_FSXP |
245                                DAVINCI_MCBSP_PCR_FSRP, 1);
246                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG, w);
247                 break;
248         case SND_SOC_DAIFMT_IB_IF:
249                 w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_PCR_REG);
250                 MOD_REG_BIT(w, DAVINCI_MCBSP_PCR_CLKXP |
251                                DAVINCI_MCBSP_PCR_CLKRP |
252                                DAVINCI_MCBSP_PCR_FSXP |
253                                DAVINCI_MCBSP_PCR_FSRP, 1);
254                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_PCR_REG, w);
255                 break;
256         case SND_SOC_DAIFMT_NB_NF:
257                 break;
258         default:
259                 return -EINVAL;
260         }
261
262         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
263         case SND_SOC_DAIFMT_RIGHT_J:
264                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_RCR_REG,
265                                         DAVINCI_MCBSP_RCR_RFRLEN1(1) |
266                                         DAVINCI_MCBSP_RCR_RDATDLY(0));
267                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_XCR_REG,
268                                         DAVINCI_MCBSP_XCR_XFRLEN1(1) |
269                                         DAVINCI_MCBSP_XCR_XDATDLY(0) |
270                                         DAVINCI_MCBSP_XCR_XFIG);
271                 break;
272         case SND_SOC_DAIFMT_I2S:
273         default:
274                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_RCR_REG,
275                                         DAVINCI_MCBSP_RCR_RFRLEN1(1) |
276                                         DAVINCI_MCBSP_RCR_RDATDLY(1));
277                 davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_XCR_REG,
278                                         DAVINCI_MCBSP_XCR_XFRLEN1(1) |
279                                         DAVINCI_MCBSP_XCR_XDATDLY(1) |
280                                         DAVINCI_MCBSP_XCR_XFIG);
281                 break;
282         }
283
284         return 0;
285 }
286
287 static int davinci_i2s_hw_params(struct snd_pcm_substream *substream,
288                                  struct snd_pcm_hw_params *params)
289 {
290         struct snd_soc_pcm_runtime *rtd = substream->private_data;
291         struct davinci_pcm_dma_params *dma_params = rtd->dai->cpu_dai->dma_data;
292         struct davinci_mcbsp_dev *dev = rtd->dai->cpu_dai->private_data;
293         struct snd_interval *i = NULL;
294         int mcbsp_word_length;
295         u32 w;
296
297         /* general line settings */
298         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SPCR_REG,
299                                 DAVINCI_MCBSP_SPCR_RINTM(3) |
300                                 DAVINCI_MCBSP_SPCR_XINTM(3) |
301                                 DAVINCI_MCBSP_SPCR_FREE);
302
303         i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_SAMPLE_BITS);
304         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SRGR_REG);
305         MOD_REG_BIT(w, DAVINCI_MCBSP_SRGR_FWID(snd_interval_value(i) - 1), 1);
306         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG, w);
307
308         i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_FRAME_BITS);
309         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_SRGR_REG);
310         MOD_REG_BIT(w, DAVINCI_MCBSP_SRGR_FPER(snd_interval_value(i) - 1), 1);
311         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_SRGR_REG, w);
312
313         /* Determine xfer data type */
314         switch (params_format(params)) {
315         case SNDRV_PCM_FORMAT_S8:
316                 dma_params->data_type = 1;
317                 mcbsp_word_length = DAVINCI_MCBSP_WORD_8;
318                 break;
319         case SNDRV_PCM_FORMAT_S16_LE:
320                 dma_params->data_type = 2;
321                 mcbsp_word_length = DAVINCI_MCBSP_WORD_16;
322                 break;
323         case SNDRV_PCM_FORMAT_S32_LE:
324                 dma_params->data_type = 4;
325                 mcbsp_word_length = DAVINCI_MCBSP_WORD_32;
326                 break;
327         default:
328                 printk(KERN_WARNING "davinci-i2s: unsupported PCM format\n");
329                 return -EINVAL;
330         }
331
332         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_RCR_REG);
333         MOD_REG_BIT(w, DAVINCI_MCBSP_RCR_RWDLEN1(mcbsp_word_length) |
334                        DAVINCI_MCBSP_RCR_RWDLEN2(mcbsp_word_length), 1);
335         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_RCR_REG, w);
336
337         w = davinci_mcbsp_read_reg(dev, DAVINCI_MCBSP_XCR_REG);
338         MOD_REG_BIT(w, DAVINCI_MCBSP_XCR_XWDLEN1(mcbsp_word_length) |
339                        DAVINCI_MCBSP_XCR_XWDLEN2(mcbsp_word_length), 1);
340         davinci_mcbsp_write_reg(dev, DAVINCI_MCBSP_XCR_REG, w);
341
342         return 0;
343 }
344
345 static int davinci_i2s_trigger(struct snd_pcm_substream *substream, int cmd)
346 {
347         int ret = 0;
348
349         switch (cmd) {
350         case SNDRV_PCM_TRIGGER_START:
351         case SNDRV_PCM_TRIGGER_RESUME:
352         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
353                 davinci_mcbsp_start(substream);
354                 break;
355         case SNDRV_PCM_TRIGGER_STOP:
356         case SNDRV_PCM_TRIGGER_SUSPEND:
357         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
358                 davinci_mcbsp_stop(substream);
359                 break;
360         default:
361                 ret = -EINVAL;
362         }
363
364         return ret;
365 }
366
367 static int davinci_i2s_probe(struct platform_device *pdev,
368                              struct snd_soc_dai *dai)
369 {
370         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
371         struct snd_soc_machine *machine = socdev->machine;
372         struct snd_soc_dai *cpu_dai = machine->dai_link[pdev->id].cpu_dai;
373         struct davinci_mcbsp_dev *dev;
374         struct resource *mem, *ioarea;
375         struct evm_snd_platform_data *pdata;
376         int ret;
377
378         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
379         if (!mem) {
380                 dev_err(&pdev->dev, "no mem resource?\n");
381                 return -ENODEV;
382         }
383
384         ioarea = request_mem_region(mem->start, (mem->end - mem->start) + 1,
385                                     pdev->name);
386         if (!ioarea) {
387                 dev_err(&pdev->dev, "McBSP region already claimed\n");
388                 return -EBUSY;
389         }
390
391         dev = kzalloc(sizeof(struct davinci_mcbsp_dev), GFP_KERNEL);
392         if (!dev) {
393                 ret = -ENOMEM;
394                 goto err_release_region;
395         }
396
397         cpu_dai->private_data = dev;
398
399         dev->clk = clk_get(&pdev->dev, "McBSPCLK");
400         if (IS_ERR(dev->clk)) {
401                 ret = -ENODEV;
402                 goto err_free_mem;
403         }
404         clk_enable(dev->clk);
405
406         dev->base = (void __iomem *)IO_ADDRESS(mem->start);
407         pdata = pdev->dev.platform_data;
408
409         dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK] = &davinci_i2s_pcm_out;
410         dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK]->channel = pdata->tx_dma_ch;
411         dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK]->dma_addr =
412             (dma_addr_t)(io_v2p(dev->base) + DAVINCI_MCBSP_DXR_REG);
413
414         dev->dma_params[SNDRV_PCM_STREAM_CAPTURE] = &davinci_i2s_pcm_in;
415         dev->dma_params[SNDRV_PCM_STREAM_CAPTURE]->channel = pdata->rx_dma_ch;
416         dev->dma_params[SNDRV_PCM_STREAM_CAPTURE]->dma_addr =
417             (dma_addr_t)(io_v2p(dev->base) + DAVINCI_MCBSP_DRR_REG);
418
419         return 0;
420
421 err_free_mem:
422         kfree(dev);
423 err_release_region:
424         release_mem_region(mem->start, (mem->end - mem->start) + 1);
425
426         return ret;
427 }
428
429 static void davinci_i2s_remove(struct platform_device *pdev,
430                                struct snd_soc_dai *dai)
431 {
432         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
433         struct snd_soc_machine *machine = socdev->machine;
434         struct snd_soc_dai *cpu_dai = machine->dai_link[pdev->id].cpu_dai;
435         struct davinci_mcbsp_dev *dev = cpu_dai->private_data;
436         struct resource *mem;
437
438         clk_disable(dev->clk);
439         clk_put(dev->clk);
440         dev->clk = NULL;
441
442         kfree(dev);
443
444         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
445         release_mem_region(mem->start, (mem->end - mem->start) + 1);
446 }
447
448 #define DAVINCI_I2S_RATES       SNDRV_PCM_RATE_8000_96000
449
450 struct snd_soc_dai davinci_i2s_dai = {
451         .name = "davinci-i2s",
452         .id = 0,
453         .type = SND_SOC_DAI_I2S,
454         .probe = davinci_i2s_probe,
455         .remove = davinci_i2s_remove,
456         .playback = {
457                 .channels_min = 2,
458                 .channels_max = 2,
459                 .rates = DAVINCI_I2S_RATES,
460                 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
461         .capture = {
462                 .channels_min = 2,
463                 .channels_max = 2,
464                 .rates = DAVINCI_I2S_RATES,
465                 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
466         .ops = {
467                 .startup = davinci_i2s_startup,
468                 .trigger = davinci_i2s_trigger,
469                 .hw_params = davinci_i2s_hw_params,},
470         .dai_ops = {
471                 .set_fmt = davinci_i2s_set_dai_fmt,
472         },
473 };
474 EXPORT_SYMBOL_GPL(davinci_i2s_dai);
475
476 MODULE_AUTHOR("Vladimir Barinov");
477 MODULE_DESCRIPTION("TI DAVINCI I2S (McBSP) SoC Interface");
478 MODULE_LICENSE("GPL");