]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - sound/soc/generic/simple-card.c
ASoC: simple-card: Fix the reference count of device nodes
[mirror_ubuntu-bionic-kernel.git] / sound / soc / generic / simple-card.c
CommitLineData
f2390880
KM
1/*
2 * ASoC simple sound card support
3 *
4 * Copyright (C) 2012 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
fa558c28 11#include <linux/clk.h>
6ff62eed 12#include <linux/device.h>
f2390880 13#include <linux/module.h>
fa558c28 14#include <linux/of.h>
f2390880 15#include <linux/platform_device.h>
ca919fe4 16#include <linux/string.h>
f2390880 17#include <sound/simple_card.h>
6ff62eed
XL
18#include <sound/soc-dai.h>
19#include <sound/soc.h>
f2390880 20
45fce594
JFM
21struct simple_card_data {
22 struct snd_soc_card snd_card;
23 unsigned int daifmt;
24 struct asoc_simple_dai cpu_dai;
25 struct asoc_simple_dai codec_dai;
26 struct snd_soc_dai_link snd_link;
27};
28
a4a2992c 29static int __asoc_simple_card_dai_init(struct snd_soc_dai *dai,
30d0341e 30 struct asoc_simple_dai *set)
a4a2992c 31{
4763ebe2 32 int ret;
a4a2992c 33
30d0341e
XL
34 if (set->fmt) {
35 ret = snd_soc_dai_set_fmt(dai, set->fmt);
4763ebe2
XL
36 if (ret && ret != -ENOTSUPP) {
37 dev_err(dai->dev, "simple-card: set_fmt error\n");
38 goto err;
39 }
e244bb9b
KM
40 }
41
4763ebe2 42 if (set->sysclk) {
a4a2992c 43 ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
4763ebe2
XL
44 if (ret && ret != -ENOTSUPP) {
45 dev_err(dai->dev, "simple-card: set_sysclk error\n");
46 goto err;
47 }
48 }
49
6ff62eed
XL
50 if (set->slots) {
51 ret = snd_soc_dai_set_tdm_slot(dai, 0, 0,
52 set->slots,
53 set->slot_width);
54 if (ret && ret != -ENOTSUPP) {
55 dev_err(dai->dev, "simple-card: set_tdm_slot error\n");
56 goto err;
57 }
58 }
59
4763ebe2 60 ret = 0;
a4a2992c 61
4763ebe2 62err:
a4a2992c
KM
63 return ret;
64}
65
f2390880
KM
66static int asoc_simple_card_dai_init(struct snd_soc_pcm_runtime *rtd)
67{
b367a325 68 struct simple_card_data *priv =
ba194a4d 69 snd_soc_card_get_drvdata(rtd->card);
f2390880
KM
70 struct snd_soc_dai *codec = rtd->codec_dai;
71 struct snd_soc_dai *cpu = rtd->cpu_dai;
f2390880
KM
72 int ret;
73
30d0341e 74 ret = __asoc_simple_card_dai_init(codec, &priv->codec_dai);
a4a2992c
KM
75 if (ret < 0)
76 return ret;
f2390880 77
30d0341e 78 ret = __asoc_simple_card_dai_init(cpu, &priv->cpu_dai);
a4a2992c
KM
79 if (ret < 0)
80 return ret;
f2390880
KM
81
82 return 0;
83}
84
fa558c28
KM
85static int
86asoc_simple_card_sub_parse_of(struct device_node *np,
30d0341e 87 unsigned int daifmt,
fa558c28 88 struct asoc_simple_dai *dai,
52008472
JFM
89 const struct device_node **p_node,
90 const char **name)
fa558c28 91{
201a0eac 92 struct device_node *node;
fa558c28
KM
93 struct clk *clk;
94 int ret;
95
96 /*
97 * get node via "sound-dai = <&phandle port>"
98 * it will be used as xxx_of_node on soc_bind_dai_link()
99 */
201a0eac
JFM
100 node = of_parse_phandle(np, "sound-dai", 0);
101 if (!node)
fa558c28 102 return -ENODEV;
201a0eac 103 *p_node = node;
fa558c28
KM
104
105 /* get dai->name */
52008472 106 ret = snd_soc_of_get_dai_name(np, name);
fa558c28 107 if (ret < 0)
e512e001 108 return ret;
fa558c28 109
6ff62eed
XL
110 /* parse TDM slot */
111 ret = snd_soc_of_parse_tdm_slot(np, &dai->slots, &dai->slot_width);
112 if (ret)
e512e001 113 return ret;
6ff62eed 114
fa558c28
KM
115 /*
116 * bitclock-inversion, frame-inversion
117 * bitclock-master, frame-master
118 * and specific "format" if it has
119 */
120 dai->fmt = snd_soc_of_parse_daifmt(np, NULL);
30d0341e 121 dai->fmt |= daifmt;
fa558c28
KM
122
123 /*
124 * dai->sysclk come from
125 * "clocks = <&xxx>" (if system has common clock)
126 * or "system-clock-frequency = <xxx>"
71467e46 127 * or device's module clock.
fa558c28 128 */
71467e46
XL
129 if (of_property_read_bool(np, "clocks")) {
130 clk = of_clk_get(np, 0);
131 if (IS_ERR(clk)) {
132 ret = PTR_ERR(clk);
e512e001 133 return ret;
71467e46
XL
134 }
135
136 dai->sysclk = clk_get_rate(clk);
137 } else if (of_property_read_bool(np, "system-clock-frequency")) {
fa558c28
KM
138 of_property_read_u32(np,
139 "system-clock-frequency",
140 &dai->sysclk);
71467e46 141 } else {
201a0eac 142 clk = of_clk_get(node, 0);
e2a19ac6
XL
143 if (!IS_ERR(clk))
144 dai->sysclk = clk_get_rate(clk);
71467e46 145 }
fa558c28 146
e512e001 147 return 0;
fa558c28
KM
148}
149
150static int asoc_simple_card_parse_of(struct device_node *node,
b367a325 151 struct simple_card_data *priv,
201a0eac 152 struct device *dev)
fa558c28 153{
b367a325 154 struct snd_soc_dai_link *dai_link = priv->snd_card.dai_link;
fa558c28
KM
155 struct device_node *np;
156 char *name;
d4c22094 157 int ret;
fa558c28 158
2772555b
XL
159 /* parsing the card name from DT */
160 snd_soc_of_parse_card_name(&priv->snd_card, "simple-audio-card,name");
161
fa558c28 162 /* get CPU/CODEC common format via simple-audio-card,format */
b367a325 163 priv->daifmt = snd_soc_of_parse_daifmt(node, "simple-audio-card,") &
fa558c28
KM
164 (SND_SOC_DAIFMT_FORMAT_MASK | SND_SOC_DAIFMT_INV_MASK);
165
9d681f5b
XL
166 /* off-codec widgets */
167 if (of_property_read_bool(node, "simple-audio-card,widgets")) {
168 ret = snd_soc_of_parse_audio_simple_widgets(&priv->snd_card,
169 "simple-audio-card,widgets");
170 if (ret)
171 return ret;
172 }
173
d4c22094 174 /* DAPM routes */
8c0b8230 175 if (of_property_read_bool(node, "simple-audio-card,routing")) {
b367a325 176 ret = snd_soc_of_parse_audio_routing(&priv->snd_card,
8c0b8230 177 "simple-audio-card,routing");
f87a3e82
XL
178 if (ret)
179 return ret;
180 }
d4c22094 181
fa558c28
KM
182 /* CPU sub-node */
183 ret = -EINVAL;
184 np = of_get_child_by_name(node, "simple-audio-card,cpu");
e512e001 185 if (np) {
30d0341e 186 ret = asoc_simple_card_sub_parse_of(np, priv->daifmt,
b367a325 187 &priv->cpu_dai,
52008472
JFM
188 &dai_link->cpu_of_node,
189 &dai_link->cpu_dai_name);
e512e001
JFM
190 of_node_put(np);
191 }
fa558c28
KM
192 if (ret < 0)
193 return ret;
194
195 /* CODEC sub-node */
196 ret = -EINVAL;
197 np = of_get_child_by_name(node, "simple-audio-card,codec");
e512e001 198 if (np) {
30d0341e 199 ret = asoc_simple_card_sub_parse_of(np, priv->daifmt,
b367a325 200 &priv->codec_dai,
52008472
JFM
201 &dai_link->codec_of_node,
202 &dai_link->codec_dai_name);
e512e001
JFM
203 of_node_put(np);
204 }
fa558c28
KM
205 if (ret < 0)
206 return ret;
207
52008472 208 if (!dai_link->cpu_dai_name || !dai_link->codec_dai_name)
dd41e0c4
XL
209 return -EINVAL;
210
fa558c28
KM
211 /* card name is created from CPU/CODEC dai name */
212 name = devm_kzalloc(dev,
52008472
JFM
213 strlen(dai_link->cpu_dai_name) +
214 strlen(dai_link->codec_dai_name) + 2,
fa558c28 215 GFP_KERNEL);
52008472
JFM
216 sprintf(name, "%s-%s", dai_link->cpu_dai_name,
217 dai_link->codec_dai_name);
2772555b
XL
218 if (!priv->snd_card.name)
219 priv->snd_card.name = name;
5ca8ba41 220 dai_link->name = dai_link->stream_name = name;
fa558c28
KM
221
222 /* simple-card assumes platform == cpu */
5ca8ba41 223 dai_link->platform_of_node = dai_link->cpu_of_node;
fa558c28 224
2bee9914 225 dev_dbg(dev, "card-name : %s\n", name);
b367a325 226 dev_dbg(dev, "platform : %04x\n", priv->daifmt);
fa558c28 227 dev_dbg(dev, "cpu : %s / %04x / %d\n",
52008472 228 dai_link->cpu_dai_name,
b367a325
JFM
229 priv->cpu_dai.fmt,
230 priv->cpu_dai.sysclk);
fa558c28 231 dev_dbg(dev, "codec : %s / %04x / %d\n",
52008472 232 dai_link->codec_dai_name,
b367a325
JFM
233 priv->codec_dai.fmt,
234 priv->codec_dai.sysclk);
fa558c28 235
f687d900
KM
236 /*
237 * soc_bind_dai_link() will check cpu name
238 * after of_node matching if dai_link has cpu_dai_name.
239 * but, it will never match if name was created by fmt_single_name()
240 * remove cpu_dai_name to escape name matching.
241 * see
242 * fmt_single_name()
243 * fmt_multiple_name()
244 */
245 dai_link->cpu_dai_name = NULL;
246
fa558c28
KM
247 return 0;
248}
249
e512e001
JFM
250/* update the reference count of the devices nodes at end of probe */
251static int asoc_simple_card_unref(struct platform_device *pdev)
252{
253 struct snd_soc_card *card = platform_get_drvdata(pdev);
254 struct snd_soc_dai_link *dai_link;
255 struct device_node *np;
256 int num_links;
257
258 for (num_links = 0, dai_link = card->dai_link;
259 num_links < card->num_links;
260 num_links++, dai_link++) {
261 np = (struct device_node *) dai_link->cpu_of_node;
262 if (np)
263 of_node_put(np);
264 np = (struct device_node *) dai_link->codec_of_node;
265 if (np)
266 of_node_put(np);
267 }
268 return 0;
269}
270
f2390880
KM
271static int asoc_simple_card_probe(struct platform_device *pdev)
272{
45fce594 273 struct simple_card_data *priv;
5ca8ba41 274 struct snd_soc_dai_link *dai_link;
fa558c28 275 struct device_node *np = pdev->dev.of_node;
f89983ef 276 struct device *dev = &pdev->dev;
ca919fe4 277 int ret;
f2390880 278
ca65b492
JFM
279 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
280 if (!priv)
ca919fe4
XL
281 return -ENOMEM;
282
201a0eac
JFM
283 /*
284 * init snd_soc_card
285 */
ca65b492
JFM
286 priv->snd_card.owner = THIS_MODULE;
287 priv->snd_card.dev = dev;
288 dai_link = &priv->snd_link;
289 priv->snd_card.dai_link = dai_link;
290 priv->snd_card.num_links = 1;
201a0eac 291
fa558c28 292 if (np && of_device_is_available(np)) {
ca919fe4 293
ca65b492 294 ret = asoc_simple_card_parse_of(np, priv, dev);
ca919fe4
XL
295 if (ret < 0) {
296 if (ret != -EPROBE_DEFER)
297 dev_err(dev, "parse error %d\n", ret);
e512e001 298 goto err;
fa558c28
KM
299 }
300 } else {
ca65b492
JFM
301 struct asoc_simple_card_info *cinfo;
302
303 cinfo = dev->platform_data;
304 if (!cinfo) {
34787d0a
XL
305 dev_err(dev, "no info for asoc-simple-card\n");
306 return -EINVAL;
307 }
fa558c28 308
7722f830 309 if (!cinfo->name ||
7722f830
JFM
310 !cinfo->codec_dai.name ||
311 !cinfo->codec ||
312 !cinfo->platform ||
313 !cinfo->cpu_dai.name) {
314 dev_err(dev, "insufficient asoc_simple_card_info settings\n");
315 return -EINVAL;
316 }
2bee9914 317
12ffa6fc 318 priv->snd_card.name = (cinfo->card) ? cinfo->card : cinfo->name;
5ca8ba41
JFM
319 dai_link->name = cinfo->name;
320 dai_link->stream_name = cinfo->name;
321 dai_link->platform_name = cinfo->platform;
322 dai_link->codec_name = cinfo->codec;
52008472
JFM
323 dai_link->cpu_dai_name = cinfo->cpu_dai.name;
324 dai_link->codec_dai_name = cinfo->codec_dai.name;
ca65b492
JFM
325 memcpy(&priv->cpu_dai, &cinfo->cpu_dai,
326 sizeof(priv->cpu_dai));
327 memcpy(&priv->codec_dai, &cinfo->codec_dai,
328 sizeof(priv->codec_dai));
81985bd6
KM
329
330 priv->cpu_dai.fmt |= cinfo->daifmt;
331 priv->codec_dai.fmt |= cinfo->daifmt;
f2390880
KM
332 }
333
334 /*
335 * init snd_soc_dai_link
336 */
5ca8ba41 337 dai_link->init = asoc_simple_card_dai_init;
f2390880 338
ca65b492 339 snd_soc_card_set_drvdata(&priv->snd_card, priv);
f2390880 340
e512e001
JFM
341 ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
342
343err:
344 asoc_simple_card_unref(pdev);
345 return ret;
f2390880
KM
346}
347
fa558c28
KM
348static const struct of_device_id asoc_simple_of_match[] = {
349 { .compatible = "simple-audio-card", },
350 {},
351};
352MODULE_DEVICE_TABLE(of, asoc_simple_of_match);
353
f2390880
KM
354static struct platform_driver asoc_simple_card = {
355 .driver = {
356 .name = "asoc-simple-card",
c445be35 357 .owner = THIS_MODULE,
fa558c28 358 .of_match_table = asoc_simple_of_match,
f2390880
KM
359 },
360 .probe = asoc_simple_card_probe,
f2390880
KM
361};
362
363module_platform_driver(asoc_simple_card);
364
c445be35 365MODULE_ALIAS("platform:asoc-simple-card");
f2390880
KM
366MODULE_LICENSE("GPL");
367MODULE_DESCRIPTION("ASoC Simple Sound Card");
368MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");