]> git.karo-electronics.de Git - karo-tx-linux.git/blob - sound/soc/sh/rcar/rsrc-card.c
ASoC: rsnd: rsrc-card: check return value of snd_soc_of_get_dai_name()
[karo-tx-linux.git] / sound / soc / sh / rcar / rsrc-card.c
1 /*
2  * Renesas Sampling Rate Convert Sound Card for DPCM
3  *
4  * Copyright (C) 2015 Renesas Solutions Corp.
5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6  *
7  * based on ${LINUX}/sound/soc/generic/simple-card.c
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13 #include <linux/clk.h>
14 #include <linux/device.h>
15 #include <linux/module.h>
16 #include <linux/of.h>
17 #include <linux/of_device.h>
18 #include <linux/platform_device.h>
19 #include <linux/string.h>
20 #include <sound/jack.h>
21 #include <sound/soc.h>
22 #include <sound/soc-dai.h>
23
24 struct rsrc_card_of_data {
25         const char *prefix;
26         const struct snd_soc_dapm_route *routes;
27         int num_routes;
28 };
29
30 static const struct snd_soc_dapm_route routes_ssi0_ak4642[] = {
31         {"ak4642 Playback", NULL, "DAI0 Playback"},
32         {"DAI0 Capture", NULL, "ak4642 Capture"},
33 };
34
35 static const struct rsrc_card_of_data routes_of_ssi0_ak4642 = {
36         .prefix         = "ak4642",
37         .routes         = routes_ssi0_ak4642,
38         .num_routes     = ARRAY_SIZE(routes_ssi0_ak4642),
39 };
40
41 static const struct of_device_id rsrc_card_of_match[] = {
42         { .compatible = "renesas,rsrc-card,lager",      .data = &routes_of_ssi0_ak4642 },
43         { .compatible = "renesas,rsrc-card,koelsch",    .data = &routes_of_ssi0_ak4642 },
44         { .compatible = "renesas,rsrc-card", },
45         {},
46 };
47 MODULE_DEVICE_TABLE(of, rsrc_card_of_match);
48
49 #define DAI_NAME_NUM    32
50 struct rsrc_card_dai {
51         unsigned int fmt;
52         unsigned int sysclk;
53         struct clk *clk;
54         char dai_name[DAI_NAME_NUM];
55 };
56
57 #define IDX_CPU         0
58 #define IDX_CODEC       1
59 struct rsrc_card_priv {
60         struct snd_soc_card snd_card;
61         struct snd_soc_codec_conf codec_conf;
62         struct rsrc_card_dai *dai_props;
63         struct snd_soc_dai_link *dai_link;
64         int dai_num;
65         u32 convert_rate;
66 };
67
68 #define rsrc_priv_to_dev(priv) ((priv)->snd_card.dev)
69 #define rsrc_priv_to_link(priv, i) ((priv)->snd_card.dai_link + (i))
70 #define rsrc_priv_to_props(priv, i) ((priv)->dai_props + (i))
71 #define rsrc_dev_to_of_data(dev) (of_match_device(rsrc_card_of_match, (dev))->data)
72
73 static int rsrc_card_startup(struct snd_pcm_substream *substream)
74 {
75         struct snd_soc_pcm_runtime *rtd = substream->private_data;
76         struct rsrc_card_priv *priv =   snd_soc_card_get_drvdata(rtd->card);
77         struct rsrc_card_dai *dai_props =
78                 rsrc_priv_to_props(priv, rtd - rtd->card->rtd);
79
80         return clk_prepare_enable(dai_props->clk);
81 }
82
83 static void rsrc_card_shutdown(struct snd_pcm_substream *substream)
84 {
85         struct snd_soc_pcm_runtime *rtd = substream->private_data;
86         struct rsrc_card_priv *priv =   snd_soc_card_get_drvdata(rtd->card);
87         struct rsrc_card_dai *dai_props =
88                 rsrc_priv_to_props(priv, rtd - rtd->card->rtd);
89
90         clk_disable_unprepare(dai_props->clk);
91 }
92
93 static struct snd_soc_ops rsrc_card_ops = {
94         .startup = rsrc_card_startup,
95         .shutdown = rsrc_card_shutdown,
96 };
97
98 static int rsrc_card_dai_init(struct snd_soc_pcm_runtime *rtd)
99 {
100         struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
101         struct snd_soc_dai *dai;
102         struct snd_soc_dai_link *dai_link;
103         struct rsrc_card_dai *dai_props;
104         int num = rtd - rtd->card->rtd;
105         int ret;
106
107         dai_link        = rsrc_priv_to_link(priv, num);
108         dai_props       = rsrc_priv_to_props(priv, num);
109         dai             = dai_link->dynamic ?
110                                 rtd->cpu_dai :
111                                 rtd->codec_dai;
112
113         if (dai_props->fmt) {
114                 ret = snd_soc_dai_set_fmt(dai, dai_props->fmt);
115                 if (ret && ret != -ENOTSUPP) {
116                         dev_err(dai->dev, "set_fmt error\n");
117                         goto err;
118                 }
119         }
120
121         if (dai_props->sysclk) {
122                 ret = snd_soc_dai_set_sysclk(dai, 0, dai_props->sysclk, 0);
123                 if (ret && ret != -ENOTSUPP) {
124                         dev_err(dai->dev, "set_sysclk error\n");
125                         goto err;
126                 }
127         }
128
129         ret = 0;
130
131 err:
132         return ret;
133 }
134
135 static int rsrc_card_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
136                                         struct snd_pcm_hw_params *params)
137 {
138         struct rsrc_card_priv *priv = snd_soc_card_get_drvdata(rtd->card);
139         struct snd_interval *rate = hw_param_interval(params,
140                                                       SNDRV_PCM_HW_PARAM_RATE);
141
142         if (!priv->convert_rate)
143                 return 0;
144
145         rate->min = rate->max = priv->convert_rate;
146
147         return 0;
148 }
149
150 static int rsrc_card_parse_daifmt(struct device_node *node,
151                                   struct device_node *np,
152                                   struct rsrc_card_priv *priv,
153                                   int idx, bool is_fe)
154 {
155         struct rsrc_card_dai *dai_props = rsrc_priv_to_props(priv, idx);
156         struct device_node *bitclkmaster = NULL;
157         struct device_node *framemaster = NULL;
158         struct device_node *codec = is_fe ? NULL : np;
159         unsigned int daifmt;
160
161         daifmt = snd_soc_of_parse_daifmt(node, NULL,
162                                          &bitclkmaster, &framemaster);
163         daifmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
164
165         if (!bitclkmaster && !framemaster)
166                 return -EINVAL;
167
168         if (codec == bitclkmaster)
169                 daifmt |= (codec == framemaster) ?
170                         SND_SOC_DAIFMT_CBM_CFM : SND_SOC_DAIFMT_CBM_CFS;
171         else
172                 daifmt |= (codec == framemaster) ?
173                         SND_SOC_DAIFMT_CBS_CFM : SND_SOC_DAIFMT_CBS_CFS;
174
175         dai_props->fmt  = daifmt;
176
177         of_node_put(bitclkmaster);
178         of_node_put(framemaster);
179
180         return 0;
181 }
182
183 static int rsrc_card_parse_links(struct device_node *np,
184                                  struct rsrc_card_priv *priv,
185                                  int idx, bool is_fe)
186 {
187         struct snd_soc_dai_link *dai_link = rsrc_priv_to_link(priv, idx);
188         struct rsrc_card_dai *dai_props = rsrc_priv_to_props(priv, idx);
189         struct of_phandle_args args;
190         int ret;
191
192         /*
193          * Get node via "sound-dai = <&phandle port>"
194          * it will be used as xxx_of_node on soc_bind_dai_link()
195          */
196         ret = of_parse_phandle_with_args(np, "sound-dai",
197                                          "#sound-dai-cells", 0, &args);
198         if (ret)
199                 return ret;
200
201         if (is_fe) {
202                 /* BE is dummy */
203                 dai_link->codec_of_node         = NULL;
204                 dai_link->codec_dai_name        = "snd-soc-dummy-dai";
205                 dai_link->codec_name            = "snd-soc-dummy";
206
207                 /* FE settings */
208                 dai_link->dynamic               = 1;
209                 dai_link->dpcm_merged_format    = 1;
210                 dai_link->cpu_of_node           = args.np;
211                 ret = snd_soc_of_get_dai_name(np, &dai_link->cpu_dai_name);
212                 if (ret < 0)
213                         return ret;
214
215                 /* set dai_name */
216                 snprintf(dai_props->dai_name, DAI_NAME_NUM, "fe.%s",
217                          dai_link->cpu_dai_name);
218
219                 /*
220                  * In soc_bind_dai_link() will check cpu name after
221                  * of_node matching if dai_link has cpu_dai_name.
222                  * but, it will never match if name was created by
223                  * fmt_single_name() remove cpu_dai_name if cpu_args
224                  * was 0. See:
225                  *      fmt_single_name()
226                  *      fmt_multiple_name()
227                  */
228                 if (!args.args_count)
229                         dai_link->cpu_dai_name = NULL;
230         } else {
231                 struct device *dev = rsrc_priv_to_dev(priv);
232                 const struct rsrc_card_of_data *of_data;
233
234                 of_data = rsrc_dev_to_of_data(dev);
235
236                 /* FE is dummy */
237                 dai_link->cpu_of_node           = NULL;
238                 dai_link->cpu_dai_name          = "snd-soc-dummy-dai";
239                 dai_link->cpu_name              = "snd-soc-dummy";
240
241                 /* BE settings */
242                 dai_link->no_pcm                = 1;
243                 dai_link->be_hw_params_fixup    = rsrc_card_be_hw_params_fixup;
244                 dai_link->codec_of_node         = args.np;
245                 ret = snd_soc_of_get_dai_name(np, &dai_link->codec_dai_name);
246                 if (ret < 0)
247                         return ret;
248
249                 /* additional name prefix */
250                 if (of_data) {
251                         priv->codec_conf.of_node = dai_link->codec_of_node;
252                         priv->codec_conf.name_prefix = of_data->prefix;
253                 } else {
254                         snd_soc_of_parse_audio_prefix(&priv->snd_card,
255                                                       &priv->codec_conf,
256                                                       dai_link->codec_of_node,
257                                                       "audio-prefix");
258                 }
259
260                 /* set dai_name */
261                 snprintf(dai_props->dai_name, DAI_NAME_NUM, "be.%s",
262                          dai_link->codec_dai_name);
263         }
264
265         /* Simple Card assumes platform == cpu */
266         dai_link->platform_of_node      = dai_link->cpu_of_node;
267         dai_link->dpcm_playback         = 1;
268         dai_link->dpcm_capture          = 1;
269         dai_link->name                  = dai_props->dai_name;
270         dai_link->stream_name           = dai_props->dai_name;
271         dai_link->ops                   = &rsrc_card_ops;
272         dai_link->init                  = rsrc_card_dai_init;
273
274         return 0;
275 }
276
277 static int rsrc_card_parse_clk(struct device_node *np,
278                                struct rsrc_card_priv *priv,
279                                int idx, bool is_fe)
280 {
281         struct snd_soc_dai_link *dai_link = rsrc_priv_to_link(priv, idx);
282         struct rsrc_card_dai *dai_props = rsrc_priv_to_props(priv, idx);
283         struct clk *clk;
284         struct device_node *of_np = is_fe ?     dai_link->cpu_of_node :
285                                                 dai_link->codec_of_node;
286         u32 val;
287
288         /*
289          * Parse dai->sysclk come from "clocks = <&xxx>"
290          * (if system has common clock)
291          *  or "system-clock-frequency = <xxx>"
292          *  or device's module clock.
293          */
294         if (of_property_read_bool(np, "clocks")) {
295                 clk = of_clk_get(np, 0);
296                 if (IS_ERR(clk))
297                         return PTR_ERR(clk);
298
299                 dai_props->sysclk = clk_get_rate(clk);
300                 dai_props->clk = clk;
301         } else if (!of_property_read_u32(np, "system-clock-frequency", &val)) {
302                 dai_props->sysclk = val;
303         } else {
304                 clk = of_clk_get(of_np, 0);
305                 if (!IS_ERR(clk))
306                         dai_props->sysclk = clk_get_rate(clk);
307         }
308
309         return 0;
310 }
311
312 static int rsrc_card_dai_link_of(struct device_node *node,
313                                  struct device_node *np,
314                                  struct rsrc_card_priv *priv,
315                                  int idx)
316 {
317         struct device *dev = rsrc_priv_to_dev(priv);
318         struct rsrc_card_dai *dai_props = rsrc_priv_to_props(priv, idx);
319         bool is_fe = false;
320         int ret;
321
322         if (0 == strcmp(np->name, "cpu"))
323                 is_fe = true;
324
325         ret = rsrc_card_parse_daifmt(node, np, priv, idx, is_fe);
326         if (ret < 0)
327                 return ret;
328
329         ret = rsrc_card_parse_links(np, priv, idx, is_fe);
330         if (ret < 0)
331                 return ret;
332
333         ret = rsrc_card_parse_clk(np, priv, idx, is_fe);
334         if (ret < 0)
335                 return ret;
336
337         dev_dbg(dev, "\t%s / %04x / %d\n",
338                 dai_props->dai_name,
339                 dai_props->fmt,
340                 dai_props->sysclk);
341
342         return ret;
343 }
344
345 static int rsrc_card_parse_of(struct device_node *node,
346                               struct rsrc_card_priv *priv,
347                               struct device *dev)
348 {
349         const struct rsrc_card_of_data *of_data = rsrc_dev_to_of_data(dev);
350         struct rsrc_card_dai *props;
351         struct snd_soc_dai_link *links;
352         struct device_node *np;
353         int ret;
354         int i, num;
355
356         if (!node)
357                 return -EINVAL;
358
359         num = of_get_child_count(node);
360         props = devm_kzalloc(dev, sizeof(*props) * num, GFP_KERNEL);
361         links = devm_kzalloc(dev, sizeof(*links) * num, GFP_KERNEL);
362         if (!props || !links)
363                 return -ENOMEM;
364
365         priv->dai_props = props;
366         priv->dai_link  = links;
367         priv->dai_num   = num;
368
369         /* Init snd_soc_card */
370         priv->snd_card.owner                    = THIS_MODULE;
371         priv->snd_card.dev                      = dev;
372         priv->snd_card.dai_link                 = priv->dai_link;
373         priv->snd_card.num_links                = num;
374         priv->snd_card.codec_conf               = &priv->codec_conf;
375         priv->snd_card.num_configs              = 1;
376
377         if (of_data) {
378                 priv->snd_card.of_dapm_routes           = of_data->routes;
379                 priv->snd_card.num_of_dapm_routes       = of_data->num_routes;
380         } else {
381                 snd_soc_of_parse_audio_routing(&priv->snd_card,
382                                                "audio-routing");
383         }
384
385         /* Parse the card name from DT */
386         snd_soc_of_parse_card_name(&priv->snd_card, "card-name");
387
388         /* sampling rate convert */
389         of_property_read_u32(node, "convert-rate", &priv->convert_rate);
390
391         dev_dbg(dev, "New rsrc-audio-card: %s (%d)\n",
392                 priv->snd_card.name ? priv->snd_card.name : "",
393                 priv->convert_rate);
394
395         i = 0;
396         for_each_child_of_node(node, np) {
397                 ret = rsrc_card_dai_link_of(node, np, priv, i);
398                 if (ret < 0)
399                         return ret;
400                 i++;
401         }
402
403         if (!priv->snd_card.name)
404                 priv->snd_card.name = priv->snd_card.dai_link->name;
405
406         return 0;
407 }
408
409 /* Decrease the reference count of the device nodes */
410 static int rsrc_card_unref(struct snd_soc_card *card)
411 {
412         struct snd_soc_dai_link *dai_link;
413         int num_links;
414
415         for (num_links = 0, dai_link = card->dai_link;
416              num_links < card->num_links;
417              num_links++, dai_link++) {
418                 of_node_put(dai_link->cpu_of_node);
419                 of_node_put(dai_link->codec_of_node);
420         }
421         return 0;
422 }
423
424 static int rsrc_card_probe(struct platform_device *pdev)
425 {
426         struct rsrc_card_priv *priv;
427         struct device_node *np = pdev->dev.of_node;
428         struct device *dev = &pdev->dev;
429         int ret;
430
431         /* Allocate the private data */
432         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
433         if (!priv)
434                 return -ENOMEM;
435
436         ret = rsrc_card_parse_of(np, priv, dev);
437         if (ret < 0) {
438                 if (ret != -EPROBE_DEFER)
439                         dev_err(dev, "parse error %d\n", ret);
440                 goto err;
441         }
442
443         snd_soc_card_set_drvdata(&priv->snd_card, priv);
444
445         ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
446         if (ret >= 0)
447                 return ret;
448 err:
449         rsrc_card_unref(&priv->snd_card);
450
451         return ret;
452 }
453
454 static int rsrc_card_remove(struct platform_device *pdev)
455 {
456         struct snd_soc_card *card = platform_get_drvdata(pdev);
457
458         return rsrc_card_unref(card);
459 }
460
461 static struct platform_driver rsrc_card = {
462         .driver = {
463                 .name = "renesas-src-audio-card",
464                 .of_match_table = rsrc_card_of_match,
465         },
466         .probe = rsrc_card_probe,
467         .remove = rsrc_card_remove,
468 };
469
470 module_platform_driver(rsrc_card);
471
472 MODULE_ALIAS("platform:renesas-src-audio-card");
473 MODULE_LICENSE("GPL");
474 MODULE_DESCRIPTION("Renesas Sampling Rate Convert Sound Card");
475 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");