Merge branch 'perf-urgent-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[cascardo/linux.git] / sound / soc / dwc / designware_i2s.c
1 /*
2  * ALSA SoC Synopsys I2S Audio Layer
3  *
4  * sound/soc/dwc/designware_i2s.c
5  *
6  * Copyright (C) 2010 ST Microelectronics
7  * Rajeev Kumar <rajeevkumar.linux@gmail.com>
8  *
9  * This file is licensed under the terms of the GNU General Public
10  * License version 2. This program is licensed "as is" without any
11  * warranty of any kind, whether express or implied.
12  */
13
14 #include <linux/clk.h>
15 #include <linux/device.h>
16 #include <linux/init.h>
17 #include <linux/io.h>
18 #include <linux/interrupt.h>
19 #include <linux/module.h>
20 #include <linux/slab.h>
21 #include <sound/designware_i2s.h>
22 #include <sound/pcm.h>
23 #include <sound/pcm_params.h>
24 #include <sound/soc.h>
25
26 /* common register for all channel */
27 #define IER             0x000
28 #define IRER            0x004
29 #define ITER            0x008
30 #define CER             0x00C
31 #define CCR             0x010
32 #define RXFFR           0x014
33 #define TXFFR           0x018
34
35 /* I2STxRxRegisters for all channels */
36 #define LRBR_LTHR(x)    (0x40 * x + 0x020)
37 #define RRBR_RTHR(x)    (0x40 * x + 0x024)
38 #define RER(x)          (0x40 * x + 0x028)
39 #define TER(x)          (0x40 * x + 0x02C)
40 #define RCR(x)          (0x40 * x + 0x030)
41 #define TCR(x)          (0x40 * x + 0x034)
42 #define ISR(x)          (0x40 * x + 0x038)
43 #define IMR(x)          (0x40 * x + 0x03C)
44 #define ROR(x)          (0x40 * x + 0x040)
45 #define TOR(x)          (0x40 * x + 0x044)
46 #define RFCR(x)         (0x40 * x + 0x048)
47 #define TFCR(x)         (0x40 * x + 0x04C)
48 #define RFF(x)          (0x40 * x + 0x050)
49 #define TFF(x)          (0x40 * x + 0x054)
50
51 /* I2SCOMPRegisters */
52 #define I2S_COMP_PARAM_2        0x01F0
53 #define I2S_COMP_PARAM_1        0x01F4
54 #define I2S_COMP_VERSION        0x01F8
55 #define I2S_COMP_TYPE           0x01FC
56
57 #define MAX_CHANNEL_NUM         8
58 #define MIN_CHANNEL_NUM         2
59
60 struct dw_i2s_dev {
61         void __iomem *i2s_base;
62         struct clk *clk;
63         int active;
64         unsigned int capability;
65         struct device *dev;
66
67         /* data related to DMA transfers b/w i2s and DMAC */
68         struct i2s_dma_data play_dma_data;
69         struct i2s_dma_data capture_dma_data;
70         struct i2s_clk_config_data config;
71         int (*i2s_clk_cfg)(struct i2s_clk_config_data *config);
72 };
73
74 static inline void i2s_write_reg(void __iomem *io_base, int reg, u32 val)
75 {
76         writel(val, io_base + reg);
77 }
78
79 static inline u32 i2s_read_reg(void __iomem *io_base, int reg)
80 {
81         return readl(io_base + reg);
82 }
83
84 static inline void i2s_disable_channels(struct dw_i2s_dev *dev, u32 stream)
85 {
86         u32 i = 0;
87
88         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
89                 for (i = 0; i < 4; i++)
90                         i2s_write_reg(dev->i2s_base, TER(i), 0);
91         } else {
92                 for (i = 0; i < 4; i++)
93                         i2s_write_reg(dev->i2s_base, RER(i), 0);
94         }
95 }
96
97 static inline void i2s_clear_irqs(struct dw_i2s_dev *dev, u32 stream)
98 {
99         u32 i = 0;
100
101         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
102                 for (i = 0; i < 4; i++)
103                         i2s_write_reg(dev->i2s_base, TOR(i), 0);
104         } else {
105                 for (i = 0; i < 4; i++)
106                         i2s_write_reg(dev->i2s_base, ROR(i), 0);
107         }
108 }
109
110 static void i2s_start(struct dw_i2s_dev *dev,
111                       struct snd_pcm_substream *substream)
112 {
113
114         i2s_write_reg(dev->i2s_base, IER, 1);
115
116         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
117                 i2s_write_reg(dev->i2s_base, ITER, 1);
118         else
119                 i2s_write_reg(dev->i2s_base, IRER, 1);
120
121         i2s_write_reg(dev->i2s_base, CER, 1);
122 }
123
124 static void i2s_stop(struct dw_i2s_dev *dev,
125                 struct snd_pcm_substream *substream)
126 {
127         u32 i = 0, irq;
128
129         i2s_clear_irqs(dev, substream->stream);
130         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
131                 i2s_write_reg(dev->i2s_base, ITER, 0);
132
133                 for (i = 0; i < 4; i++) {
134                         irq = i2s_read_reg(dev->i2s_base, IMR(i));
135                         i2s_write_reg(dev->i2s_base, IMR(i), irq | 0x30);
136                 }
137         } else {
138                 i2s_write_reg(dev->i2s_base, IRER, 0);
139
140                 for (i = 0; i < 4; i++) {
141                         irq = i2s_read_reg(dev->i2s_base, IMR(i));
142                         i2s_write_reg(dev->i2s_base, IMR(i), irq | 0x03);
143                 }
144         }
145
146         if (!dev->active) {
147                 i2s_write_reg(dev->i2s_base, CER, 0);
148                 i2s_write_reg(dev->i2s_base, IER, 0);
149         }
150 }
151
152 static int dw_i2s_startup(struct snd_pcm_substream *substream,
153                 struct snd_soc_dai *cpu_dai)
154 {
155         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(cpu_dai);
156         struct i2s_dma_data *dma_data = NULL;
157
158         if (!(dev->capability & DWC_I2S_RECORD) &&
159                         (substream->stream == SNDRV_PCM_STREAM_CAPTURE))
160                 return -EINVAL;
161
162         if (!(dev->capability & DWC_I2S_PLAY) &&
163                         (substream->stream == SNDRV_PCM_STREAM_PLAYBACK))
164                 return -EINVAL;
165
166         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
167                 dma_data = &dev->play_dma_data;
168         else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
169                 dma_data = &dev->capture_dma_data;
170
171         snd_soc_dai_set_dma_data(cpu_dai, substream, (void *)dma_data);
172
173         return 0;
174 }
175
176 static int dw_i2s_hw_params(struct snd_pcm_substream *substream,
177                 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
178 {
179         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
180         struct i2s_clk_config_data *config = &dev->config;
181         u32 ccr, xfer_resolution, ch_reg, irq;
182         int ret;
183
184         switch (params_format(params)) {
185         case SNDRV_PCM_FORMAT_S16_LE:
186                 config->data_width = 16;
187                 ccr = 0x00;
188                 xfer_resolution = 0x02;
189                 break;
190
191         case SNDRV_PCM_FORMAT_S24_LE:
192                 config->data_width = 24;
193                 ccr = 0x08;
194                 xfer_resolution = 0x04;
195                 break;
196
197         case SNDRV_PCM_FORMAT_S32_LE:
198                 config->data_width = 32;
199                 ccr = 0x10;
200                 xfer_resolution = 0x05;
201                 break;
202
203         default:
204                 dev_err(dev->dev, "designware-i2s: unsuppted PCM fmt");
205                 return -EINVAL;
206         }
207
208         config->chan_nr = params_channels(params);
209
210         switch (config->chan_nr) {
211         case EIGHT_CHANNEL_SUPPORT:
212         case SIX_CHANNEL_SUPPORT:
213         case FOUR_CHANNEL_SUPPORT:
214         case TWO_CHANNEL_SUPPORT:
215                 break;
216         default:
217                 dev_err(dev->dev, "channel not supported\n");
218                 return -EINVAL;
219         }
220
221         i2s_disable_channels(dev, substream->stream);
222
223         for (ch_reg = 0; ch_reg < (config->chan_nr / 2); ch_reg++) {
224                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
225                         i2s_write_reg(dev->i2s_base, TCR(ch_reg),
226                                       xfer_resolution);
227                         i2s_write_reg(dev->i2s_base, TFCR(ch_reg), 0x02);
228                         irq = i2s_read_reg(dev->i2s_base, IMR(ch_reg));
229                         i2s_write_reg(dev->i2s_base, IMR(ch_reg), irq & ~0x30);
230                         i2s_write_reg(dev->i2s_base, TER(ch_reg), 1);
231                 } else {
232                         i2s_write_reg(dev->i2s_base, RCR(ch_reg),
233                                       xfer_resolution);
234                         i2s_write_reg(dev->i2s_base, RFCR(ch_reg), 0x07);
235                         irq = i2s_read_reg(dev->i2s_base, IMR(ch_reg));
236                         i2s_write_reg(dev->i2s_base, IMR(ch_reg), irq & ~0x03);
237                         i2s_write_reg(dev->i2s_base, RER(ch_reg), 1);
238                 }
239         }
240
241         i2s_write_reg(dev->i2s_base, CCR, ccr);
242
243         config->sample_rate = params_rate(params);
244
245         if (!dev->i2s_clk_cfg)
246                 return -EINVAL;
247
248         ret = dev->i2s_clk_cfg(config);
249         if (ret < 0) {
250                 dev_err(dev->dev, "runtime audio clk config fail\n");
251                 return ret;
252         }
253
254         return 0;
255 }
256
257 static void dw_i2s_shutdown(struct snd_pcm_substream *substream,
258                 struct snd_soc_dai *dai)
259 {
260         snd_soc_dai_set_dma_data(dai, substream, NULL);
261 }
262
263 static int dw_i2s_prepare(struct snd_pcm_substream *substream,
264                           struct snd_soc_dai *dai)
265 {
266         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
267
268         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
269                 i2s_write_reg(dev->i2s_base, TXFFR, 1);
270         else
271                 i2s_write_reg(dev->i2s_base, RXFFR, 1);
272
273         return 0;
274 }
275
276 static int dw_i2s_trigger(struct snd_pcm_substream *substream,
277                 int cmd, struct snd_soc_dai *dai)
278 {
279         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
280         int ret = 0;
281
282         switch (cmd) {
283         case SNDRV_PCM_TRIGGER_START:
284         case SNDRV_PCM_TRIGGER_RESUME:
285         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
286                 dev->active++;
287                 i2s_start(dev, substream);
288                 break;
289
290         case SNDRV_PCM_TRIGGER_STOP:
291         case SNDRV_PCM_TRIGGER_SUSPEND:
292         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
293                 dev->active--;
294                 i2s_stop(dev, substream);
295                 break;
296         default:
297                 ret = -EINVAL;
298                 break;
299         }
300         return ret;
301 }
302
303 static struct snd_soc_dai_ops dw_i2s_dai_ops = {
304         .startup        = dw_i2s_startup,
305         .shutdown       = dw_i2s_shutdown,
306         .hw_params      = dw_i2s_hw_params,
307         .prepare        = dw_i2s_prepare,
308         .trigger        = dw_i2s_trigger,
309 };
310
311 static const struct snd_soc_component_driver dw_i2s_component = {
312         .name           = "dw-i2s",
313 };
314
315 #ifdef CONFIG_PM
316
317 static int dw_i2s_suspend(struct snd_soc_dai *dai)
318 {
319         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
320
321         clk_disable(dev->clk);
322         return 0;
323 }
324
325 static int dw_i2s_resume(struct snd_soc_dai *dai)
326 {
327         struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
328
329         clk_enable(dev->clk);
330         return 0;
331 }
332
333 #else
334 #define dw_i2s_suspend  NULL
335 #define dw_i2s_resume   NULL
336 #endif
337
338 static int dw_i2s_probe(struct platform_device *pdev)
339 {
340         const struct i2s_platform_data *pdata = pdev->dev.platform_data;
341         struct dw_i2s_dev *dev;
342         struct resource *res;
343         int ret;
344         unsigned int cap;
345         struct snd_soc_dai_driver *dw_i2s_dai;
346
347         if (!pdata) {
348                 dev_err(&pdev->dev, "Invalid platform data\n");
349                 return -EINVAL;
350         }
351
352         dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
353         if (!dev) {
354                 dev_warn(&pdev->dev, "kzalloc fail\n");
355                 return -ENOMEM;
356         }
357
358         dw_i2s_dai = devm_kzalloc(&pdev->dev, sizeof(*dw_i2s_dai), GFP_KERNEL);
359         if (!dw_i2s_dai) {
360                 dev_err(&pdev->dev, "mem allocation failed for dai driver\n");
361                 return -ENOMEM;
362         }
363
364         dw_i2s_dai->ops = &dw_i2s_dai_ops;
365         dw_i2s_dai->suspend = dw_i2s_suspend;
366         dw_i2s_dai->resume = dw_i2s_resume;
367
368         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
369         if (!res) {
370                 dev_err(&pdev->dev, "no i2s resource defined\n");
371                 return -ENODEV;
372         }
373
374         dev->i2s_base = devm_ioremap_resource(&pdev->dev, res);
375         if (IS_ERR(dev->i2s_base)) {
376                 dev_err(&pdev->dev, "ioremap fail for i2s_region\n");
377                 return PTR_ERR(dev->i2s_base);
378         }
379
380         cap = pdata->cap;
381         dev->capability = cap;
382         dev->i2s_clk_cfg = pdata->i2s_clk_cfg;
383
384         /* Set DMA slaves info */
385
386         dev->play_dma_data.data = pdata->play_dma_data;
387         dev->capture_dma_data.data = pdata->capture_dma_data;
388         dev->play_dma_data.addr = res->start + I2S_TXDMA;
389         dev->capture_dma_data.addr = res->start + I2S_RXDMA;
390         dev->play_dma_data.max_burst = 16;
391         dev->capture_dma_data.max_burst = 16;
392         dev->play_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES;
393         dev->capture_dma_data.addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES;
394         dev->play_dma_data.filter = pdata->filter;
395         dev->capture_dma_data.filter = pdata->filter;
396
397         dev->clk = clk_get(&pdev->dev, NULL);
398         if (IS_ERR(dev->clk))
399                 return  PTR_ERR(dev->clk);
400
401         ret = clk_enable(dev->clk);
402         if (ret < 0)
403                 goto err_clk_put;
404
405         if (cap & DWC_I2S_PLAY) {
406                 dev_dbg(&pdev->dev, " designware: play supported\n");
407                 dw_i2s_dai->playback.channels_min = MIN_CHANNEL_NUM;
408                 dw_i2s_dai->playback.channels_max = pdata->channel;
409                 dw_i2s_dai->playback.formats = pdata->snd_fmts;
410                 dw_i2s_dai->playback.rates = pdata->snd_rates;
411         }
412
413         if (cap & DWC_I2S_RECORD) {
414                 dev_dbg(&pdev->dev, "designware: record supported\n");
415                 dw_i2s_dai->capture.channels_min = MIN_CHANNEL_NUM;
416                 dw_i2s_dai->capture.channels_max = pdata->channel;
417                 dw_i2s_dai->capture.formats = pdata->snd_fmts;
418                 dw_i2s_dai->capture.rates = pdata->snd_rates;
419         }
420
421         dev->dev = &pdev->dev;
422         dev_set_drvdata(&pdev->dev, dev);
423         ret = snd_soc_register_component(&pdev->dev, &dw_i2s_component,
424                                          dw_i2s_dai, 1);
425         if (ret != 0) {
426                 dev_err(&pdev->dev, "not able to register dai\n");
427                 goto err_clk_disable;
428         }
429
430         return 0;
431
432 err_clk_disable:
433         clk_disable(dev->clk);
434 err_clk_put:
435         clk_put(dev->clk);
436         return ret;
437 }
438
439 static int dw_i2s_remove(struct platform_device *pdev)
440 {
441         struct dw_i2s_dev *dev = dev_get_drvdata(&pdev->dev);
442
443         snd_soc_unregister_component(&pdev->dev);
444
445         clk_put(dev->clk);
446
447         return 0;
448 }
449
450 static struct platform_driver dw_i2s_driver = {
451         .probe          = dw_i2s_probe,
452         .remove         = dw_i2s_remove,
453         .driver         = {
454                 .name   = "designware-i2s",
455         },
456 };
457
458 module_platform_driver(dw_i2s_driver);
459
460 MODULE_AUTHOR("Rajeev Kumar <rajeevkumar.linux@gmail.com>");
461 MODULE_DESCRIPTION("DESIGNWARE I2S SoC Interface");
462 MODULE_LICENSE("GPL");
463 MODULE_ALIAS("platform:designware_i2s");