projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ASoC: rsnd: add rsnd_io_to_rdai()
[deliverable/linux.git] / sound / soc / sh / rcar / core.c
1 /*
2 * Renesas R-Car SRU/SCU/SSIU/SSI support
3 *
4 * Copyright (C) 2013 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6 *
7 * Based on fsi.c
8 * Kuninori Morimoto <morimoto.kuninori@renesas.com>
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
13 */
14
15 /*
16 * Renesas R-Car sound device structure
17 *
18 * Gen1
19 *
20 * SRU : Sound Routing Unit
21 * - SRC : Sampling Rate Converter
22 * - CMD
23 * - CTU : Channel Count Conversion Unit
24 * - MIX : Mixer
25 * - DVC : Digital Volume and Mute Function
26 * - SSI : Serial Sound Interface
27 *
28 * Gen2
29 *
30 * SCU : Sampling Rate Converter Unit
31 * - SRC : Sampling Rate Converter
32 * - CMD
33 * - CTU : Channel Count Conversion Unit
34 * - MIX : Mixer
35 * - DVC : Digital Volume and Mute Function
36 * SSIU : Serial Sound Interface Unit
37 * - SSI : Serial Sound Interface
38 */
39
40 /*
41 * driver data Image
42 *
43 * rsnd_priv
44 * |
45 * | ** this depends on Gen1/Gen2
46 * |
47 * +- gen
48 * |
49 * | ** these depend on data path
50 * | ** gen and platform data control it
51 * |
52 * +- rdai[0]
53 * | | sru ssiu ssi
54 * | +- playback -> [mod] -> [mod] -> [mod] -> ...
55 * | |
56 * | | sru ssiu ssi
57 * | +- capture -> [mod] -> [mod] -> [mod] -> ...
58 * |
59 * +- rdai[1]
60 * | | sru ssiu ssi
61 * | +- playback -> [mod] -> [mod] -> [mod] -> ...
62 * | |
63 * | | sru ssiu ssi
64 * | +- capture -> [mod] -> [mod] -> [mod] -> ...
65 * ...
66 * |
67 * | ** these control ssi
68 * |
69 * +- ssi
70 * | |
71 * | +- ssi[0]
72 * | +- ssi[1]
73 * | +- ssi[2]
74 * | ...
75 * |
76 * | ** these control src
77 * |
78 * +- src
79 * |
80 * +- src[0]
81 * +- src[1]
82 * +- src[2]
83 * ...
84 *
85 *
86 * for_each_rsnd_dai(xx, priv, xx)
87 * rdai[0] => rdai[1] => rdai[2] => ...
88 *
89 * for_each_rsnd_mod(xx, rdai, xx)
90 * [mod] => [mod] => [mod] => ...
91 *
92 * rsnd_dai_call(xxx, fn )
93 * [mod]->fn() -> [mod]->fn() -> [mod]->fn()...
94 *
95 */
96 #include <linux/pm_runtime.h>
97 #include <linux/shdma-base.h>
98 #include "rsnd.h"
99
100 #define RSND_RATES SNDRV_PCM_RATE_8000_96000
101 #define RSND_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
102
103 static struct rsnd_of_data rsnd_of_data_gen1 = {
104 .flags = RSND_GEN1,
105 };
106
107 static struct rsnd_of_data rsnd_of_data_gen2 = {
108 .flags = RSND_GEN2,
109 };
110
111 static struct of_device_id rsnd_of_match[] = {
112 { .compatible = "renesas,rcar_sound-gen1", .data = &rsnd_of_data_gen1 },
113 { .compatible = "renesas,rcar_sound-gen2", .data = &rsnd_of_data_gen2 },
114 {},
115 };
116 MODULE_DEVICE_TABLE(of, rsnd_of_match);
117
118 /*
119 * rsnd_platform functions
120 */
121 #define rsnd_platform_call(priv, dai, func, param...) \
122 (!(priv->info->func) ? 0 : \
123 priv->info->func(param))
124
125 #define rsnd_is_enable_path(io, name) \
126 ((io)->info ? (io)->info->name : NULL)
127 #define rsnd_info_id(priv, io, name) \
128 ((io)->info->name - priv->info->name##_info)
129
130 /*
131 * rsnd_mod functions
132 */
133 char *rsnd_mod_name(struct rsnd_mod *mod)
134 {
135 if (!mod || !mod->ops)
136 return "unknown";
137
138 return mod->ops->name;
139 }
140
141 char *rsnd_mod_dma_name(struct rsnd_mod *mod)
142 {
143 if (!mod || !mod->ops)
144 return "unknown";
145
146 if (!mod->ops->dma_name)
147 return mod->ops->name;
148
149 return mod->ops->dma_name(mod);
150 }
151
152 void rsnd_mod_init(struct rsnd_priv *priv,
153 struct rsnd_mod *mod,
154 struct rsnd_mod_ops *ops,
155 struct clk *clk,
156 enum rsnd_mod_type type,
157 int id)
158 {
159 mod->priv = priv;
160 mod->id = id;
161 mod->ops = ops;
162 mod->type = type;
163 mod->clk = clk;
164 }
165
166 /*
167 * rsnd_dma functions
168 */
169 void rsnd_dma_stop(struct rsnd_dma *dma)
170 {
171 dmaengine_terminate_all(dma->chan);
172 }
173
174 static void rsnd_dma_complete(void *data)
175 {
176 struct rsnd_dma *dma = (struct rsnd_dma *)data;
177 struct rsnd_mod *mod = rsnd_dma_to_mod(dma);
178 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
179
180 /*
181 * Renesas sound Gen1 needs 1 DMAC,
182 * Gen2 needs 2 DMAC.
183 * In Gen2 case, it are Audio-DMAC, and Audio-DMAC-peri-peri.
184 * But, Audio-DMAC-peri-peri doesn't have interrupt,
185 * and this driver is assuming that here.
186 *
187 * If Audio-DMAC-peri-peri has interrpt,
188 * rsnd_dai_pointer_update() will be called twice,
189 * ant it will breaks io->byte_pos
190 */
191
192 rsnd_dai_pointer_update(io, io->byte_per_period);
193 }
194
195 void rsnd_dma_start(struct rsnd_dma *dma)
196 {
197 struct rsnd_mod *mod = rsnd_dma_to_mod(dma);
198 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
199 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
200 struct snd_pcm_substream *substream = io->substream;
201 struct device *dev = rsnd_priv_to_dev(priv);
202 struct dma_async_tx_descriptor *desc;
203
204 desc = dmaengine_prep_dma_cyclic(dma->chan,
205 (dma->addr) ? dma->addr :
206 substream->runtime->dma_addr,
207 snd_pcm_lib_buffer_bytes(substream),
208 snd_pcm_lib_period_bytes(substream),
209 dma->dir,
210 DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
211
212 if (!desc) {
213 dev_err(dev, "dmaengine_prep_slave_sg() fail\n");
214 return;
215 }
216
217 desc->callback = rsnd_dma_complete;
218 desc->callback_param = dma;
219
220 if (dmaengine_submit(desc) < 0) {
221 dev_err(dev, "dmaengine_submit() fail\n");
222 return;
223 }
224
225 dma_async_issue_pending(dma->chan);
226 }
227
228 int rsnd_dma_available(struct rsnd_dma *dma)
229 {
230 return !!dma->chan;
231 }
232
233 #define DMA_NAME_SIZE 16
234 #define MOD_MAX 4 /* MEM/SSI/SRC/DVC */
235 static int _rsnd_dma_of_name(char *dma_name, struct rsnd_mod *mod)
236 {
237 if (mod)
238 return snprintf(dma_name, DMA_NAME_SIZE / 2, "%s%d",
239 rsnd_mod_dma_name(mod), rsnd_mod_id(mod));
240 else
241 return snprintf(dma_name, DMA_NAME_SIZE / 2, "mem");
242
243 }
244
245 static void rsnd_dma_of_name(struct rsnd_mod *mod_from,
246 struct rsnd_mod *mod_to,
247 char *dma_name)
248 {
249 int index = 0;
250
251 index = _rsnd_dma_of_name(dma_name + index, mod_from);
252 *(dma_name + index++) = '_';
253 index = _rsnd_dma_of_name(dma_name + index, mod_to);
254 }
255
256 static void rsnd_dma_of_path(struct rsnd_dma *dma,
257 int is_play,
258 struct rsnd_mod **mod_from,
259 struct rsnd_mod **mod_to)
260 {
261 struct rsnd_mod *this = rsnd_dma_to_mod(dma);
262 struct rsnd_dai_stream *io = rsnd_mod_to_io(this);
263 struct rsnd_mod *ssi = rsnd_io_to_mod_ssi(io);
264 struct rsnd_mod *src = rsnd_io_to_mod_src(io);
265 struct rsnd_mod *dvc = rsnd_io_to_mod_dvc(io);
266 struct rsnd_mod *mod[MOD_MAX];
267 int i, index;
268
269
270 for (i = 0; i < MOD_MAX; i++)
271 mod[i] = NULL;
272
273 /*
274 * in play case...
275 *
276 * src -> dst
277 *
278 * mem -> SSI
279 * mem -> SRC -> SSI
280 * mem -> SRC -> DVC -> SSI
281 */
282 mod[0] = NULL; /* for "mem" */
283 index = 1;
284 for (i = 1; i < MOD_MAX; i++) {
285 if (!src) {
286 mod[i] = ssi;
287 } else if (!dvc) {
288 mod[i] = src;
289 src = NULL;
290 } else {
291 if ((!is_play) && (this == src))
292 this = dvc;
293
294 mod[i] = (is_play) ? src : dvc;
295 i++;
296 mod[i] = (is_play) ? dvc : src;
297 src = NULL;
298 dvc = NULL;
299 }
300
301 if (mod[i] == this)
302 index = i;
303
304 if (mod[i] == ssi)
305 break;
306 }
307
308 if (is_play) {
309 *mod_from = mod[index - 1];
310 *mod_to = mod[index];
311 } else {
312 *mod_from = mod[index];
313 *mod_to = mod[index - 1];
314 }
315 }
316
317 int rsnd_dma_init(struct rsnd_priv *priv, struct rsnd_dma *dma,
318 int is_play, int id)
319 {
320 struct device *dev = rsnd_priv_to_dev(priv);
321 struct dma_slave_config cfg;
322 struct rsnd_mod *mod_from;
323 struct rsnd_mod *mod_to;
324 char dma_name[DMA_NAME_SIZE];
325 dma_cap_mask_t mask;
326 int ret;
327
328 if (dma->chan) {
329 dev_err(dev, "it already has dma channel\n");
330 return -EIO;
331 }
332
333 dma_cap_zero(mask);
334 dma_cap_set(DMA_SLAVE, mask);
335
336 rsnd_dma_of_path(dma, is_play, &mod_from, &mod_to);
337 rsnd_dma_of_name(mod_from, mod_to, dma_name);
338
339 cfg.slave_id = id;
340 cfg.direction = is_play ? DMA_MEM_TO_DEV : DMA_DEV_TO_MEM;
341 cfg.src_addr = rsnd_gen_dma_addr(priv, mod_from, is_play, 1);
342 cfg.dst_addr = rsnd_gen_dma_addr(priv, mod_to, is_play, 0);
343 cfg.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
344 cfg.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
345
346 dev_dbg(dev, "dma : %s %pad -> %pad\n",
347 dma_name, &cfg.src_addr, &cfg.dst_addr);
348
349 dma->chan = dma_request_slave_channel_compat(mask, shdma_chan_filter,
350 (void *)id, dev,
351 dma_name);
352 if (!dma->chan) {
353 dev_err(dev, "can't get dma channel\n");
354 goto rsnd_dma_channel_err;
355 }
356
357 ret = dmaengine_slave_config(dma->chan, &cfg);
358 if (ret < 0)
359 goto rsnd_dma_init_err;
360
361 dma->addr = is_play ? cfg.src_addr : cfg.dst_addr;
362 dma->dir = is_play ? DMA_MEM_TO_DEV : DMA_DEV_TO_MEM;
363
364 return 0;
365
366 rsnd_dma_init_err:
367 rsnd_dma_quit(priv, dma);
368 rsnd_dma_channel_err:
369
370 /*
371 * DMA failed. try to PIO mode
372 * see
373 * rsnd_ssi_fallback()
374 * rsnd_rdai_continuance_probe()
375 */
376 return -EAGAIN;
377 }
378
379 void rsnd_dma_quit(struct rsnd_priv *priv,
380 struct rsnd_dma *dma)
381 {
382 if (dma->chan)
383 dma_release_channel(dma->chan);
384
385 dma->chan = NULL;
386 }
387
388 /*
389 * settting function
390 */
391 u32 rsnd_get_adinr(struct rsnd_mod *mod)
392 {
393 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
394 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
395 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
396 struct device *dev = rsnd_priv_to_dev(priv);
397 u32 adinr = runtime->channels;
398
399 switch (runtime->sample_bits) {
400 case 16:
401 adinr |= (8 << 16);
402 break;
403 case 32:
404 adinr |= (0 << 16);
405 break;
406 default:
407 dev_warn(dev, "not supported sample bits\n");
408 return 0;
409 }
410
411 return adinr;
412 }
413
414 /*
415 * rsnd_dai functions
416 */
417 #define __rsnd_mod_call(mod, func, rdai...) \
418 ({ \
419 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); \
420 struct device *dev = rsnd_priv_to_dev(priv); \
421 u32 mask = 1 << __rsnd_mod_shift_##func; \
422 u32 call = __rsnd_mod_call_##func << __rsnd_mod_shift_##func; \
423 int ret = 0; \
424 if ((mod->status & mask) == call) { \
425 dev_dbg(dev, "%s[%d] %s\n", \
426 rsnd_mod_name(mod), rsnd_mod_id(mod), #func); \
427 ret = (mod)->ops->func(mod, rdai); \
428 mod->status = (mod->status & ~mask) | (~call & mask); \
429 } \
430 ret; \
431 })
432
433 #define rsnd_mod_call(mod, func, rdai...) \
434 (!(mod) ? -ENODEV : \
435 !((mod)->ops->func) ? 0 : \
436 __rsnd_mod_call(mod, func, rdai))
437
438 #define rsnd_dai_call(fn, io, rdai...) \
439 ({ \
440 struct rsnd_mod *mod; \
441 int ret = 0, i; \
442 for (i = 0; i < RSND_MOD_MAX; i++) { \
443 mod = (io)->mod[i]; \
444 if (!mod) \
445 continue; \
446 ret = rsnd_mod_call(mod, fn, rdai); \
447 if (ret < 0) \
448 break; \
449 } \
450 ret; \
451 })
452
453 static int rsnd_dai_connect(struct rsnd_mod *mod,
454 struct rsnd_dai_stream *io)
455 {
456 if (!mod)
457 return -EIO;
458
459 if (io->mod[mod->type]) {
460 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
461 struct device *dev = rsnd_priv_to_dev(priv);
462
463 dev_err(dev, "%s%d is not empty\n",
464 rsnd_mod_name(mod),
465 rsnd_mod_id(mod));
466 return -EIO;
467 }
468
469 io->mod[mod->type] = mod;
470 mod->io = io;
471
472 return 0;
473 }
474
475 static void rsnd_dai_disconnect(struct rsnd_mod *mod,
476 struct rsnd_dai_stream *io)
477 {
478 mod->io = NULL;
479 io->mod[mod->type] = NULL;
480 }
481
482 struct rsnd_dai *rsnd_rdai_get(struct rsnd_priv *priv, int id)
483 {
484 if ((id < 0) || (id >= rsnd_rdai_nr(priv)))
485 return NULL;
486
487 return priv->rdai + id;
488 }
489
490 static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai)
491 {
492 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai);
493
494 return rsnd_rdai_get(priv, dai->id);
495 }
496
497 int rsnd_dai_is_play(struct rsnd_dai *rdai, struct rsnd_dai_stream *io)
498 {
499 return &rdai->playback == io;
500 }
501
502 /*
503 * rsnd_soc_dai functions
504 */
505 int rsnd_dai_pointer_offset(struct rsnd_dai_stream *io, int additional)
506 {
507 struct snd_pcm_substream *substream = io->substream;
508 struct snd_pcm_runtime *runtime = substream->runtime;
509 int pos = io->byte_pos + additional;
510
511 pos %= (runtime->periods * io->byte_per_period);
512
513 return pos;
514 }
515
516 void rsnd_dai_pointer_update(struct rsnd_dai_stream *io, int byte)
517 {
518 io->byte_pos += byte;
519
520 if (io->byte_pos >= io->next_period_byte) {
521 struct snd_pcm_substream *substream = io->substream;
522 struct snd_pcm_runtime *runtime = substream->runtime;
523
524 io->period_pos++;
525 io->next_period_byte += io->byte_per_period;
526
527 if (io->period_pos >= runtime->periods) {
528 io->byte_pos = 0;
529 io->period_pos = 0;
530 io->next_period_byte = io->byte_per_period;
531 }
532
533 snd_pcm_period_elapsed(substream);
534 }
535 }
536
537 static int rsnd_dai_stream_init(struct rsnd_dai_stream *io,
538 struct snd_pcm_substream *substream)
539 {
540 struct snd_pcm_runtime *runtime = substream->runtime;
541
542 io->substream = substream;
543 io->byte_pos = 0;
544 io->period_pos = 0;
545 io->byte_per_period = runtime->period_size *
546 runtime->channels *
547 samples_to_bytes(runtime, 1);
548 io->next_period_byte = io->byte_per_period;
549
550 return 0;
551 }
552
553 static
554 struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream)
555 {
556 struct snd_soc_pcm_runtime *rtd = substream->private_data;
557
558 return rtd->cpu_dai;
559 }
560
561 static
562 struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai,
563 struct snd_pcm_substream *substream)
564 {
565 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
566 return &rdai->playback;
567 else
568 return &rdai->capture;
569 }
570
571 static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd,
572 struct snd_soc_dai *dai)
573 {
574 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai);
575 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
576 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
577 int ssi_id = rsnd_mod_id(rsnd_io_to_mod_ssi(io));
578 int ret;
579 unsigned long flags;
580
581 rsnd_lock(priv, flags);
582
583 switch (cmd) {
584 case SNDRV_PCM_TRIGGER_START:
585 ret = rsnd_dai_stream_init(io, substream);
586 if (ret < 0)
587 goto dai_trigger_end;
588
589 ret = rsnd_platform_call(priv, dai, start, ssi_id);
590 if (ret < 0)
591 goto dai_trigger_end;
592
593 ret = rsnd_dai_call(init, io, rdai);
594 if (ret < 0)
595 goto dai_trigger_end;
596
597 ret = rsnd_dai_call(start, io, rdai);
598 if (ret < 0)
599 goto dai_trigger_end;
600 break;
601 case SNDRV_PCM_TRIGGER_STOP:
602 ret = rsnd_dai_call(stop, io, rdai);
603 if (ret < 0)
604 goto dai_trigger_end;
605
606 ret = rsnd_dai_call(quit, io, rdai);
607 if (ret < 0)
608 goto dai_trigger_end;
609
610 ret = rsnd_platform_call(priv, dai, stop, ssi_id);
611 if (ret < 0)
612 goto dai_trigger_end;
613 break;
614 default:
615 ret = -EINVAL;
616 }
617
618 dai_trigger_end:
619 rsnd_unlock(priv, flags);
620
621 return ret;
622 }
623
624 static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
625 {
626 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
627
628 /* set master/slave audio interface */
629 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
630 case SND_SOC_DAIFMT_CBM_CFM:
631 rdai->clk_master = 0;
632 break;
633 case SND_SOC_DAIFMT_CBS_CFS:
634 rdai->clk_master = 1; /* codec is slave, cpu is master */
635 break;
636 default:
637 return -EINVAL;
638 }
639
640 /* set format */
641 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
642 case SND_SOC_DAIFMT_I2S:
643 rdai->sys_delay = 0;
644 rdai->data_alignment = 0;
645 rdai->frm_clk_inv = 0;
646 break;
647 case SND_SOC_DAIFMT_LEFT_J:
648 rdai->sys_delay = 1;
649 rdai->data_alignment = 0;
650 rdai->frm_clk_inv = 1;
651 break;
652 case SND_SOC_DAIFMT_RIGHT_J:
653 rdai->sys_delay = 1;
654 rdai->data_alignment = 1;
655 rdai->frm_clk_inv = 1;
656 break;
657 }
658
659 /* set clock inversion */
660 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
661 case SND_SOC_DAIFMT_NB_IF:
662 rdai->bit_clk_inv = rdai->bit_clk_inv;
663 rdai->frm_clk_inv = !rdai->frm_clk_inv;
664 break;
665 case SND_SOC_DAIFMT_IB_NF:
666 rdai->bit_clk_inv = !rdai->bit_clk_inv;
667 rdai->frm_clk_inv = rdai->frm_clk_inv;
668 break;
669 case SND_SOC_DAIFMT_IB_IF:
670 rdai->bit_clk_inv = !rdai->bit_clk_inv;
671 rdai->frm_clk_inv = !rdai->frm_clk_inv;
672 break;
673 case SND_SOC_DAIFMT_NB_NF:
674 default:
675 break;
676 }
677
678 return 0;
679 }
680
681 static const struct snd_soc_dai_ops rsnd_soc_dai_ops = {
682 .trigger = rsnd_soc_dai_trigger,
683 .set_fmt = rsnd_soc_dai_set_fmt,
684 };
685
686 #define rsnd_path_parse(priv, io, type) \
687 ({ \
688 struct rsnd_mod *mod; \
689 int ret = 0; \
690 int id = -1; \
691 \
692 if (rsnd_is_enable_path(io, type)) { \
693 id = rsnd_info_id(priv, io, type); \
694 if (id >= 0) { \
695 mod = rsnd_##type##_mod_get(priv, id); \
696 ret = rsnd_dai_connect(mod, io); \
697 } \
698 } \
699 ret; \
700 })
701
702 #define rsnd_path_break(priv, io, type) \
703 { \
704 struct rsnd_mod *mod; \
705 int id = -1; \
706 \
707 if (rsnd_is_enable_path(io, type)) { \
708 id = rsnd_info_id(priv, io, type); \
709 if (id >= 0) { \
710 mod = rsnd_##type##_mod_get(priv, id); \
711 rsnd_dai_disconnect(mod, io); \
712 } \
713 } \
714 }
715
716 static int rsnd_path_init(struct rsnd_priv *priv,
717 struct rsnd_dai *rdai,
718 struct rsnd_dai_stream *io)
719 {
720 int ret;
721
722 /*
723 * Gen1 is created by SRU/SSI, and this SRU is base module of
724 * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU)
725 *
726 * Easy image is..
727 * Gen1 SRU = Gen2 SCU + SSIU + etc
728 *
729 * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is
730 * using fixed path.
731 */
732
733 /* SRC */
734 ret = rsnd_path_parse(priv, io, src);
735 if (ret < 0)
736 return ret;
737
738 /* SSI */
739 ret = rsnd_path_parse(priv, io, ssi);
740 if (ret < 0)
741 return ret;
742
743 /* DVC */
744 ret = rsnd_path_parse(priv, io, dvc);
745 if (ret < 0)
746 return ret;
747
748 return ret;
749 }
750
751 static void rsnd_of_parse_dai(struct platform_device *pdev,
752 const struct rsnd_of_data *of_data,
753 struct rsnd_priv *priv)
754 {
755 struct device_node *dai_node, *dai_np;
756 struct device_node *ssi_node, *ssi_np;
757 struct device_node *src_node, *src_np;
758 struct device_node *dvc_node, *dvc_np;
759 struct device_node *playback, *capture;
760 struct rsnd_dai_platform_info *dai_info;
761 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
762 struct device *dev = &pdev->dev;
763 int nr, i;
764 int dai_i, ssi_i, src_i, dvc_i;
765
766 if (!of_data)
767 return;
768
769 dai_node = of_get_child_by_name(dev->of_node, "rcar_sound,dai");
770 if (!dai_node)
771 return;
772
773 nr = of_get_child_count(dai_node);
774 if (!nr)
775 return;
776
777 dai_info = devm_kzalloc(dev,
778 sizeof(struct rsnd_dai_platform_info) * nr,
779 GFP_KERNEL);
780 if (!dai_info) {
781 dev_err(dev, "dai info allocation error\n");
782 return;
783 }
784
785 info->dai_info_nr = nr;
786 info->dai_info = dai_info;
787
788 ssi_node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
789 src_node = of_get_child_by_name(dev->of_node, "rcar_sound,src");
790 dvc_node = of_get_child_by_name(dev->of_node, "rcar_sound,dvc");
791
792 #define mod_parse(name) \
793 if (name##_node) { \
794 struct rsnd_##name##_platform_info *name##_info; \
795 \
796 name##_i = 0; \
797 for_each_child_of_node(name##_node, name##_np) { \
798 name##_info = info->name##_info + name##_i; \
799 \
800 if (name##_np == playback) \
801 dai_info->playback.name = name##_info; \
802 if (name##_np == capture) \
803 dai_info->capture.name = name##_info; \
804 \
805 name##_i++; \
806 } \
807 }
808
809 /*
810 * parse all dai
811 */
812 dai_i = 0;
813 for_each_child_of_node(dai_node, dai_np) {
814 dai_info = info->dai_info + dai_i;
815
816 for (i = 0;; i++) {
817
818 playback = of_parse_phandle(dai_np, "playback", i);
819 capture = of_parse_phandle(dai_np, "capture", i);
820
821 if (!playback && !capture)
822 break;
823
824 mod_parse(ssi);
825 mod_parse(src);
826 mod_parse(dvc);
827
828 of_node_put(playback);
829 of_node_put(capture);
830 }
831
832 dai_i++;
833 }
834 }
835
836 static int rsnd_dai_probe(struct platform_device *pdev,
837 const struct rsnd_of_data *of_data,
838 struct rsnd_priv *priv)
839 {
840 struct snd_soc_dai_driver *drv;
841 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
842 struct rsnd_dai *rdai;
843 struct rsnd_ssi_platform_info *pmod, *cmod;
844 struct device *dev = rsnd_priv_to_dev(priv);
845 int dai_nr;
846 int i;
847
848 rsnd_of_parse_dai(pdev, of_data, priv);
849
850 dai_nr = info->dai_info_nr;
851 if (!dai_nr) {
852 dev_err(dev, "no dai\n");
853 return -EIO;
854 }
855
856 drv = devm_kzalloc(dev, sizeof(*drv) * dai_nr, GFP_KERNEL);
857 rdai = devm_kzalloc(dev, sizeof(*rdai) * dai_nr, GFP_KERNEL);
858 if (!drv || !rdai) {
859 dev_err(dev, "dai allocate failed\n");
860 return -ENOMEM;
861 }
862
863 priv->rdai_nr = dai_nr;
864 priv->daidrv = drv;
865 priv->rdai = rdai;
866
867 for (i = 0; i < dai_nr; i++) {
868
869 pmod = info->dai_info[i].playback.ssi;
870 cmod = info->dai_info[i].capture.ssi;
871
872 /*
873 * init rsnd_dai
874 */
875 snprintf(rdai[i].name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", i);
876
877 /*
878 * init snd_soc_dai_driver
879 */
880 drv[i].name = rdai[i].name;
881 drv[i].ops = &rsnd_soc_dai_ops;
882 if (pmod) {
883 drv[i].playback.rates = RSND_RATES;
884 drv[i].playback.formats = RSND_FMTS;
885 drv[i].playback.channels_min = 2;
886 drv[i].playback.channels_max = 2;
887
888 rdai[i].playback.info = &info->dai_info[i].playback;
889 rdai[i].playback.rdai = rdai + i;
890 rsnd_path_init(priv, &rdai[i], &rdai[i].playback);
891 }
892 if (cmod) {
893 drv[i].capture.rates = RSND_RATES;
894 drv[i].capture.formats = RSND_FMTS;
895 drv[i].capture.channels_min = 2;
896 drv[i].capture.channels_max = 2;
897
898 rdai[i].capture.info = &info->dai_info[i].capture;
899 rdai[i].capture.rdai = rdai + i;
900 rsnd_path_init(priv, &rdai[i], &rdai[i].capture);
901 }
902
903 dev_dbg(dev, "%s (%s/%s)\n", rdai[i].name,
904 pmod ? "play" : " -- ",
905 cmod ? "capture" : " -- ");
906 }
907
908 return 0;
909 }
910
911 /*
912 * pcm ops
913 */
914 static struct snd_pcm_hardware rsnd_pcm_hardware = {
915 .info = SNDRV_PCM_INFO_INTERLEAVED |
916 SNDRV_PCM_INFO_MMAP |
917 SNDRV_PCM_INFO_MMAP_VALID,
918 .buffer_bytes_max = 64 * 1024,
919 .period_bytes_min = 32,
920 .period_bytes_max = 8192,
921 .periods_min = 1,
922 .periods_max = 32,
923 .fifo_size = 256,
924 };
925
926 static int rsnd_pcm_open(struct snd_pcm_substream *substream)
927 {
928 struct snd_pcm_runtime *runtime = substream->runtime;
929 int ret = 0;
930
931 snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware);
932
933 ret = snd_pcm_hw_constraint_integer(runtime,
934 SNDRV_PCM_HW_PARAM_PERIODS);
935
936 return ret;
937 }
938
939 static int rsnd_hw_params(struct snd_pcm_substream *substream,
940 struct snd_pcm_hw_params *hw_params)
941 {
942 return snd_pcm_lib_malloc_pages(substream,
943 params_buffer_bytes(hw_params));
944 }
945
946 static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream)
947 {
948 struct snd_pcm_runtime *runtime = substream->runtime;
949 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
950 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
951 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
952
953 return bytes_to_frames(runtime, io->byte_pos);
954 }
955
956 static struct snd_pcm_ops rsnd_pcm_ops = {
957 .open = rsnd_pcm_open,
958 .ioctl = snd_pcm_lib_ioctl,
959 .hw_params = rsnd_hw_params,
960 .hw_free = snd_pcm_lib_free_pages,
961 .pointer = rsnd_pointer,
962 };
963
964 /*
965 * snd_kcontrol
966 */
967 #define kcontrol_to_cfg(kctrl) ((struct rsnd_kctrl_cfg *)kctrl->private_value)
968 static int rsnd_kctrl_info(struct snd_kcontrol *kctrl,
969 struct snd_ctl_elem_info *uinfo)
970 {
971 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
972
973 if (cfg->texts) {
974 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
975 uinfo->count = cfg->size;
976 uinfo->value.enumerated.items = cfg->max;
977 if (uinfo->value.enumerated.item >= cfg->max)
978 uinfo->value.enumerated.item = cfg->max - 1;
979 strlcpy(uinfo->value.enumerated.name,
980 cfg->texts[uinfo->value.enumerated.item],
981 sizeof(uinfo->value.enumerated.name));
982 } else {
983 uinfo->count = cfg->size;
984 uinfo->value.integer.min = 0;
985 uinfo->value.integer.max = cfg->max;
986 uinfo->type = (cfg->max == 1) ?
987 SNDRV_CTL_ELEM_TYPE_BOOLEAN :
988 SNDRV_CTL_ELEM_TYPE_INTEGER;
989 }
990
991 return 0;
992 }
993
994 static int rsnd_kctrl_get(struct snd_kcontrol *kctrl,
995 struct snd_ctl_elem_value *uc)
996 {
997 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
998 int i;
999
1000 for (i = 0; i < cfg->size; i++)
1001 if (cfg->texts)
1002 uc->value.enumerated.item[i] = cfg->val[i];
1003 else
1004 uc->value.integer.value[i] = cfg->val[i];
1005
1006 return 0;
1007 }
1008
1009 static int rsnd_kctrl_put(struct snd_kcontrol *kctrl,
1010 struct snd_ctl_elem_value *uc)
1011 {
1012 struct rsnd_mod *mod = snd_kcontrol_chip(kctrl);
1013 struct rsnd_kctrl_cfg *cfg = kcontrol_to_cfg(kctrl);
1014 int i, change = 0;
1015
1016 for (i = 0; i < cfg->size; i++) {
1017 if (cfg->texts) {
1018 change |= (uc->value.enumerated.item[i] != cfg->val[i]);
1019 cfg->val[i] = uc->value.enumerated.item[i];
1020 } else {
1021 change |= (uc->value.integer.value[i] != cfg->val[i]);
1022 cfg->val[i] = uc->value.integer.value[i];
1023 }
1024 }
1025
1026 if (change)
1027 cfg->update(mod);
1028
1029 return change;
1030 }
1031
1032 static int __rsnd_kctrl_new(struct rsnd_mod *mod,
1033 struct rsnd_dai *rdai,
1034 struct snd_soc_pcm_runtime *rtd,
1035 const unsigned char *name,
1036 struct rsnd_kctrl_cfg *cfg,
1037 void (*update)(struct rsnd_mod *mod))
1038 {
1039 struct snd_card *card = rtd->card->snd_card;
1040 struct snd_kcontrol *kctrl;
1041 struct snd_kcontrol_new knew = {
1042 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1043 .name = name,
1044 .info = rsnd_kctrl_info,
1045 .get = rsnd_kctrl_get,
1046 .put = rsnd_kctrl_put,
1047 .private_value = (unsigned long)cfg,
1048 };
1049 int ret;
1050
1051 kctrl = snd_ctl_new1(&knew, mod);
1052 if (!kctrl)
1053 return -ENOMEM;
1054
1055 ret = snd_ctl_add(card, kctrl);
1056 if (ret < 0)
1057 return ret;
1058
1059 cfg->update = update;
1060
1061 return 0;
1062 }
1063
1064 int rsnd_kctrl_new_m(struct rsnd_mod *mod,
1065 struct rsnd_dai *rdai,
1066 struct snd_soc_pcm_runtime *rtd,
1067 const unsigned char *name,
1068 void (*update)(struct rsnd_mod *mod),
1069 struct rsnd_kctrl_cfg_m *_cfg,
1070 u32 max)
1071 {
1072 _cfg->cfg.max = max;
1073 _cfg->cfg.size = RSND_DVC_CHANNELS;
1074 _cfg->cfg.val = _cfg->val;
1075 return __rsnd_kctrl_new(mod, rdai, rtd, name, &_cfg->cfg, update);
1076 }
1077
1078 int rsnd_kctrl_new_s(struct rsnd_mod *mod,
1079 struct rsnd_dai *rdai,
1080 struct snd_soc_pcm_runtime *rtd,
1081 const unsigned char *name,
1082 void (*update)(struct rsnd_mod *mod),
1083 struct rsnd_kctrl_cfg_s *_cfg,
1084 u32 max)
1085 {
1086 _cfg->cfg.max = max;
1087 _cfg->cfg.size = 1;
1088 _cfg->cfg.val = &_cfg->val;
1089 return __rsnd_kctrl_new(mod, rdai, rtd, name, &_cfg->cfg, update);
1090 }
1091
1092 int rsnd_kctrl_new_e(struct rsnd_mod *mod,
1093 struct rsnd_dai *rdai,
1094 struct snd_soc_pcm_runtime *rtd,
1095 const unsigned char *name,
1096 struct rsnd_kctrl_cfg_s *_cfg,
1097 void (*update)(struct rsnd_mod *mod),
1098 const char * const *texts,
1099 u32 max)
1100 {
1101 _cfg->cfg.max = max;
1102 _cfg->cfg.size = 1;
1103 _cfg->cfg.val = &_cfg->val;
1104 _cfg->cfg.texts = texts;
1105 return __rsnd_kctrl_new(mod, rdai, rtd, name, &_cfg->cfg, update);
1106 }
1107
1108 /*
1109 * snd_soc_platform
1110 */
1111
1112 #define PREALLOC_BUFFER (32 * 1024)
1113 #define PREALLOC_BUFFER_MAX (32 * 1024)
1114
1115 static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd)
1116 {
1117 struct snd_soc_dai *dai = rtd->cpu_dai;
1118 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
1119 int ret;
1120
1121 ret = rsnd_dai_call(pcm_new, &rdai->playback, rdai, rtd);
1122 if (ret)
1123 return ret;
1124
1125 ret = rsnd_dai_call(pcm_new, &rdai->capture, rdai, rtd);
1126 if (ret)
1127 return ret;
1128
1129 return snd_pcm_lib_preallocate_pages_for_all(
1130 rtd->pcm,
1131 SNDRV_DMA_TYPE_DEV,
1132 rtd->card->snd_card->dev,
1133 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
1134 }
1135
1136 static struct snd_soc_platform_driver rsnd_soc_platform = {
1137 .ops = &rsnd_pcm_ops,
1138 .pcm_new = rsnd_pcm_new,
1139 };
1140
1141 static const struct snd_soc_component_driver rsnd_soc_component = {
1142 .name = "rsnd",
1143 };
1144
1145 static int rsnd_rdai_continuance_probe(struct rsnd_priv *priv,
1146 struct rsnd_dai *rdai,
1147 int is_play)
1148 {
1149 struct rsnd_dai_stream *io = is_play ? &rdai->playback : &rdai->capture;
1150 int ret;
1151
1152 ret = rsnd_dai_call(probe, io, rdai);
1153 if (ret == -EAGAIN) {
1154 /*
1155 * Fallback to PIO mode
1156 */
1157
1158 /*
1159 * call "remove" for SSI/SRC/DVC
1160 * SSI will be switch to PIO mode if it was DMA mode
1161 * see
1162 * rsnd_dma_init()
1163 * rsnd_ssi_fallback()
1164 */
1165 rsnd_dai_call(remove, io, rdai);
1166
1167 /*
1168 * remove SRC/DVC from DAI,
1169 */
1170 rsnd_path_break(priv, io, src);
1171 rsnd_path_break(priv, io, dvc);
1172
1173 /*
1174 * fallback
1175 */
1176 rsnd_dai_call(fallback, io, rdai);
1177
1178 /*
1179 * retry to "probe".
1180 * DAI has SSI which is PIO mode only now.
1181 */
1182 ret = rsnd_dai_call(probe, io, rdai);
1183 }
1184
1185 return ret;
1186 }
1187
1188 /*
1189 * rsnd probe
1190 */
1191 static int rsnd_probe(struct platform_device *pdev)
1192 {
1193 struct rcar_snd_info *info;
1194 struct rsnd_priv *priv;
1195 struct device *dev = &pdev->dev;
1196 struct rsnd_dai *rdai;
1197 const struct of_device_id *of_id = of_match_device(rsnd_of_match, dev);
1198 const struct rsnd_of_data *of_data;
1199 int (*probe_func[])(struct platform_device *pdev,
1200 const struct rsnd_of_data *of_data,
1201 struct rsnd_priv *priv) = {
1202 rsnd_gen_probe,
1203 rsnd_ssi_probe,
1204 rsnd_src_probe,
1205 rsnd_dvc_probe,
1206 rsnd_adg_probe,
1207 rsnd_dai_probe,
1208 };
1209 int ret, i;
1210
1211 info = NULL;
1212 of_data = NULL;
1213 if (of_id) {
1214 info = devm_kzalloc(&pdev->dev,
1215 sizeof(struct rcar_snd_info), GFP_KERNEL);
1216 of_data = of_id->data;
1217 } else {
1218 info = pdev->dev.platform_data;
1219 }
1220
1221 if (!info) {
1222 dev_err(dev, "driver needs R-Car sound information\n");
1223 return -ENODEV;
1224 }
1225
1226 /*
1227 * init priv data
1228 */
1229 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1230 if (!priv) {
1231 dev_err(dev, "priv allocate failed\n");
1232 return -ENODEV;
1233 }
1234
1235 priv->pdev = pdev;
1236 priv->info = info;
1237 spin_lock_init(&priv->lock);
1238
1239 /*
1240 * init each module
1241 */
1242 for (i = 0; i < ARRAY_SIZE(probe_func); i++) {
1243 ret = probe_func[i](pdev, of_data, priv);
1244 if (ret)
1245 return ret;
1246 }
1247
1248 for_each_rsnd_dai(rdai, priv, i) {
1249 ret = rsnd_rdai_continuance_probe(priv, rdai, 1);
1250 if (ret)
1251 goto exit_snd_probe;
1252
1253 ret = rsnd_rdai_continuance_probe(priv, rdai, 0);
1254 if (ret)
1255 goto exit_snd_probe;
1256 }
1257
1258 /*
1259 * asoc register
1260 */
1261 ret = snd_soc_register_platform(dev, &rsnd_soc_platform);
1262 if (ret < 0) {
1263 dev_err(dev, "cannot snd soc register\n");
1264 return ret;
1265 }
1266
1267 ret = snd_soc_register_component(dev, &rsnd_soc_component,
1268 priv->daidrv, rsnd_rdai_nr(priv));
1269 if (ret < 0) {
1270 dev_err(dev, "cannot snd dai register\n");
1271 goto exit_snd_soc;
1272 }
1273
1274 dev_set_drvdata(dev, priv);
1275
1276 pm_runtime_enable(dev);
1277
1278 dev_info(dev, "probed\n");
1279 return ret;
1280
1281 exit_snd_soc:
1282 snd_soc_unregister_platform(dev);
1283 exit_snd_probe:
1284 for_each_rsnd_dai(rdai, priv, i) {
1285 rsnd_dai_call(remove, &rdai->playback, rdai);
1286 rsnd_dai_call(remove, &rdai->capture, rdai);
1287 }
1288
1289 return ret;
1290 }
1291
1292 static int rsnd_remove(struct platform_device *pdev)
1293 {
1294 struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev);
1295 struct rsnd_dai *rdai;
1296 int ret = 0, i;
1297
1298 pm_runtime_disable(&pdev->dev);
1299
1300 for_each_rsnd_dai(rdai, priv, i) {
1301 ret |= rsnd_dai_call(remove, &rdai->playback, rdai);
1302 ret |= rsnd_dai_call(remove, &rdai->capture, rdai);
1303 }
1304
1305 return ret;
1306 }
1307
1308 static struct platform_driver rsnd_driver = {
1309 .driver = {
1310 .name = "rcar_sound",
1311 .of_match_table = rsnd_of_match,
1312 },
1313 .probe = rsnd_probe,
1314 .remove = rsnd_remove,
1315 };
1316 module_platform_driver(rsnd_driver);
1317
1318 MODULE_LICENSE("GPL");
1319 MODULE_DESCRIPTION("Renesas R-Car audio driver");
1320 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
1321 MODULE_ALIAS("platform:rcar-pcm-audio");
Linux kernel - Deliverables
This page took 0.058573 seconds and 5 git commands to generate.