ASoC: kirkwood: Fix invalid S/PDIF format
[deliverable/linux.git] / sound / soc / kirkwood / kirkwood-i2s.c
CommitLineData
f9b95980 1/*
2 * kirkwood-i2s.c
3 *
4 * (c) 2010 Arnaud Patard <apatard@mandriva.com>
69737897 5 * (c) 2010 Arnaud Patard <arnaud.patard@rtp-net.org>
f9b95980 6 *
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
11 */
12
13#include <linux/init.h>
14#include <linux/module.h>
15#include <linux/platform_device.h>
16#include <linux/io.h>
17#include <linux/slab.h>
18#include <linux/mbus.h>
19#include <linux/delay.h>
e919c716 20#include <linux/clk.h>
f9b95980 21#include <sound/pcm.h>
22#include <sound/pcm_params.h>
23#include <sound/soc.h>
c02cecb9 24#include <linux/platform_data/asoc-kirkwood.h>
eb632318
JFM
25#include <linux/of.h>
26
f9b95980 27#include "kirkwood.h"
28
64ddf1f8 29#define DRV_NAME "mvebu-audio"
f9b95980 30
f9b95980 31#define KIRKWOOD_I2S_FORMATS \
32 (SNDRV_PCM_FMTBIT_S16_LE | \
33 SNDRV_PCM_FMTBIT_S24_LE | \
34 SNDRV_PCM_FMTBIT_S32_LE)
35
1c195ddb
JFM
36#define KIRKWOOD_SPDIF_FORMATS \
37 (SNDRV_PCM_FMTBIT_S16_LE | \
38 SNDRV_PCM_FMTBIT_S24_LE)
39
f9b95980 40static int kirkwood_i2s_set_fmt(struct snd_soc_dai *cpu_dai,
41 unsigned int fmt)
42{
f0fba2ad 43 struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(cpu_dai);
f9b95980 44 unsigned long mask;
45 unsigned long value;
46
47 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
48 case SND_SOC_DAIFMT_RIGHT_J:
49 mask = KIRKWOOD_I2S_CTL_RJ;
50 break;
51 case SND_SOC_DAIFMT_LEFT_J:
52 mask = KIRKWOOD_I2S_CTL_LJ;
53 break;
54 case SND_SOC_DAIFMT_I2S:
55 mask = KIRKWOOD_I2S_CTL_I2S;
56 break;
57 default:
58 return -EINVAL;
59 }
60
61 /*
62 * Set same format for playback and record
63 * This avoids some troubles.
64 */
65 value = readl(priv->io+KIRKWOOD_I2S_PLAYCTL);
66 value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
67 value |= mask;
68 writel(value, priv->io+KIRKWOOD_I2S_PLAYCTL);
69
70 value = readl(priv->io+KIRKWOOD_I2S_RECCTL);
71 value &= ~KIRKWOOD_I2S_CTL_JUST_MASK;
72 value |= mask;
73 writel(value, priv->io+KIRKWOOD_I2S_RECCTL);
74
75 return 0;
76}
77
78static inline void kirkwood_set_dco(void __iomem *io, unsigned long rate)
79{
80 unsigned long value;
81
82 value = KIRKWOOD_DCO_CTL_OFFSET_0;
83 switch (rate) {
84 default:
85 case 44100:
86 value |= KIRKWOOD_DCO_CTL_FREQ_11;
87 break;
88 case 48000:
89 value |= KIRKWOOD_DCO_CTL_FREQ_12;
90 break;
91 case 96000:
92 value |= KIRKWOOD_DCO_CTL_FREQ_24;
93 break;
94 }
95 writel(value, io + KIRKWOOD_DCO_CTL);
96
97 /* wait for dco locked */
98 do {
99 cpu_relax();
100 value = readl(io + KIRKWOOD_DCO_SPCR_STATUS);
2424d458 101 value &= KIRKWOOD_DCO_SPCR_STATUS_DCO_LOCK;
f9b95980 102 } while (value == 0);
103}
104
363589bf
RK
105static void kirkwood_set_rate(struct snd_soc_dai *dai,
106 struct kirkwood_dma_data *priv, unsigned long rate)
107{
108 uint32_t clks_ctrl;
109
1f1b6579 110 if (IS_ERR(priv->extclk)) {
8a537f85
JFM
111 /* use internal dco for the supported rates
112 * defined in kirkwood_i2s_dai */
363589bf
RK
113 dev_dbg(dai->dev, "%s: dco set rate = %lu\n",
114 __func__, rate);
115 kirkwood_set_dco(priv->io, rate);
116
117 clks_ctrl = KIRKWOOD_MCLK_SOURCE_DCO;
8a537f85
JFM
118 } else {
119 /* use the external clock for the other rates
120 * defined in kirkwood_i2s_dai_extclk */
363589bf
RK
121 dev_dbg(dai->dev, "%s: extclk set rate = %lu -> %lu\n",
122 __func__, rate, 256 * rate);
123 clk_set_rate(priv->extclk, 256 * rate);
124
125 clks_ctrl = KIRKWOOD_MCLK_SOURCE_EXTCLK;
126 }
127 writel(clks_ctrl, priv->io + KIRKWOOD_CLOCKS_CTRL);
128}
129
f0fba2ad
LG
130static int kirkwood_i2s_startup(struct snd_pcm_substream *substream,
131 struct snd_soc_dai *dai)
132{
133 struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
134
135 snd_soc_dai_set_dma_data(dai, substream, priv);
136 return 0;
137}
138
f9b95980 139static int kirkwood_i2s_hw_params(struct snd_pcm_substream *substream,
140 struct snd_pcm_hw_params *params,
141 struct snd_soc_dai *dai)
142{
f0fba2ad 143 struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
d8d11ba5
RK
144 uint32_t ctl_play, ctl_rec;
145 unsigned int i2s_reg;
146 unsigned long i2s_value;
f9b95980 147
148 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
149 i2s_reg = KIRKWOOD_I2S_PLAYCTL;
f9b95980 150 } else {
151 i2s_reg = KIRKWOOD_I2S_RECCTL;
f9b95980 152 }
153
363589bf 154 kirkwood_set_rate(dai, priv, params_rate(params));
f9b95980 155
156 i2s_value = readl(priv->io+i2s_reg);
157 i2s_value &= ~KIRKWOOD_I2S_CTL_SIZE_MASK;
158
f9b95980 159 /*
160 * Size settings in play/rec i2s control regs and play/rec control
161 * regs must be the same.
162 */
163 switch (params_format(params)) {
164 case SNDRV_PCM_FORMAT_S16_LE:
165 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_16;
d8d11ba5 166 ctl_play = KIRKWOOD_PLAYCTL_SIZE_16_C |
75b9b65e
JFM
167 KIRKWOOD_PLAYCTL_I2S_EN |
168 KIRKWOOD_PLAYCTL_SPDIF_EN;
d8d11ba5 169 ctl_rec = KIRKWOOD_RECCTL_SIZE_16_C |
75b9b65e
JFM
170 KIRKWOOD_RECCTL_I2S_EN |
171 KIRKWOOD_RECCTL_SPDIF_EN;
f9b95980 172 break;
173 /*
174 * doesn't work... S20_3LE != kirkwood 20bit format ?
175 *
176 case SNDRV_PCM_FORMAT_S20_3LE:
177 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_20;
d8d11ba5
RK
178 ctl_play = KIRKWOOD_PLAYCTL_SIZE_20 |
179 KIRKWOOD_PLAYCTL_I2S_EN;
180 ctl_rec = KIRKWOOD_RECCTL_SIZE_20 |
181 KIRKWOOD_RECCTL_I2S_EN;
f9b95980 182 break;
183 */
184 case SNDRV_PCM_FORMAT_S24_LE:
185 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_24;
d8d11ba5 186 ctl_play = KIRKWOOD_PLAYCTL_SIZE_24 |
75b9b65e
JFM
187 KIRKWOOD_PLAYCTL_I2S_EN |
188 KIRKWOOD_PLAYCTL_SPDIF_EN;
d8d11ba5 189 ctl_rec = KIRKWOOD_RECCTL_SIZE_24 |
75b9b65e
JFM
190 KIRKWOOD_RECCTL_I2S_EN |
191 KIRKWOOD_RECCTL_SPDIF_EN;
f9b95980 192 break;
193 case SNDRV_PCM_FORMAT_S32_LE:
194 i2s_value |= KIRKWOOD_I2S_CTL_SIZE_32;
d8d11ba5
RK
195 ctl_play = KIRKWOOD_PLAYCTL_SIZE_32 |
196 KIRKWOOD_PLAYCTL_I2S_EN;
197 ctl_rec = KIRKWOOD_RECCTL_SIZE_32 |
198 KIRKWOOD_RECCTL_I2S_EN;
f9b95980 199 break;
200 default:
201 return -EINVAL;
202 }
dfe4c936 203
204 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
dfe4c936 205 if (params_channels(params) == 1)
d8d11ba5 206 ctl_play |= KIRKWOOD_PLAYCTL_MONO_BOTH;
dfe4c936 207 else
d8d11ba5
RK
208 ctl_play |= KIRKWOOD_PLAYCTL_MONO_OFF;
209
210 priv->ctl_play &= ~(KIRKWOOD_PLAYCTL_MONO_MASK |
db43b16f 211 KIRKWOOD_PLAYCTL_ENABLE_MASK |
d8d11ba5
RK
212 KIRKWOOD_PLAYCTL_SIZE_MASK);
213 priv->ctl_play |= ctl_play;
214 } else {
215 priv->ctl_rec &= ~KIRKWOOD_RECCTL_SIZE_MASK;
216 priv->ctl_rec |= ctl_rec;
dfe4c936 217 }
218
f9b95980 219 writel(i2s_value, priv->io+i2s_reg);
f9b95980 220
221 return 0;
222}
223
224static int kirkwood_i2s_play_trigger(struct snd_pcm_substream *substream,
225 int cmd, struct snd_soc_dai *dai)
226{
f0fba2ad 227 struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
982b604b
RK
228 uint32_t ctl, value;
229
230 ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
231 if (ctl & KIRKWOOD_PLAYCTL_PAUSE) {
232 unsigned timeout = 5000;
233 /*
234 * The Armada510 spec says that if we enter pause mode, the
235 * busy bit must be read back as clear _twice_. Make sure
236 * we respect that otherwise we get DMA underruns.
237 */
238 do {
239 value = ctl;
240 ctl = readl(priv->io + KIRKWOOD_PLAYCTL);
241 if (!((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY))
242 break;
243 udelay(1);
244 } while (timeout--);
245
246 if ((ctl | value) & KIRKWOOD_PLAYCTL_PLAY_BUSY)
247 dev_notice(dai->dev, "timed out waiting for busy to deassert: %08x\n",
248 ctl);
249 }
f9b95980 250
75b9b65e
JFM
251 if (dai->id == 0)
252 ctl &= ~KIRKWOOD_PLAYCTL_SPDIF_EN; /* i2s */
253 else
254 ctl &= ~KIRKWOOD_PLAYCTL_I2S_EN; /* spdif */
255
f9b95980 256 switch (cmd) {
257 case SNDRV_PCM_TRIGGER_START:
d8d11ba5
RK
258 /* configure */
259 ctl = priv->ctl_play;
db43b16f 260 value = ctl & ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
d8d11ba5
RK
261 writel(value, priv->io + KIRKWOOD_PLAYCTL);
262
263 /* enable interrupts */
f9b95980 264 value = readl(priv->io + KIRKWOOD_INT_MASK);
265 value |= KIRKWOOD_INT_CAUSE_PLAY_BYTES;
266 writel(value, priv->io + KIRKWOOD_INT_MASK);
267
d8d11ba5 268 /* enable playback */
982b604b 269 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
f9b95980 270 break;
271
272 case SNDRV_PCM_TRIGGER_STOP:
273 /* stop audio, disable interrupts */
75b9b65e
JFM
274 ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
275 KIRKWOOD_PLAYCTL_SPDIF_MUTE;
982b604b 276 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
f9b95980 277
278 value = readl(priv->io + KIRKWOOD_INT_MASK);
279 value &= ~KIRKWOOD_INT_CAUSE_PLAY_BYTES;
280 writel(value, priv->io + KIRKWOOD_INT_MASK);
281
282 /* disable all playbacks */
db43b16f 283 ctl &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
982b604b 284 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
f9b95980 285 break;
286
287 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
288 case SNDRV_PCM_TRIGGER_SUSPEND:
75b9b65e
JFM
289 ctl |= KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
290 KIRKWOOD_PLAYCTL_SPDIF_MUTE;
982b604b 291 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
f9b95980 292 break;
293
294 case SNDRV_PCM_TRIGGER_RESUME:
295 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
75b9b65e
JFM
296 ctl &= ~(KIRKWOOD_PLAYCTL_PAUSE | KIRKWOOD_PLAYCTL_I2S_MUTE |
297 KIRKWOOD_PLAYCTL_SPDIF_MUTE);
982b604b 298 writel(ctl, priv->io + KIRKWOOD_PLAYCTL);
f9b95980 299 break;
300
301 default:
302 return -EINVAL;
303 }
304
305 return 0;
306}
307
308static int kirkwood_i2s_rec_trigger(struct snd_pcm_substream *substream,
309 int cmd, struct snd_soc_dai *dai)
310{
f0fba2ad 311 struct kirkwood_dma_data *priv = snd_soc_dai_get_drvdata(dai);
d8d11ba5 312 uint32_t ctl, value;
f9b95980 313
314 value = readl(priv->io + KIRKWOOD_RECCTL);
315
316 switch (cmd) {
317 case SNDRV_PCM_TRIGGER_START:
d8d11ba5
RK
318 /* configure */
319 ctl = priv->ctl_rec;
75b9b65e
JFM
320 if (dai->id == 0)
321 ctl &= ~KIRKWOOD_RECCTL_SPDIF_EN; /* i2s */
322 else
323 ctl &= ~KIRKWOOD_RECCTL_I2S_EN; /* spdif */
324
325 value = ctl & ~(KIRKWOOD_RECCTL_I2S_EN |
326 KIRKWOOD_RECCTL_SPDIF_EN);
d8d11ba5
RK
327 writel(value, priv->io + KIRKWOOD_RECCTL);
328
329 /* enable interrupts */
f9b95980 330 value = readl(priv->io + KIRKWOOD_INT_MASK);
331 value |= KIRKWOOD_INT_CAUSE_REC_BYTES;
332 writel(value, priv->io + KIRKWOOD_INT_MASK);
333
d8d11ba5
RK
334 /* enable record */
335 writel(ctl, priv->io + KIRKWOOD_RECCTL);
f9b95980 336 break;
337
338 case SNDRV_PCM_TRIGGER_STOP:
339 /* stop audio, disable interrupts */
340 value = readl(priv->io + KIRKWOOD_RECCTL);
b424ec95 341 value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
f9b95980 342 writel(value, priv->io + KIRKWOOD_RECCTL);
343
344 value = readl(priv->io + KIRKWOOD_INT_MASK);
345 value &= ~KIRKWOOD_INT_CAUSE_REC_BYTES;
346 writel(value, priv->io + KIRKWOOD_INT_MASK);
347
348 /* disable all records */
349 value = readl(priv->io + KIRKWOOD_RECCTL);
350 value &= ~(KIRKWOOD_RECCTL_I2S_EN | KIRKWOOD_RECCTL_SPDIF_EN);
351 writel(value, priv->io + KIRKWOOD_RECCTL);
352 break;
353
354 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
355 case SNDRV_PCM_TRIGGER_SUSPEND:
356 value = readl(priv->io + KIRKWOOD_RECCTL);
b424ec95 357 value |= KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE;
f9b95980 358 writel(value, priv->io + KIRKWOOD_RECCTL);
359 break;
360
361 case SNDRV_PCM_TRIGGER_RESUME:
362 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
363 value = readl(priv->io + KIRKWOOD_RECCTL);
b424ec95 364 value &= ~(KIRKWOOD_RECCTL_PAUSE | KIRKWOOD_RECCTL_MUTE);
f9b95980 365 writel(value, priv->io + KIRKWOOD_RECCTL);
366 break;
367
368 default:
369 return -EINVAL;
f9b95980 370 }
371
372 return 0;
373}
374
375static int kirkwood_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
376 struct snd_soc_dai *dai)
377{
378 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
379 return kirkwood_i2s_play_trigger(substream, cmd, dai);
380 else
381 return kirkwood_i2s_rec_trigger(substream, cmd, dai);
382
383 return 0;
384}
385
75b9b65e 386static int kirkwood_i2s_init(struct kirkwood_dma_data *priv)
f9b95980 387{
388 unsigned long value;
389 unsigned int reg_data;
390
391 /* put system in a "safe" state : */
392 /* disable audio interrupts */
393 writel(0xffffffff, priv->io + KIRKWOOD_INT_CAUSE);
394 writel(0, priv->io + KIRKWOOD_INT_MASK);
395
396 reg_data = readl(priv->io + 0x1200);
397 reg_data &= (~(0x333FF8));
398 reg_data |= 0x111D18;
399 writel(reg_data, priv->io + 0x1200);
400
401 msleep(500);
402
403 reg_data = readl(priv->io + 0x1200);
404 reg_data &= (~(0x333FF8));
405 reg_data |= 0x111D18;
406 writel(reg_data, priv->io + 0x1200);
407
408 /* disable playback/record */
409 value = readl(priv->io + KIRKWOOD_PLAYCTL);
db43b16f 410 value &= ~KIRKWOOD_PLAYCTL_ENABLE_MASK;
f9b95980 411 writel(value, priv->io + KIRKWOOD_PLAYCTL);
412
413 value = readl(priv->io + KIRKWOOD_RECCTL);
414 value &= ~(KIRKWOOD_RECCTL_I2S_EN | KIRKWOOD_RECCTL_SPDIF_EN);
415 writel(value, priv->io + KIRKWOOD_RECCTL);
416
417 return 0;
418
419}
420
85e7652d 421static const struct snd_soc_dai_ops kirkwood_i2s_dai_ops = {
f0fba2ad 422 .startup = kirkwood_i2s_startup,
f9b95980 423 .trigger = kirkwood_i2s_trigger,
424 .hw_params = kirkwood_i2s_hw_params,
425 .set_fmt = kirkwood_i2s_set_fmt,
426};
427
75b9b65e
JFM
428static struct snd_soc_dai_driver kirkwood_i2s_dai[2] = {
429 {
430 .name = "i2s",
431 .id = 0,
432 .playback = {
433 .channels_min = 1,
434 .channels_max = 2,
435 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
436 SNDRV_PCM_RATE_96000,
437 .formats = KIRKWOOD_I2S_FORMATS,
438 },
439 .capture = {
440 .channels_min = 1,
441 .channels_max = 2,
442 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
443 SNDRV_PCM_RATE_96000,
444 .formats = KIRKWOOD_I2S_FORMATS,
445 },
446 .ops = &kirkwood_i2s_dai_ops,
447 },
448 {
449 .name = "spdif",
450 .id = 1,
f9b95980 451 .playback = {
452 .channels_min = 1,
453 .channels_max = 2,
9e12cbd9
MB
454 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
455 SNDRV_PCM_RATE_96000,
1c195ddb 456 .formats = KIRKWOOD_SPDIF_FORMATS,
363589bf 457 },
f9b95980 458 .capture = {
459 .channels_min = 1,
460 .channels_max = 2,
9e12cbd9
MB
461 .rates = SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
462 SNDRV_PCM_RATE_96000,
1c195ddb 463 .formats = KIRKWOOD_SPDIF_FORMATS,
363589bf
RK
464 },
465 .ops = &kirkwood_i2s_dai_ops,
75b9b65e 466 },
363589bf
RK
467};
468
75b9b65e
JFM
469static struct snd_soc_dai_driver kirkwood_i2s_dai_extclk[2] = {
470 {
471 .name = "i2s",
472 .id = 0,
473 .playback = {
474 .channels_min = 1,
475 .channels_max = 2,
476 .rates = SNDRV_PCM_RATE_8000_192000 |
477 SNDRV_PCM_RATE_CONTINUOUS |
478 SNDRV_PCM_RATE_KNOT,
479 .formats = KIRKWOOD_I2S_FORMATS,
480 },
481 .capture = {
482 .channels_min = 1,
483 .channels_max = 2,
484 .rates = SNDRV_PCM_RATE_8000_192000 |
485 SNDRV_PCM_RATE_CONTINUOUS |
486 SNDRV_PCM_RATE_KNOT,
487 .formats = KIRKWOOD_I2S_FORMATS,
488 },
489 .ops = &kirkwood_i2s_dai_ops,
490 },
491 {
492 .name = "spdif",
493 .id = 1,
363589bf
RK
494 .playback = {
495 .channels_min = 1,
496 .channels_max = 2,
497 .rates = SNDRV_PCM_RATE_8000_192000 |
498 SNDRV_PCM_RATE_CONTINUOUS |
499 SNDRV_PCM_RATE_KNOT,
1c195ddb 500 .formats = KIRKWOOD_SPDIF_FORMATS,
363589bf
RK
501 },
502 .capture = {
503 .channels_min = 1,
504 .channels_max = 2,
505 .rates = SNDRV_PCM_RATE_8000_192000 |
506 SNDRV_PCM_RATE_CONTINUOUS |
507 SNDRV_PCM_RATE_KNOT,
1c195ddb 508 .formats = KIRKWOOD_SPDIF_FORMATS,
363589bf 509 },
f9b95980 510 .ops = &kirkwood_i2s_dai_ops,
75b9b65e 511 },
f9b95980 512};
f9b95980 513
83d85f53
KM
514static const struct snd_soc_component_driver kirkwood_i2s_component = {
515 .name = DRV_NAME,
516};
517
34e15fbd 518static int kirkwood_i2s_dev_probe(struct platform_device *pdev)
f9b95980 519{
363589bf 520 struct kirkwood_asoc_platform_data *data = pdev->dev.platform_data;
75b9b65e 521 struct snd_soc_dai_driver *soc_dai = kirkwood_i2s_dai;
f0fba2ad 522 struct kirkwood_dma_data *priv;
363589bf 523 struct resource *mem;
eb632318 524 struct device_node *np = pdev->dev.of_node;
f9b95980 525 int err;
526
dbc517bf 527 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
f9b95980 528 if (!priv) {
529 dev_err(&pdev->dev, "allocation failed\n");
dbc517bf 530 return -ENOMEM;
f9b95980 531 }
f0fba2ad 532 dev_set_drvdata(&pdev->dev, priv);
f9b95980 533
534 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
b25b5aa0
TR
535 priv->io = devm_ioremap_resource(&pdev->dev, mem);
536 if (IS_ERR(priv->io))
537 return PTR_ERR(priv->io);
f9b95980 538
539 priv->irq = platform_get_irq(pdev, 0);
540 if (priv->irq <= 0) {
541 dev_err(&pdev->dev, "platform_get_irq failed\n");
dbc517bf 542 return -ENXIO;
f9b95980 543 }
544
eb632318
JFM
545 if (np) {
546 priv->burst = 128; /* might be 32 or 128 */
547 } else if (data) {
548 priv->burst = data->burst;
549 } else {
550 dev_err(&pdev->dev, "no DT nor platform data ?!\n");
dbc517bf 551 return -EINVAL;
f9b95980 552 }
553
eb632318 554 priv->clk = devm_clk_get(&pdev->dev, np ? "internal" : NULL);
e919c716
AL
555 if (IS_ERR(priv->clk)) {
556 dev_err(&pdev->dev, "no clock\n");
dbc517bf 557 return PTR_ERR(priv->clk);
e919c716 558 }
dbc517bf
RK
559
560 err = clk_prepare_enable(priv->clk);
561 if (err < 0)
562 return err;
e919c716 563
4734dc96 564 priv->extclk = devm_clk_get(&pdev->dev, "extclk");
84aac6c7
JFM
565 if (IS_ERR(priv->extclk)) {
566 if (PTR_ERR(priv->extclk) == -EPROBE_DEFER)
567 return -EPROBE_DEFER;
568 } else {
d8d11ba5 569 if (priv->extclk == priv->clk) {
af64d734 570 devm_clk_put(&pdev->dev, priv->extclk);
d8d11ba5
RK
571 priv->extclk = ERR_PTR(-EINVAL);
572 } else {
573 dev_info(&pdev->dev, "found external clock\n");
574 clk_prepare_enable(priv->extclk);
99d8d3ba 575 soc_dai = kirkwood_i2s_dai_extclk;
d8d11ba5
RK
576 }
577 }
578
579 /* Some sensible defaults - this reflects the powerup values */
580 priv->ctl_play = KIRKWOOD_PLAYCTL_SIZE_24;
581 priv->ctl_rec = KIRKWOOD_RECCTL_SIZE_24;
582
583 /* Select the burst size */
eb632318 584 if (priv->burst == 32) {
d8d11ba5
RK
585 priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_32;
586 priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_32;
587 } else {
588 priv->ctl_play |= KIRKWOOD_PLAYCTL_BURST_128;
589 priv->ctl_rec |= KIRKWOOD_RECCTL_BURST_128;
590 }
591
83d85f53 592 err = snd_soc_register_component(&pdev->dev, &kirkwood_i2s_component,
75b9b65e 593 soc_dai, 2);
64ddf1f8
RK
594 if (err) {
595 dev_err(&pdev->dev, "snd_soc_register_component failed\n");
596 goto err_component;
597 }
baffab28 598
64ddf1f8
RK
599 err = snd_soc_register_platform(&pdev->dev, &kirkwood_soc_platform);
600 if (err) {
601 dev_err(&pdev->dev, "snd_soc_register_platform failed\n");
602 goto err_platform;
603 }
75b9b65e
JFM
604
605 kirkwood_i2s_init(priv);
606
64ddf1f8
RK
607 return 0;
608 err_platform:
609 snd_soc_unregister_component(&pdev->dev);
610 err_component:
4734dc96 611 if (!IS_ERR(priv->extclk))
363589bf 612 clk_disable_unprepare(priv->extclk);
baffab28 613 clk_disable_unprepare(priv->clk);
dbc517bf 614
f9b95980 615 return err;
616}
617
34e15fbd 618static int kirkwood_i2s_dev_remove(struct platform_device *pdev)
f9b95980 619{
f0fba2ad
LG
620 struct kirkwood_dma_data *priv = dev_get_drvdata(&pdev->dev);
621
64ddf1f8 622 snd_soc_unregister_platform(&pdev->dev);
83d85f53 623 snd_soc_unregister_component(&pdev->dev);
e919c716 624
4734dc96 625 if (!IS_ERR(priv->extclk))
363589bf 626 clk_disable_unprepare(priv->extclk);
e919c716 627 clk_disable_unprepare(priv->clk);
f0fba2ad 628
f9b95980 629 return 0;
630}
631
eb632318
JFM
632#ifdef CONFIG_OF
633static struct of_device_id mvebu_audio_of_match[] = {
d098b2f0
TP
634 { .compatible = "marvell,kirkwood-audio" },
635 { .compatible = "marvell,dove-audio" },
eb632318
JFM
636 { }
637};
638MODULE_DEVICE_TABLE(of, mvebu_audio_of_match);
639#endif
640
f9b95980 641static struct platform_driver kirkwood_i2s_driver = {
642 .probe = kirkwood_i2s_dev_probe,
34e15fbd 643 .remove = kirkwood_i2s_dev_remove,
f9b95980 644 .driver = {
645 .name = DRV_NAME,
646 .owner = THIS_MODULE,
eb632318 647 .of_match_table = of_match_ptr(mvebu_audio_of_match),
f9b95980 648 },
649};
650
41b10225 651module_platform_driver(kirkwood_i2s_driver);
f9b95980 652
653/* Module information */
69737897 654MODULE_AUTHOR("Arnaud Patard, <arnaud.patard@rtp-net.org>");
f9b95980 655MODULE_DESCRIPTION("Kirkwood I2S SoC Interface");
656MODULE_LICENSE("GPL");
64ddf1f8 657MODULE_ALIAS("platform:mvebu-audio");
This page took 0.18019 seconds and 5 git commands to generate.