4 * (c) 2010 Arnaud Patard <apatard@mandriva.com>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2 of the License, or (at your
9 * option) any later version.
12 #include <linux/init.h>
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
16 #include <linux/slab.h>
17 #include <linux/mbus.h>
18 #include <linux/delay.h>
19 #include <sound/pcm.h>
20 #include <sound/pcm_params.h>
21 #include <sound/soc.h>
22 #include <plat/audio.h>
25 #define DRV_NAME "kirkwood-i2s"
27 #define KIRKWOOD_I2S_RATES \
28 (SNDRV_PCM_RATE_44100 | \
29 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000)
30 #define KIRKWOOD_I2S_FORMATS \
31 (SNDRV_PCM_FMTBIT_S16_LE | \
32 SNDRV_PCM_FMTBIT_S24_LE | \
33 SNDRV_PCM_FMTBIT_S32_LE)
35 static int kirkwood_i2s_set_fmt(struct snd_soc_dai
*cpu_dai
,
38 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(cpu_dai
);
42 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
43 case SND_SOC_DAIFMT_RIGHT_J
:
44 mask
= KIRKWOOD_I2S_CTL_RJ
;
46 case SND_SOC_DAIFMT_LEFT_J
:
47 mask
= KIRKWOOD_I2S_CTL_LJ
;
49 case SND_SOC_DAIFMT_I2S
:
50 mask
= KIRKWOOD_I2S_CTL_I2S
;
57 * Set same format for playback and record
58 * This avoids some troubles.
60 value
= readl(priv
->io
+KIRKWOOD_I2S_PLAYCTL
);
61 value
&= ~KIRKWOOD_I2S_CTL_JUST_MASK
;
63 writel(value
, priv
->io
+KIRKWOOD_I2S_PLAYCTL
);
65 value
= readl(priv
->io
+KIRKWOOD_I2S_RECCTL
);
66 value
&= ~KIRKWOOD_I2S_CTL_JUST_MASK
;
68 writel(value
, priv
->io
+KIRKWOOD_I2S_RECCTL
);
73 static inline void kirkwood_set_dco(void __iomem
*io
, unsigned long rate
)
77 value
= KIRKWOOD_DCO_CTL_OFFSET_0
;
81 value
|= KIRKWOOD_DCO_CTL_FREQ_11
;
84 value
|= KIRKWOOD_DCO_CTL_FREQ_12
;
87 value
|= KIRKWOOD_DCO_CTL_FREQ_24
;
90 writel(value
, io
+ KIRKWOOD_DCO_CTL
);
92 /* wait for dco locked */
95 value
= readl(io
+ KIRKWOOD_DCO_SPCR_STATUS
);
96 value
&= KIRKWOOD_DCO_SPCR_STATUS
;
100 static int kirkwood_i2s_startup(struct snd_pcm_substream
*substream
,
101 struct snd_soc_dai
*dai
)
103 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(dai
);
105 snd_soc_dai_set_dma_data(dai
, substream
, priv
);
109 static int kirkwood_i2s_hw_params(struct snd_pcm_substream
*substream
,
110 struct snd_pcm_hw_params
*params
,
111 struct snd_soc_dai
*dai
)
113 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(dai
);
114 unsigned int i2s_reg
, reg
;
115 unsigned long i2s_value
, value
;
117 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
118 i2s_reg
= KIRKWOOD_I2S_PLAYCTL
;
119 reg
= KIRKWOOD_PLAYCTL
;
121 i2s_reg
= KIRKWOOD_I2S_RECCTL
;
122 reg
= KIRKWOOD_RECCTL
;
126 kirkwood_set_dco(priv
->io
, params_rate(params
));
128 i2s_value
= readl(priv
->io
+i2s_reg
);
129 i2s_value
&= ~KIRKWOOD_I2S_CTL_SIZE_MASK
;
131 value
= readl(priv
->io
+reg
);
132 value
&= ~KIRKWOOD_PLAYCTL_SIZE_MASK
;
135 * Size settings in play/rec i2s control regs and play/rec control
136 * regs must be the same.
138 switch (params_format(params
)) {
139 case SNDRV_PCM_FORMAT_S16_LE
:
140 i2s_value
|= KIRKWOOD_I2S_CTL_SIZE_16
;
141 value
|= KIRKWOOD_PLAYCTL_SIZE_16_C
;
144 * doesn't work... S20_3LE != kirkwood 20bit format ?
146 case SNDRV_PCM_FORMAT_S20_3LE:
147 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_20;
148 value |= KIRKWOOD_PLAYCTL_SIZE_20;
151 case SNDRV_PCM_FORMAT_S24_LE
:
152 i2s_value
|= KIRKWOOD_I2S_CTL_SIZE_24
;
153 value
|= KIRKWOOD_PLAYCTL_SIZE_24
;
155 case SNDRV_PCM_FORMAT_S32_LE
:
156 i2s_value
|= KIRKWOOD_I2S_CTL_SIZE_32
;
157 value
|= KIRKWOOD_PLAYCTL_SIZE_32
;
163 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
164 value
&= ~KIRKWOOD_PLAYCTL_MONO_MASK
;
165 if (params_channels(params
) == 1)
166 value
|= KIRKWOOD_PLAYCTL_MONO_BOTH
;
168 value
|= KIRKWOOD_PLAYCTL_MONO_OFF
;
171 writel(i2s_value
, priv
->io
+i2s_reg
);
172 writel(value
, priv
->io
+reg
);
177 static int kirkwood_i2s_play_trigger(struct snd_pcm_substream
*substream
,
178 int cmd
, struct snd_soc_dai
*dai
)
180 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(dai
);
184 * specs says KIRKWOOD_PLAYCTL must be read 2 times before
185 * changing it. So read 1 time here and 1 later.
187 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
190 case SNDRV_PCM_TRIGGER_START
:
191 /* stop audio, enable interrupts */
192 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
193 value
|= KIRKWOOD_PLAYCTL_PAUSE
;
194 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
196 value
= readl(priv
->io
+ KIRKWOOD_INT_MASK
);
197 value
|= KIRKWOOD_INT_CAUSE_PLAY_BYTES
;
198 writel(value
, priv
->io
+ KIRKWOOD_INT_MASK
);
200 /* configure audio & enable i2s playback */
201 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
202 value
&= ~KIRKWOOD_PLAYCTL_BURST_MASK
;
203 value
&= ~(KIRKWOOD_PLAYCTL_PAUSE
| KIRKWOOD_PLAYCTL_I2S_MUTE
204 | KIRKWOOD_PLAYCTL_SPDIF_EN
);
206 if (priv
->burst
== 32)
207 value
|= KIRKWOOD_PLAYCTL_BURST_32
;
209 value
|= KIRKWOOD_PLAYCTL_BURST_128
;
210 value
|= KIRKWOOD_PLAYCTL_I2S_EN
;
211 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
214 case SNDRV_PCM_TRIGGER_STOP
:
215 /* stop audio, disable interrupts */
216 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
217 value
|= KIRKWOOD_PLAYCTL_PAUSE
| KIRKWOOD_PLAYCTL_I2S_MUTE
;
218 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
220 value
= readl(priv
->io
+ KIRKWOOD_INT_MASK
);
221 value
&= ~KIRKWOOD_INT_CAUSE_PLAY_BYTES
;
222 writel(value
, priv
->io
+ KIRKWOOD_INT_MASK
);
224 /* disable all playbacks */
225 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
226 value
&= ~(KIRKWOOD_PLAYCTL_I2S_EN
| KIRKWOOD_PLAYCTL_SPDIF_EN
);
227 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
230 case SNDRV_PCM_TRIGGER_PAUSE_PUSH
:
231 case SNDRV_PCM_TRIGGER_SUSPEND
:
232 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
233 value
|= KIRKWOOD_PLAYCTL_PAUSE
| KIRKWOOD_PLAYCTL_I2S_MUTE
;
234 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
237 case SNDRV_PCM_TRIGGER_RESUME
:
238 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE
:
239 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
240 value
&= ~(KIRKWOOD_PLAYCTL_PAUSE
| KIRKWOOD_PLAYCTL_I2S_MUTE
);
241 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
251 static int kirkwood_i2s_rec_trigger(struct snd_pcm_substream
*substream
,
252 int cmd
, struct snd_soc_dai
*dai
)
254 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(dai
);
257 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
260 case SNDRV_PCM_TRIGGER_START
:
261 /* stop audio, enable interrupts */
262 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
263 value
|= KIRKWOOD_RECCTL_PAUSE
;
264 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
266 value
= readl(priv
->io
+ KIRKWOOD_INT_MASK
);
267 value
|= KIRKWOOD_INT_CAUSE_REC_BYTES
;
268 writel(value
, priv
->io
+ KIRKWOOD_INT_MASK
);
270 /* configure audio & enable i2s record */
271 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
272 value
&= ~KIRKWOOD_RECCTL_BURST_MASK
;
273 value
&= ~KIRKWOOD_RECCTL_MONO
;
274 value
&= ~(KIRKWOOD_RECCTL_PAUSE
| KIRKWOOD_RECCTL_MUTE
275 | KIRKWOOD_RECCTL_SPDIF_EN
);
277 if (priv
->burst
== 32)
278 value
|= KIRKWOOD_RECCTL_BURST_32
;
280 value
|= KIRKWOOD_RECCTL_BURST_128
;
281 value
|= KIRKWOOD_RECCTL_I2S_EN
;
283 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
286 case SNDRV_PCM_TRIGGER_STOP
:
287 /* stop audio, disable interrupts */
288 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
289 value
|= KIRKWOOD_RECCTL_PAUSE
| KIRKWOOD_RECCTL_MUTE
;
290 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
292 value
= readl(priv
->io
+ KIRKWOOD_INT_MASK
);
293 value
&= ~KIRKWOOD_INT_CAUSE_REC_BYTES
;
294 writel(value
, priv
->io
+ KIRKWOOD_INT_MASK
);
296 /* disable all records */
297 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
298 value
&= ~(KIRKWOOD_RECCTL_I2S_EN
| KIRKWOOD_RECCTL_SPDIF_EN
);
299 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
302 case SNDRV_PCM_TRIGGER_PAUSE_PUSH
:
303 case SNDRV_PCM_TRIGGER_SUSPEND
:
304 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
305 value
|= KIRKWOOD_RECCTL_PAUSE
| KIRKWOOD_RECCTL_MUTE
;
306 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
309 case SNDRV_PCM_TRIGGER_RESUME
:
310 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE
:
311 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
312 value
&= ~(KIRKWOOD_RECCTL_PAUSE
| KIRKWOOD_RECCTL_MUTE
);
313 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
323 static int kirkwood_i2s_trigger(struct snd_pcm_substream
*substream
, int cmd
,
324 struct snd_soc_dai
*dai
)
326 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
327 return kirkwood_i2s_play_trigger(substream
, cmd
, dai
);
329 return kirkwood_i2s_rec_trigger(substream
, cmd
, dai
);
334 static int kirkwood_i2s_probe(struct snd_soc_dai
*dai
)
336 struct kirkwood_dma_data
*priv
= snd_soc_dai_get_drvdata(dai
);
338 unsigned int reg_data
;
340 /* put system in a "safe" state : */
341 /* disable audio interrupts */
342 writel(0xffffffff, priv
->io
+ KIRKWOOD_INT_CAUSE
);
343 writel(0, priv
->io
+ KIRKWOOD_INT_MASK
);
345 reg_data
= readl(priv
->io
+ 0x1200);
346 reg_data
&= (~(0x333FF8));
347 reg_data
|= 0x111D18;
348 writel(reg_data
, priv
->io
+ 0x1200);
352 reg_data
= readl(priv
->io
+ 0x1200);
353 reg_data
&= (~(0x333FF8));
354 reg_data
|= 0x111D18;
355 writel(reg_data
, priv
->io
+ 0x1200);
357 /* disable playback/record */
358 value
= readl(priv
->io
+ KIRKWOOD_PLAYCTL
);
359 value
&= ~(KIRKWOOD_PLAYCTL_I2S_EN
|KIRKWOOD_PLAYCTL_SPDIF_EN
);
360 writel(value
, priv
->io
+ KIRKWOOD_PLAYCTL
);
362 value
= readl(priv
->io
+ KIRKWOOD_RECCTL
);
363 value
&= ~(KIRKWOOD_RECCTL_I2S_EN
| KIRKWOOD_RECCTL_SPDIF_EN
);
364 writel(value
, priv
->io
+ KIRKWOOD_RECCTL
);
370 static int kirkwood_i2s_remove(struct snd_soc_dai
*dai
)
375 static struct snd_soc_dai_ops kirkwood_i2s_dai_ops
= {
376 .startup
= kirkwood_i2s_startup
,
377 .trigger
= kirkwood_i2s_trigger
,
378 .hw_params
= kirkwood_i2s_hw_params
,
379 .set_fmt
= kirkwood_i2s_set_fmt
,
383 static struct snd_soc_dai_driver kirkwood_i2s_dai
= {
384 .probe
= kirkwood_i2s_probe
,
385 .remove
= kirkwood_i2s_remove
,
389 .rates
= KIRKWOOD_I2S_RATES
,
390 .formats
= KIRKWOOD_I2S_FORMATS
,},
394 .rates
= KIRKWOOD_I2S_RATES
,
395 .formats
= KIRKWOOD_I2S_FORMATS
,},
396 .ops
= &kirkwood_i2s_dai_ops
,
399 static __devinit
int kirkwood_i2s_dev_probe(struct platform_device
*pdev
)
401 struct resource
*mem
;
402 struct kirkwood_asoc_platform_data
*data
=
403 pdev
->dev
.platform_data
;
404 struct kirkwood_dma_data
*priv
;
407 priv
= kzalloc(sizeof(struct kirkwood_dma_data
), GFP_KERNEL
);
409 dev_err(&pdev
->dev
, "allocation failed\n");
413 dev_set_drvdata(&pdev
->dev
, priv
);
415 mem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
417 dev_err(&pdev
->dev
, "platform_get_resource failed\n");
422 priv
->mem
= request_mem_region(mem
->start
, SZ_16K
, DRV_NAME
);
424 dev_err(&pdev
->dev
, "request_mem_region failed\n");
429 priv
->io
= ioremap(priv
->mem
->start
, SZ_16K
);
431 dev_err(&pdev
->dev
, "ioremap failed\n");
436 priv
->irq
= platform_get_irq(pdev
, 0);
437 if (priv
->irq
<= 0) {
438 dev_err(&pdev
->dev
, "platform_get_irq failed\n");
443 if (!data
|| !data
->dram
) {
444 dev_err(&pdev
->dev
, "no platform data ?!\n");
449 priv
->dram
= data
->dram
;
450 priv
->burst
= data
->burst
;
452 return snd_soc_register_dai(&pdev
->dev
, &kirkwood_i2s_dai
);
457 release_mem_region(priv
->mem
->start
, SZ_16K
);
464 static __devexit
int kirkwood_i2s_dev_remove(struct platform_device
*pdev
)
466 struct kirkwood_dma_data
*priv
= dev_get_drvdata(&pdev
->dev
);
468 snd_soc_unregister_dai(&pdev
->dev
);
470 release_mem_region(priv
->mem
->start
, SZ_16K
);
476 static struct platform_driver kirkwood_i2s_driver
= {
477 .probe
= kirkwood_i2s_dev_probe
,
478 .remove
= kirkwood_i2s_dev_remove
,
481 .owner
= THIS_MODULE
,
485 static int __init
kirkwood_i2s_init(void)
487 return platform_driver_register(&kirkwood_i2s_driver
);
489 module_init(kirkwood_i2s_init
);
491 static void __exit
kirkwood_i2s_exit(void)
493 platform_driver_unregister(&kirkwood_i2s_driver
);
495 module_exit(kirkwood_i2s_exit
);
497 /* Module information */
498 MODULE_AUTHOR("Arnaud Patard, <apatard@mandriva.com>");
499 MODULE_DESCRIPTION("Kirkwood I2S SoC Interface");
500 MODULE_LICENSE("GPL");
501 MODULE_ALIAS("platform:kirkwood-i2s");