1 // SPDX-License-Identifier: GPL-2.0
2 //
3 // ASoC audio graph SCU sound card support
4 //
5 // Copyright (C) 2017 Renesas Solutions Corp.
6 // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7 //
8 // based on
9 // ${LINUX}/sound/soc/generic/simple-scu-card.c
10 // ${LINUX}/sound/soc/generic/audio-graph-card.c
11
12 #include <linux/clk.h>
13 #include <linux/device.h>
14 #include <linux/gpio.h>
15 #include <linux/module.h>
16 #include <linux/of.h>
17 #include <linux/of_device.h>
18 #include <linux/of_gpio.h>
19 #include <linux/of_graph.h>
20 #include <linux/platform_device.h>
21 #include <linux/string.h>
22 #include <sound/jack.h>
23 #include <sound/simple_card_utils.h>
24
25 struct graph_card_data {
26 struct snd_soc_card snd_card;
27 struct snd_soc_codec_conf codec_conf;
28 struct asoc_simple_dai *dai_props;
29 struct snd_soc_dai_link *dai_link;
30 struct asoc_simple_card_data adata;
31 };
32
33 #define graph_priv_to_card(priv) (&(priv)->snd_card)
34 #define graph_priv_to_props(priv, i) ((priv)->dai_props + (i))
35 #define graph_priv_to_dev(priv) (graph_priv_to_card(priv)->dev)
36 #define graph_priv_to_link(priv, i) (graph_priv_to_card(priv)->dai_link + (i))
37
asoc_graph_card_startup(struct snd_pcm_substream * substream)38 static int asoc_graph_card_startup(struct snd_pcm_substream *substream)
39 {
40 struct snd_soc_pcm_runtime *rtd = substream->private_data;
41 struct graph_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
42 struct asoc_simple_dai *dai_props = graph_priv_to_props(priv, rtd->num);
43
44 return asoc_simple_card_clk_enable(dai_props);
45 }
46
asoc_graph_card_shutdown(struct snd_pcm_substream * substream)47 static void asoc_graph_card_shutdown(struct snd_pcm_substream *substream)
48 {
49 struct snd_soc_pcm_runtime *rtd = substream->private_data;
50 struct graph_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
51 struct asoc_simple_dai *dai_props = graph_priv_to_props(priv, rtd->num);
52
53 asoc_simple_card_clk_disable(dai_props);
54 }
55
56 static const struct snd_soc_ops asoc_graph_card_ops = {
57 .startup = asoc_graph_card_startup,
58 .shutdown = asoc_graph_card_shutdown,
59 };
60
asoc_graph_card_dai_init(struct snd_soc_pcm_runtime * rtd)61 static int asoc_graph_card_dai_init(struct snd_soc_pcm_runtime *rtd)
62 {
63 struct graph_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
64 struct snd_soc_dai *dai;
65 struct snd_soc_dai_link *dai_link;
66 struct asoc_simple_dai *dai_props;
67 int num = rtd->num;
68
69 dai_link = graph_priv_to_link(priv, num);
70 dai_props = graph_priv_to_props(priv, num);
71 dai = dai_link->dynamic ?
72 rtd->cpu_dai :
73 rtd->codec_dai;
74
75 return asoc_simple_card_init_dai(dai, dai_props);
76 }
77
asoc_graph_card_be_hw_params_fixup(struct snd_soc_pcm_runtime * rtd,struct snd_pcm_hw_params * params)78 static int asoc_graph_card_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
79 struct snd_pcm_hw_params *params)
80 {
81 struct graph_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
82
83 asoc_simple_card_convert_fixup(&priv->adata, params);
84
85 return 0;
86 }
87
asoc_graph_card_dai_link_of(struct device_node * ep,struct graph_card_data * priv,unsigned int daifmt,int idx,int is_fe)88 static int asoc_graph_card_dai_link_of(struct device_node *ep,
89 struct graph_card_data *priv,
90 unsigned int daifmt,
91 int idx, int is_fe)
92 {
93 struct device *dev = graph_priv_to_dev(priv);
94 struct snd_soc_dai_link *dai_link = graph_priv_to_link(priv, idx);
95 struct asoc_simple_dai *dai_props = graph_priv_to_props(priv, idx);
96 struct snd_soc_card *card = graph_priv_to_card(priv);
97 int ret;
98
99 if (is_fe) {
100 /* BE is dummy */
101 dai_link->codec_of_node = NULL;
102 dai_link->codec_dai_name = "snd-soc-dummy-dai";
103 dai_link->codec_name = "snd-soc-dummy";
104
105 /* FE settings */
106 dai_link->dynamic = 1;
107 dai_link->dpcm_merged_format = 1;
108
109 ret = asoc_simple_card_parse_graph_cpu(ep, dai_link);
110 if (ret)
111 return ret;
112
113 ret = asoc_simple_card_parse_clk_cpu(dev, ep, dai_link, dai_props);
114 if (ret < 0)
115 return ret;
116
117 ret = asoc_simple_card_set_dailink_name(dev, dai_link,
118 "fe.%s",
119 dai_link->cpu_dai_name);
120 if (ret < 0)
121 return ret;
122
123 /* card->num_links includes Codec */
124 asoc_simple_card_canonicalize_cpu(dai_link,
125 of_graph_get_endpoint_count(dai_link->cpu_of_node) == 1);
126 } else {
127 /* FE is dummy */
128 dai_link->cpu_of_node = NULL;
129 dai_link->cpu_dai_name = "snd-soc-dummy-dai";
130 dai_link->cpu_name = "snd-soc-dummy";
131
132 /* BE settings */
133 dai_link->no_pcm = 1;
134 dai_link->be_hw_params_fixup = asoc_graph_card_be_hw_params_fixup;
135
136 ret = asoc_simple_card_parse_graph_codec(ep, dai_link);
137 if (ret < 0)
138 return ret;
139
140 ret = asoc_simple_card_parse_clk_codec(dev, ep, dai_link, dai_props);
141 if (ret < 0)
142 return ret;
143
144 ret = asoc_simple_card_set_dailink_name(dev, dai_link,
145 "be.%s",
146 dai_link->codec_dai_name);
147 if (ret < 0)
148 return ret;
149
150 snd_soc_of_parse_audio_prefix(card,
151 &priv->codec_conf,
152 dai_link->codec_of_node,
153 "prefix");
154 }
155
156 ret = asoc_simple_card_of_parse_tdm(ep, dai_props);
157 if (ret)
158 return ret;
159
160 ret = asoc_simple_card_canonicalize_dailink(dai_link);
161 if (ret < 0)
162 return ret;
163
164 dai_link->dai_fmt = daifmt;
165 dai_link->dpcm_playback = 1;
166 dai_link->dpcm_capture = 1;
167 dai_link->ops = &asoc_graph_card_ops;
168 dai_link->init = asoc_graph_card_dai_init;
169
170 return 0;
171 }
172
asoc_graph_card_parse_of(struct graph_card_data * priv)173 static int asoc_graph_card_parse_of(struct graph_card_data *priv)
174 {
175 struct of_phandle_iterator it;
176 struct device *dev = graph_priv_to_dev(priv);
177 struct snd_soc_card *card = graph_priv_to_card(priv);
178 struct device_node *node = dev->of_node;
179 struct device_node *cpu_port;
180 struct device_node *cpu_ep;
181 struct device_node *codec_ep;
182 struct device_node *rcpu_ep;
183 struct device_node *codec_port;
184 struct device_node *codec_port_old;
185 unsigned int daifmt = 0;
186 int dai_idx, ret;
187 int rc, codec;
188
189 if (!node)
190 return -EINVAL;
191
192 /*
193 * we need to consider "widgets", "mclk-fs" around here
194 * see simple-card
195 */
196
197 ret = asoc_simple_card_of_parse_routing(card, NULL, 0);
198 if (ret < 0)
199 return ret;
200
201 asoc_simple_card_parse_convert(dev, NULL, &priv->adata);
202
203 /*
204 * it supports multi CPU, single CODEC only here
205 * see asoc_graph_get_dais_count
206 */
207
208 /* find 1st codec */
209 of_for_each_phandle(&it, rc, node, "dais", NULL, 0) {
210 cpu_port = it.node;
211 cpu_ep = of_get_next_child(cpu_port, NULL);
212 codec_ep = of_graph_get_remote_endpoint(cpu_ep);
213 rcpu_ep = of_graph_get_remote_endpoint(codec_ep);
214
215 of_node_put(cpu_ep);
216 of_node_put(codec_ep);
217 of_node_put(rcpu_ep);
218
219 if (!codec_ep)
220 continue;
221
222 if (rcpu_ep != cpu_ep) {
223 dev_err(dev, "remote-endpoint missmatch (%s/%s/%s)\n",
224 cpu_ep->name, codec_ep->name, rcpu_ep->name);
225 ret = -EINVAL;
226 goto parse_of_err;
227 }
228
229 ret = asoc_simple_card_parse_daifmt(dev, cpu_ep, codec_ep,
230 NULL, &daifmt);
231 if (ret < 0) {
232 of_node_put(cpu_port);
233 goto parse_of_err;
234 }
235 }
236
237 dai_idx = 0;
238 codec_port_old = NULL;
239 for (codec = 0; codec < 2; codec++) {
240 /*
241 * To listup valid sounds continuously,
242 * detect all CPU-dummy first, and
243 * detect all dummy-Codec second
244 */
245 of_for_each_phandle(&it, rc, node, "dais", NULL, 0) {
246 cpu_port = it.node;
247 cpu_ep = of_get_next_child(cpu_port, NULL);
248 codec_ep = of_graph_get_remote_endpoint(cpu_ep);
249 codec_port = of_graph_get_port_parent(codec_ep);
250
251 of_node_put(cpu_ep);
252 of_node_put(codec_ep);
253 of_node_put(codec_port);
254
255 if (codec) {
256 if (!codec_port)
257 continue;
258
259 if (codec_port_old == codec_port)
260 continue;
261
262 codec_port_old = codec_port;
263
264 /* Back-End (= Codec) */
265 ret = asoc_graph_card_dai_link_of(codec_ep, priv, daifmt, dai_idx++, 0);
266 if (ret < 0) {
267 of_node_put(cpu_port);
268 goto parse_of_err;
269 }
270 } else {
271 /* Front-End (= CPU) */
272 ret = asoc_graph_card_dai_link_of(cpu_ep, priv, daifmt, dai_idx++, 1);
273 if (ret < 0) {
274 of_node_put(cpu_port);
275 goto parse_of_err;
276 }
277 }
278 }
279 }
280
281 ret = asoc_simple_card_parse_card_name(card, NULL);
282 if (ret)
283 goto parse_of_err;
284
285 ret = 0;
286
287 parse_of_err:
288 return ret;
289 }
290
asoc_graph_get_dais_count(struct device * dev)291 static int asoc_graph_get_dais_count(struct device *dev)
292 {
293 struct of_phandle_iterator it;
294 struct device_node *node = dev->of_node;
295 struct device_node *cpu_port;
296 struct device_node *cpu_ep;
297 struct device_node *codec_ep;
298 struct device_node *codec_port;
299 struct device_node *codec_port_old;
300 int count = 0;
301 int rc;
302
303 codec_port_old = NULL;
304 of_for_each_phandle(&it, rc, node, "dais", NULL, 0) {
305 cpu_port = it.node;
306 cpu_ep = of_get_next_child(cpu_port, NULL);
307 codec_ep = of_graph_get_remote_endpoint(cpu_ep);
308 codec_port = of_graph_get_port_parent(codec_ep);
309
310 of_node_put(cpu_ep);
311 of_node_put(codec_ep);
312 of_node_put(codec_port);
313
314 if (cpu_ep)
315 count++;
316
317 if (!codec_port)
318 continue;
319
320 if (codec_port_old == codec_port)
321 continue;
322
323 count++;
324 codec_port_old = codec_port;
325 }
326
327 return count;
328 }
329
asoc_graph_card_probe(struct platform_device * pdev)330 static int asoc_graph_card_probe(struct platform_device *pdev)
331 {
332 struct graph_card_data *priv;
333 struct snd_soc_dai_link *dai_link;
334 struct asoc_simple_dai *dai_props;
335 struct device *dev = &pdev->dev;
336 struct snd_soc_card *card;
337 int num, ret;
338
339 /* Allocate the private data and the DAI link array */
340 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
341 if (!priv)
342 return -ENOMEM;
343
344 num = asoc_graph_get_dais_count(dev);
345 if (num == 0)
346 return -EINVAL;
347
348 dai_props = devm_kcalloc(dev, num, sizeof(*dai_props), GFP_KERNEL);
349 dai_link = devm_kcalloc(dev, num, sizeof(*dai_link), GFP_KERNEL);
350 if (!dai_props || !dai_link)
351 return -ENOMEM;
352
353 priv->dai_props = dai_props;
354 priv->dai_link = dai_link;
355
356 /* Init snd_soc_card */
357 card = graph_priv_to_card(priv);
358 card->owner = THIS_MODULE;
359 card->dev = dev;
360 card->dai_link = priv->dai_link;
361 card->num_links = num;
362 card->codec_conf = &priv->codec_conf;
363 card->num_configs = 1;
364
365 ret = asoc_graph_card_parse_of(priv);
366 if (ret < 0) {
367 if (ret != -EPROBE_DEFER)
368 dev_err(dev, "parse error %d\n", ret);
369 goto err;
370 }
371
372 snd_soc_card_set_drvdata(card, priv);
373
374 ret = devm_snd_soc_register_card(dev, card);
375 if (ret < 0)
376 goto err;
377
378 return 0;
379 err:
380 asoc_simple_card_clean_reference(card);
381
382 return ret;
383 }
384
asoc_graph_card_remove(struct platform_device * pdev)385 static int asoc_graph_card_remove(struct platform_device *pdev)
386 {
387 struct snd_soc_card *card = platform_get_drvdata(pdev);
388
389 return asoc_simple_card_clean_reference(card);
390 }
391
392 static const struct of_device_id asoc_graph_of_match[] = {
393 { .compatible = "audio-graph-scu-card", },
394 {},
395 };
396 MODULE_DEVICE_TABLE(of, asoc_graph_of_match);
397
398 static struct platform_driver asoc_graph_card = {
399 .driver = {
400 .name = "asoc-audio-graph-scu-card",
401 .pm = &snd_soc_pm_ops,
402 .of_match_table = asoc_graph_of_match,
403 },
404 .probe = asoc_graph_card_probe,
405 .remove = asoc_graph_card_remove,
406 };
407 module_platform_driver(asoc_graph_card);
408
409 MODULE_ALIAS("platform:asoc-audio-graph-scu-card");
410 MODULE_LICENSE("GPL v2");
411 MODULE_DESCRIPTION("ASoC Audio Graph SCU Sound Card");
412 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
413