mediatek/common/mtk-dsp-sof-common.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * mtk-dsp-sof-common.c  --  MediaTek dsp sof common ctrl
0004  *
0005  * Copyright (c) 2022 MediaTek Inc.
0006  * Author: Chunxu Li <chunxu.li@mediatek.com>
0007  */
0008
0009 #include "mtk-dsp-sof-common.h"
0010 #include "mtk-soc-card.h"
0011
0012 /* fixup the BE DAI link to match any values from topology */
0013 int mtk_sof_dai_link_fixup(struct snd_soc_pcm_runtime *rtd,
0014                struct snd_pcm_hw_params *params)
0015 {
0016     struct snd_soc_card *card = rtd->card;
0017     struct mtk_soc_card_data *soc_card_data = snd_soc_card_get_drvdata(card);
0018     struct mtk_sof_priv *sof_priv = soc_card_data->sof_priv;
0019     int i, j, ret = 0;
0020
0021     for (i = 0; i < sof_priv->num_streams; i++) {
0022         struct snd_soc_dai *cpu_dai;
0023         struct snd_soc_pcm_runtime *runtime;
0024         struct snd_soc_dai_link *sof_dai_link = NULL;
0025         const struct sof_conn_stream *conn = &sof_priv->conn_streams[i];
0026
0027         if (strcmp(rtd->dai_link->name, conn->normal_link))
0028             continue;
0029
0030         for_each_card_rtds(card, runtime) {
0031             if (strcmp(runtime->dai_link->name, conn->sof_link))
0032                 continue;
0033
0034             for_each_rtd_cpu_dais(runtime, j, cpu_dai) {
0035                 if (cpu_dai->stream_active[conn->stream_dir] > 0) {
0036                     sof_dai_link = runtime->dai_link;
0037                     break;
0038                 }
0039             }
0040             break;
0041         }
0042
0043         if (sof_dai_link && sof_dai_link->be_hw_params_fixup)
0044             ret = sof_dai_link->be_hw_params_fixup(runtime, params);
0045
0046         break;
0047     }
0048
0049     return ret;
0050 }
0051 EXPORT_SYMBOL_GPL(mtk_sof_dai_link_fixup);
0052
0053 int mtk_sof_card_probe(struct snd_soc_card *card)
0054 {
0055     int i;
0056     struct snd_soc_dai_link *dai_link;
0057
0058     /* Set stream_name to help sof bind widgets */
0059     for_each_card_prelinks(card, i, dai_link) {
0060         if (dai_link->no_pcm && !dai_link->stream_name && dai_link->name)
0061             dai_link->stream_name = dai_link->name;
0062     }
0063
0064     return 0;
0065 }
0066 EXPORT_SYMBOL_GPL(mtk_sof_card_probe);
0067
0068 int mtk_sof_card_late_probe(struct snd_soc_card *card)
0069 {
0070     struct snd_soc_pcm_runtime *rtd;
0071     struct snd_soc_component *sof_comp = NULL;
0072     struct mtk_soc_card_data *soc_card_data =
0073         snd_soc_card_get_drvdata(card);
0074     struct mtk_sof_priv *sof_priv = soc_card_data->sof_priv;
0075     int i;
0076
0077     /* 1. find sof component */
0078     for_each_card_rtds(card, rtd) {
0079         sof_comp = snd_soc_rtdcom_lookup(rtd, "sof-audio-component");
0080         if (sof_comp)
0081             break;
0082     }
0083
0084     if (!sof_comp) {
0085         dev_info(card->dev, "probe without sof-audio-component\n");
0086         return 0;
0087     }
0088
0089     /* 2. add route path and fixup callback */
0090     for (i = 0; i < sof_priv->num_streams; i++) {
0091         const struct sof_conn_stream *conn = &sof_priv->conn_streams[i];
0092         struct snd_soc_pcm_runtime *sof_rtd = NULL;
0093         struct snd_soc_pcm_runtime *normal_rtd = NULL;
0094
0095         for_each_card_rtds(card, rtd) {
0096             if (!strcmp(rtd->dai_link->name, conn->sof_link)) {
0097                 sof_rtd = rtd;
0098                 continue;
0099             }
0100             if (!strcmp(rtd->dai_link->name, conn->normal_link)) {
0101                 normal_rtd = rtd;
0102                 continue;
0103             }
0104             if (normal_rtd && sof_rtd)
0105                 break;
0106         }
0107         if (normal_rtd && sof_rtd) {
0108             int j;
0109             struct snd_soc_dai *cpu_dai;
0110
0111             for_each_rtd_cpu_dais(sof_rtd, j, cpu_dai) {
0112                 struct snd_soc_dapm_route route;
0113                 struct snd_soc_dapm_path *p = NULL;
0114                 struct snd_soc_dapm_widget *play_widget =
0115                     cpu_dai->playback_widget;
0116                 struct snd_soc_dapm_widget *cap_widget =
0117                     cpu_dai->capture_widget;
0118                 memset(&route, 0, sizeof(route));
0119                 if (conn->stream_dir == SNDRV_PCM_STREAM_CAPTURE &&
0120                     cap_widget) {
0121                     snd_soc_dapm_widget_for_each_sink_path(cap_widget, p) {
0122                         route.source = conn->sof_dma;
0123                         route.sink = p->sink->name;
0124                         snd_soc_dapm_add_routes(&card->dapm, &route, 1);
0125                     }
0126                 } else if (conn->stream_dir == SNDRV_PCM_STREAM_PLAYBACK &&
0127                         play_widget) {
0128                     snd_soc_dapm_widget_for_each_source_path(play_widget, p) {
0129                         route.source = p->source->name;
0130                         route.sink = conn->sof_dma;
0131                         snd_soc_dapm_add_routes(&card->dapm, &route, 1);
0132                     }
0133                 } else {
0134                     dev_err(cpu_dai->dev, "stream dir and widget not pair\n");
0135                 }
0136             }
0137
0138             sof_rtd->dai_link->be_hw_params_fixup =
0139                 sof_comp->driver->be_hw_params_fixup;
0140             if (sof_priv->sof_dai_link_fixup)
0141                 normal_rtd->dai_link->be_hw_params_fixup =
0142                     sof_priv->sof_dai_link_fixup;
0143             else
0144                 normal_rtd->dai_link->be_hw_params_fixup = mtk_sof_dai_link_fixup;
0145         }
0146     }
0147
0148     return 0;
0149 }
0150 EXPORT_SYMBOL_GPL(mtk_sof_card_late_probe);
0151
0152 int mtk_sof_dailink_parse_of(struct snd_soc_card *card, struct device_node *np,
0153                  const char *propname, struct snd_soc_dai_link *pre_dai_links,
0154                  int pre_num_links)
0155 {
0156     struct device *dev = card->dev;
0157     struct snd_soc_dai_link *parsed_dai_link;
0158     const char *dai_name = NULL;
0159     int i, j, ret, num_links, parsed_num_links = 0;
0160
0161     num_links = of_property_count_strings(np, "mediatek,dai-link");
0162     if (num_links < 0 || num_links > card->num_links) {
0163         dev_dbg(dev, "number of dai-link is invalid\n");
0164         return -EINVAL;
0165     }
0166
0167     parsed_dai_link = devm_kcalloc(dev, num_links, sizeof(*parsed_dai_link), GFP_KERNEL);
0168     if (!parsed_dai_link)
0169         return -ENOMEM;
0170
0171     for (i = 0; i < num_links; i++) {
0172         ret = of_property_read_string_index(np, propname, i, &dai_name);
0173         if (ret) {
0174             dev_dbg(dev, "ASoC: Property '%s' index %d could not be read: %d\n",
0175                 propname, i, ret);
0176             return ret;
0177         }
0178         dev_dbg(dev, "ASoC: Property get dai_name:%s\n", dai_name);
0179         for (j = 0; j < pre_num_links; j++) {
0180             if (!strcmp(dai_name, pre_dai_links[j].name)) {
0181                 memcpy(&parsed_dai_link[parsed_num_links++], &pre_dai_links[j],
0182                        sizeof(struct snd_soc_dai_link));
0183                 break;
0184             }
0185         }
0186     }
0187
0188     if (parsed_num_links != num_links)
0189         return -EINVAL;
0190
0191     card->dai_link = parsed_dai_link;
0192     card->num_links = parsed_num_links;
0193
0194     return 0;
0195 }
0196 EXPORT_SYMBOL_GPL(mtk_sof_dailink_parse_of);