Refactor rockchip_sound_probe, parse dai links from dts instead of
hard coding them.
Signed-off-by: Jeffy Chen <jeffy.c...@rock-chips.com>
---
sound/soc/rockchip/rk3399_gru_sound.c | 129 ++++++++++++++++++++++------------
1 file changed, 86 insertions(+), 43 deletions(-)
diff --git a/sound/soc/rockchip/rk3399_gru_sound.c
b/sound/soc/rockchip/rk3399_gru_sound.c
index 3475c61..c2bc675 100644
--- a/sound/soc/rockchip/rk3399_gru_sound.c
+++ b/sound/soc/rockchip/rk3399_gru_sound.c
@@ -247,9 +247,7 @@ enum {
DAILINK_RT5514_DSP,
};
-#define DAILINK_ENTITIES (DAILINK_DA7219 + 1)
-
-static struct snd_soc_dai_link rockchip_dailinks[] = {
+static const struct snd_soc_dai_link rockchip_dais[] = {
[DAILINK_MAX98357A] = {
.name = "MAX98357A",
.stream_name = "MAX98357A PCM",
@@ -290,8 +288,6 @@ static struct snd_soc_dai_link rockchip_dailinks[] = {
static struct snd_soc_card rockchip_sound_card = {
.name = "rk3399-gru-sound",
.owner = THIS_MODULE,
- .dai_link = rockchip_dailinks,
- .num_links = ARRAY_SIZE(rockchip_dailinks),
.dapm_widgets = rockchip_dapm_widgets,
.num_dapm_widgets = ARRAY_SIZE(rockchip_dapm_widgets),
.dapm_routes = rockchip_dapm_routes,
@@ -305,71 +301,118 @@ static int rockchip_sound_match_stub(struct device *dev,
void *data)
return 1;
}
-static int rockchip_sound_probe(struct platform_device *pdev)
+static int rockchip_sound_of_parse_dais(struct device *dev,
+ struct snd_soc_card *card)
{
- struct snd_soc_card *card = &rockchip_sound_card;
+ struct device *rt5514_dev;
+ struct device_driver *rt5514_drv;
struct device_node *cpu_node;
- struct device *dev;
- struct device_driver *drv;
- int i, ret;
-
- cpu_node = of_parse_phandle(pdev->dev.of_node, "rockchip,cpu", 0);
- if (!cpu_node) {
- dev_err(&pdev->dev, "Property 'rockchip,cpu' missing or
invalid\n");
- return -EINVAL;
- }
+ struct device_node *np_codec;
+ struct snd_soc_dai_link *dai;
+ bool has_rt5514 = false, legacy;
+ int i, index, ret;
+
+ card->dai_link = devm_kzalloc(dev, sizeof(rockchip_dais),
+ GFP_KERNEL);
+ if (!card->dai_link)
+ return -ENOMEM;
+
+ cpu_node = of_parse_phandle(dev->of_node, "rockchip,cpu", 0);
+
+ legacy = !of_get_property(dev->of_node, "rockchip,codec-names", NULL);
+
+ card->num_links = 0;
+ for (i = 0; i < DAILINK_RT5514_DSP; i++) {
+ if (!legacy) {
+ index = of_property_match_string(dev->of_node,
+ "rockchip,codec-names",
+ rockchip_dais[i].name);
+ if (index < 0)
+ continue;
+ } else {
+ index = i;
+ }
- for (i = 0; i < DAILINK_ENTITIES; i++) {
- rockchip_dailinks[i].platform_of_node = cpu_node;
- rockchip_dailinks[i].cpu_of_node = cpu_node;
+ np_codec = of_parse_phandle(dev->of_node,
+ "rockchip,codec", index);
+ if (!np_codec) {
+ dev_err(dev, "Missing 'rockchip,codec' for %s\n",
+ rockchip_dais[i].name);
+ return -EINVAL;
+ }
+ if (!of_device_is_available(np_codec))
+ continue;
- rockchip_dailinks[i].codec_of_node =
- of_parse_phandle(pdev->dev.of_node, "rockchip,codec",
i);
- if (!rockchip_dailinks[i].codec_of_node) {
- dev_err(&pdev->dev,
- "Property[%d] 'rockchip,codec' missing or
invalid\n", i);
+ if (!cpu_node) {
+ dev_err(dev, "Missing 'rockchip,cpu' for %s\n",
+ rockchip_dais[i].name);
return -EINVAL;
}
+
+ dai = &card->dai_link[card->num_links++];
+ *dai = rockchip_dais[i];
+
+ dai->codec_of_node = np_codec;
+ dai->platform_of_node = cpu_node;
+ dai->cpu_of_node = cpu_node;
+
+ if (i == DAILINK_RT5514)
+ has_rt5514 = true;
}
+ if (!legacy && !has_rt5514)
+ return 0;
+
/**
* To acquire the spi driver of the rt5514 and set the dai-links names
* for soc_bind_dai_link
*/
- drv = driver_find("rt5514", &spi_bus_type);
- if (!drv) {
- dev_err(&pdev->dev, "Can not find the rt5514 driver at the spi
bus\n");
+ rt5514_drv = driver_find("rt5514", &spi_bus_type);
+ if (!rt5514_drv) {
+ dev_err(dev, "Can not find the rt5514 driver at the spi bus\n");
return -EINVAL;
}
- dev = driver_find_device(drv, NULL, NULL, rockchip_sound_match_stub);
- if (!dev) {
- dev_err(&pdev->dev, "Can not find the rt5514 device\n");
+ rt5514_dev = driver_find_device(rt5514_drv, NULL, NULL,
+ rockchip_sound_match_stub);
+ if (!rt5514_dev) {
+ dev_err(dev, "Can not find the rt5514 device\n");
return -ENODEV;
}
/* Set DMIC delay */
- ret = device_property_read_u32(&pdev->dev, "dmic-delay",
- &rt5514_dmic_delay);
- if (ret) {
+ ret = device_property_read_u32(dev, "dmic-delay", &rt5514_dmic_delay);
+ if (ret < 0) {
rt5514_dmic_delay = 0;
- dev_dbg(&pdev->dev,
+ dev_dbg(dev,
"no optional property 'dmic-delay' found, default: no
delay\n");
}
- rockchip_dailinks[DAILINK_RT5514_DSP].cpu_name =
kstrdup_const(dev_name(dev), GFP_KERNEL);
- rockchip_dailinks[DAILINK_RT5514_DSP].cpu_dai_name =
kstrdup_const(dev_name(dev), GFP_KERNEL);
- rockchip_dailinks[DAILINK_RT5514_DSP].platform_name =
kstrdup_const(dev_name(dev), GFP_KERNEL);
+ dai = &card->dai_link[card->num_links++];
+ *dai = rockchip_dais[DAILINK_RT5514_DSP];
+
+ dai->cpu_name = devm_kstrdup(dev, dev_name(rt5514_dev), GFP_KERNEL);
+ dai->cpu_dai_name = dai->cpu_name;
+ dai->platform_name = dai->cpu_name;
+
+ return 0;
+}
+
+static int rockchip_sound_probe(struct platform_device *pdev)
+{
+ struct snd_soc_card *card = &rockchip_sound_card;
+ int ret;
+
+ ret = rockchip_sound_of_parse_dais(&pdev->dev, card);
+ if (ret < 0) {
+ dev_err(&pdev->dev, "Failed to parse dais: %d\n", ret);
+ return ret;
+ }
card->dev = &pdev->dev;
platform_set_drvdata(pdev, card);
- ret = devm_snd_soc_register_card(&pdev->dev, card);
- if (ret)
- dev_err(&pdev->dev, "%s snd_soc_register_card fail %d\n",
- __func__, ret);
-
- return ret;
+ return devm_snd_soc_register_card(&pdev->dev, card);
}
static const struct of_device_id rockchip_sound_of_match[] = {
--
2.1.4
