?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
spi-topcliff-pch: add recovery processing in case wait-event timeout
[zen-stable.git] / sound / soc / sh / siu_dai.c
blob52d4c17b12325ac079ed8b0cb65950c382290344
1 /*
2 * siu_dai.c - ALSA SoC driver for Renesas SH7343, SH7722 SIU peripheral.
3 *
4 * Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de>
5 * Copyright (C) 2006 Carlos Munoz <carlos@kenati.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 as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21
22 #include <linux/delay.h>
23 #include <linux/firmware.h>
24 #include <linux/pm_runtime.h>
25 #include <linux/slab.h>
26 #include <linux/module.h>
27
28 #include <asm/clock.h>
29 #include <asm/siu.h>
30
31 #include <sound/control.h>
32 #include <sound/soc.h>
33
34 #include "siu.h"
35
36 /* Board specifics */
37 #if defined(CONFIG_CPU_SUBTYPE_SH7722)
38 # define SIU_MAX_VOLUME 0x1000
39 #else
40 # define SIU_MAX_VOLUME 0x7fff
41 #endif
42
43 #define PRAM_SIZE 0x2000
44 #define XRAM_SIZE 0x800
45 #define YRAM_SIZE 0x800
46
47 #define XRAM_OFFSET 0x4000
48 #define YRAM_OFFSET 0x6000
49 #define REG_OFFSET 0xc000
50
51 #define PLAYBACK_ENABLED 1
52 #define CAPTURE_ENABLED 2
53
54 #define VOLUME_CAPTURE 0
55 #define VOLUME_PLAYBACK 1
56 #define DFLT_VOLUME_LEVEL 0x08000800
57
58 /*
59 * SPDIF is only available on port A and on some SIU implementations it is only
60 * available for input. Due to the lack of hardware to test it, SPDIF is left
61 * disabled in this driver version
62 */
63 struct format_flag {
64 u32 i2s;
65 u32 pcm;
66 u32 spdif;
67 u32 mask;
68 };
69
70 struct port_flag {
71 struct format_flag playback;
72 struct format_flag capture;
73 };
74
75 struct siu_info *siu_i2s_data;
76
77 static struct port_flag siu_flags[SIU_PORT_NUM] = {
78 [SIU_PORT_A] = {
79 .playback = {
80 .i2s = 0x50000000,
81 .pcm = 0x40000000,
82 .spdif = 0x80000000, /* not on all SIU versions */
83 .mask = 0xd0000000,
84 },
85 .capture = {
86 .i2s = 0x05000000,
87 .pcm = 0x04000000,
88 .spdif = 0x08000000,
89 .mask = 0x0d000000,
90 },
91 },
92 [SIU_PORT_B] = {
93 .playback = {
94 .i2s = 0x00500000,
95 .pcm = 0x00400000,
96 .spdif = 0, /* impossible - turn off */
97 .mask = 0x00500000,
98 },
99 .capture = {
100 .i2s = 0x00050000,
101 .pcm = 0x00040000,
102 .spdif = 0, /* impossible - turn off */
103 .mask = 0x00050000,
104 },
105 },
106 };
107
108 static void siu_dai_start(struct siu_port *port_info)
109 {
110 struct siu_info *info = siu_i2s_data;
111 u32 __iomem *base = info->reg;
112
113 dev_dbg(port_info->pcm->card->dev, "%s\n", __func__);
114
115 /* Issue software reset to siu */
116 siu_write32(base + SIU_SRCTL, 0);
117
118 /* Wait for the reset to take effect */
119 udelay(1);
120
121 port_info->stfifo = 0;
122 port_info->trdat = 0;
123
124 /* portA, portB, SIU operate */
125 siu_write32(base + SIU_SRCTL, 0x301);
126
127 /* portA=256fs, portB=256fs */
128 siu_write32(base + SIU_CKCTL, 0x40400000);
129
130 /* portA's BRG does not divide SIUCKA */
131 siu_write32(base + SIU_BRGASEL, 0);
132 siu_write32(base + SIU_BRRA, 0);
133
134 /* portB's BRG divides SIUCKB by half */
135 siu_write32(base + SIU_BRGBSEL, 1);
136 siu_write32(base + SIU_BRRB, 0);
137
138 siu_write32(base + SIU_IFCTL, 0x44440000);
139
140 /* portA: 32 bit/fs, master; portB: 32 bit/fs, master */
141 siu_write32(base + SIU_SFORM, 0x0c0c0000);
142
143 /*
144 * Volume levels: looks like the DSP firmware implements volume controls
145 * differently from what's described in the datasheet
146 */
147 siu_write32(base + SIU_SBDVCA, port_info->playback.volume);
148 siu_write32(base + SIU_SBDVCB, port_info->capture.volume);
149 }
150
151 static void siu_dai_stop(struct siu_port *port_info)
152 {
153 struct siu_info *info = siu_i2s_data;
154 u32 __iomem *base = info->reg;
155
156 /* SIU software reset */
157 siu_write32(base + SIU_SRCTL, 0);
158 }
159
160 static void siu_dai_spbAselect(struct siu_port *port_info)
161 {
162 struct siu_info *info = siu_i2s_data;
163 struct siu_firmware *fw = &info->fw;
164 u32 *ydef = fw->yram0;
165 u32 idx;
166
167 /* path A use */
168 if (!info->port_id)
169 idx = 1; /* portA */
170 else
171 idx = 2; /* portB */
172
173 ydef[0] = (fw->spbpar[idx].ab1a << 16) |
174 (fw->spbpar[idx].ab0a << 8) |
175 (fw->spbpar[idx].dir << 7) | 3;
176 ydef[1] = fw->yram0[1]; /* 0x03000300 */
177 ydef[2] = (16 / 2) << 24;
178 ydef[3] = fw->yram0[3]; /* 0 */
179 ydef[4] = fw->yram0[4]; /* 0 */
180 ydef[7] = fw->spbpar[idx].event;
181 port_info->stfifo |= fw->spbpar[idx].stfifo;
182 port_info->trdat |= fw->spbpar[idx].trdat;
183 }
184
185 static void siu_dai_spbBselect(struct siu_port *port_info)
186 {
187 struct siu_info *info = siu_i2s_data;
188 struct siu_firmware *fw = &info->fw;
189 u32 *ydef = fw->yram0;
190 u32 idx;
191
192 /* path B use */
193 if (!info->port_id)
194 idx = 7; /* portA */
195 else
196 idx = 8; /* portB */
197
198 ydef[5] = (fw->spbpar[idx].ab1a << 16) |
199 (fw->spbpar[idx].ab0a << 8) | 1;
200 ydef[6] = fw->spbpar[idx].event;
201 port_info->stfifo |= fw->spbpar[idx].stfifo;
202 port_info->trdat |= fw->spbpar[idx].trdat;
203 }
204
205 static void siu_dai_open(struct siu_stream *siu_stream)
206 {
207 struct siu_info *info = siu_i2s_data;
208 u32 __iomem *base = info->reg;
209 u32 srctl, ifctl;
210
211 srctl = siu_read32(base + SIU_SRCTL);
212 ifctl = siu_read32(base + SIU_IFCTL);
213
214 switch (info->port_id) {
215 case SIU_PORT_A:
216 /* portA operates */
217 srctl |= 0x200;
218 ifctl &= ~0xc2;
219 break;
220 case SIU_PORT_B:
221 /* portB operates */
222 srctl |= 0x100;
223 ifctl &= ~0x31;
224 break;
225 }
226
227 siu_write32(base + SIU_SRCTL, srctl);
228 /* Unmute and configure portA */
229 siu_write32(base + SIU_IFCTL, ifctl);
230 }
231
232 /*
233 * At the moment only fixed Left-upper, Left-lower, Right-upper, Right-lower
234 * packing is supported
235 */
236 static void siu_dai_pcmdatapack(struct siu_stream *siu_stream)
237 {
238 struct siu_info *info = siu_i2s_data;
239 u32 __iomem *base = info->reg;
240 u32 dpak;
241
242 dpak = siu_read32(base + SIU_DPAK);
243
244 switch (info->port_id) {
245 case SIU_PORT_A:
246 dpak &= ~0xc0000000;
247 break;
248 case SIU_PORT_B:
249 dpak &= ~0x00c00000;
250 break;
251 }
252
253 siu_write32(base + SIU_DPAK, dpak);
254 }
255
256 static int siu_dai_spbstart(struct siu_port *port_info)
257 {
258 struct siu_info *info = siu_i2s_data;
259 u32 __iomem *base = info->reg;
260 struct siu_firmware *fw = &info->fw;
261 u32 *ydef = fw->yram0;
262 int cnt;
263 u32 __iomem *add;
264 u32 *ptr;
265
266 /* Load SPB Program in PRAM */
267 ptr = fw->pram0;
268 add = info->pram;
269 for (cnt = 0; cnt < PRAM0_SIZE; cnt++, add++, ptr++)
270 siu_write32(add, *ptr);
271
272 ptr = fw->pram1;
273 add = info->pram + (0x0100 / sizeof(u32));
274 for (cnt = 0; cnt < PRAM1_SIZE; cnt++, add++, ptr++)
275 siu_write32(add, *ptr);
276
277 /* XRAM initialization */
278 add = info->xram;
279 for (cnt = 0; cnt < XRAM0_SIZE + XRAM1_SIZE + XRAM2_SIZE; cnt++, add++)
280 siu_write32(add, 0);
281
282 /* YRAM variable area initialization */
283 add = info->yram;
284 for (cnt = 0; cnt < YRAM_DEF_SIZE; cnt++, add++)
285 siu_write32(add, ydef[cnt]);
286
287 /* YRAM FIR coefficient area initialization */
288 add = info->yram + (0x0200 / sizeof(u32));
289 for (cnt = 0; cnt < YRAM_FIR_SIZE; cnt++, add++)
290 siu_write32(add, fw->yram_fir_coeff[cnt]);
291
292 /* YRAM IIR coefficient area initialization */
293 add = info->yram + (0x0600 / sizeof(u32));
294 for (cnt = 0; cnt < YRAM_IIR_SIZE; cnt++, add++)
295 siu_write32(add, 0);
296
297 siu_write32(base + SIU_TRDAT, port_info->trdat);
298 port_info->trdat = 0x0;
299
300
301 /* SPB start condition: software */
302 siu_write32(base + SIU_SBACTIV, 0);
303 /* Start SPB */
304 siu_write32(base + SIU_SBCTL, 0xc0000000);
305 /* Wait for program to halt */
306 cnt = 0x10000;
307 while (--cnt && siu_read32(base + SIU_SBCTL) != 0x80000000)
308 cpu_relax();
309
310 if (!cnt)
311 return -EBUSY;
312
313 /* SPB program start address setting */
314 siu_write32(base + SIU_SBPSET, 0x00400000);
315 /* SPB hardware start(FIFOCTL source) */
316 siu_write32(base + SIU_SBACTIV, 0xc0000000);
317
318 return 0;
319 }
320
321 static void siu_dai_spbstop(struct siu_port *port_info)
322 {
323 struct siu_info *info = siu_i2s_data;
324 u32 __iomem *base = info->reg;
325
326 siu_write32(base + SIU_SBACTIV, 0);
327 /* SPB stop */
328 siu_write32(base + SIU_SBCTL, 0);
329
330 port_info->stfifo = 0;
331 }
332
333 /* API functions */
334
335 /* Playback and capture hardware properties are identical */
336 static struct snd_pcm_hardware siu_dai_pcm_hw = {
337 .info = SNDRV_PCM_INFO_INTERLEAVED,
338 .formats = SNDRV_PCM_FMTBIT_S16,
339 .rates = SNDRV_PCM_RATE_8000_48000,
340 .rate_min = 8000,
341 .rate_max = 48000,
342 .channels_min = 2,
343 .channels_max = 2,
344 .buffer_bytes_max = SIU_BUFFER_BYTES_MAX,
345 .period_bytes_min = SIU_PERIOD_BYTES_MIN,
346 .period_bytes_max = SIU_PERIOD_BYTES_MAX,
347 .periods_min = SIU_PERIODS_MIN,
348 .periods_max = SIU_PERIODS_MAX,
349 };
350
351 static int siu_dai_info_volume(struct snd_kcontrol *kctrl,
352 struct snd_ctl_elem_info *uinfo)
353 {
354 struct siu_port *port_info = snd_kcontrol_chip(kctrl);
355
356 dev_dbg(port_info->pcm->card->dev, "%s\n", __func__);
357
358 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
359 uinfo->count = 2;
360 uinfo->value.integer.min = 0;
361 uinfo->value.integer.max = SIU_MAX_VOLUME;
362
363 return 0;
364 }
365
366 static int siu_dai_get_volume(struct snd_kcontrol *kctrl,
367 struct snd_ctl_elem_value *ucontrol)
368 {
369 struct siu_port *port_info = snd_kcontrol_chip(kctrl);
370 struct device *dev = port_info->pcm->card->dev;
371 u32 vol;
372
373 dev_dbg(dev, "%s\n", __func__);
374
375 switch (kctrl->private_value) {
376 case VOLUME_PLAYBACK:
377 /* Playback is always on port 0 */
378 vol = port_info->playback.volume;
379 ucontrol->value.integer.value[0] = vol & 0xffff;
380 ucontrol->value.integer.value[1] = vol >> 16 & 0xffff;
381 break;
382 case VOLUME_CAPTURE:
383 /* Capture is always on port 1 */
384 vol = port_info->capture.volume;
385 ucontrol->value.integer.value[0] = vol & 0xffff;
386 ucontrol->value.integer.value[1] = vol >> 16 & 0xffff;
387 break;
388 default:
389 dev_err(dev, "%s() invalid private_value=%ld\n",
390 __func__, kctrl->private_value);
391 return -EINVAL;
392 }
393
394 return 0;
395 }
396
397 static int siu_dai_put_volume(struct snd_kcontrol *kctrl,
398 struct snd_ctl_elem_value *ucontrol)
399 {
400 struct siu_port *port_info = snd_kcontrol_chip(kctrl);
401 struct device *dev = port_info->pcm->card->dev;
402 struct siu_info *info = siu_i2s_data;
403 u32 __iomem *base = info->reg;
404 u32 new_vol;
405 u32 cur_vol;
406
407 dev_dbg(dev, "%s\n", __func__);
408
409 if (ucontrol->value.integer.value[0] < 0 ||
410 ucontrol->value.integer.value[0] > SIU_MAX_VOLUME ||
411 ucontrol->value.integer.value[1] < 0 ||
412 ucontrol->value.integer.value[1] > SIU_MAX_VOLUME)
413 return -EINVAL;
414
415 new_vol = ucontrol->value.integer.value[0] |
416 ucontrol->value.integer.value[1] << 16;
417
418 /* See comment above - DSP firmware implementation */
419 switch (kctrl->private_value) {
420 case VOLUME_PLAYBACK:
421 /* Playback is always on port 0 */
422 cur_vol = port_info->playback.volume;
423 siu_write32(base + SIU_SBDVCA, new_vol);
424 port_info->playback.volume = new_vol;
425 break;
426 case VOLUME_CAPTURE:
427 /* Capture is always on port 1 */
428 cur_vol = port_info->capture.volume;
429 siu_write32(base + SIU_SBDVCB, new_vol);
430 port_info->capture.volume = new_vol;
431 break;
432 default:
433 dev_err(dev, "%s() invalid private_value=%ld\n",
434 __func__, kctrl->private_value);
435 return -EINVAL;
436 }
437
438 if (cur_vol != new_vol)
439 return 1;
440
441 return 0;
442 }
443
444 static struct snd_kcontrol_new playback_controls = {
445 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
446 .name = "PCM Playback Volume",
447 .index = 0,
448 .info = siu_dai_info_volume,
449 .get = siu_dai_get_volume,
450 .put = siu_dai_put_volume,
451 .private_value = VOLUME_PLAYBACK,
452 };
453
454 static struct snd_kcontrol_new capture_controls = {
455 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
456 .name = "PCM Capture Volume",
457 .index = 0,
458 .info = siu_dai_info_volume,
459 .get = siu_dai_get_volume,
460 .put = siu_dai_put_volume,
461 .private_value = VOLUME_CAPTURE,
462 };
463
464 int siu_init_port(int port, struct siu_port **port_info, struct snd_card *card)
465 {
466 struct device *dev = card->dev;
467 struct snd_kcontrol *kctrl;
468 int ret;
469
470 *port_info = kzalloc(sizeof(**port_info), GFP_KERNEL);
471 if (!*port_info)
472 return -ENOMEM;
473
474 dev_dbg(dev, "%s: port #%d@%p\n", __func__, port, *port_info);
475
476 (*port_info)->playback.volume = DFLT_VOLUME_LEVEL;
477 (*port_info)->capture.volume = DFLT_VOLUME_LEVEL;
478
479 /*
480 * Add mixer support. The SPB is used to change the volume. Both
481 * ports use the same SPB. Therefore, we only register one
482 * control instance since it will be used by both channels.
483 * In error case we continue without controls.
484 */
485 kctrl = snd_ctl_new1(&playback_controls, *port_info);
486 ret = snd_ctl_add(card, kctrl);
487 if (ret < 0)
488 dev_err(dev,
489 "failed to add playback controls %p port=%d err=%d\n",
490 kctrl, port, ret);
491
492 kctrl = snd_ctl_new1(&capture_controls, *port_info);
493 ret = snd_ctl_add(card, kctrl);
494 if (ret < 0)
495 dev_err(dev,
496 "failed to add capture controls %p port=%d err=%d\n",
497 kctrl, port, ret);
498
499 return 0;
500 }
501
502 void siu_free_port(struct siu_port *port_info)
503 {
504 kfree(port_info);
505 }
506
507 static int siu_dai_startup(struct snd_pcm_substream *substream,
508 struct snd_soc_dai *dai)
509 {
510 struct siu_info *info = snd_soc_dai_get_drvdata(dai);
511 struct snd_pcm_runtime *rt = substream->runtime;
512 struct siu_port *port_info = siu_port_info(substream);
513 int ret;
514
515 dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__,
516 info->port_id, port_info);
517
518 snd_soc_set_runtime_hwparams(substream, &siu_dai_pcm_hw);
519
520 ret = snd_pcm_hw_constraint_integer(rt, SNDRV_PCM_HW_PARAM_PERIODS);
521 if (unlikely(ret < 0))
522 return ret;
523
524 siu_dai_start(port_info);
525
526 return 0;
527 }
528
529 static void siu_dai_shutdown(struct snd_pcm_substream *substream,
530 struct snd_soc_dai *dai)
531 {
532 struct siu_info *info = snd_soc_dai_get_drvdata(dai);
533 struct siu_port *port_info = siu_port_info(substream);
534
535 dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__,
536 info->port_id, port_info);
537
538 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
539 port_info->play_cap &= ~PLAYBACK_ENABLED;
540 else
541 port_info->play_cap &= ~CAPTURE_ENABLED;
542
543 /* Stop the siu if the other stream is not using it */
544 if (!port_info->play_cap) {
545 /* during stmread or stmwrite ? */
546 BUG_ON(port_info->playback.rw_flg || port_info->capture.rw_flg);
547 siu_dai_spbstop(port_info);
548 siu_dai_stop(port_info);
549 }
550 }
551
552 /* PCM part of siu_dai_playback_prepare() / siu_dai_capture_prepare() */
553 static int siu_dai_prepare(struct snd_pcm_substream *substream,
554 struct snd_soc_dai *dai)
555 {
556 struct siu_info *info = snd_soc_dai_get_drvdata(dai);
557 struct snd_pcm_runtime *rt = substream->runtime;
558 struct siu_port *port_info = siu_port_info(substream);
559 struct siu_stream *siu_stream;
560 int self, ret;
561
562 dev_dbg(substream->pcm->card->dev,
563 "%s: port %d, active streams %lx, %d channels\n",
564 __func__, info->port_id, port_info->play_cap, rt->channels);
565
566 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
567 self = PLAYBACK_ENABLED;
568 siu_stream = &port_info->playback;
569 } else {
570 self = CAPTURE_ENABLED;
571 siu_stream = &port_info->capture;
572 }
573
574 /* Set up the siu if not already done */
575 if (!port_info->play_cap) {
576 siu_stream->rw_flg = 0; /* stream-data transfer flag */
577
578 siu_dai_spbAselect(port_info);
579 siu_dai_spbBselect(port_info);
580
581 siu_dai_open(siu_stream);
582
583 siu_dai_pcmdatapack(siu_stream);
584
585 ret = siu_dai_spbstart(port_info);
586 if (ret < 0)
587 goto fail;
588 } else {
589 ret = 0;
590 }
591
592 port_info->play_cap |= self;
593
594 fail:
595 return ret;
596 }
597
598 /*
599 * SIU can set bus format to I2S / PCM / SPDIF independently for playback and
600 * capture, however, the current API sets the bus format globally for a DAI.
601 */
602 static int siu_dai_set_fmt(struct snd_soc_dai *dai,
603 unsigned int fmt)
604 {
605 struct siu_info *info = snd_soc_dai_get_drvdata(dai);
606 u32 __iomem *base = info->reg;
607 u32 ifctl;
608
609 dev_dbg(dai->dev, "%s: fmt 0x%x on port %d\n",
610 __func__, fmt, info->port_id);
611
612 if (info->port_id < 0)
613 return -ENODEV;
614
615 /* Here select between I2S / PCM / SPDIF */
616 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
617 case SND_SOC_DAIFMT_I2S:
618 ifctl = siu_flags[info->port_id].playback.i2s |
619 siu_flags[info->port_id].capture.i2s;
620 break;
621 case SND_SOC_DAIFMT_LEFT_J:
622 ifctl = siu_flags[info->port_id].playback.pcm |
623 siu_flags[info->port_id].capture.pcm;
624 break;
625 /* SPDIF disabled - see comment at the top */
626 default:
627 return -EINVAL;
628 }
629
630 ifctl |= ~(siu_flags[info->port_id].playback.mask |
631 siu_flags[info->port_id].capture.mask) &
632 siu_read32(base + SIU_IFCTL);
633 siu_write32(base + SIU_IFCTL, ifctl);
634
635 return 0;
636 }
637
638 static int siu_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
639 unsigned int freq, int dir)
640 {
641 struct clk *siu_clk, *parent_clk;
642 char *siu_name, *parent_name;
643 int ret;
644
645 if (dir != SND_SOC_CLOCK_IN)
646 return -EINVAL;
647
648 dev_dbg(dai->dev, "%s: using clock %d\n", __func__, clk_id);
649
650 switch (clk_id) {
651 case SIU_CLKA_PLL:
652 siu_name = "siua_clk";
653 parent_name = "pll_clk";
654 break;
655 case SIU_CLKA_EXT:
656 siu_name = "siua_clk";
657 parent_name = "siumcka_clk";
658 break;
659 case SIU_CLKB_PLL:
660 siu_name = "siub_clk";
661 parent_name = "pll_clk";
662 break;
663 case SIU_CLKB_EXT:
664 siu_name = "siub_clk";
665 parent_name = "siumckb_clk";
666 break;
667 default:
668 return -EINVAL;
669 }
670
671 siu_clk = clk_get(dai->dev, siu_name);
672 if (IS_ERR(siu_clk)) {
673 dev_err(dai->dev, "%s: cannot get a SIU clock: %ld\n", __func__,
674 PTR_ERR(siu_clk));
675 return PTR_ERR(siu_clk);
676 }
677
678 parent_clk = clk_get(dai->dev, parent_name);
679 if (IS_ERR(parent_clk)) {
680 ret = PTR_ERR(parent_clk);
681 dev_err(dai->dev, "cannot get a SIU clock parent: %d\n", ret);
682 goto epclkget;
683 }
684
685 ret = clk_set_parent(siu_clk, parent_clk);
686 if (ret < 0) {
687 dev_err(dai->dev, "cannot reparent the SIU clock: %d\n", ret);
688 goto eclksetp;
689 }
690
691 ret = clk_set_rate(siu_clk, freq);
692 if (ret < 0)
693 dev_err(dai->dev, "cannot set SIU clock rate: %d\n", ret);
694
695 /* TODO: when clkdev gets reference counting we'll move these to siu_dai_shutdown() */
696 eclksetp:
697 clk_put(parent_clk);
698 epclkget:
699 clk_put(siu_clk);
700
701 return ret;
702 }
703
704 static const struct snd_soc_dai_ops siu_dai_ops = {
705 .startup = siu_dai_startup,
706 .shutdown = siu_dai_shutdown,
707 .prepare = siu_dai_prepare,
708 .set_sysclk = siu_dai_set_sysclk,
709 .set_fmt = siu_dai_set_fmt,
710 };
711
712 static struct snd_soc_dai_driver siu_i2s_dai = {
713 .name = "siu-i2s-dai",
714 .playback = {
715 .channels_min = 2,
716 .channels_max = 2,
717 .formats = SNDRV_PCM_FMTBIT_S16,
718 .rates = SNDRV_PCM_RATE_8000_48000,
719 },
720 .capture = {
721 .channels_min = 2,
722 .channels_max = 2,
723 .formats = SNDRV_PCM_FMTBIT_S16,
724 .rates = SNDRV_PCM_RATE_8000_48000,
725 },
726 .ops = &siu_dai_ops,
727 };
728
729 static int __devinit siu_probe(struct platform_device *pdev)
730 {
731 const struct firmware *fw_entry;
732 struct resource *res, *region;
733 struct siu_info *info;
734 int ret;
735
736 info = kmalloc(sizeof(*info), GFP_KERNEL);
737 if (!info)
738 return -ENOMEM;
739 siu_i2s_data = info;
740 info->dev = &pdev->dev;
741
742 ret = request_firmware(&fw_entry, "siu_spb.bin", &pdev->dev);
743 if (ret)
744 goto ereqfw;
745
746 /*
747 * Loaded firmware is "const" - read only, but we have to modify it in
748 * snd_siu_sh7343_spbAselect() and snd_siu_sh7343_spbBselect()
749 */
750 memcpy(&info->fw, fw_entry->data, fw_entry->size);
751
752 release_firmware(fw_entry);
753
754 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
755 if (!res) {
756 ret = -ENODEV;
757 goto egetres;
758 }
759
760 region = request_mem_region(res->start, resource_size(res),
761 pdev->name);
762 if (!region) {
763 dev_err(&pdev->dev, "SIU region already claimed\n");
764 ret = -EBUSY;
765 goto ereqmemreg;
766 }
767
768 ret = -ENOMEM;
769 info->pram = ioremap(res->start, PRAM_SIZE);
770 if (!info->pram)
771 goto emappram;
772 info->xram = ioremap(res->start + XRAM_OFFSET, XRAM_SIZE);
773 if (!info->xram)
774 goto emapxram;
775 info->yram = ioremap(res->start + YRAM_OFFSET, YRAM_SIZE);
776 if (!info->yram)
777 goto emapyram;
778 info->reg = ioremap(res->start + REG_OFFSET, resource_size(res) -
779 REG_OFFSET);
780 if (!info->reg)
781 goto emapreg;
782
783 dev_set_drvdata(&pdev->dev, info);
784
785 /* register using ARRAY version so we can keep dai name */
786 ret = snd_soc_register_dais(&pdev->dev, &siu_i2s_dai, 1);
787 if (ret < 0)
788 goto edaiinit;
789
790 ret = snd_soc_register_platform(&pdev->dev, &siu_platform);
791 if (ret < 0)
792 goto esocregp;
793
794 pm_runtime_enable(&pdev->dev);
795
796 return ret;
797
798 esocregp:
799 snd_soc_unregister_dai(&pdev->dev);
800 edaiinit:
801 iounmap(info->reg);
802 emapreg:
803 iounmap(info->yram);
804 emapyram:
805 iounmap(info->xram);
806 emapxram:
807 iounmap(info->pram);
808 emappram:
809 release_mem_region(res->start, resource_size(res));
810 ereqmemreg:
811 egetres:
812 ereqfw:
813 kfree(info);
814
815 return ret;
816 }
817
818 static int __devexit siu_remove(struct platform_device *pdev)
819 {
820 struct siu_info *info = dev_get_drvdata(&pdev->dev);
821 struct resource *res;
822
823 pm_runtime_disable(&pdev->dev);
824
825 snd_soc_unregister_platform(&pdev->dev);
826 snd_soc_unregister_dai(&pdev->dev);
827
828 iounmap(info->reg);
829 iounmap(info->yram);
830 iounmap(info->xram);
831 iounmap(info->pram);
832 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
833 if (res)
834 release_mem_region(res->start, resource_size(res));
835 kfree(info);
836
837 return 0;
838 }
839
840 static struct platform_driver siu_driver = {
841 .driver = {
842 .owner = THIS_MODULE,
843 .name = "siu-pcm-audio",
844 },
845 .probe = siu_probe,
846 .remove = __devexit_p(siu_remove),
847 };
848
849 module_platform_driver(siu_driver);
850
851 MODULE_AUTHOR("Carlos Munoz <carlos@kenati.com>");
852 MODULE_DESCRIPTION("ALSA SoC SH7722 SIU driver");
853 MODULE_LICENSE("GPL");