projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/linville/wirel...
[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 void rsnd_mod_init(struct rsnd_priv *priv,
142 struct rsnd_mod *mod,
143 struct rsnd_mod_ops *ops,
144 enum rsnd_mod_type type,
145 int id)
146 {
147 mod->priv = priv;
148 mod->id = id;
149 mod->ops = ops;
150 mod->type = type;
151 }
152
153 /*
154 * rsnd_dma functions
155 */
156 static void __rsnd_dma_start(struct rsnd_dma *dma);
157 static void rsnd_dma_continue(struct rsnd_dma *dma)
158 {
159 /* push next A or B plane */
160 dma->submit_loop = 1;
161 schedule_work(&dma->work);
162 }
163
164 void rsnd_dma_start(struct rsnd_dma *dma)
165 {
166 /* push both A and B plane*/
167 dma->offset = 0;
168 dma->submit_loop = 2;
169 __rsnd_dma_start(dma);
170 }
171
172 void rsnd_dma_stop(struct rsnd_dma *dma)
173 {
174 dma->submit_loop = 0;
175 cancel_work_sync(&dma->work);
176 dmaengine_terminate_all(dma->chan);
177 }
178
179 static void rsnd_dma_complete(void *data)
180 {
181 struct rsnd_dma *dma = (struct rsnd_dma *)data;
182 struct rsnd_mod *mod = rsnd_dma_to_mod(dma);
183 struct rsnd_priv *priv = rsnd_mod_to_priv(rsnd_dma_to_mod(dma));
184 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
185 unsigned long flags;
186
187 rsnd_lock(priv, flags);
188
189 /*
190 * Renesas sound Gen1 needs 1 DMAC,
191 * Gen2 needs 2 DMAC.
192 * In Gen2 case, it are Audio-DMAC, and Audio-DMAC-peri-peri.
193 * But, Audio-DMAC-peri-peri doesn't have interrupt,
194 * and this driver is assuming that here.
195 *
196 * If Audio-DMAC-peri-peri has interrpt,
197 * rsnd_dai_pointer_update() will be called twice,
198 * ant it will breaks io->byte_pos
199 */
200 if (dma->submit_loop)
201 rsnd_dma_continue(dma);
202
203 rsnd_unlock(priv, flags);
204
205 rsnd_dai_pointer_update(io, io->byte_per_period);
206 }
207
208 static void __rsnd_dma_start(struct rsnd_dma *dma)
209 {
210 struct rsnd_mod *mod = rsnd_dma_to_mod(dma);
211 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
212 struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
213 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
214 struct device *dev = rsnd_priv_to_dev(priv);
215 struct dma_async_tx_descriptor *desc;
216 dma_addr_t buf;
217 size_t len = io->byte_per_period;
218 int i;
219
220 for (i = 0; i < dma->submit_loop; i++) {
221
222 buf = runtime->dma_addr +
223 rsnd_dai_pointer_offset(io, dma->offset + len);
224 dma->offset = len;
225
226 desc = dmaengine_prep_slave_single(
227 dma->chan, buf, len, dma->dir,
228 DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
229 if (!desc) {
230 dev_err(dev, "dmaengine_prep_slave_sg() fail\n");
231 return;
232 }
233
234 desc->callback = rsnd_dma_complete;
235 desc->callback_param = dma;
236
237 if (dmaengine_submit(desc) < 0) {
238 dev_err(dev, "dmaengine_submit() fail\n");
239 return;
240 }
241
242 dma_async_issue_pending(dma->chan);
243 }
244 }
245
246 static void rsnd_dma_do_work(struct work_struct *work)
247 {
248 struct rsnd_dma *dma = container_of(work, struct rsnd_dma, work);
249
250 __rsnd_dma_start(dma);
251 }
252
253 int rsnd_dma_available(struct rsnd_dma *dma)
254 {
255 return !!dma->chan;
256 }
257
258 int rsnd_dma_init(struct rsnd_priv *priv, struct rsnd_dma *dma,
259 int is_play, int id)
260 {
261 struct device *dev = rsnd_priv_to_dev(priv);
262 struct dma_slave_config cfg;
263 dma_cap_mask_t mask;
264 int ret;
265
266 if (dma->chan) {
267 dev_err(dev, "it already has dma channel\n");
268 return -EIO;
269 }
270
271 dma_cap_zero(mask);
272 dma_cap_set(DMA_SLAVE, mask);
273
274 dma->chan = dma_request_slave_channel_compat(mask, shdma_chan_filter,
275 (void *)id, dev,
276 is_play ? "tx" : "rx");
277 if (!dma->chan) {
278 dev_err(dev, "can't get dma channel\n");
279 return -EIO;
280 }
281
282 cfg.slave_id = id;
283 cfg.dst_addr = 0; /* use default addr when playback */
284 cfg.src_addr = 0; /* use default addr when capture */
285 cfg.direction = is_play ? DMA_MEM_TO_DEV : DMA_DEV_TO_MEM;
286
287 ret = dmaengine_slave_config(dma->chan, &cfg);
288 if (ret < 0)
289 goto rsnd_dma_init_err;
290
291 dma->dir = is_play ? DMA_TO_DEVICE : DMA_FROM_DEVICE;
292 INIT_WORK(&dma->work, rsnd_dma_do_work);
293
294 return 0;
295
296 rsnd_dma_init_err:
297 rsnd_dma_quit(priv, dma);
298
299 return ret;
300 }
301
302 void rsnd_dma_quit(struct rsnd_priv *priv,
303 struct rsnd_dma *dma)
304 {
305 if (dma->chan)
306 dma_release_channel(dma->chan);
307
308 dma->chan = NULL;
309 }
310
311 /*
312 * rsnd_dai functions
313 */
314 #define __rsnd_mod_call(mod, func, rdai, io) \
315 ({ \
316 struct rsnd_priv *priv = rsnd_mod_to_priv(mod); \
317 struct device *dev = rsnd_priv_to_dev(priv); \
318 dev_dbg(dev, "%s [%d] %s\n", \
319 rsnd_mod_name(mod), rsnd_mod_id(mod), #func); \
320 (mod)->ops->func(mod, rdai, io); \
321 })
322
323 #define rsnd_mod_call(mod, func, rdai, io) \
324 (!(mod) ? -ENODEV : \
325 !((mod)->ops->func) ? 0 : \
326 __rsnd_mod_call(mod, func, (rdai), (io)))
327
328 #define rsnd_dai_call(rdai, io, fn) \
329 ({ \
330 struct rsnd_mod *mod; \
331 int ret = 0, i; \
332 for (i = 0; i < RSND_MOD_MAX; i++) { \
333 mod = (io)->mod[i]; \
334 if (!mod) \
335 continue; \
336 ret = rsnd_mod_call(mod, fn, (rdai), (io)); \
337 if (ret < 0) \
338 break; \
339 } \
340 ret; \
341 })
342
343 static int rsnd_dai_connect(struct rsnd_mod *mod,
344 struct rsnd_dai_stream *io)
345 {
346 if (!mod)
347 return -EIO;
348
349 if (io->mod[mod->type]) {
350 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
351 struct device *dev = rsnd_priv_to_dev(priv);
352
353 dev_err(dev, "%s%d is not empty\n",
354 rsnd_mod_name(mod),
355 rsnd_mod_id(mod));
356 return -EIO;
357 }
358
359 io->mod[mod->type] = mod;
360 mod->io = io;
361
362 return 0;
363 }
364
365 int rsnd_dai_id(struct rsnd_priv *priv, struct rsnd_dai *rdai)
366 {
367 int id = rdai - priv->rdai;
368
369 if ((id < 0) || (id >= rsnd_rdai_nr(priv)))
370 return -EINVAL;
371
372 return id;
373 }
374
375 struct rsnd_dai *rsnd_dai_get(struct rsnd_priv *priv, int id)
376 {
377 if ((id < 0) || (id >= rsnd_rdai_nr(priv)))
378 return NULL;
379
380 return priv->rdai + id;
381 }
382
383 static struct rsnd_dai *rsnd_dai_to_rdai(struct snd_soc_dai *dai)
384 {
385 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai);
386
387 return rsnd_dai_get(priv, dai->id);
388 }
389
390 int rsnd_dai_is_play(struct rsnd_dai *rdai, struct rsnd_dai_stream *io)
391 {
392 return &rdai->playback == io;
393 }
394
395 /*
396 * rsnd_soc_dai functions
397 */
398 int rsnd_dai_pointer_offset(struct rsnd_dai_stream *io, int additional)
399 {
400 struct snd_pcm_substream *substream = io->substream;
401 struct snd_pcm_runtime *runtime = substream->runtime;
402 int pos = io->byte_pos + additional;
403
404 pos %= (runtime->periods * io->byte_per_period);
405
406 return pos;
407 }
408
409 void rsnd_dai_pointer_update(struct rsnd_dai_stream *io, int byte)
410 {
411 io->byte_pos += byte;
412
413 if (io->byte_pos >= io->next_period_byte) {
414 struct snd_pcm_substream *substream = io->substream;
415 struct snd_pcm_runtime *runtime = substream->runtime;
416
417 io->period_pos++;
418 io->next_period_byte += io->byte_per_period;
419
420 if (io->period_pos >= runtime->periods) {
421 io->byte_pos = 0;
422 io->period_pos = 0;
423 io->next_period_byte = io->byte_per_period;
424 }
425
426 snd_pcm_period_elapsed(substream);
427 }
428 }
429
430 static int rsnd_dai_stream_init(struct rsnd_dai_stream *io,
431 struct snd_pcm_substream *substream)
432 {
433 struct snd_pcm_runtime *runtime = substream->runtime;
434
435 io->substream = substream;
436 io->byte_pos = 0;
437 io->period_pos = 0;
438 io->byte_per_period = runtime->period_size *
439 runtime->channels *
440 samples_to_bytes(runtime, 1);
441 io->next_period_byte = io->byte_per_period;
442
443 return 0;
444 }
445
446 static
447 struct snd_soc_dai *rsnd_substream_to_dai(struct snd_pcm_substream *substream)
448 {
449 struct snd_soc_pcm_runtime *rtd = substream->private_data;
450
451 return rtd->cpu_dai;
452 }
453
454 static
455 struct rsnd_dai_stream *rsnd_rdai_to_io(struct rsnd_dai *rdai,
456 struct snd_pcm_substream *substream)
457 {
458 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
459 return &rdai->playback;
460 else
461 return &rdai->capture;
462 }
463
464 static int rsnd_soc_dai_trigger(struct snd_pcm_substream *substream, int cmd,
465 struct snd_soc_dai *dai)
466 {
467 struct rsnd_priv *priv = snd_soc_dai_get_drvdata(dai);
468 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
469 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
470 struct rsnd_mod *mod = rsnd_ssi_mod_get_frm_dai(priv,
471 rsnd_dai_id(priv, rdai),
472 rsnd_dai_is_play(rdai, io));
473 int ssi_id = rsnd_mod_id(mod);
474 int ret;
475 unsigned long flags;
476
477 rsnd_lock(priv, flags);
478
479 switch (cmd) {
480 case SNDRV_PCM_TRIGGER_START:
481 ret = rsnd_dai_stream_init(io, substream);
482 if (ret < 0)
483 goto dai_trigger_end;
484
485 ret = rsnd_platform_call(priv, dai, start, ssi_id);
486 if (ret < 0)
487 goto dai_trigger_end;
488
489 ret = rsnd_dai_call(rdai, io, init);
490 if (ret < 0)
491 goto dai_trigger_end;
492
493 ret = rsnd_dai_call(rdai, io, start);
494 if (ret < 0)
495 goto dai_trigger_end;
496 break;
497 case SNDRV_PCM_TRIGGER_STOP:
498 ret = rsnd_dai_call(rdai, io, stop);
499 if (ret < 0)
500 goto dai_trigger_end;
501
502 ret = rsnd_dai_call(rdai, io, quit);
503 if (ret < 0)
504 goto dai_trigger_end;
505
506 ret = rsnd_platform_call(priv, dai, stop, ssi_id);
507 if (ret < 0)
508 goto dai_trigger_end;
509 break;
510 default:
511 ret = -EINVAL;
512 }
513
514 dai_trigger_end:
515 rsnd_unlock(priv, flags);
516
517 return ret;
518 }
519
520 static int rsnd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
521 {
522 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
523
524 /* set master/slave audio interface */
525 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
526 case SND_SOC_DAIFMT_CBM_CFM:
527 rdai->clk_master = 0;
528 break;
529 case SND_SOC_DAIFMT_CBS_CFS:
530 rdai->clk_master = 1; /* codec is slave, cpu is master */
531 break;
532 default:
533 return -EINVAL;
534 }
535
536 /* set clock inversion */
537 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
538 case SND_SOC_DAIFMT_NB_IF:
539 rdai->bit_clk_inv = 0;
540 rdai->frm_clk_inv = 1;
541 break;
542 case SND_SOC_DAIFMT_IB_NF:
543 rdai->bit_clk_inv = 1;
544 rdai->frm_clk_inv = 0;
545 break;
546 case SND_SOC_DAIFMT_IB_IF:
547 rdai->bit_clk_inv = 1;
548 rdai->frm_clk_inv = 1;
549 break;
550 case SND_SOC_DAIFMT_NB_NF:
551 default:
552 rdai->bit_clk_inv = 0;
553 rdai->frm_clk_inv = 0;
554 break;
555 }
556
557 /* set format */
558 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
559 case SND_SOC_DAIFMT_I2S:
560 rdai->sys_delay = 0;
561 rdai->data_alignment = 0;
562 break;
563 case SND_SOC_DAIFMT_LEFT_J:
564 rdai->sys_delay = 1;
565 rdai->data_alignment = 0;
566 break;
567 case SND_SOC_DAIFMT_RIGHT_J:
568 rdai->sys_delay = 1;
569 rdai->data_alignment = 1;
570 break;
571 }
572
573 return 0;
574 }
575
576 static const struct snd_soc_dai_ops rsnd_soc_dai_ops = {
577 .trigger = rsnd_soc_dai_trigger,
578 .set_fmt = rsnd_soc_dai_set_fmt,
579 };
580
581 static int rsnd_path_init(struct rsnd_priv *priv,
582 struct rsnd_dai *rdai,
583 struct rsnd_dai_stream *io)
584 {
585 struct rsnd_mod *mod;
586 struct rsnd_dai_platform_info *dai_info = rdai->info;
587 int ret;
588 int ssi_id = -1;
589 int src_id = -1;
590
591 /*
592 * Gen1 is created by SRU/SSI, and this SRU is base module of
593 * Gen2's SCU/SSIU/SSI. (Gen2 SCU/SSIU came from SRU)
594 *
595 * Easy image is..
596 * Gen1 SRU = Gen2 SCU + SSIU + etc
597 *
598 * Gen2 SCU path is very flexible, but, Gen1 SRU (SCU parts) is
599 * using fixed path.
600 */
601 if (dai_info) {
602 if (rsnd_is_enable_path(io, ssi))
603 ssi_id = rsnd_info_id(priv, io, ssi);
604 if (rsnd_is_enable_path(io, src))
605 src_id = rsnd_info_id(priv, io, src);
606 } else {
607 /* get SSI's ID */
608 mod = rsnd_ssi_mod_get_frm_dai(priv,
609 rsnd_dai_id(priv, rdai),
610 rsnd_dai_is_play(rdai, io));
611 if (!mod)
612 return 0;
613 ssi_id = src_id = rsnd_mod_id(mod);
614 }
615
616 ret = 0;
617
618 /* SRC */
619 if (src_id >= 0) {
620 mod = rsnd_src_mod_get(priv, src_id);
621 ret = rsnd_dai_connect(mod, io);
622 if (ret < 0)
623 return ret;
624 }
625
626 /* SSI */
627 if (ssi_id >= 0) {
628 mod = rsnd_ssi_mod_get(priv, ssi_id);
629 ret = rsnd_dai_connect(mod, io);
630 if (ret < 0)
631 return ret;
632 }
633
634 return ret;
635 }
636
637 static void rsnd_of_parse_dai(struct platform_device *pdev,
638 const struct rsnd_of_data *of_data,
639 struct rsnd_priv *priv)
640 {
641 struct device_node *dai_node, *dai_np;
642 struct device_node *ssi_node, *ssi_np;
643 struct device_node *src_node, *src_np;
644 struct device_node *playback, *capture;
645 struct rsnd_dai_platform_info *dai_info;
646 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
647 struct device *dev = &pdev->dev;
648 int nr, i;
649 int dai_i, ssi_i, src_i;
650
651 if (!of_data)
652 return;
653
654 dai_node = of_get_child_by_name(dev->of_node, "rcar_sound,dai");
655 if (!dai_node)
656 return;
657
658 nr = of_get_child_count(dai_node);
659 if (!nr)
660 return;
661
662 dai_info = devm_kzalloc(dev,
663 sizeof(struct rsnd_dai_platform_info) * nr,
664 GFP_KERNEL);
665 if (!dai_info) {
666 dev_err(dev, "dai info allocation error\n");
667 return;
668 }
669
670 info->dai_info_nr = nr;
671 info->dai_info = dai_info;
672
673 ssi_node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
674 src_node = of_get_child_by_name(dev->of_node, "rcar_sound,src");
675
676 #define mod_parse(name) \
677 if (name##_node) { \
678 struct rsnd_##name##_platform_info *name##_info; \
679 \
680 name##_i = 0; \
681 for_each_child_of_node(name##_node, name##_np) { \
682 name##_info = info->name##_info + name##_i; \
683 \
684 if (name##_np == playback) \
685 dai_info->playback.name = name##_info; \
686 if (name##_np == capture) \
687 dai_info->capture.name = name##_info; \
688 \
689 name##_i++; \
690 } \
691 }
692
693 /*
694 * parse all dai
695 */
696 dai_i = 0;
697 for_each_child_of_node(dai_node, dai_np) {
698 dai_info = info->dai_info + dai_i;
699
700 for (i = 0;; i++) {
701
702 playback = of_parse_phandle(dai_np, "playback", i);
703 capture = of_parse_phandle(dai_np, "capture", i);
704
705 if (!playback && !capture)
706 break;
707
708 mod_parse(ssi);
709 mod_parse(src);
710
711 if (playback)
712 of_node_put(playback);
713 if (capture)
714 of_node_put(capture);
715 }
716
717 dai_i++;
718 }
719 }
720
721 static int rsnd_dai_probe(struct platform_device *pdev,
722 const struct rsnd_of_data *of_data,
723 struct rsnd_priv *priv)
724 {
725 struct snd_soc_dai_driver *drv;
726 struct rcar_snd_info *info = rsnd_priv_to_info(priv);
727 struct rsnd_dai *rdai;
728 struct rsnd_mod *pmod, *cmod;
729 struct device *dev = rsnd_priv_to_dev(priv);
730 int dai_nr;
731 int i;
732
733 rsnd_of_parse_dai(pdev, of_data, priv);
734
735 /*
736 * dai_nr should be set via dai_info_nr,
737 * but allow it to keeping compatible
738 */
739 dai_nr = info->dai_info_nr;
740 if (!dai_nr) {
741 /* get max dai nr */
742 for (dai_nr = 0; dai_nr < 32; dai_nr++) {
743 pmod = rsnd_ssi_mod_get_frm_dai(priv, dai_nr, 1);
744 cmod = rsnd_ssi_mod_get_frm_dai(priv, dai_nr, 0);
745
746 if (!pmod && !cmod)
747 break;
748 }
749 }
750
751 if (!dai_nr) {
752 dev_err(dev, "no dai\n");
753 return -EIO;
754 }
755
756 drv = devm_kzalloc(dev, sizeof(*drv) * dai_nr, GFP_KERNEL);
757 rdai = devm_kzalloc(dev, sizeof(*rdai) * dai_nr, GFP_KERNEL);
758 if (!drv || !rdai) {
759 dev_err(dev, "dai allocate failed\n");
760 return -ENOMEM;
761 }
762
763 priv->rdai_nr = dai_nr;
764 priv->daidrv = drv;
765 priv->rdai = rdai;
766
767 for (i = 0; i < dai_nr; i++) {
768 if (info->dai_info)
769 rdai[i].info = &info->dai_info[i];
770
771 pmod = rsnd_ssi_mod_get_frm_dai(priv, i, 1);
772 cmod = rsnd_ssi_mod_get_frm_dai(priv, i, 0);
773
774 /*
775 * init rsnd_dai
776 */
777 snprintf(rdai[i].name, RSND_DAI_NAME_SIZE, "rsnd-dai.%d", i);
778
779 /*
780 * init snd_soc_dai_driver
781 */
782 drv[i].name = rdai[i].name;
783 drv[i].ops = &rsnd_soc_dai_ops;
784 if (pmod) {
785 drv[i].playback.rates = RSND_RATES;
786 drv[i].playback.formats = RSND_FMTS;
787 drv[i].playback.channels_min = 2;
788 drv[i].playback.channels_max = 2;
789
790 if (info->dai_info)
791 rdai[i].playback.info = &info->dai_info[i].playback;
792 rsnd_path_init(priv, &rdai[i], &rdai[i].playback);
793 }
794 if (cmod) {
795 drv[i].capture.rates = RSND_RATES;
796 drv[i].capture.formats = RSND_FMTS;
797 drv[i].capture.channels_min = 2;
798 drv[i].capture.channels_max = 2;
799
800 if (info->dai_info)
801 rdai[i].capture.info = &info->dai_info[i].capture;
802 rsnd_path_init(priv, &rdai[i], &rdai[i].capture);
803 }
804
805 dev_dbg(dev, "%s (%s/%s)\n", rdai[i].name,
806 pmod ? "play" : " -- ",
807 cmod ? "capture" : " -- ");
808 }
809
810 return 0;
811 }
812
813 /*
814 * pcm ops
815 */
816 static struct snd_pcm_hardware rsnd_pcm_hardware = {
817 .info = SNDRV_PCM_INFO_INTERLEAVED |
818 SNDRV_PCM_INFO_MMAP |
819 SNDRV_PCM_INFO_MMAP_VALID |
820 SNDRV_PCM_INFO_PAUSE,
821 .buffer_bytes_max = 64 * 1024,
822 .period_bytes_min = 32,
823 .period_bytes_max = 8192,
824 .periods_min = 1,
825 .periods_max = 32,
826 .fifo_size = 256,
827 };
828
829 static int rsnd_pcm_open(struct snd_pcm_substream *substream)
830 {
831 struct snd_pcm_runtime *runtime = substream->runtime;
832 int ret = 0;
833
834 snd_soc_set_runtime_hwparams(substream, &rsnd_pcm_hardware);
835
836 ret = snd_pcm_hw_constraint_integer(runtime,
837 SNDRV_PCM_HW_PARAM_PERIODS);
838
839 return ret;
840 }
841
842 static int rsnd_hw_params(struct snd_pcm_substream *substream,
843 struct snd_pcm_hw_params *hw_params)
844 {
845 return snd_pcm_lib_malloc_pages(substream,
846 params_buffer_bytes(hw_params));
847 }
848
849 static snd_pcm_uframes_t rsnd_pointer(struct snd_pcm_substream *substream)
850 {
851 struct snd_pcm_runtime *runtime = substream->runtime;
852 struct snd_soc_dai *dai = rsnd_substream_to_dai(substream);
853 struct rsnd_dai *rdai = rsnd_dai_to_rdai(dai);
854 struct rsnd_dai_stream *io = rsnd_rdai_to_io(rdai, substream);
855
856 return bytes_to_frames(runtime, io->byte_pos);
857 }
858
859 static struct snd_pcm_ops rsnd_pcm_ops = {
860 .open = rsnd_pcm_open,
861 .ioctl = snd_pcm_lib_ioctl,
862 .hw_params = rsnd_hw_params,
863 .hw_free = snd_pcm_lib_free_pages,
864 .pointer = rsnd_pointer,
865 };
866
867 /*
868 * snd_soc_platform
869 */
870
871 #define PREALLOC_BUFFER (32 * 1024)
872 #define PREALLOC_BUFFER_MAX (32 * 1024)
873
874 static int rsnd_pcm_new(struct snd_soc_pcm_runtime *rtd)
875 {
876 return snd_pcm_lib_preallocate_pages_for_all(
877 rtd->pcm,
878 SNDRV_DMA_TYPE_DEV,
879 rtd->card->snd_card->dev,
880 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
881 }
882
883 static void rsnd_pcm_free(struct snd_pcm *pcm)
884 {
885 snd_pcm_lib_preallocate_free_for_all(pcm);
886 }
887
888 static struct snd_soc_platform_driver rsnd_soc_platform = {
889 .ops = &rsnd_pcm_ops,
890 .pcm_new = rsnd_pcm_new,
891 .pcm_free = rsnd_pcm_free,
892 };
893
894 static const struct snd_soc_component_driver rsnd_soc_component = {
895 .name = "rsnd",
896 };
897
898 /*
899 * rsnd probe
900 */
901 static int rsnd_probe(struct platform_device *pdev)
902 {
903 struct rcar_snd_info *info;
904 struct rsnd_priv *priv;
905 struct device *dev = &pdev->dev;
906 struct rsnd_dai *rdai;
907 const struct of_device_id *of_id = of_match_device(rsnd_of_match, dev);
908 const struct rsnd_of_data *of_data;
909 int (*probe_func[])(struct platform_device *pdev,
910 const struct rsnd_of_data *of_data,
911 struct rsnd_priv *priv) = {
912 rsnd_gen_probe,
913 rsnd_ssi_probe,
914 rsnd_src_probe,
915 rsnd_adg_probe,
916 rsnd_dai_probe,
917 };
918 int ret, i;
919
920 info = NULL;
921 of_data = NULL;
922 if (of_id) {
923 info = devm_kzalloc(&pdev->dev,
924 sizeof(struct rcar_snd_info), GFP_KERNEL);
925 of_data = of_id->data;
926 } else {
927 info = pdev->dev.platform_data;
928 }
929
930 if (!info) {
931 dev_err(dev, "driver needs R-Car sound information\n");
932 return -ENODEV;
933 }
934
935 /*
936 * init priv data
937 */
938 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
939 if (!priv) {
940 dev_err(dev, "priv allocate failed\n");
941 return -ENODEV;
942 }
943
944 priv->dev = dev;
945 priv->info = info;
946 spin_lock_init(&priv->lock);
947
948 /*
949 * init each module
950 */
951 for (i = 0; i < ARRAY_SIZE(probe_func); i++) {
952 ret = probe_func[i](pdev, of_data, priv);
953 if (ret)
954 return ret;
955 }
956
957 for_each_rsnd_dai(rdai, priv, i) {
958 ret = rsnd_dai_call(rdai, &rdai->playback, probe);
959 if (ret)
960 return ret;
961
962 ret = rsnd_dai_call(rdai, &rdai->capture, probe);
963 if (ret)
964 return ret;
965 }
966
967 /*
968 * asoc register
969 */
970 ret = snd_soc_register_platform(dev, &rsnd_soc_platform);
971 if (ret < 0) {
972 dev_err(dev, "cannot snd soc register\n");
973 return ret;
974 }
975
976 ret = snd_soc_register_component(dev, &rsnd_soc_component,
977 priv->daidrv, rsnd_rdai_nr(priv));
978 if (ret < 0) {
979 dev_err(dev, "cannot snd dai register\n");
980 goto exit_snd_soc;
981 }
982
983 dev_set_drvdata(dev, priv);
984
985 pm_runtime_enable(dev);
986
987 dev_info(dev, "probed\n");
988 return ret;
989
990 exit_snd_soc:
991 snd_soc_unregister_platform(dev);
992
993 return ret;
994 }
995
996 static int rsnd_remove(struct platform_device *pdev)
997 {
998 struct rsnd_priv *priv = dev_get_drvdata(&pdev->dev);
999 struct rsnd_dai *rdai;
1000 int ret, i;
1001
1002 pm_runtime_disable(&pdev->dev);
1003
1004 for_each_rsnd_dai(rdai, priv, i) {
1005 ret = rsnd_dai_call(rdai, &rdai->playback, remove);
1006 if (ret)
1007 return ret;
1008
1009 ret = rsnd_dai_call(rdai, &rdai->capture, remove);
1010 if (ret)
1011 return ret;
1012 }
1013
1014 return 0;
1015 }
1016
1017 static struct platform_driver rsnd_driver = {
1018 .driver = {
1019 .name = "rcar_sound",
1020 .of_match_table = rsnd_of_match,
1021 },
1022 .probe = rsnd_probe,
1023 .remove = rsnd_remove,
1024 };
1025 module_platform_driver(rsnd_driver);
1026
1027 MODULE_LICENSE("GPL");
1028 MODULE_DESCRIPTION("Renesas R-Car audio driver");
1029 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
1030 MODULE_ALIAS("platform:rcar-pcm-audio");
Linux kernel - Deliverables
This page took 0.151717 seconds and 6 git commands to generate.