mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
196 lines
5.4 KiB
196 lines
5.4 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* |
|
* mtk-dsp-sof-common.c -- MediaTek dsp sof common ctrl |
|
* |
|
* Copyright (c) 2022 MediaTek Inc. |
|
* Author: Chunxu Li <[email protected]> |
|
*/ |
|
|
|
#include "mtk-dsp-sof-common.h" |
|
#include "mtk-soc-card.h" |
|
|
|
/* fixup the BE DAI link to match any values from topology */ |
|
int mtk_sof_dai_link_fixup(struct snd_soc_pcm_runtime *rtd, |
|
struct snd_pcm_hw_params *params) |
|
{ |
|
struct snd_soc_card *card = rtd->card; |
|
struct mtk_soc_card_data *soc_card_data = snd_soc_card_get_drvdata(card); |
|
struct mtk_sof_priv *sof_priv = soc_card_data->sof_priv; |
|
int i, j, ret = 0; |
|
|
|
for (i = 0; i < sof_priv->num_streams; i++) { |
|
struct snd_soc_dai *cpu_dai; |
|
struct snd_soc_pcm_runtime *runtime; |
|
struct snd_soc_dai_link *sof_dai_link = NULL; |
|
const struct sof_conn_stream *conn = &sof_priv->conn_streams[i]; |
|
|
|
if (strcmp(rtd->dai_link->name, conn->normal_link)) |
|
continue; |
|
|
|
for_each_card_rtds(card, runtime) { |
|
if (strcmp(runtime->dai_link->name, conn->sof_link)) |
|
continue; |
|
|
|
for_each_rtd_cpu_dais(runtime, j, cpu_dai) { |
|
if (cpu_dai->stream_active[conn->stream_dir] > 0) { |
|
sof_dai_link = runtime->dai_link; |
|
break; |
|
} |
|
} |
|
break; |
|
} |
|
|
|
if (sof_dai_link && sof_dai_link->be_hw_params_fixup) |
|
ret = sof_dai_link->be_hw_params_fixup(runtime, params); |
|
|
|
break; |
|
} |
|
|
|
return ret; |
|
} |
|
EXPORT_SYMBOL_GPL(mtk_sof_dai_link_fixup); |
|
|
|
int mtk_sof_card_probe(struct snd_soc_card *card) |
|
{ |
|
int i; |
|
struct snd_soc_dai_link *dai_link; |
|
|
|
/* Set stream_name to help sof bind widgets */ |
|
for_each_card_prelinks(card, i, dai_link) { |
|
if (dai_link->no_pcm && !dai_link->stream_name && dai_link->name) |
|
dai_link->stream_name = dai_link->name; |
|
} |
|
|
|
return 0; |
|
} |
|
EXPORT_SYMBOL_GPL(mtk_sof_card_probe); |
|
|
|
int mtk_sof_card_late_probe(struct snd_soc_card *card) |
|
{ |
|
struct snd_soc_pcm_runtime *rtd; |
|
struct snd_soc_component *sof_comp = NULL; |
|
struct mtk_soc_card_data *soc_card_data = |
|
snd_soc_card_get_drvdata(card); |
|
struct mtk_sof_priv *sof_priv = soc_card_data->sof_priv; |
|
int i; |
|
|
|
/* 1. find sof component */ |
|
for_each_card_rtds(card, rtd) { |
|
sof_comp = snd_soc_rtdcom_lookup(rtd, "sof-audio-component"); |
|
if (sof_comp) |
|
break; |
|
} |
|
|
|
if (!sof_comp) { |
|
dev_info(card->dev, "probe without sof-audio-component\n"); |
|
return 0; |
|
} |
|
|
|
/* 2. add route path and fixup callback */ |
|
for (i = 0; i < sof_priv->num_streams; i++) { |
|
const struct sof_conn_stream *conn = &sof_priv->conn_streams[i]; |
|
struct snd_soc_pcm_runtime *sof_rtd = NULL; |
|
struct snd_soc_pcm_runtime *normal_rtd = NULL; |
|
|
|
for_each_card_rtds(card, rtd) { |
|
if (!strcmp(rtd->dai_link->name, conn->sof_link)) { |
|
sof_rtd = rtd; |
|
continue; |
|
} |
|
if (!strcmp(rtd->dai_link->name, conn->normal_link)) { |
|
normal_rtd = rtd; |
|
continue; |
|
} |
|
if (normal_rtd && sof_rtd) |
|
break; |
|
} |
|
if (normal_rtd && sof_rtd) { |
|
int j; |
|
struct snd_soc_dai *cpu_dai; |
|
|
|
for_each_rtd_cpu_dais(sof_rtd, j, cpu_dai) { |
|
struct snd_soc_dapm_route route; |
|
struct snd_soc_dapm_path *p = NULL; |
|
struct snd_soc_dapm_widget *play_widget = |
|
cpu_dai->playback_widget; |
|
struct snd_soc_dapm_widget *cap_widget = |
|
cpu_dai->capture_widget; |
|
memset(&route, 0, sizeof(route)); |
|
if (conn->stream_dir == SNDRV_PCM_STREAM_CAPTURE && |
|
cap_widget) { |
|
snd_soc_dapm_widget_for_each_sink_path(cap_widget, p) { |
|
route.source = conn->sof_dma; |
|
route.sink = p->sink->name; |
|
snd_soc_dapm_add_routes(&card->dapm, &route, 1); |
|
} |
|
} else if (conn->stream_dir == SNDRV_PCM_STREAM_PLAYBACK && |
|
play_widget) { |
|
snd_soc_dapm_widget_for_each_source_path(play_widget, p) { |
|
route.source = p->source->name; |
|
route.sink = conn->sof_dma; |
|
snd_soc_dapm_add_routes(&card->dapm, &route, 1); |
|
} |
|
} else { |
|
dev_err(cpu_dai->dev, "stream dir and widget not pair\n"); |
|
} |
|
} |
|
|
|
sof_rtd->dai_link->be_hw_params_fixup = |
|
sof_comp->driver->be_hw_params_fixup; |
|
if (sof_priv->sof_dai_link_fixup) |
|
normal_rtd->dai_link->be_hw_params_fixup = |
|
sof_priv->sof_dai_link_fixup; |
|
else |
|
normal_rtd->dai_link->be_hw_params_fixup = mtk_sof_dai_link_fixup; |
|
} |
|
} |
|
|
|
return 0; |
|
} |
|
EXPORT_SYMBOL_GPL(mtk_sof_card_late_probe); |
|
|
|
int mtk_sof_dailink_parse_of(struct snd_soc_card *card, struct device_node *np, |
|
const char *propname, struct snd_soc_dai_link *pre_dai_links, |
|
int pre_num_links) |
|
{ |
|
struct device *dev = card->dev; |
|
struct snd_soc_dai_link *parsed_dai_link; |
|
const char *dai_name = NULL; |
|
int i, j, ret, num_links, parsed_num_links = 0; |
|
|
|
num_links = of_property_count_strings(np, "mediatek,dai-link"); |
|
if (num_links < 0 || num_links > card->num_links) { |
|
dev_dbg(dev, "number of dai-link is invalid\n"); |
|
return -EINVAL; |
|
} |
|
|
|
parsed_dai_link = devm_kcalloc(dev, num_links, sizeof(*parsed_dai_link), GFP_KERNEL); |
|
if (!parsed_dai_link) |
|
return -ENOMEM; |
|
|
|
for (i = 0; i < num_links; i++) { |
|
ret = of_property_read_string_index(np, propname, i, &dai_name); |
|
if (ret) { |
|
dev_dbg(dev, "ASoC: Property '%s' index %d could not be read: %d\n", |
|
propname, i, ret); |
|
return ret; |
|
} |
|
dev_dbg(dev, "ASoC: Property get dai_name:%s\n", dai_name); |
|
for (j = 0; j < pre_num_links; j++) { |
|
if (!strcmp(dai_name, pre_dai_links[j].name)) { |
|
memcpy(&parsed_dai_link[parsed_num_links++], &pre_dai_links[j], |
|
sizeof(struct snd_soc_dai_link)); |
|
break; |
|
} |
|
} |
|
} |
|
|
|
if (parsed_num_links != num_links) |
|
return -EINVAL; |
|
|
|
card->dai_link = parsed_dai_link; |
|
card->num_links = parsed_num_links; |
|
|
|
return 0; |
|
} |
|
EXPORT_SYMBOL_GPL(mtk_sof_dailink_parse_of);
|
|
|