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