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