common.c 3.48 KB
Newer Older
1
2
3
4
5
6
// SPDX-License-Identifier: GPL-2.0
// Copyright (c) 2018, Linaro Limited.
// Copyright (c) 2018, The Linux Foundation. All rights reserved.

#include <linux/module.h>
#include "common.h"
7
#include "qdsp6/q6afe.h"
8
9
10
11
12
13
14
15
16
17

int qcom_snd_parse_of(struct snd_soc_card *card)
{
	struct device_node *np;
	struct device_node *codec = NULL;
	struct device_node *platform = NULL;
	struct device_node *cpu = NULL;
	struct device *dev = card->dev;
	struct snd_soc_dai_link *link;
	struct of_phandle_args args;
18
	struct snd_soc_dai_link_component *dlc;
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
	int ret, num_links;

	ret = snd_soc_of_parse_card_name(card, "model");
	if (ret) {
		dev_err(dev, "Error parsing card name: %d\n", ret);
		return ret;
	}

	/* DAPM routes */
	if (of_property_read_bool(dev->of_node, "audio-routing")) {
		ret = snd_soc_of_parse_audio_routing(card,
				"audio-routing");
		if (ret)
			return ret;
	}

	/* Populate links */
	num_links = of_get_child_count(dev->of_node);

	/* Allocate the DAI link array */
	card->dai_link = kcalloc(num_links, sizeof(*link), GFP_KERNEL);
	if (!card->dai_link)
		return -ENOMEM;

	card->num_links = num_links;
	link = card->dai_link;
45

46
	for_each_child_of_node(dev->of_node, np) {
47
48
49
50
51
52
53
54
55
56
		dlc = devm_kzalloc(dev, 2 * sizeof(*dlc), GFP_KERNEL);
		if (!dlc)
			return -ENOMEM;

		link->cpus	= &dlc[0];
		link->platforms	= &dlc[1];

		link->num_cpus		= 1;
		link->num_platforms	= 1;

57
58
59
60
61
62
		ret = of_property_read_string(np, "link-name", &link->name);
		if (ret) {
			dev_err(card->dev, "error getting codec dai_link name\n");
			goto err;
		}

63
		cpu = of_get_child_by_name(np, "cpu");
64
65
66
		platform = of_get_child_by_name(np, "platform");
		codec = of_get_child_by_name(np, "codec");

67
		if (!cpu) {
68
			dev_err(dev, "%s: Can't find cpu DT node\n", link->name);
69
70
71
72
73
74
75
			ret = -EINVAL;
			goto err;
		}

		ret = of_parse_phandle_with_args(cpu, "sound-dai",
					"#sound-dai-cells", 0, &args);
		if (ret) {
76
			dev_err(card->dev, "%s: error getting cpu phandle\n", link->name);
77
78
			goto err;
		}
79
		link->cpus->of_node = args.np;
80
81
		link->id = args.args[0];

82
		ret = snd_soc_of_get_dai_name(cpu, &link->cpus->dai_name);
83
		if (ret) {
84
			dev_err(card->dev, "%s: error getting cpu dai name\n", link->name);
85
86
87
88
			goto err;
		}

		if (codec && platform) {
89
			link->platforms->of_node = of_parse_phandle(platform,
90
91
					"sound-dai",
					0);
92
			if (!link->platforms->of_node) {
93
				dev_err(card->dev, "%s: platform dai not found\n", link->name);
94
95
96
97
98
99
				ret = -EINVAL;
				goto err;
			}

			ret = snd_soc_of_get_dai_link_codecs(dev, codec, link);
			if (ret < 0) {
100
				dev_err(card->dev, "%s: codec dai not found\n", link->name);
101
102
103
104
				goto err;
			}
			link->no_pcm = 1;
			link->ignore_pmdown_time = 1;
105
106
107
108
109
110
111
112
113

			if (q6afe_is_rx_port(link->id)) {
				link->dpcm_playback = 1;
				link->dpcm_capture = 0;
			} else {
				link->dpcm_playback = 0;
				link->dpcm_capture = 1;
			}

114
		} else {
115
116
117
118
119
120
121
122
123
124
			dlc = devm_kzalloc(dev, sizeof(*dlc), GFP_KERNEL);
			if (!dlc)
				return -ENOMEM;

			link->codecs	 = dlc;
			link->num_codecs = 1;

			link->platforms->of_node = link->cpus->of_node;
			link->codecs->dai_name = "snd-soc-dummy-dai";
			link->codecs->name = "snd-soc-dummy";
125
			link->dynamic = 1;
126
127
			link->dpcm_playback = 1;
			link->dpcm_capture = 1;
128
129
130
		}

		link->ignore_suspend = 1;
131
		link->nonatomic = 1;
132
133
		link->stream_name = link->name;
		link++;
134
135
136
137

		of_node_put(cpu);
		of_node_put(codec);
		of_node_put(platform);
138
139
140
141
	}

	return 0;
err:
142
	of_node_put(np);
143
144
145
146
147
148
149
150
151
	of_node_put(cpu);
	of_node_put(codec);
	of_node_put(platform);
	kfree(card->dai_link);
	return ret;
}
EXPORT_SYMBOL(qcom_snd_parse_of);

MODULE_LICENSE("GPL v2");