Merge tag 'asoc-v6.10' of https://git.kernel.org/pub/scm/linux/kernel/git/broonie...
[sfrench/cifs-2.6.git] / sound / soc / mediatek / common / mtk-soundcard-driver.c
index a58e1e3674deca03f71c28c3b38500375d2e5545..3bbf42c42805fbb88d6feccbd6ebe8de8eb4db8c 100644 (file)
@@ -10,6 +10,8 @@
 #include <linux/of.h>
 #include <sound/soc.h>
 
+#include "mtk-dsp-sof-common.h"
+#include "mtk-soc-card.h"
 #include "mtk-soundcard-driver.h"
 
 static int set_card_codec_info(struct snd_soc_card *card,
@@ -22,7 +24,11 @@ static int set_card_codec_info(struct snd_soc_card *card,
 
        codec_node = of_get_child_by_name(sub_node, "codec");
        if (!codec_node) {
-               dev_dbg(dev, "%s no specified codec\n", dai_link->name);
+               dev_dbg(dev, "%s no specified codec: setting dummy.\n", dai_link->name);
+
+               dai_link->codecs = &snd_soc_dummy_dlc;
+               dai_link->num_codecs = 1;
+               dai_link->dynamic = 1;
                return 0;
        }
 
@@ -132,3 +138,200 @@ void clean_card_reference(struct snd_soc_card *card)
                snd_soc_of_put_dai_link_codecs(dai_link);
 }
 EXPORT_SYMBOL_GPL(clean_card_reference);
+
+int mtk_soundcard_startup(struct snd_pcm_substream *substream,
+                         enum mtk_pcm_constraint_type ctype)
+{
+       struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
+       struct mtk_soc_card_data *soc_card = snd_soc_card_get_drvdata(rtd->card);
+       const struct mtk_pcm_constraints_data *mpc = &soc_card->card_data->pcm_constraints[ctype];
+       int ret;
+
+       if (unlikely(!mpc))
+               return -EINVAL;
+
+       ret = snd_pcm_hw_constraint_list(substream->runtime, 0,
+                                        SNDRV_PCM_HW_PARAM_RATE,
+                                        mpc->rates);
+       if (ret < 0) {
+               dev_err(rtd->dev, "hw_constraint_list rate failed\n");
+               return ret;
+       }
+
+       ret = snd_pcm_hw_constraint_list(substream->runtime, 0,
+                                        SNDRV_PCM_HW_PARAM_CHANNELS,
+                                        mpc->channels);
+       if (ret < 0) {
+               dev_err(rtd->dev, "hw_constraint_list channel failed\n");
+               return ret;
+       }
+
+       return 0;
+}
+EXPORT_SYMBOL_GPL(mtk_soundcard_startup);
+
+static int mtk_soundcard_playback_startup(struct snd_pcm_substream *substream)
+{
+       return mtk_soundcard_startup(substream, MTK_CONSTRAINT_PLAYBACK);
+}
+
+const struct snd_soc_ops mtk_soundcard_common_playback_ops = {
+       .startup = mtk_soundcard_playback_startup,
+};
+EXPORT_SYMBOL_GPL(mtk_soundcard_common_playback_ops);
+
+static int mtk_soundcard_capture_startup(struct snd_pcm_substream *substream)
+{
+       return mtk_soundcard_startup(substream, MTK_CONSTRAINT_CAPTURE);
+}
+
+const struct snd_soc_ops mtk_soundcard_common_capture_ops = {
+       .startup = mtk_soundcard_capture_startup,
+};
+EXPORT_SYMBOL_GPL(mtk_soundcard_common_capture_ops);
+
+int mtk_soundcard_common_probe(struct platform_device *pdev)
+{
+       struct device_node *platform_node, *adsp_node;
+       const struct mtk_soundcard_pdata *pdata;
+       struct mtk_soc_card_data *soc_card_data;
+       struct snd_soc_dai_link *orig_dai_link, *dai_link;
+       struct snd_soc_jack *jacks;
+       struct snd_soc_card *card;
+       int i, orig_num_links, ret;
+       bool needs_legacy_probe;
+
+       pdata = device_get_match_data(&pdev->dev);
+       if (!pdata)
+               return -EINVAL;
+
+       card = pdata->card_data->card;
+       card->dev = &pdev->dev;
+       orig_dai_link = card->dai_link;
+       orig_num_links = card->num_links;
+
+       ret = snd_soc_of_parse_card_name(card, "model");
+       if (ret)
+               return ret;
+
+       if (!card->name) {
+               if (!pdata->card_name)
+                       return -EINVAL;
+
+               card->name = pdata->card_name;
+       }
+
+       needs_legacy_probe = !of_property_read_bool(pdev->dev.of_node, "audio-routing");
+       if (needs_legacy_probe) {
+               /*
+                * If we have no .soc_probe() callback there's no way of using
+                * any legacy probe mechanism, as that cannot not be generic.
+                */
+               if (!pdata->soc_probe)
+                       return -EINVAL;
+
+               dev_info_once(&pdev->dev, "audio-routing not found: using legacy probe\n");
+       } else {
+               ret = snd_soc_of_parse_audio_routing(card, "audio-routing");
+               if (ret)
+                       return ret;
+       }
+
+       soc_card_data = devm_kzalloc(&pdev->dev, sizeof(*soc_card_data), GFP_KERNEL);
+       if (!soc_card_data)
+               return -ENOMEM;
+
+       soc_card_data->card_data = pdata->card_data;
+
+       jacks = devm_kcalloc(card->dev, soc_card_data->card_data->num_jacks,
+                            sizeof(*jacks), GFP_KERNEL);
+       if (!jacks)
+               return -ENOMEM;
+
+       soc_card_data->card_data->jacks = jacks;
+
+       platform_node = of_parse_phandle(pdev->dev.of_node, "mediatek,platform", 0);
+       if (!platform_node)
+               return dev_err_probe(&pdev->dev, -EINVAL,
+                                    "Property mediatek,platform missing or invalid\n");
+
+       /* Check if this SoC has an Audio DSP */
+       if (pdata->sof_priv)
+               adsp_node = of_parse_phandle(pdev->dev.of_node, "mediatek,adsp", 0);
+       else
+               adsp_node = NULL;
+
+       if (adsp_node) {
+               if (of_property_read_bool(pdev->dev.of_node, "mediatek,dai-link")) {
+                       ret = mtk_sof_dailink_parse_of(card, pdev->dev.of_node,
+                                                      "mediatek,dai-link",
+                                                      card->dai_link, card->num_links);
+                       if (ret) {
+                               of_node_put(adsp_node);
+                               of_node_put(platform_node);
+                               return dev_err_probe(&pdev->dev, ret,
+                                                    "Cannot parse mediatek,dai-link\n");
+                       }
+               }
+
+               soc_card_data->sof_priv = pdata->sof_priv;
+               card->probe = mtk_sof_card_probe;
+               card->late_probe = mtk_sof_card_late_probe;
+               if (!card->topology_shortname_created) {
+                       snprintf(card->topology_shortname, 32, "sof-%s", card->name);
+                       card->topology_shortname_created = true;
+               }
+               card->name = card->topology_shortname;
+       }
+
+       /*
+        * Regardless of whether the ADSP is wanted and/or present in a machine
+        * specific device tree or not and regardless of whether any AFE_SOF
+        * link is present, we have to make sure that the platforms->of_node
+        * is not NULL, and set to either ADSP (adsp_node) or AFE (platform_node).
+        */
+       for_each_card_prelinks(card, i, dai_link) {
+               if (adsp_node && !strncmp(dai_link->name, "AFE_SOF", strlen("AFE_SOF")))
+                       dai_link->platforms->of_node = adsp_node;
+               else if (!dai_link->platforms->name && !dai_link->platforms->of_node)
+                       dai_link->platforms->of_node = platform_node;
+       }
+
+       if (!needs_legacy_probe) {
+               ret = parse_dai_link_info(card);
+               if (ret)
+                       goto err_restore_dais;
+       } else {
+               if (adsp_node)
+                       of_node_put(adsp_node);
+               of_node_put(platform_node);
+       }
+
+       if (pdata->soc_probe) {
+               ret = pdata->soc_probe(soc_card_data, needs_legacy_probe);
+               if (ret) {
+                       if (!needs_legacy_probe)
+                               clean_card_reference(card);
+                       goto err_restore_dais;
+               }
+       }
+       snd_soc_card_set_drvdata(card, soc_card_data);
+
+       ret = devm_snd_soc_register_card(&pdev->dev, card);
+
+       if (!needs_legacy_probe)
+               clean_card_reference(card);
+
+       if (ret) {
+               dev_err_probe(&pdev->dev, ret, "Cannot register card\n");
+               goto err_restore_dais;
+       }
+
+       return 0;
+
+err_restore_dais:
+       card->dai_link = orig_dai_link;
+       card->num_links = orig_num_links;
+       return ret;
+}
+EXPORT_SYMBOL_GPL(mtk_soundcard_common_probe);