treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / generic / simple-card.c
blob55e9f8800b3e103638e38b651aa9e37ac37fdcc7
1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // ASoC simple sound card support
4 //
5 // Copyright (C) 2012 Renesas Solutions Corp.
6 // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
8 #include <linux/clk.h>
9 #include <linux/device.h>
10 #include <linux/module.h>
11 #include <linux/of.h>
12 #include <linux/of_device.h>
13 #include <linux/platform_device.h>
14 #include <linux/string.h>
15 #include <sound/simple_card.h>
16 #include <sound/soc-dai.h>
17 #include <sound/soc.h>
19 #define DPCM_SELECTABLE 1
21 #define DAI "sound-dai"
22 #define CELL "#sound-dai-cells"
23 #define PREFIX "simple-audio-card,"
25 static const struct snd_soc_ops simple_ops = {
26 .startup = asoc_simple_startup,
27 .shutdown = asoc_simple_shutdown,
28 .hw_params = asoc_simple_hw_params,
31 static int asoc_simple_parse_dai(struct device_node *node,
32 struct snd_soc_dai_link_component *dlc,
33 int *is_single_link)
35 struct of_phandle_args args;
36 int ret;
38 if (!node)
39 return 0;
42 * Get node via "sound-dai = <&phandle port>"
43 * it will be used as xxx_of_node on soc_bind_dai_link()
45 ret = of_parse_phandle_with_args(node, DAI, CELL, 0, &args);
46 if (ret)
47 return ret;
50 * FIXME
52 * Here, dlc->dai_name is pointer to CPU/Codec DAI name.
53 * If user unbinded CPU or Codec driver, but not for Sound Card,
54 * dlc->dai_name is keeping unbinded CPU or Codec
55 * driver's pointer.
57 * If user re-bind CPU or Codec driver again, ALSA SoC will try
58 * to rebind Card via snd_soc_try_rebind_card(), but because of
59 * above reason, it might can't bind Sound Card.
60 * Because Sound Card is pointing to released dai_name pointer.
62 * To avoid this rebind Card issue,
63 * 1) It needs to alloc memory to keep dai_name eventhough
64 * CPU or Codec driver was unbinded, or
65 * 2) user need to rebind Sound Card everytime
66 * if he unbinded CPU or Codec.
68 ret = snd_soc_of_get_dai_name(node, &dlc->dai_name);
69 if (ret < 0)
70 return ret;
72 dlc->of_node = args.np;
74 if (is_single_link)
75 *is_single_link = !args.args_count;
77 return 0;
80 static void simple_parse_convert(struct device *dev,
81 struct device_node *np,
82 struct asoc_simple_data *adata)
84 struct device_node *top = dev->of_node;
85 struct device_node *node = of_get_parent(np);
87 asoc_simple_parse_convert(dev, top, PREFIX, adata);
88 asoc_simple_parse_convert(dev, node, PREFIX, adata);
89 asoc_simple_parse_convert(dev, node, NULL, adata);
90 asoc_simple_parse_convert(dev, np, NULL, adata);
92 of_node_put(node);
95 static void simple_parse_mclk_fs(struct device_node *top,
96 struct device_node *cpu,
97 struct device_node *codec,
98 struct simple_dai_props *props,
99 char *prefix)
101 struct device_node *node = of_get_parent(cpu);
102 char prop[128];
104 snprintf(prop, sizeof(prop), "%smclk-fs", PREFIX);
105 of_property_read_u32(top, prop, &props->mclk_fs);
107 snprintf(prop, sizeof(prop), "%smclk-fs", prefix);
108 of_property_read_u32(node, prop, &props->mclk_fs);
109 of_property_read_u32(cpu, prop, &props->mclk_fs);
110 of_property_read_u32(codec, prop, &props->mclk_fs);
112 of_node_put(node);
115 static int simple_dai_link_of_dpcm(struct asoc_simple_priv *priv,
116 struct device_node *np,
117 struct device_node *codec,
118 struct link_info *li,
119 bool is_top)
121 struct device *dev = simple_priv_to_dev(priv);
122 struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
123 struct simple_dai_props *dai_props = simple_priv_to_props(priv, li->link);
124 struct asoc_simple_dai *dai;
125 struct snd_soc_dai_link_component *cpus = dai_link->cpus;
126 struct snd_soc_dai_link_component *codecs = dai_link->codecs;
127 struct device_node *top = dev->of_node;
128 struct device_node *node = of_get_parent(np);
129 char *prefix = "";
130 int ret;
133 * |CPU |Codec : turn
134 * CPU |Pass |return
135 * Codec |return|Pass
136 * np
138 if (li->cpu == (np == codec))
139 return 0;
141 dev_dbg(dev, "link_of DPCM (%pOF)\n", np);
143 li->link++;
145 /* For single DAI link & old style of DT node */
146 if (is_top)
147 prefix = PREFIX;
149 if (li->cpu) {
150 int is_single_links = 0;
152 /* Codec is dummy */
153 codecs->of_node = NULL;
154 codecs->dai_name = "snd-soc-dummy-dai";
155 codecs->name = "snd-soc-dummy";
157 /* FE settings */
158 dai_link->dynamic = 1;
159 dai_link->dpcm_merged_format = 1;
161 dai =
162 dai_props->cpu_dai = &priv->dais[li->dais++];
164 ret = asoc_simple_parse_cpu(np, dai_link, &is_single_links);
165 if (ret)
166 goto out_put_node;
168 ret = asoc_simple_parse_clk_cpu(dev, np, dai_link, dai);
169 if (ret < 0)
170 goto out_put_node;
172 ret = asoc_simple_set_dailink_name(dev, dai_link,
173 "fe.%s",
174 cpus->dai_name);
175 if (ret < 0)
176 goto out_put_node;
178 asoc_simple_canonicalize_cpu(dai_link, is_single_links);
179 } else {
180 struct snd_soc_codec_conf *cconf;
182 /* CPU is dummy */
183 cpus->of_node = NULL;
184 cpus->dai_name = "snd-soc-dummy-dai";
185 cpus->name = "snd-soc-dummy";
187 /* BE settings */
188 dai_link->no_pcm = 1;
189 dai_link->be_hw_params_fixup = asoc_simple_be_hw_params_fixup;
191 dai =
192 dai_props->codec_dai = &priv->dais[li->dais++];
194 cconf =
195 dai_props->codec_conf = &priv->codec_conf[li->conf++];
197 ret = asoc_simple_parse_codec(np, dai_link);
198 if (ret < 0)
199 goto out_put_node;
201 ret = asoc_simple_parse_clk_codec(dev, np, dai_link, dai);
202 if (ret < 0)
203 goto out_put_node;
205 ret = asoc_simple_set_dailink_name(dev, dai_link,
206 "be.%s",
207 codecs->dai_name);
208 if (ret < 0)
209 goto out_put_node;
211 /* check "prefix" from top node */
212 snd_soc_of_parse_node_prefix(top, cconf, codecs->of_node,
213 PREFIX "prefix");
214 snd_soc_of_parse_node_prefix(node, cconf, codecs->of_node,
215 "prefix");
216 snd_soc_of_parse_node_prefix(np, cconf, codecs->of_node,
217 "prefix");
220 simple_parse_convert(dev, np, &dai_props->adata);
221 simple_parse_mclk_fs(top, np, codec, dai_props, prefix);
223 asoc_simple_canonicalize_platform(dai_link);
225 ret = asoc_simple_parse_tdm(np, dai);
226 if (ret)
227 goto out_put_node;
229 ret = asoc_simple_parse_daifmt(dev, node, codec,
230 prefix, &dai_link->dai_fmt);
231 if (ret < 0)
232 goto out_put_node;
234 dai_link->dpcm_playback = 1;
235 dai_link->dpcm_capture = 1;
236 dai_link->ops = &simple_ops;
237 dai_link->init = asoc_simple_dai_init;
239 out_put_node:
240 of_node_put(node);
241 return ret;
244 static int simple_dai_link_of(struct asoc_simple_priv *priv,
245 struct device_node *np,
246 struct device_node *codec,
247 struct link_info *li,
248 bool is_top)
250 struct device *dev = simple_priv_to_dev(priv);
251 struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
252 struct simple_dai_props *dai_props = simple_priv_to_props(priv, li->link);
253 struct asoc_simple_dai *cpu_dai;
254 struct asoc_simple_dai *codec_dai;
255 struct device_node *top = dev->of_node;
256 struct device_node *cpu = NULL;
257 struct device_node *node = NULL;
258 struct device_node *plat = NULL;
259 char prop[128];
260 char *prefix = "";
261 int ret, single_cpu;
264 * |CPU |Codec : turn
265 * CPU |Pass |return
266 * Codec |return|return
267 * np
269 if (!li->cpu || np == codec)
270 return 0;
272 cpu = np;
273 node = of_get_parent(np);
274 li->link++;
276 dev_dbg(dev, "link_of (%pOF)\n", node);
278 /* For single DAI link & old style of DT node */
279 if (is_top)
280 prefix = PREFIX;
282 snprintf(prop, sizeof(prop), "%splat", prefix);
283 plat = of_get_child_by_name(node, prop);
285 cpu_dai =
286 dai_props->cpu_dai = &priv->dais[li->dais++];
287 codec_dai =
288 dai_props->codec_dai = &priv->dais[li->dais++];
290 ret = asoc_simple_parse_daifmt(dev, node, codec,
291 prefix, &dai_link->dai_fmt);
292 if (ret < 0)
293 goto dai_link_of_err;
295 simple_parse_mclk_fs(top, cpu, codec, dai_props, prefix);
297 ret = asoc_simple_parse_cpu(cpu, dai_link, &single_cpu);
298 if (ret < 0)
299 goto dai_link_of_err;
301 ret = asoc_simple_parse_codec(codec, dai_link);
302 if (ret < 0)
303 goto dai_link_of_err;
305 ret = asoc_simple_parse_platform(plat, dai_link);
306 if (ret < 0)
307 goto dai_link_of_err;
309 ret = asoc_simple_parse_tdm(cpu, cpu_dai);
310 if (ret < 0)
311 goto dai_link_of_err;
313 ret = asoc_simple_parse_tdm(codec, codec_dai);
314 if (ret < 0)
315 goto dai_link_of_err;
317 ret = asoc_simple_parse_clk_cpu(dev, cpu, dai_link, cpu_dai);
318 if (ret < 0)
319 goto dai_link_of_err;
321 ret = asoc_simple_parse_clk_codec(dev, codec, dai_link, codec_dai);
322 if (ret < 0)
323 goto dai_link_of_err;
325 ret = asoc_simple_set_dailink_name(dev, dai_link,
326 "%s-%s",
327 dai_link->cpus->dai_name,
328 dai_link->codecs->dai_name);
329 if (ret < 0)
330 goto dai_link_of_err;
332 dai_link->ops = &simple_ops;
333 dai_link->init = asoc_simple_dai_init;
335 asoc_simple_canonicalize_cpu(dai_link, single_cpu);
336 asoc_simple_canonicalize_platform(dai_link);
338 dai_link_of_err:
339 of_node_put(plat);
340 of_node_put(node);
342 return ret;
345 static int simple_for_each_link(struct asoc_simple_priv *priv,
346 struct link_info *li,
347 int (*func_noml)(struct asoc_simple_priv *priv,
348 struct device_node *np,
349 struct device_node *codec,
350 struct link_info *li, bool is_top),
351 int (*func_dpcm)(struct asoc_simple_priv *priv,
352 struct device_node *np,
353 struct device_node *codec,
354 struct link_info *li, bool is_top))
356 struct device *dev = simple_priv_to_dev(priv);
357 struct device_node *top = dev->of_node;
358 struct device_node *node;
359 uintptr_t dpcm_selectable = (uintptr_t)of_device_get_match_data(dev);
360 bool is_top = 0;
361 int ret = 0;
363 /* Check if it has dai-link */
364 node = of_get_child_by_name(top, PREFIX "dai-link");
365 if (!node) {
366 node = of_node_get(top);
367 is_top = 1;
370 /* loop for all dai-link */
371 do {
372 struct asoc_simple_data adata;
373 struct device_node *codec;
374 struct device_node *plat;
375 struct device_node *np;
376 int num = of_get_child_count(node);
378 /* get codec */
379 codec = of_get_child_by_name(node, is_top ?
380 PREFIX "codec" : "codec");
381 if (!codec) {
382 ret = -ENODEV;
383 goto error;
385 /* get platform */
386 plat = of_get_child_by_name(node, is_top ?
387 PREFIX "plat" : "plat");
389 /* get convert-xxx property */
390 memset(&adata, 0, sizeof(adata));
391 for_each_child_of_node(node, np)
392 simple_parse_convert(dev, np, &adata);
394 /* loop for all CPU/Codec node */
395 for_each_child_of_node(node, np) {
396 if (plat == np)
397 continue;
399 * It is DPCM
400 * if it has many CPUs,
401 * or has convert-xxx property
403 if (dpcm_selectable &&
404 (num > 2 ||
405 adata.convert_rate || adata.convert_channels))
406 ret = func_dpcm(priv, np, codec, li, is_top);
407 /* else normal sound */
408 else
409 ret = func_noml(priv, np, codec, li, is_top);
411 if (ret < 0) {
412 of_node_put(codec);
413 of_node_put(np);
414 goto error;
418 of_node_put(codec);
419 node = of_get_next_child(top, node);
420 } while (!is_top && node);
422 error:
423 of_node_put(node);
424 return ret;
427 static int simple_parse_aux_devs(struct device_node *node,
428 struct asoc_simple_priv *priv)
430 struct device *dev = simple_priv_to_dev(priv);
431 struct device_node *aux_node;
432 struct snd_soc_card *card = simple_priv_to_card(priv);
433 int i, n, len;
435 if (!of_find_property(node, PREFIX "aux-devs", &len))
436 return 0; /* Ok to have no aux-devs */
438 n = len / sizeof(__be32);
439 if (n <= 0)
440 return -EINVAL;
442 card->aux_dev = devm_kcalloc(dev,
443 n, sizeof(*card->aux_dev), GFP_KERNEL);
444 if (!card->aux_dev)
445 return -ENOMEM;
447 for (i = 0; i < n; i++) {
448 aux_node = of_parse_phandle(node, PREFIX "aux-devs", i);
449 if (!aux_node)
450 return -EINVAL;
451 card->aux_dev[i].dlc.of_node = aux_node;
454 card->num_aux_devs = n;
455 return 0;
458 static int simple_parse_of(struct asoc_simple_priv *priv)
460 struct device *dev = simple_priv_to_dev(priv);
461 struct device_node *top = dev->of_node;
462 struct snd_soc_card *card = simple_priv_to_card(priv);
463 struct link_info li;
464 int ret;
466 if (!top)
467 return -EINVAL;
469 ret = asoc_simple_parse_widgets(card, PREFIX);
470 if (ret < 0)
471 return ret;
473 ret = asoc_simple_parse_routing(card, PREFIX);
474 if (ret < 0)
475 return ret;
477 ret = asoc_simple_parse_pin_switches(card, PREFIX);
478 if (ret < 0)
479 return ret;
481 /* Single/Muti DAI link(s) & New style of DT node */
482 memset(&li, 0, sizeof(li));
483 for (li.cpu = 1; li.cpu >= 0; li.cpu--) {
485 * Detect all CPU first, and Detect all Codec 2nd.
487 * In Normal sound case, all DAIs are detected
488 * as "CPU-Codec".
490 * In DPCM sound case,
491 * all CPUs are detected as "CPU-dummy", and
492 * all Codecs are detected as "dummy-Codec".
493 * To avoid random sub-device numbering,
494 * detect "dummy-Codec" in last;
496 ret = simple_for_each_link(priv, &li,
497 simple_dai_link_of,
498 simple_dai_link_of_dpcm);
499 if (ret < 0)
500 return ret;
503 ret = asoc_simple_parse_card_name(card, PREFIX);
504 if (ret < 0)
505 return ret;
507 ret = simple_parse_aux_devs(top, priv);
509 return ret;
512 static int simple_count_noml(struct asoc_simple_priv *priv,
513 struct device_node *np,
514 struct device_node *codec,
515 struct link_info *li, bool is_top)
517 li->dais++; /* CPU or Codec */
518 if (np != codec)
519 li->link++; /* CPU-Codec */
521 return 0;
524 static int simple_count_dpcm(struct asoc_simple_priv *priv,
525 struct device_node *np,
526 struct device_node *codec,
527 struct link_info *li, bool is_top)
529 li->dais++; /* CPU or Codec */
530 li->link++; /* CPU-dummy or dummy-Codec */
531 if (np == codec)
532 li->conf++;
534 return 0;
537 static void simple_get_dais_count(struct asoc_simple_priv *priv,
538 struct link_info *li)
540 struct device *dev = simple_priv_to_dev(priv);
541 struct device_node *top = dev->of_node;
544 * link_num : number of links.
545 * CPU-Codec / CPU-dummy / dummy-Codec
546 * dais_num : number of DAIs
547 * ccnf_num : number of codec_conf
548 * same number for "dummy-Codec"
550 * ex1)
551 * CPU0 --- Codec0 link : 5
552 * CPU1 --- Codec1 dais : 7
553 * CPU2 -/ ccnf : 1
554 * CPU3 --- Codec2
556 * => 5 links = 2xCPU-Codec + 2xCPU-dummy + 1xdummy-Codec
557 * => 7 DAIs = 4xCPU + 3xCodec
558 * => 1 ccnf = 1xdummy-Codec
560 * ex2)
561 * CPU0 --- Codec0 link : 5
562 * CPU1 --- Codec1 dais : 6
563 * CPU2 -/ ccnf : 1
564 * CPU3 -/
566 * => 5 links = 1xCPU-Codec + 3xCPU-dummy + 1xdummy-Codec
567 * => 6 DAIs = 4xCPU + 2xCodec
568 * => 1 ccnf = 1xdummy-Codec
570 * ex3)
571 * CPU0 --- Codec0 link : 6
572 * CPU1 -/ dais : 6
573 * CPU2 --- Codec1 ccnf : 2
574 * CPU3 -/
576 * => 6 links = 0xCPU-Codec + 4xCPU-dummy + 2xdummy-Codec
577 * => 6 DAIs = 4xCPU + 2xCodec
578 * => 2 ccnf = 2xdummy-Codec
580 * ex4)
581 * CPU0 --- Codec0 (convert-rate) link : 3
582 * CPU1 --- Codec1 dais : 4
583 * ccnf : 1
585 * => 3 links = 1xCPU-Codec + 1xCPU-dummy + 1xdummy-Codec
586 * => 4 DAIs = 2xCPU + 2xCodec
587 * => 1 ccnf = 1xdummy-Codec
589 if (!top) {
590 li->link = 1;
591 li->dais = 2;
592 li->conf = 0;
593 return;
596 simple_for_each_link(priv, li,
597 simple_count_noml,
598 simple_count_dpcm);
600 dev_dbg(dev, "link %d, dais %d, ccnf %d\n",
601 li->link, li->dais, li->conf);
604 static int simple_soc_probe(struct snd_soc_card *card)
606 struct asoc_simple_priv *priv = snd_soc_card_get_drvdata(card);
607 int ret;
609 ret = asoc_simple_init_hp(card, &priv->hp_jack, PREFIX);
610 if (ret < 0)
611 return ret;
613 ret = asoc_simple_init_mic(card, &priv->mic_jack, PREFIX);
614 if (ret < 0)
615 return ret;
617 return 0;
620 static int asoc_simple_probe(struct platform_device *pdev)
622 struct asoc_simple_priv *priv;
623 struct device *dev = &pdev->dev;
624 struct device_node *np = dev->of_node;
625 struct snd_soc_card *card;
626 struct link_info li;
627 int ret;
629 /* Allocate the private data and the DAI link array */
630 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
631 if (!priv)
632 return -ENOMEM;
634 card = simple_priv_to_card(priv);
635 card->owner = THIS_MODULE;
636 card->dev = dev;
637 card->probe = simple_soc_probe;
639 memset(&li, 0, sizeof(li));
640 simple_get_dais_count(priv, &li);
641 if (!li.link || !li.dais)
642 return -EINVAL;
644 ret = asoc_simple_init_priv(priv, &li);
645 if (ret < 0)
646 return ret;
648 if (np && of_device_is_available(np)) {
650 ret = simple_parse_of(priv);
651 if (ret < 0) {
652 if (ret != -EPROBE_DEFER)
653 dev_err(dev, "parse error %d\n", ret);
654 goto err;
657 } else {
658 struct asoc_simple_card_info *cinfo;
659 struct snd_soc_dai_link_component *cpus;
660 struct snd_soc_dai_link_component *codecs;
661 struct snd_soc_dai_link_component *platform;
662 struct snd_soc_dai_link *dai_link = priv->dai_link;
663 struct simple_dai_props *dai_props = priv->dai_props;
665 int dai_idx = 0;
667 cinfo = dev->platform_data;
668 if (!cinfo) {
669 dev_err(dev, "no info for asoc-simple-card\n");
670 return -EINVAL;
673 if (!cinfo->name ||
674 !cinfo->codec_dai.name ||
675 !cinfo->codec ||
676 !cinfo->platform ||
677 !cinfo->cpu_dai.name) {
678 dev_err(dev, "insufficient asoc_simple_card_info settings\n");
679 return -EINVAL;
682 dai_props->cpu_dai = &priv->dais[dai_idx++];
683 dai_props->codec_dai = &priv->dais[dai_idx++];
685 cpus = dai_link->cpus;
686 cpus->dai_name = cinfo->cpu_dai.name;
688 codecs = dai_link->codecs;
689 codecs->name = cinfo->codec;
690 codecs->dai_name = cinfo->codec_dai.name;
692 platform = dai_link->platforms;
693 platform->name = cinfo->platform;
695 card->name = (cinfo->card) ? cinfo->card : cinfo->name;
696 dai_link->name = cinfo->name;
697 dai_link->stream_name = cinfo->name;
698 dai_link->dai_fmt = cinfo->daifmt;
699 dai_link->init = asoc_simple_dai_init;
700 memcpy(dai_props->cpu_dai, &cinfo->cpu_dai,
701 sizeof(*dai_props->cpu_dai));
702 memcpy(dai_props->codec_dai, &cinfo->codec_dai,
703 sizeof(*dai_props->codec_dai));
706 snd_soc_card_set_drvdata(card, priv);
708 asoc_simple_debug_info(priv);
710 ret = devm_snd_soc_register_card(dev, card);
711 if (ret < 0)
712 goto err;
714 return 0;
715 err:
716 asoc_simple_clean_reference(card);
718 return ret;
721 static int asoc_simple_remove(struct platform_device *pdev)
723 struct snd_soc_card *card = platform_get_drvdata(pdev);
725 return asoc_simple_clean_reference(card);
728 static const struct of_device_id simple_of_match[] = {
729 { .compatible = "simple-audio-card", },
730 { .compatible = "simple-scu-audio-card",
731 .data = (void *)DPCM_SELECTABLE },
734 MODULE_DEVICE_TABLE(of, simple_of_match);
736 static struct platform_driver asoc_simple_card = {
737 .driver = {
738 .name = "asoc-simple-card",
739 .pm = &snd_soc_pm_ops,
740 .of_match_table = simple_of_match,
742 .probe = asoc_simple_probe,
743 .remove = asoc_simple_remove,
746 module_platform_driver(asoc_simple_card);
748 MODULE_ALIAS("platform:asoc-simple-card");
749 MODULE_LICENSE("GPL v2");
750 MODULE_DESCRIPTION("ASoC Simple Sound Card");
751 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");