mirror of
https://github.com/torvalds/linux.git
synced 2024-11-26 06:02:05 +00:00
6558e8737a
There is no need to keep separate token list for dai and 'common' copier token list when the 'common' list is actually the aif list, the SOF_COPIER_DEEP_BUFFER_TOKENS are not applicable for buffers. We could have separate lists for all types but it is probably simpler to just use a single list for all types of copiers. Function specific tokens will be only parsed by function specific code anyways. Reviewed-by: Bard Liao <yung-chuan.liao@linux.intel.com> Reviewed-by: Ranjani Sridharan <ranjani.sridharan@linux.intel.com> Signed-off-by: Peter Ujfalusi <peter.ujfalusi@linux.intel.com> Signed-off-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com> Link: https://patch.msgid.link/20240704085944.371450-1-pierre-louis.bossart@linux.intel.com Signed-off-by: Mark Brown <broonie@kernel.org>
3421 lines
105 KiB
C
3421 lines
105 KiB
C
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
|
|
//
|
|
// This file is provided under a dual BSD/GPLv2 license. When using or
|
|
// redistributing this file, you may do so under either license.
|
|
//
|
|
// Copyright(c) 2022 Intel Corporation
|
|
//
|
|
//
|
|
#include <linux/bitfield.h>
|
|
#include <uapi/sound/sof/tokens.h>
|
|
#include <sound/pcm_params.h>
|
|
#include <sound/sof/ext_manifest4.h>
|
|
#include <sound/intel-nhlt.h>
|
|
#include "sof-priv.h"
|
|
#include "sof-audio.h"
|
|
#include "ipc4-priv.h"
|
|
#include "ipc4-topology.h"
|
|
#include "ops.h"
|
|
|
|
/*
|
|
* The ignore_cpc flag can be used to ignore the CPC value for all modules by
|
|
* using 0 instead.
|
|
* The CPC is sent to the firmware along with the SOF_IPC4_MOD_INIT_INSTANCE
|
|
* message and it is used for clock scaling.
|
|
* 0 as CPC value will instruct the firmware to use maximum frequency, thus
|
|
* deactivating the clock scaling.
|
|
*/
|
|
static bool ignore_cpc;
|
|
module_param_named(ipc4_ignore_cpc, ignore_cpc, bool, 0444);
|
|
MODULE_PARM_DESC(ipc4_ignore_cpc,
|
|
"Ignore CPC values. This option will disable clock scaling in firmware.");
|
|
|
|
#define SOF_IPC4_GAIN_PARAM_ID 0
|
|
#define SOF_IPC4_TPLG_ABI_SIZE 6
|
|
#define SOF_IPC4_CHAIN_DMA_BUF_SIZE_MS 2
|
|
|
|
static DEFINE_IDA(alh_group_ida);
|
|
static DEFINE_IDA(pipeline_ida);
|
|
|
|
static const struct sof_topology_token ipc4_sched_tokens[] = {
|
|
{SOF_TKN_SCHED_LP_MODE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pipeline, lp_mode)},
|
|
{SOF_TKN_SCHED_USE_CHAIN_DMA, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
|
|
offsetof(struct sof_ipc4_pipeline, use_chain_dma)},
|
|
{SOF_TKN_SCHED_CORE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pipeline, core_id)},
|
|
{SOF_TKN_SCHED_PRIORITY, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pipeline, priority)},
|
|
};
|
|
|
|
static const struct sof_topology_token pipeline_tokens[] = {
|
|
{SOF_TKN_SCHED_DYNAMIC_PIPELINE, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
|
|
offsetof(struct snd_sof_widget, dynamic_pipeline_widget)},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_comp_tokens[] = {
|
|
{SOF_TKN_COMP_IS_PAGES, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_base_module_cfg, is_pages)},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_in_audio_format_tokens[] = {
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.sampling_frequency)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_BIT_DEPTH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.bit_depth)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_CH_MAP, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.ch_map)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_CH_CFG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.ch_cfg)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_INTERLEAVING_STYLE, SND_SOC_TPLG_TUPLE_TYPE_WORD,
|
|
get_token_u32, offsetof(struct sof_ipc4_pin_format,
|
|
audio_fmt.interleaving_style)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IN_FMT_CFG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.fmt_cfg)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_INPUT_PIN_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, pin_index)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_IBS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, buffer_size)},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_out_audio_format_tokens[] = {
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.sampling_frequency)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_BIT_DEPTH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.bit_depth)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_CH_MAP, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.ch_map)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_CH_CFG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.ch_cfg)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_INTERLEAVING_STYLE, SND_SOC_TPLG_TUPLE_TYPE_WORD,
|
|
get_token_u32, offsetof(struct sof_ipc4_pin_format,
|
|
audio_fmt.interleaving_style)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUT_FMT_CFG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, audio_fmt.fmt_cfg)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OUTPUT_PIN_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, pin_index)},
|
|
{SOF_TKN_CAVS_AUDIO_FORMAT_OBS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_pin_format, buffer_size)},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_copier_deep_buffer_tokens[] = {
|
|
{SOF_TKN_INTEL_COPIER_DEEP_BUFFER_DMA_MS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32, 0},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_copier_tokens[] = {
|
|
{SOF_TKN_INTEL_COPIER_NODE_TYPE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32, 0},
|
|
};
|
|
|
|
static const struct sof_topology_token ipc4_audio_fmt_num_tokens[] = {
|
|
{SOF_TKN_COMP_NUM_INPUT_AUDIO_FORMATS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_available_audio_format, num_input_formats)},
|
|
{SOF_TKN_COMP_NUM_OUTPUT_AUDIO_FORMATS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_available_audio_format, num_output_formats)},
|
|
};
|
|
|
|
static const struct sof_topology_token dai_tokens[] = {
|
|
{SOF_TKN_DAI_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_dai_type,
|
|
offsetof(struct sof_ipc4_copier, dai_type)},
|
|
{SOF_TKN_DAI_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_copier, dai_index)},
|
|
};
|
|
|
|
/* Component extended tokens */
|
|
static const struct sof_topology_token comp_ext_tokens[] = {
|
|
{SOF_TKN_COMP_UUID, SND_SOC_TPLG_TUPLE_TYPE_UUID, get_token_uuid,
|
|
offsetof(struct snd_sof_widget, uuid)},
|
|
{SOF_TKN_COMP_CORE_ID, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct snd_sof_widget, core)},
|
|
};
|
|
|
|
static const struct sof_topology_token gain_tokens[] = {
|
|
{SOF_TKN_GAIN_RAMP_TYPE, SND_SOC_TPLG_TUPLE_TYPE_WORD,
|
|
get_token_u32, offsetof(struct sof_ipc4_gain_params, curve_type)},
|
|
{SOF_TKN_GAIN_RAMP_DURATION,
|
|
SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_gain_params, curve_duration_l)},
|
|
{SOF_TKN_GAIN_VAL, SND_SOC_TPLG_TUPLE_TYPE_WORD,
|
|
get_token_u32, offsetof(struct sof_ipc4_gain_params, init_val)},
|
|
};
|
|
|
|
/* SRC */
|
|
static const struct sof_topology_token src_tokens[] = {
|
|
{SOF_TKN_SRC_RATE_OUT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
|
|
offsetof(struct sof_ipc4_src_data, sink_rate)},
|
|
};
|
|
|
|
static const struct sof_token_info ipc4_token_list[SOF_TOKEN_COUNT] = {
|
|
[SOF_DAI_TOKENS] = {"DAI tokens", dai_tokens, ARRAY_SIZE(dai_tokens)},
|
|
[SOF_PIPELINE_TOKENS] = {"Pipeline tokens", pipeline_tokens, ARRAY_SIZE(pipeline_tokens)},
|
|
[SOF_SCHED_TOKENS] = {"Scheduler tokens", ipc4_sched_tokens,
|
|
ARRAY_SIZE(ipc4_sched_tokens)},
|
|
[SOF_COMP_EXT_TOKENS] = {"Comp extended tokens", comp_ext_tokens,
|
|
ARRAY_SIZE(comp_ext_tokens)},
|
|
[SOF_COMP_TOKENS] = {"IPC4 Component tokens",
|
|
ipc4_comp_tokens, ARRAY_SIZE(ipc4_comp_tokens)},
|
|
[SOF_IN_AUDIO_FORMAT_TOKENS] = {"IPC4 Input Audio format tokens",
|
|
ipc4_in_audio_format_tokens, ARRAY_SIZE(ipc4_in_audio_format_tokens)},
|
|
[SOF_OUT_AUDIO_FORMAT_TOKENS] = {"IPC4 Output Audio format tokens",
|
|
ipc4_out_audio_format_tokens, ARRAY_SIZE(ipc4_out_audio_format_tokens)},
|
|
[SOF_COPIER_DEEP_BUFFER_TOKENS] = {"IPC4 Copier deep buffer tokens",
|
|
ipc4_copier_deep_buffer_tokens, ARRAY_SIZE(ipc4_copier_deep_buffer_tokens)},
|
|
[SOF_COPIER_TOKENS] = {"IPC4 Copier tokens", ipc4_copier_tokens,
|
|
ARRAY_SIZE(ipc4_copier_tokens)},
|
|
[SOF_AUDIO_FMT_NUM_TOKENS] = {"IPC4 Audio format number tokens",
|
|
ipc4_audio_fmt_num_tokens, ARRAY_SIZE(ipc4_audio_fmt_num_tokens)},
|
|
[SOF_GAIN_TOKENS] = {"Gain tokens", gain_tokens, ARRAY_SIZE(gain_tokens)},
|
|
[SOF_SRC_TOKENS] = {"SRC tokens", src_tokens, ARRAY_SIZE(src_tokens)},
|
|
};
|
|
|
|
struct snd_sof_widget *sof_ipc4_find_swidget_by_ids(struct snd_sof_dev *sdev,
|
|
u32 module_id, int instance_id)
|
|
{
|
|
struct snd_sof_widget *swidget;
|
|
|
|
list_for_each_entry(swidget, &sdev->widget_list, list) {
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
|
|
/* Only active module instances have valid instance_id */
|
|
if (!swidget->use_count)
|
|
continue;
|
|
|
|
if (fw_module && fw_module->man4_module_entry.id == module_id &&
|
|
swidget->instance_id == instance_id)
|
|
return swidget;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static void sof_ipc4_dbg_audio_format(struct device *dev, struct sof_ipc4_pin_format *pin_fmt,
|
|
int num_formats)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < num_formats; i++) {
|
|
struct sof_ipc4_audio_format *fmt = &pin_fmt[i].audio_fmt;
|
|
dev_dbg(dev,
|
|
"Pin index #%d: %uHz, %ubit, %luch (ch_map %#x ch_cfg %u interleaving_style %u fmt_cfg %#x) buffer size %d\n",
|
|
pin_fmt[i].pin_index, fmt->sampling_frequency, fmt->bit_depth,
|
|
SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg),
|
|
fmt->ch_map, fmt->ch_cfg, fmt->interleaving_style, fmt->fmt_cfg,
|
|
pin_fmt[i].buffer_size);
|
|
}
|
|
}
|
|
|
|
static const struct sof_ipc4_audio_format *
|
|
sof_ipc4_get_input_pin_audio_fmt(struct snd_sof_widget *swidget, int pin_index)
|
|
{
|
|
struct sof_ipc4_base_module_cfg_ext *base_cfg_ext;
|
|
struct sof_ipc4_process *process;
|
|
int i;
|
|
|
|
if (swidget->id != snd_soc_dapm_effect) {
|
|
struct sof_ipc4_base_module_cfg *base = swidget->private;
|
|
|
|
/* For non-process modules, base module config format is used for all input pins */
|
|
return &base->audio_fmt;
|
|
}
|
|
|
|
process = swidget->private;
|
|
|
|
/*
|
|
* For process modules without base config extension, base module config
|
|
* format is used for all input pins
|
|
*/
|
|
if (process->init_config != SOF_IPC4_MODULE_INIT_CONFIG_TYPE_BASE_CFG_WITH_EXT)
|
|
return &process->base_config.audio_fmt;
|
|
|
|
base_cfg_ext = process->base_config_ext;
|
|
|
|
/*
|
|
* If there are multiple input formats available for a pin, the first available format
|
|
* is chosen.
|
|
*/
|
|
for (i = 0; i < base_cfg_ext->num_input_pin_fmts; i++) {
|
|
struct sof_ipc4_pin_format *pin_format = &base_cfg_ext->pin_formats[i];
|
|
|
|
if (pin_format->pin_index == pin_index)
|
|
return &pin_format->audio_fmt;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/**
|
|
* sof_ipc4_get_audio_fmt - get available audio formats from swidget->tuples
|
|
* @scomp: pointer to pointer to SOC component
|
|
* @swidget: pointer to struct snd_sof_widget containing tuples
|
|
* @available_fmt: pointer to struct sof_ipc4_available_audio_format being filling in
|
|
* @module_base_cfg: Pointer to the base_config in the module init IPC payload
|
|
*
|
|
* Return: 0 if successful
|
|
*/
|
|
static int sof_ipc4_get_audio_fmt(struct snd_soc_component *scomp,
|
|
struct snd_sof_widget *swidget,
|
|
struct sof_ipc4_available_audio_format *available_fmt,
|
|
struct sof_ipc4_base_module_cfg *module_base_cfg)
|
|
{
|
|
struct sof_ipc4_pin_format *in_format = NULL;
|
|
struct sof_ipc4_pin_format *out_format;
|
|
int ret;
|
|
|
|
ret = sof_update_ipc_object(scomp, available_fmt,
|
|
SOF_AUDIO_FMT_NUM_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*available_fmt), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "Failed to parse audio format token count\n");
|
|
return ret;
|
|
}
|
|
|
|
if (!available_fmt->num_input_formats && !available_fmt->num_output_formats) {
|
|
dev_err(scomp->dev, "No input/output pin formats set in topology\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
dev_dbg(scomp->dev,
|
|
"Number of input audio formats: %d. Number of output audio formats: %d\n",
|
|
available_fmt->num_input_formats, available_fmt->num_output_formats);
|
|
|
|
/* set is_pages in the module's base_config */
|
|
ret = sof_update_ipc_object(scomp, module_base_cfg, SOF_COMP_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*module_base_cfg), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse comp tokens for %s failed, error: %d\n",
|
|
swidget->widget->name, ret);
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(scomp->dev, "widget %s: is_pages: %d\n", swidget->widget->name,
|
|
module_base_cfg->is_pages);
|
|
|
|
if (available_fmt->num_input_formats) {
|
|
in_format = kcalloc(available_fmt->num_input_formats,
|
|
sizeof(*in_format), GFP_KERNEL);
|
|
if (!in_format)
|
|
return -ENOMEM;
|
|
available_fmt->input_pin_fmts = in_format;
|
|
|
|
ret = sof_update_ipc_object(scomp, in_format,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*in_format),
|
|
available_fmt->num_input_formats);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse input audio fmt tokens failed %d\n", ret);
|
|
goto err_in;
|
|
}
|
|
|
|
dev_dbg(scomp->dev, "Input audio formats for %s\n", swidget->widget->name);
|
|
sof_ipc4_dbg_audio_format(scomp->dev, in_format,
|
|
available_fmt->num_input_formats);
|
|
}
|
|
|
|
if (available_fmt->num_output_formats) {
|
|
out_format = kcalloc(available_fmt->num_output_formats, sizeof(*out_format),
|
|
GFP_KERNEL);
|
|
if (!out_format) {
|
|
ret = -ENOMEM;
|
|
goto err_in;
|
|
}
|
|
|
|
ret = sof_update_ipc_object(scomp, out_format,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*out_format),
|
|
available_fmt->num_output_formats);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse output audio fmt tokens failed\n");
|
|
goto err_out;
|
|
}
|
|
|
|
available_fmt->output_pin_fmts = out_format;
|
|
dev_dbg(scomp->dev, "Output audio formats for %s\n", swidget->widget->name);
|
|
sof_ipc4_dbg_audio_format(scomp->dev, out_format,
|
|
available_fmt->num_output_formats);
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_out:
|
|
kfree(out_format);
|
|
err_in:
|
|
kfree(in_format);
|
|
available_fmt->input_pin_fmts = NULL;
|
|
return ret;
|
|
}
|
|
|
|
/* release the memory allocated in sof_ipc4_get_audio_fmt */
|
|
static void sof_ipc4_free_audio_fmt(struct sof_ipc4_available_audio_format *available_fmt)
|
|
|
|
{
|
|
kfree(available_fmt->output_pin_fmts);
|
|
available_fmt->output_pin_fmts = NULL;
|
|
kfree(available_fmt->input_pin_fmts);
|
|
available_fmt->input_pin_fmts = NULL;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_pipeline(struct snd_sof_widget *swidget)
|
|
{
|
|
kfree(swidget->private);
|
|
}
|
|
|
|
static int sof_ipc4_widget_set_module_info(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
|
|
swidget->module_info = sof_ipc4_find_module_by_uuid(sdev, &swidget->uuid);
|
|
|
|
if (swidget->module_info)
|
|
return 0;
|
|
|
|
dev_err(sdev->dev, "failed to find module info for widget %s with UUID %pUL\n",
|
|
swidget->widget->name, &swidget->uuid);
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_msg(struct snd_sof_widget *swidget, struct sof_ipc4_msg *msg)
|
|
{
|
|
struct sof_ipc4_fw_module *fw_module;
|
|
uint32_t type;
|
|
int ret;
|
|
|
|
ret = sof_ipc4_widget_set_module_info(swidget);
|
|
if (ret)
|
|
return ret;
|
|
|
|
fw_module = swidget->module_info;
|
|
|
|
msg->primary = fw_module->man4_module_entry.id;
|
|
msg->primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_INIT_INSTANCE);
|
|
msg->primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
msg->primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
msg->extension = SOF_IPC4_MOD_EXT_CORE_ID(swidget->core);
|
|
|
|
type = (fw_module->man4_module_entry.type & SOF_IPC4_MODULE_DP) ? 1 : 0;
|
|
msg->extension |= SOF_IPC4_MOD_EXT_DOMAIN(type);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sof_ipc4_widget_update_kcontrol_module_id(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
struct snd_sof_control *scontrol;
|
|
|
|
/* update module ID for all kcontrols for this widget */
|
|
list_for_each_entry(scontrol, &sdev->kcontrol_list, list) {
|
|
if (scontrol->comp_id == swidget->comp_id) {
|
|
struct sof_ipc4_control_data *cdata = scontrol->ipc_control_data;
|
|
struct sof_ipc4_msg *msg = &cdata->msg;
|
|
|
|
msg->primary |= fw_module->man4_module_entry.id;
|
|
}
|
|
}
|
|
}
|
|
|
|
static int
|
|
sof_ipc4_update_card_components_string(struct snd_sof_widget *swidget,
|
|
struct snd_sof_pcm *spcm, int dir)
|
|
{
|
|
struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline = pipe_widget->private;
|
|
struct snd_soc_component *scomp = spcm->scomp;
|
|
struct snd_soc_card *card = scomp->card;
|
|
const char *pt_marker = "iec61937-pcm";
|
|
|
|
/*
|
|
* Update the card's components list with iec61937-pcm and a list of PCM
|
|
* ids where ChainDMA is enabled.
|
|
* These PCMs can be used for bytestream passthrough.
|
|
*/
|
|
if (!pipeline->use_chain_dma)
|
|
return 0;
|
|
|
|
if (card->components) {
|
|
const char *tmp = card->components;
|
|
|
|
if (strstr(card->components, pt_marker))
|
|
card->components = devm_kasprintf(card->dev, GFP_KERNEL,
|
|
"%s,%d",
|
|
card->components,
|
|
spcm->pcm.pcm_id);
|
|
else
|
|
card->components = devm_kasprintf(card->dev, GFP_KERNEL,
|
|
"%s %s:%d",
|
|
card->components,
|
|
pt_marker,
|
|
spcm->pcm.pcm_id);
|
|
|
|
devm_kfree(card->dev, tmp);
|
|
} else {
|
|
card->components = devm_kasprintf(card->dev, GFP_KERNEL,
|
|
"%s:%d", pt_marker,
|
|
spcm->pcm.pcm_id);
|
|
}
|
|
|
|
if (!card->components)
|
|
return -ENOMEM;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_pcm(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
struct snd_sof_pcm *spcm;
|
|
int node_type = 0;
|
|
int ret, dir;
|
|
|
|
ipc4_copier = kzalloc(sizeof(*ipc4_copier), GFP_KERNEL);
|
|
if (!ipc4_copier)
|
|
return -ENOMEM;
|
|
|
|
swidget->private = ipc4_copier;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
dev_dbg(scomp->dev, "Updating IPC structure for %s\n", swidget->widget->name);
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, available_fmt,
|
|
&ipc4_copier->data.base_config);
|
|
if (ret)
|
|
goto free_copier;
|
|
|
|
/*
|
|
* This callback is used by host copier and module-to-module copier,
|
|
* and only host copier needs to set gtw_cfg.
|
|
*/
|
|
if (!WIDGET_IS_AIF(swidget->id))
|
|
goto skip_gtw_cfg;
|
|
|
|
ret = sof_update_ipc_object(scomp, &node_type,
|
|
SOF_COPIER_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(node_type), 1);
|
|
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse host copier node type token failed %d\n",
|
|
ret);
|
|
goto free_available_fmt;
|
|
}
|
|
dev_dbg(scomp->dev, "host copier '%s' node_type %u\n", swidget->widget->name, node_type);
|
|
|
|
spcm = snd_sof_find_spcm_comp(scomp, swidget->comp_id, &dir);
|
|
if (!spcm)
|
|
goto skip_gtw_cfg;
|
|
|
|
ret = sof_ipc4_update_card_components_string(swidget, spcm, dir);
|
|
if (ret)
|
|
goto free_available_fmt;
|
|
|
|
if (dir == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
struct snd_sof_pcm_stream *sps = &spcm->stream[dir];
|
|
|
|
sof_update_ipc_object(scomp, &sps->dsp_max_burst_size_in_ms,
|
|
SOF_COPIER_DEEP_BUFFER_TOKENS,
|
|
swidget->tuples,
|
|
swidget->num_tuples, sizeof(u32), 1);
|
|
/* Set default DMA buffer size if it is not specified in topology */
|
|
if (!sps->dsp_max_burst_size_in_ms)
|
|
sps->dsp_max_burst_size_in_ms = SOF_IPC4_MIN_DMA_BUFFER_SIZE;
|
|
} else {
|
|
/* Capture data is copied from DSP to host in 1ms bursts */
|
|
spcm->stream[dir].dsp_max_burst_size_in_ms = 1;
|
|
}
|
|
|
|
skip_gtw_cfg:
|
|
ipc4_copier->gtw_attr = kzalloc(sizeof(*ipc4_copier->gtw_attr), GFP_KERNEL);
|
|
if (!ipc4_copier->gtw_attr) {
|
|
ret = -ENOMEM;
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
ipc4_copier->copier_config = (uint32_t *)ipc4_copier->gtw_attr;
|
|
ipc4_copier->data.gtw_cfg.config_length =
|
|
sizeof(struct sof_ipc4_gtw_attributes) >> 2;
|
|
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_aif_in:
|
|
case snd_soc_dapm_aif_out:
|
|
ipc4_copier->data.gtw_cfg.node_id = SOF_IPC4_NODE_TYPE(node_type);
|
|
break;
|
|
case snd_soc_dapm_buffer:
|
|
ipc4_copier->data.gtw_cfg.node_id = SOF_IPC4_INVALID_NODE_ID;
|
|
ipc4_copier->ipc_config_size = 0;
|
|
break;
|
|
default:
|
|
dev_err(scomp->dev, "invalid widget type %d\n", swidget->id);
|
|
ret = -EINVAL;
|
|
goto free_gtw_attr;
|
|
}
|
|
|
|
/* set up module info and message header */
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &ipc4_copier->msg);
|
|
if (ret)
|
|
goto free_gtw_attr;
|
|
|
|
return 0;
|
|
|
|
free_gtw_attr:
|
|
kfree(ipc4_copier->gtw_attr);
|
|
free_available_fmt:
|
|
sof_ipc4_free_audio_fmt(available_fmt);
|
|
free_copier:
|
|
kfree(ipc4_copier);
|
|
swidget->private = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_pcm(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_copier *ipc4_copier = swidget->private;
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
|
|
if (!ipc4_copier)
|
|
return;
|
|
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
kfree(available_fmt->output_pin_fmts);
|
|
kfree(ipc4_copier->gtw_attr);
|
|
kfree(ipc4_copier);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_comp_dai(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct snd_sof_dai *dai = swidget->private;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
struct snd_sof_widget *pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
int node_type = 0;
|
|
int ret;
|
|
|
|
ipc4_copier = kzalloc(sizeof(*ipc4_copier), GFP_KERNEL);
|
|
if (!ipc4_copier)
|
|
return -ENOMEM;
|
|
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
dev_dbg(scomp->dev, "Updating IPC structure for %s\n", swidget->widget->name);
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, available_fmt,
|
|
&ipc4_copier->data.base_config);
|
|
if (ret)
|
|
goto free_copier;
|
|
|
|
ret = sof_update_ipc_object(scomp, &node_type,
|
|
SOF_COPIER_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(node_type), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse dai node type failed %d\n", ret);
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
ret = sof_update_ipc_object(scomp, ipc4_copier,
|
|
SOF_DAI_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(u32), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parse dai copier node token failed %d\n", ret);
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
dev_dbg(scomp->dev, "dai %s node_type %u dai_type %u dai_index %d\n", swidget->widget->name,
|
|
node_type, ipc4_copier->dai_type, ipc4_copier->dai_index);
|
|
|
|
dai->type = ipc4_copier->dai_type;
|
|
ipc4_copier->data.gtw_cfg.node_id = SOF_IPC4_NODE_TYPE(node_type);
|
|
|
|
pipe_widget = swidget->spipe->pipe_widget;
|
|
pipeline = pipe_widget->private;
|
|
|
|
if (pipeline->use_chain_dma &&
|
|
!snd_sof_is_chain_dma_supported(sdev, ipc4_copier->dai_type)) {
|
|
dev_err(scomp->dev, "Bad DAI type '%d', Chain DMA is not supported\n",
|
|
ipc4_copier->dai_type);
|
|
ret = -ENODEV;
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
switch (ipc4_copier->dai_type) {
|
|
case SOF_DAI_INTEL_ALH:
|
|
{
|
|
struct sof_ipc4_alh_configuration_blob *blob;
|
|
struct snd_soc_dapm_path *p;
|
|
struct snd_sof_widget *w;
|
|
int src_num = 0;
|
|
|
|
snd_soc_dapm_widget_for_each_source_path(swidget->widget, p)
|
|
src_num++;
|
|
|
|
if (swidget->id == snd_soc_dapm_dai_in && src_num == 0) {
|
|
/*
|
|
* The blob will not be used if the ALH copier is playback direction
|
|
* and doesn't connect to any source.
|
|
* It is fine to call kfree(ipc4_copier->copier_config) since
|
|
* ipc4_copier->copier_config is null.
|
|
*/
|
|
ret = 0;
|
|
break;
|
|
}
|
|
|
|
blob = kzalloc(sizeof(*blob), GFP_KERNEL);
|
|
if (!blob) {
|
|
ret = -ENOMEM;
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
list_for_each_entry(w, &sdev->widget_list, list) {
|
|
if (w->widget->sname &&
|
|
strcmp(w->widget->sname, swidget->widget->sname))
|
|
continue;
|
|
|
|
blob->alh_cfg.device_count++;
|
|
}
|
|
|
|
ipc4_copier->copier_config = (uint32_t *)blob;
|
|
/* set data.gtw_cfg.config_length based on device_count */
|
|
ipc4_copier->data.gtw_cfg.config_length = (sizeof(blob->gw_attr) +
|
|
sizeof(blob->alh_cfg.device_count) +
|
|
sizeof(*blob->alh_cfg.mapping) *
|
|
blob->alh_cfg.device_count) >> 2;
|
|
break;
|
|
}
|
|
case SOF_DAI_INTEL_SSP:
|
|
/* set SSP DAI index as the node_id */
|
|
ipc4_copier->data.gtw_cfg.node_id |=
|
|
SOF_IPC4_NODE_INDEX_INTEL_SSP(ipc4_copier->dai_index);
|
|
break;
|
|
case SOF_DAI_INTEL_DMIC:
|
|
/* set DMIC DAI index as the node_id */
|
|
ipc4_copier->data.gtw_cfg.node_id |=
|
|
SOF_IPC4_NODE_INDEX_INTEL_DMIC(ipc4_copier->dai_index);
|
|
break;
|
|
default:
|
|
ipc4_copier->gtw_attr = kzalloc(sizeof(*ipc4_copier->gtw_attr), GFP_KERNEL);
|
|
if (!ipc4_copier->gtw_attr) {
|
|
ret = -ENOMEM;
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
ipc4_copier->copier_config = (uint32_t *)ipc4_copier->gtw_attr;
|
|
ipc4_copier->data.gtw_cfg.config_length =
|
|
sizeof(struct sof_ipc4_gtw_attributes) >> 2;
|
|
break;
|
|
}
|
|
|
|
dai->scomp = scomp;
|
|
dai->private = ipc4_copier;
|
|
|
|
/* set up module info and message header */
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &ipc4_copier->msg);
|
|
if (ret)
|
|
goto free_copier_config;
|
|
|
|
return 0;
|
|
|
|
free_copier_config:
|
|
kfree(ipc4_copier->copier_config);
|
|
free_available_fmt:
|
|
sof_ipc4_free_audio_fmt(available_fmt);
|
|
free_copier:
|
|
kfree(ipc4_copier);
|
|
dai->private = NULL;
|
|
dai->scomp = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_dai(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
struct snd_sof_dai *dai = swidget->private;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
|
|
if (!dai)
|
|
return;
|
|
|
|
if (!dai->private) {
|
|
kfree(dai);
|
|
swidget->private = NULL;
|
|
return;
|
|
}
|
|
|
|
ipc4_copier = dai->private;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
kfree(available_fmt->output_pin_fmts);
|
|
if (ipc4_copier->dai_type != SOF_DAI_INTEL_SSP &&
|
|
ipc4_copier->dai_type != SOF_DAI_INTEL_DMIC)
|
|
kfree(ipc4_copier->copier_config);
|
|
kfree(dai->private);
|
|
kfree(dai);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_comp_pipeline(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
struct snd_sof_pipeline *spipe = swidget->spipe;
|
|
int ret;
|
|
|
|
pipeline = kzalloc(sizeof(*pipeline), GFP_KERNEL);
|
|
if (!pipeline)
|
|
return -ENOMEM;
|
|
|
|
ret = sof_update_ipc_object(scomp, pipeline, SOF_SCHED_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*pipeline), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parsing scheduler tokens failed\n");
|
|
goto err;
|
|
}
|
|
|
|
swidget->core = pipeline->core_id;
|
|
spipe->core_mask |= BIT(pipeline->core_id);
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
dev_dbg(scomp->dev, "Set up chain DMA for %s\n", swidget->widget->name);
|
|
swidget->private = pipeline;
|
|
return 0;
|
|
}
|
|
|
|
/* parse one set of pipeline tokens */
|
|
ret = sof_update_ipc_object(scomp, swidget, SOF_PIPELINE_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*swidget), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "parsing pipeline tokens failed\n");
|
|
goto err;
|
|
}
|
|
|
|
dev_dbg(scomp->dev, "pipeline '%s': id %d, pri %d, core_id %u, lp mode %d\n",
|
|
swidget->widget->name, swidget->pipeline_id,
|
|
pipeline->priority, pipeline->core_id, pipeline->lp_mode);
|
|
|
|
swidget->private = pipeline;
|
|
|
|
pipeline->msg.primary = SOF_IPC4_GLB_PIPE_PRIORITY(pipeline->priority);
|
|
pipeline->msg.primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_GLB_CREATE_PIPELINE);
|
|
pipeline->msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
pipeline->msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_FW_GEN_MSG);
|
|
|
|
pipeline->msg.extension = pipeline->lp_mode;
|
|
pipeline->msg.extension |= SOF_IPC4_GLB_PIPE_EXT_CORE_ID(pipeline->core_id);
|
|
pipeline->state = SOF_IPC4_PIPE_UNINITIALIZED;
|
|
|
|
return 0;
|
|
err:
|
|
kfree(pipeline);
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_comp_pga(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct sof_ipc4_gain *gain;
|
|
int ret;
|
|
|
|
gain = kzalloc(sizeof(*gain), GFP_KERNEL);
|
|
if (!gain)
|
|
return -ENOMEM;
|
|
|
|
swidget->private = gain;
|
|
|
|
gain->data.params.channels = SOF_IPC4_GAIN_ALL_CHANNELS_MASK;
|
|
gain->data.params.init_val = SOF_IPC4_VOL_ZERO_DB;
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, &gain->available_fmt, &gain->data.base_config);
|
|
if (ret)
|
|
goto err;
|
|
|
|
ret = sof_update_ipc_object(scomp, &gain->data.params, SOF_GAIN_TOKENS,
|
|
swidget->tuples, swidget->num_tuples, sizeof(gain->data), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "Parsing gain tokens failed\n");
|
|
goto err;
|
|
}
|
|
|
|
dev_dbg(scomp->dev,
|
|
"pga widget %s: ramp type: %d, ramp duration %d, initial gain value: %#x\n",
|
|
swidget->widget->name, gain->data.params.curve_type,
|
|
gain->data.params.curve_duration_l, gain->data.params.init_val);
|
|
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &gain->msg);
|
|
if (ret)
|
|
goto err;
|
|
|
|
sof_ipc4_widget_update_kcontrol_module_id(swidget);
|
|
|
|
return 0;
|
|
err:
|
|
sof_ipc4_free_audio_fmt(&gain->available_fmt);
|
|
kfree(gain);
|
|
swidget->private = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_pga(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_gain *gain = swidget->private;
|
|
|
|
if (!gain)
|
|
return;
|
|
|
|
sof_ipc4_free_audio_fmt(&gain->available_fmt);
|
|
kfree(swidget->private);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_comp_mixer(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct sof_ipc4_mixer *mixer;
|
|
int ret;
|
|
|
|
dev_dbg(scomp->dev, "Updating IPC structure for %s\n", swidget->widget->name);
|
|
|
|
mixer = kzalloc(sizeof(*mixer), GFP_KERNEL);
|
|
if (!mixer)
|
|
return -ENOMEM;
|
|
|
|
swidget->private = mixer;
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, &mixer->available_fmt,
|
|
&mixer->base_config);
|
|
if (ret)
|
|
goto err;
|
|
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &mixer->msg);
|
|
if (ret)
|
|
goto err;
|
|
|
|
return 0;
|
|
err:
|
|
sof_ipc4_free_audio_fmt(&mixer->available_fmt);
|
|
kfree(mixer);
|
|
swidget->private = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup_comp_src(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_pipeline *spipe = swidget->spipe;
|
|
struct sof_ipc4_src *src;
|
|
int ret;
|
|
|
|
dev_dbg(scomp->dev, "Updating IPC structure for %s\n", swidget->widget->name);
|
|
|
|
src = kzalloc(sizeof(*src), GFP_KERNEL);
|
|
if (!src)
|
|
return -ENOMEM;
|
|
|
|
swidget->private = src;
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, &src->available_fmt,
|
|
&src->data.base_config);
|
|
if (ret)
|
|
goto err;
|
|
|
|
ret = sof_update_ipc_object(scomp, &src->data, SOF_SRC_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(*src), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "Parsing SRC tokens failed\n");
|
|
goto err;
|
|
}
|
|
|
|
spipe->core_mask |= BIT(swidget->core);
|
|
|
|
dev_dbg(scomp->dev, "SRC sink rate %d\n", src->data.sink_rate);
|
|
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &src->msg);
|
|
if (ret)
|
|
goto err;
|
|
|
|
return 0;
|
|
err:
|
|
sof_ipc4_free_audio_fmt(&src->available_fmt);
|
|
kfree(src);
|
|
swidget->private = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_src(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_src *src = swidget->private;
|
|
|
|
if (!src)
|
|
return;
|
|
|
|
sof_ipc4_free_audio_fmt(&src->available_fmt);
|
|
kfree(swidget->private);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_mixer(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_mixer *mixer = swidget->private;
|
|
|
|
if (!mixer)
|
|
return;
|
|
|
|
sof_ipc4_free_audio_fmt(&mixer->available_fmt);
|
|
kfree(swidget->private);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
/*
|
|
* Add the process modules support. The process modules are defined as snd_soc_dapm_effect modules.
|
|
*/
|
|
static int sof_ipc4_widget_setup_comp_process(struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct sof_ipc4_fw_module *fw_module;
|
|
struct snd_sof_pipeline *spipe = swidget->spipe;
|
|
struct sof_ipc4_process *process;
|
|
void *cfg;
|
|
int ret;
|
|
|
|
process = kzalloc(sizeof(*process), GFP_KERNEL);
|
|
if (!process)
|
|
return -ENOMEM;
|
|
|
|
swidget->private = process;
|
|
|
|
ret = sof_ipc4_get_audio_fmt(scomp, swidget, &process->available_fmt,
|
|
&process->base_config);
|
|
if (ret)
|
|
goto err;
|
|
|
|
ret = sof_ipc4_widget_setup_msg(swidget, &process->msg);
|
|
if (ret)
|
|
goto err;
|
|
|
|
/* parse process init module payload config type from module info */
|
|
fw_module = swidget->module_info;
|
|
process->init_config = FIELD_GET(SOF_IPC4_MODULE_INIT_CONFIG_MASK,
|
|
fw_module->man4_module_entry.type);
|
|
|
|
process->ipc_config_size = sizeof(struct sof_ipc4_base_module_cfg);
|
|
|
|
/* allocate memory for base config extension if needed */
|
|
if (process->init_config == SOF_IPC4_MODULE_INIT_CONFIG_TYPE_BASE_CFG_WITH_EXT) {
|
|
struct sof_ipc4_base_module_cfg_ext *base_cfg_ext;
|
|
u32 ext_size = struct_size(base_cfg_ext, pin_formats,
|
|
size_add(swidget->num_input_pins,
|
|
swidget->num_output_pins));
|
|
|
|
base_cfg_ext = kzalloc(ext_size, GFP_KERNEL);
|
|
if (!base_cfg_ext) {
|
|
ret = -ENOMEM;
|
|
goto free_available_fmt;
|
|
}
|
|
|
|
base_cfg_ext->num_input_pin_fmts = swidget->num_input_pins;
|
|
base_cfg_ext->num_output_pin_fmts = swidget->num_output_pins;
|
|
process->base_config_ext = base_cfg_ext;
|
|
process->base_config_ext_size = ext_size;
|
|
process->ipc_config_size += ext_size;
|
|
}
|
|
|
|
cfg = kzalloc(process->ipc_config_size, GFP_KERNEL);
|
|
if (!cfg) {
|
|
ret = -ENOMEM;
|
|
goto free_base_cfg_ext;
|
|
}
|
|
|
|
process->ipc_config_data = cfg;
|
|
|
|
sof_ipc4_widget_update_kcontrol_module_id(swidget);
|
|
|
|
/* set pipeline core mask to keep track of the core the module is scheduled to run on */
|
|
spipe->core_mask |= BIT(swidget->core);
|
|
|
|
return 0;
|
|
free_base_cfg_ext:
|
|
kfree(process->base_config_ext);
|
|
process->base_config_ext = NULL;
|
|
free_available_fmt:
|
|
sof_ipc4_free_audio_fmt(&process->available_fmt);
|
|
err:
|
|
kfree(process);
|
|
swidget->private = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static void sof_ipc4_widget_free_comp_process(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_process *process = swidget->private;
|
|
|
|
if (!process)
|
|
return;
|
|
|
|
kfree(process->ipc_config_data);
|
|
kfree(process->base_config_ext);
|
|
sof_ipc4_free_audio_fmt(&process->available_fmt);
|
|
kfree(swidget->private);
|
|
swidget->private = NULL;
|
|
}
|
|
|
|
static void
|
|
sof_ipc4_update_resource_usage(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget,
|
|
struct sof_ipc4_base_module_cfg *base_config)
|
|
{
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
struct snd_sof_widget *pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
int task_mem, queue_mem;
|
|
int ibs, bss, total;
|
|
|
|
ibs = base_config->ibs;
|
|
bss = base_config->is_pages;
|
|
|
|
task_mem = SOF_IPC4_PIPELINE_OBJECT_SIZE;
|
|
task_mem += SOF_IPC4_MODULE_INSTANCE_LIST_ITEM_SIZE + bss;
|
|
|
|
if (fw_module->man4_module_entry.type & SOF_IPC4_MODULE_LL) {
|
|
task_mem += SOF_IPC4_FW_ROUNDUP(SOF_IPC4_LL_TASK_OBJECT_SIZE);
|
|
task_mem += SOF_IPC4_FW_MAX_QUEUE_COUNT * SOF_IPC4_MODULE_INSTANCE_LIST_ITEM_SIZE;
|
|
task_mem += SOF_IPC4_LL_TASK_LIST_ITEM_SIZE;
|
|
} else {
|
|
task_mem += SOF_IPC4_FW_ROUNDUP(SOF_IPC4_DP_TASK_OBJECT_SIZE);
|
|
task_mem += SOF_IPC4_DP_TASK_LIST_SIZE;
|
|
}
|
|
|
|
ibs = SOF_IPC4_FW_ROUNDUP(ibs);
|
|
queue_mem = SOF_IPC4_FW_MAX_QUEUE_COUNT * (SOF_IPC4_DATA_QUEUE_OBJECT_SIZE + ibs);
|
|
|
|
total = SOF_IPC4_FW_PAGE(task_mem + queue_mem);
|
|
|
|
pipe_widget = swidget->spipe->pipe_widget;
|
|
pipeline = pipe_widget->private;
|
|
pipeline->mem_usage += total;
|
|
|
|
/* Update base_config->cpc from the module manifest */
|
|
sof_ipc4_update_cpc_from_manifest(sdev, fw_module, base_config);
|
|
|
|
if (ignore_cpc) {
|
|
dev_dbg(sdev->dev, "%s: ibs / obs: %u / %u, forcing cpc to 0 from %u\n",
|
|
swidget->widget->name, base_config->ibs, base_config->obs,
|
|
base_config->cpc);
|
|
base_config->cpc = 0;
|
|
} else {
|
|
dev_dbg(sdev->dev, "%s: ibs / obs / cpc: %u / %u / %u\n",
|
|
swidget->widget->name, base_config->ibs, base_config->obs,
|
|
base_config->cpc);
|
|
}
|
|
}
|
|
|
|
static int sof_ipc4_widget_assign_instance_id(struct snd_sof_dev *sdev,
|
|
struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
int max_instances = fw_module->man4_module_entry.instance_max_count;
|
|
|
|
swidget->instance_id = ida_alloc_max(&fw_module->m_ida, max_instances, GFP_KERNEL);
|
|
if (swidget->instance_id < 0) {
|
|
dev_err(sdev->dev, "failed to assign instance id for widget %s",
|
|
swidget->widget->name);
|
|
return swidget->instance_id;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* update hw_params based on the audio stream format */
|
|
static int sof_ipc4_update_hw_params(struct snd_sof_dev *sdev, struct snd_pcm_hw_params *params,
|
|
struct sof_ipc4_audio_format *fmt, u32 param_to_update)
|
|
{
|
|
struct snd_interval *i;
|
|
|
|
if (param_to_update & BIT(SNDRV_PCM_HW_PARAM_FORMAT)) {
|
|
int valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
snd_pcm_format_t snd_fmt;
|
|
struct snd_mask *m;
|
|
|
|
switch (valid_bits) {
|
|
case 16:
|
|
snd_fmt = SNDRV_PCM_FORMAT_S16_LE;
|
|
break;
|
|
case 24:
|
|
snd_fmt = SNDRV_PCM_FORMAT_S24_LE;
|
|
break;
|
|
case 32:
|
|
snd_fmt = SNDRV_PCM_FORMAT_S32_LE;
|
|
break;
|
|
default:
|
|
dev_err(sdev->dev, "invalid PCM valid_bits %d\n", valid_bits);
|
|
return -EINVAL;
|
|
}
|
|
|
|
m = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
|
|
snd_mask_none(m);
|
|
snd_mask_set_format(m, snd_fmt);
|
|
}
|
|
|
|
if (param_to_update & BIT(SNDRV_PCM_HW_PARAM_RATE)) {
|
|
unsigned int rate = fmt->sampling_frequency;
|
|
|
|
i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
|
|
i->min = rate;
|
|
i->max = rate;
|
|
}
|
|
|
|
if (param_to_update & BIT(SNDRV_PCM_HW_PARAM_CHANNELS)) {
|
|
unsigned int channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
|
|
i = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
i->min = channels;
|
|
i->max = channels;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool sof_ipc4_is_single_format(struct snd_sof_dev *sdev,
|
|
struct sof_ipc4_pin_format *pin_fmts, u32 pin_fmts_size)
|
|
{
|
|
struct sof_ipc4_audio_format *fmt;
|
|
u32 rate, channels, valid_bits;
|
|
int i;
|
|
|
|
fmt = &pin_fmts[0].audio_fmt;
|
|
rate = fmt->sampling_frequency;
|
|
channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
|
|
/* check if all output formats in topology are the same */
|
|
for (i = 1; i < pin_fmts_size; i++) {
|
|
u32 _rate, _channels, _valid_bits;
|
|
|
|
fmt = &pin_fmts[i].audio_fmt;
|
|
_rate = fmt->sampling_frequency;
|
|
_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
|
|
if (_rate != rate || _channels != channels || _valid_bits != valid_bits)
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static int sof_ipc4_init_output_audio_fmt(struct snd_sof_dev *sdev,
|
|
struct sof_ipc4_base_module_cfg *base_config,
|
|
struct sof_ipc4_available_audio_format *available_fmt,
|
|
u32 out_ref_rate, u32 out_ref_channels,
|
|
u32 out_ref_valid_bits)
|
|
{
|
|
struct sof_ipc4_audio_format *out_fmt;
|
|
bool single_format;
|
|
int i;
|
|
|
|
if (!available_fmt->num_output_formats)
|
|
return -EINVAL;
|
|
|
|
single_format = sof_ipc4_is_single_format(sdev, available_fmt->output_pin_fmts,
|
|
available_fmt->num_output_formats);
|
|
|
|
/* pick the first format if there's only one available or if all formats are the same */
|
|
if (single_format) {
|
|
base_config->obs = available_fmt->output_pin_fmts[0].buffer_size;
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* if there are multiple output formats, then choose the output format that matches
|
|
* the reference params
|
|
*/
|
|
for (i = 0; i < available_fmt->num_output_formats; i++) {
|
|
u32 _out_rate, _out_channels, _out_valid_bits;
|
|
|
|
out_fmt = &available_fmt->output_pin_fmts[i].audio_fmt;
|
|
_out_rate = out_fmt->sampling_frequency;
|
|
_out_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(out_fmt->fmt_cfg);
|
|
_out_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(out_fmt->fmt_cfg);
|
|
|
|
if (_out_rate == out_ref_rate && _out_channels == out_ref_channels &&
|
|
_out_valid_bits == out_ref_valid_bits) {
|
|
base_config->obs = available_fmt->output_pin_fmts[i].buffer_size;
|
|
return i;
|
|
}
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int sof_ipc4_get_valid_bits(struct snd_sof_dev *sdev, struct snd_pcm_hw_params *params)
|
|
{
|
|
switch (params_format(params)) {
|
|
case SNDRV_PCM_FORMAT_S16_LE:
|
|
return 16;
|
|
case SNDRV_PCM_FORMAT_S24_LE:
|
|
return 24;
|
|
case SNDRV_PCM_FORMAT_S32_LE:
|
|
return 32;
|
|
default:
|
|
dev_err(sdev->dev, "invalid pcm frame format %d\n", params_format(params));
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static int sof_ipc4_init_input_audio_fmt(struct snd_sof_dev *sdev,
|
|
struct snd_sof_widget *swidget,
|
|
struct sof_ipc4_base_module_cfg *base_config,
|
|
struct snd_pcm_hw_params *params,
|
|
struct sof_ipc4_available_audio_format *available_fmt)
|
|
{
|
|
struct sof_ipc4_pin_format *pin_fmts = available_fmt->input_pin_fmts;
|
|
u32 pin_fmts_size = available_fmt->num_input_formats;
|
|
u32 valid_bits;
|
|
u32 channels;
|
|
u32 rate;
|
|
bool single_format;
|
|
int sample_valid_bits;
|
|
int i = 0;
|
|
|
|
if (!available_fmt->num_input_formats) {
|
|
dev_err(sdev->dev, "no input formats for %s\n", swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
single_format = sof_ipc4_is_single_format(sdev, available_fmt->input_pin_fmts,
|
|
available_fmt->num_input_formats);
|
|
if (single_format)
|
|
goto in_fmt;
|
|
|
|
sample_valid_bits = sof_ipc4_get_valid_bits(sdev, params);
|
|
if (sample_valid_bits < 0)
|
|
return sample_valid_bits;
|
|
|
|
/*
|
|
* Search supported input audio formats with pin index 0 to match rate, channels and
|
|
* sample_valid_bits from reference params
|
|
*/
|
|
for (i = 0; i < pin_fmts_size; i++) {
|
|
struct sof_ipc4_audio_format *fmt = &pin_fmts[i].audio_fmt;
|
|
|
|
if (pin_fmts[i].pin_index)
|
|
continue;
|
|
|
|
rate = fmt->sampling_frequency;
|
|
channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
if (params_rate(params) == rate && params_channels(params) == channels &&
|
|
sample_valid_bits == valid_bits) {
|
|
dev_dbg(sdev->dev, "matched audio format index for %uHz, %ubit, %u channels: %d\n",
|
|
rate, valid_bits, channels, i);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (i == pin_fmts_size) {
|
|
dev_err(sdev->dev, "%s: Unsupported audio format: %uHz, %ubit, %u channels\n",
|
|
__func__, params_rate(params), sample_valid_bits, params_channels(params));
|
|
return -EINVAL;
|
|
}
|
|
|
|
in_fmt:
|
|
/* copy input format */
|
|
if (available_fmt->num_input_formats && i < available_fmt->num_input_formats) {
|
|
memcpy(&base_config->audio_fmt, &available_fmt->input_pin_fmts[i].audio_fmt,
|
|
sizeof(struct sof_ipc4_audio_format));
|
|
|
|
/* set base_cfg ibs/obs */
|
|
base_config->ibs = available_fmt->input_pin_fmts[i].buffer_size;
|
|
|
|
dev_dbg(sdev->dev, "Init input audio formats for %s\n", swidget->widget->name);
|
|
sof_ipc4_dbg_audio_format(sdev->dev, &available_fmt->input_pin_fmts[i], 1);
|
|
}
|
|
|
|
return i;
|
|
}
|
|
|
|
static void sof_ipc4_unprepare_copier_module(struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_copier *ipc4_copier = NULL;
|
|
struct snd_sof_widget *pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
|
|
/* reset pipeline memory usage */
|
|
pipe_widget = swidget->spipe->pipe_widget;
|
|
pipeline = pipe_widget->private;
|
|
pipeline->mem_usage = 0;
|
|
|
|
if (WIDGET_IS_AIF(swidget->id) || swidget->id == snd_soc_dapm_buffer) {
|
|
if (pipeline->use_chain_dma) {
|
|
pipeline->msg.primary = 0;
|
|
pipeline->msg.extension = 0;
|
|
}
|
|
ipc4_copier = swidget->private;
|
|
} else if (WIDGET_IS_DAI(swidget->id)) {
|
|
struct snd_sof_dai *dai = swidget->private;
|
|
|
|
ipc4_copier = dai->private;
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
pipeline->msg.primary = 0;
|
|
pipeline->msg.extension = 0;
|
|
}
|
|
|
|
if (ipc4_copier->dai_type == SOF_DAI_INTEL_ALH) {
|
|
struct sof_ipc4_alh_configuration_blob *blob;
|
|
unsigned int group_id;
|
|
|
|
blob = (struct sof_ipc4_alh_configuration_blob *)ipc4_copier->copier_config;
|
|
if (blob->alh_cfg.device_count > 1) {
|
|
group_id = SOF_IPC4_NODE_INDEX(ipc4_copier->data.gtw_cfg.node_id) -
|
|
ALH_MULTI_GTW_BASE;
|
|
ida_free(&alh_group_ida, group_id);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (ipc4_copier) {
|
|
kfree(ipc4_copier->ipc_config_data);
|
|
ipc4_copier->ipc_config_data = NULL;
|
|
ipc4_copier->ipc_config_size = 0;
|
|
}
|
|
}
|
|
|
|
#if IS_ENABLED(CONFIG_ACPI) && IS_ENABLED(CONFIG_SND_INTEL_NHLT)
|
|
static int snd_sof_get_hw_config_params(struct snd_sof_dev *sdev, struct snd_sof_dai *dai,
|
|
int *sample_rate, int *channel_count, int *bit_depth)
|
|
{
|
|
struct snd_soc_tplg_hw_config *hw_config;
|
|
struct snd_sof_dai_link *slink;
|
|
bool dai_link_found = false;
|
|
bool hw_cfg_found = false;
|
|
int i;
|
|
|
|
/* get current hw_config from link */
|
|
list_for_each_entry(slink, &sdev->dai_link_list, list) {
|
|
if (!strcmp(slink->link->name, dai->name)) {
|
|
dai_link_found = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!dai_link_found) {
|
|
dev_err(sdev->dev, "%s: no DAI link found for DAI %s\n", __func__, dai->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
for (i = 0; i < slink->num_hw_configs; i++) {
|
|
hw_config = &slink->hw_configs[i];
|
|
if (dai->current_config == le32_to_cpu(hw_config->id)) {
|
|
hw_cfg_found = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!hw_cfg_found) {
|
|
dev_err(sdev->dev, "%s: no matching hw_config found for DAI %s\n", __func__,
|
|
dai->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
*bit_depth = le32_to_cpu(hw_config->tdm_slot_width);
|
|
*channel_count = le32_to_cpu(hw_config->tdm_slots);
|
|
*sample_rate = le32_to_cpu(hw_config->fsync_rate);
|
|
|
|
dev_dbg(sdev->dev, "sample rate: %d sample width: %d channels: %d\n",
|
|
*sample_rate, *bit_depth, *channel_count);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
snd_sof_get_nhlt_endpoint_data(struct snd_sof_dev *sdev, struct snd_sof_dai *dai,
|
|
bool single_bitdepth,
|
|
struct snd_pcm_hw_params *params, u32 dai_index,
|
|
u32 linktype, u8 dir, u32 **dst, u32 *len)
|
|
{
|
|
struct sof_ipc4_fw_data *ipc4_data = sdev->private;
|
|
struct nhlt_specific_cfg *cfg;
|
|
int sample_rate, channel_count;
|
|
bool format_change = false;
|
|
int bit_depth, ret;
|
|
u32 nhlt_type;
|
|
int dev_type = 0;
|
|
|
|
/* convert to NHLT type */
|
|
switch (linktype) {
|
|
case SOF_DAI_INTEL_DMIC:
|
|
nhlt_type = NHLT_LINK_DMIC;
|
|
channel_count = params_channels(params);
|
|
sample_rate = params_rate(params);
|
|
bit_depth = params_width(params);
|
|
/*
|
|
* Look for 32-bit blob first instead of 16-bit if copier
|
|
* supports multiple formats
|
|
*/
|
|
if (bit_depth == 16 && !single_bitdepth) {
|
|
dev_dbg(sdev->dev, "Looking for 32-bit blob first for DMIC\n");
|
|
format_change = true;
|
|
bit_depth = 32;
|
|
}
|
|
break;
|
|
case SOF_DAI_INTEL_SSP:
|
|
nhlt_type = NHLT_LINK_SSP;
|
|
ret = snd_sof_get_hw_config_params(sdev, dai, &sample_rate, &channel_count,
|
|
&bit_depth);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/*
|
|
* We need to know the type of the external device attached to a SSP
|
|
* port to retrieve the blob from NHLT. However, device type is not
|
|
* specified in topology.
|
|
* Query the type for the port and then pass that information back
|
|
* to the blob lookup function.
|
|
*/
|
|
dev_type = intel_nhlt_ssp_device_type(sdev->dev, ipc4_data->nhlt,
|
|
dai_index);
|
|
if (dev_type < 0)
|
|
return dev_type;
|
|
break;
|
|
default:
|
|
return 0;
|
|
}
|
|
|
|
dev_dbg(sdev->dev, "dai index %d nhlt type %d direction %d dev type %d\n",
|
|
dai_index, nhlt_type, dir, dev_type);
|
|
|
|
/* find NHLT blob with matching params */
|
|
cfg = intel_nhlt_get_endpoint_blob(sdev->dev, ipc4_data->nhlt, dai_index, nhlt_type,
|
|
bit_depth, bit_depth, channel_count, sample_rate,
|
|
dir, dev_type);
|
|
|
|
if (!cfg) {
|
|
bool get_new_blob = false;
|
|
|
|
if (format_change) {
|
|
/*
|
|
* The 32-bit blob was not found in NHLT table, try to
|
|
* look for one based on the params
|
|
*/
|
|
bit_depth = params_width(params);
|
|
format_change = false;
|
|
get_new_blob = true;
|
|
} else if (linktype == SOF_DAI_INTEL_DMIC && !single_bitdepth) {
|
|
/*
|
|
* The requested 32-bit blob (no format change for the
|
|
* blob request) was not found in NHLT table, try to
|
|
* look for 16-bit blob if the copier supports multiple
|
|
* formats
|
|
*/
|
|
bit_depth = 16;
|
|
format_change = true;
|
|
get_new_blob = true;
|
|
}
|
|
|
|
if (get_new_blob) {
|
|
cfg = intel_nhlt_get_endpoint_blob(sdev->dev, ipc4_data->nhlt,
|
|
dai_index, nhlt_type,
|
|
bit_depth, bit_depth,
|
|
channel_count, sample_rate,
|
|
dir, dev_type);
|
|
if (cfg)
|
|
goto out;
|
|
}
|
|
|
|
dev_err(sdev->dev,
|
|
"no matching blob for sample rate: %d sample width: %d channels: %d\n",
|
|
sample_rate, bit_depth, channel_count);
|
|
return -EINVAL;
|
|
}
|
|
|
|
out:
|
|
/* config length should be in dwords */
|
|
*len = cfg->size >> 2;
|
|
*dst = (u32 *)cfg->caps;
|
|
|
|
if (format_change) {
|
|
/*
|
|
* Update the params to reflect that different blob was loaded
|
|
* instead of the requested bit depth (16 -> 32 or 32 -> 16).
|
|
* This information is going to be used by the caller to find
|
|
* matching copier format on the dai side.
|
|
*/
|
|
struct snd_mask *m;
|
|
|
|
m = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
|
|
snd_mask_none(m);
|
|
if (bit_depth == 16)
|
|
snd_mask_set_format(m, SNDRV_PCM_FORMAT_S16_LE);
|
|
else
|
|
snd_mask_set_format(m, SNDRV_PCM_FORMAT_S32_LE);
|
|
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
static int
|
|
snd_sof_get_nhlt_endpoint_data(struct snd_sof_dev *sdev, struct snd_sof_dai *dai,
|
|
bool single_bitdepth,
|
|
struct snd_pcm_hw_params *params, u32 dai_index,
|
|
u32 linktype, u8 dir, u32 **dst, u32 *len)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
bool sof_ipc4_copier_is_single_bitdepth(struct snd_sof_dev *sdev,
|
|
struct sof_ipc4_pin_format *pin_fmts,
|
|
u32 pin_fmts_size)
|
|
{
|
|
struct sof_ipc4_audio_format *fmt;
|
|
u32 valid_bits;
|
|
int i;
|
|
|
|
fmt = &pin_fmts[0].audio_fmt;
|
|
valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
|
|
/* check if all formats in topology are the same */
|
|
for (i = 1; i < pin_fmts_size; i++) {
|
|
u32 _valid_bits;
|
|
|
|
fmt = &pin_fmts[i].audio_fmt;
|
|
_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
|
|
if (_valid_bits != valid_bits)
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static int
|
|
sof_ipc4_adjust_params_to_dai_format(struct snd_sof_dev *sdev,
|
|
struct snd_pcm_hw_params *params,
|
|
struct sof_ipc4_pin_format *pin_fmts,
|
|
u32 pin_fmts_size)
|
|
{
|
|
u32 params_mask = BIT(SNDRV_PCM_HW_PARAM_RATE) |
|
|
BIT(SNDRV_PCM_HW_PARAM_CHANNELS) |
|
|
BIT(SNDRV_PCM_HW_PARAM_FORMAT);
|
|
struct sof_ipc4_audio_format *fmt;
|
|
u32 rate, channels, valid_bits;
|
|
int i;
|
|
|
|
fmt = &pin_fmts[0].audio_fmt;
|
|
rate = fmt->sampling_frequency;
|
|
channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
|
|
/* check if parameters in topology defined formats are the same */
|
|
for (i = 1; i < pin_fmts_size; i++) {
|
|
u32 val;
|
|
|
|
fmt = &pin_fmts[i].audio_fmt;
|
|
|
|
if (params_mask & BIT(SNDRV_PCM_HW_PARAM_RATE)) {
|
|
val = fmt->sampling_frequency;
|
|
if (val != rate)
|
|
params_mask &= ~BIT(SNDRV_PCM_HW_PARAM_RATE);
|
|
}
|
|
if (params_mask & BIT(SNDRV_PCM_HW_PARAM_CHANNELS)) {
|
|
val = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(fmt->fmt_cfg);
|
|
if (val != channels)
|
|
params_mask &= ~BIT(SNDRV_PCM_HW_PARAM_CHANNELS);
|
|
}
|
|
if (params_mask & BIT(SNDRV_PCM_HW_PARAM_FORMAT)) {
|
|
val = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(fmt->fmt_cfg);
|
|
if (val != valid_bits)
|
|
params_mask &= ~BIT(SNDRV_PCM_HW_PARAM_FORMAT);
|
|
}
|
|
}
|
|
|
|
if (params_mask)
|
|
return sof_ipc4_update_hw_params(sdev, params,
|
|
&pin_fmts[0].audio_fmt,
|
|
params_mask);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
sof_ipc4_prepare_dai_copier(struct snd_sof_dev *sdev, struct snd_sof_dai *dai,
|
|
struct snd_pcm_hw_params *params, int dir)
|
|
{
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
struct snd_pcm_hw_params dai_params = *params;
|
|
struct sof_ipc4_copier_data *copier_data;
|
|
struct sof_ipc4_pin_format *pin_fmts;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
bool single_bitdepth;
|
|
u32 num_pin_fmts;
|
|
int ret;
|
|
|
|
ipc4_copier = dai->private;
|
|
copier_data = &ipc4_copier->data;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
/*
|
|
* Fixup the params based on the format parameters of the DAI. If any
|
|
* of the RATE, CHANNELS, bit depth is static among the formats then
|
|
* narrow the params to only allow that specific parameter value.
|
|
*/
|
|
if (dir == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
pin_fmts = available_fmt->output_pin_fmts;
|
|
num_pin_fmts = available_fmt->num_output_formats;
|
|
} else {
|
|
pin_fmts = available_fmt->input_pin_fmts;
|
|
num_pin_fmts = available_fmt->num_input_formats;
|
|
}
|
|
|
|
ret = sof_ipc4_adjust_params_to_dai_format(sdev, &dai_params, pin_fmts,
|
|
num_pin_fmts);
|
|
if (ret)
|
|
return ret;
|
|
|
|
single_bitdepth = sof_ipc4_copier_is_single_bitdepth(sdev, pin_fmts,
|
|
num_pin_fmts);
|
|
ret = snd_sof_get_nhlt_endpoint_data(sdev, dai, single_bitdepth,
|
|
&dai_params,
|
|
ipc4_copier->dai_index,
|
|
ipc4_copier->dai_type, dir,
|
|
&ipc4_copier->copier_config,
|
|
&copier_data->gtw_cfg.config_length);
|
|
/* Update the params to reflect the changes made in this function */
|
|
if (!ret)
|
|
*params = dai_params;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int
|
|
sof_ipc4_prepare_copier_module(struct snd_sof_widget *swidget,
|
|
struct snd_pcm_hw_params *fe_params,
|
|
struct snd_sof_platform_stream_params *platform_params,
|
|
struct snd_pcm_hw_params *pipeline_params, int dir)
|
|
{
|
|
struct sof_ipc4_available_audio_format *available_fmt;
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_copier_data *copier_data;
|
|
struct snd_pcm_hw_params ref_params;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
struct snd_sof_dai *dai;
|
|
u32 gtw_cfg_config_length;
|
|
u32 dma_config_tlv_size = 0;
|
|
void **ipc_config_data;
|
|
int *ipc_config_size;
|
|
u32 **data;
|
|
int ipc_size, ret, out_ref_valid_bits;
|
|
u32 out_ref_rate, out_ref_channels;
|
|
u32 deep_buffer_dma_ms = 0;
|
|
int output_fmt_index;
|
|
bool single_output_bitdepth;
|
|
int i;
|
|
|
|
dev_dbg(sdev->dev, "copier %s, type %d", swidget->widget->name, swidget->id);
|
|
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_aif_in:
|
|
case snd_soc_dapm_aif_out:
|
|
{
|
|
struct sof_ipc4_gtw_attributes *gtw_attr;
|
|
struct snd_sof_widget *pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
|
|
/* parse the deep buffer dma size */
|
|
ret = sof_update_ipc_object(scomp, &deep_buffer_dma_ms,
|
|
SOF_COPIER_DEEP_BUFFER_TOKENS, swidget->tuples,
|
|
swidget->num_tuples, sizeof(u32), 1);
|
|
if (ret) {
|
|
dev_err(scomp->dev, "Failed to parse deep buffer dma size for %s\n",
|
|
swidget->widget->name);
|
|
return ret;
|
|
}
|
|
|
|
ipc4_copier = (struct sof_ipc4_copier *)swidget->private;
|
|
gtw_attr = ipc4_copier->gtw_attr;
|
|
copier_data = &ipc4_copier->data;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
pipe_widget = swidget->spipe->pipe_widget;
|
|
pipeline = pipe_widget->private;
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
u32 host_dma_id;
|
|
u32 fifo_size;
|
|
|
|
host_dma_id = platform_params->stream_tag - 1;
|
|
pipeline->msg.primary |= SOF_IPC4_GLB_CHAIN_DMA_HOST_ID(host_dma_id);
|
|
|
|
/* Set SCS bit for S16_LE format only */
|
|
if (params_format(fe_params) == SNDRV_PCM_FORMAT_S16_LE)
|
|
pipeline->msg.primary |= SOF_IPC4_GLB_CHAIN_DMA_SCS_MASK;
|
|
|
|
/*
|
|
* Despite its name the bitfield 'fifo_size' is used to define DMA buffer
|
|
* size. The expression calculates 2ms buffer size.
|
|
*/
|
|
fifo_size = DIV_ROUND_UP((SOF_IPC4_CHAIN_DMA_BUF_SIZE_MS *
|
|
params_rate(fe_params) *
|
|
params_channels(fe_params) *
|
|
params_physical_width(fe_params)), 8000);
|
|
pipeline->msg.extension |= SOF_IPC4_GLB_EXT_CHAIN_DMA_FIFO_SIZE(fifo_size);
|
|
|
|
/*
|
|
* Chain DMA does not support stream timestamping, set node_id to invalid
|
|
* to skip the code in sof_ipc4_get_stream_start_offset().
|
|
*/
|
|
copier_data->gtw_cfg.node_id = SOF_IPC4_INVALID_NODE_ID;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Use the input_pin_fmts to match pcm params for playback and the output_pin_fmts
|
|
* for capture.
|
|
*/
|
|
if (dir == SNDRV_PCM_STREAM_PLAYBACK)
|
|
ref_params = *fe_params;
|
|
else
|
|
ref_params = *pipeline_params;
|
|
|
|
copier_data->gtw_cfg.node_id &= ~SOF_IPC4_NODE_INDEX_MASK;
|
|
copier_data->gtw_cfg.node_id |=
|
|
SOF_IPC4_NODE_INDEX(platform_params->stream_tag - 1);
|
|
|
|
/* set gateway attributes */
|
|
gtw_attr->lp_buffer_alloc = pipeline->lp_mode;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_dai_in:
|
|
case snd_soc_dapm_dai_out:
|
|
{
|
|
struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline = pipe_widget->private;
|
|
|
|
if (pipeline->use_chain_dma)
|
|
return 0;
|
|
|
|
dai = swidget->private;
|
|
|
|
ipc4_copier = (struct sof_ipc4_copier *)dai->private;
|
|
copier_data = &ipc4_copier->data;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
|
|
/*
|
|
* Use the fe_params as a base for the copier configuration.
|
|
* The ref_params might get updated to reflect what format is
|
|
* supported by the copier on the DAI side.
|
|
*
|
|
* In case of capture the ref_params returned will be used to
|
|
* find the input configuration of the copier.
|
|
*/
|
|
ref_params = *fe_params;
|
|
ret = sof_ipc4_prepare_dai_copier(sdev, dai, &ref_params, dir);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/*
|
|
* For playback the pipeline_params needs to be used to find the
|
|
* input configuration of the copier.
|
|
*/
|
|
if (dir == SNDRV_PCM_STREAM_PLAYBACK)
|
|
ref_params = *pipeline_params;
|
|
|
|
break;
|
|
}
|
|
case snd_soc_dapm_buffer:
|
|
{
|
|
ipc4_copier = (struct sof_ipc4_copier *)swidget->private;
|
|
copier_data = &ipc4_copier->data;
|
|
available_fmt = &ipc4_copier->available_fmt;
|
|
ref_params = *pipeline_params;
|
|
|
|
break;
|
|
}
|
|
default:
|
|
dev_err(sdev->dev, "unsupported type %d for copier %s",
|
|
swidget->id, swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* set input and output audio formats */
|
|
ret = sof_ipc4_init_input_audio_fmt(sdev, swidget, &copier_data->base_config,
|
|
&ref_params, available_fmt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* set the reference params for output format selection */
|
|
single_output_bitdepth = sof_ipc4_copier_is_single_bitdepth(sdev,
|
|
available_fmt->output_pin_fmts,
|
|
available_fmt->num_output_formats);
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_aif_in:
|
|
case snd_soc_dapm_dai_out:
|
|
case snd_soc_dapm_buffer:
|
|
{
|
|
struct sof_ipc4_audio_format *in_fmt;
|
|
|
|
in_fmt = &available_fmt->input_pin_fmts[ret].audio_fmt;
|
|
out_ref_rate = in_fmt->sampling_frequency;
|
|
out_ref_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(in_fmt->fmt_cfg);
|
|
|
|
if (!single_output_bitdepth)
|
|
out_ref_valid_bits =
|
|
SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(in_fmt->fmt_cfg);
|
|
break;
|
|
}
|
|
case snd_soc_dapm_aif_out:
|
|
case snd_soc_dapm_dai_in:
|
|
out_ref_rate = params_rate(fe_params);
|
|
out_ref_channels = params_channels(fe_params);
|
|
if (!single_output_bitdepth) {
|
|
out_ref_valid_bits = sof_ipc4_get_valid_bits(sdev, fe_params);
|
|
if (out_ref_valid_bits < 0)
|
|
return out_ref_valid_bits;
|
|
}
|
|
break;
|
|
default:
|
|
/*
|
|
* Unsupported type should be caught by the former switch default
|
|
* case, this should never happen in reality.
|
|
*/
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* if the output format is the same across all available output formats, choose
|
|
* that as the reference.
|
|
*/
|
|
if (single_output_bitdepth) {
|
|
struct sof_ipc4_audio_format *out_fmt;
|
|
|
|
out_fmt = &available_fmt->output_pin_fmts[0].audio_fmt;
|
|
out_ref_valid_bits =
|
|
SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(out_fmt->fmt_cfg);
|
|
}
|
|
|
|
dev_dbg(sdev->dev, "copier %s: reference output rate %d, channels %d valid_bits %d\n",
|
|
swidget->widget->name, out_ref_rate, out_ref_channels, out_ref_valid_bits);
|
|
|
|
output_fmt_index = sof_ipc4_init_output_audio_fmt(sdev, &copier_data->base_config,
|
|
available_fmt, out_ref_rate,
|
|
out_ref_channels, out_ref_valid_bits);
|
|
if (output_fmt_index < 0) {
|
|
dev_err(sdev->dev, "Failed to initialize output format for %s",
|
|
swidget->widget->name);
|
|
return output_fmt_index;
|
|
}
|
|
|
|
/*
|
|
* Set the output format. Current topology defines pin 0 input and output formats in pairs.
|
|
* This assumes that the pin 0 formats are defined before all other pins.
|
|
* So pick the output audio format with the same index as the chosen
|
|
* input format. This logic will need to be updated when the format definitions
|
|
* in topology change.
|
|
*/
|
|
memcpy(&copier_data->out_format,
|
|
&available_fmt->output_pin_fmts[output_fmt_index].audio_fmt,
|
|
sizeof(struct sof_ipc4_audio_format));
|
|
dev_dbg(sdev->dev, "Output audio format for %s\n", swidget->widget->name);
|
|
sof_ipc4_dbg_audio_format(sdev->dev, &available_fmt->output_pin_fmts[output_fmt_index], 1);
|
|
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_dai_in:
|
|
case snd_soc_dapm_dai_out:
|
|
{
|
|
/*
|
|
* Only SOF_DAI_INTEL_ALH needs copier_data to set blob.
|
|
* That's why only ALH dai's blob is set after sof_ipc4_init_input_audio_fmt
|
|
*/
|
|
if (ipc4_copier->dai_type == SOF_DAI_INTEL_ALH) {
|
|
struct sof_ipc4_alh_configuration_blob *blob;
|
|
struct sof_ipc4_dma_config *dma_config;
|
|
struct sof_ipc4_copier_data *alh_data;
|
|
struct sof_ipc4_copier *alh_copier;
|
|
struct snd_sof_widget *w;
|
|
u32 ch_count = 0;
|
|
u32 ch_mask = 0;
|
|
u32 ch_map;
|
|
u32 step;
|
|
u32 mask;
|
|
|
|
blob = (struct sof_ipc4_alh_configuration_blob *)ipc4_copier->copier_config;
|
|
|
|
blob->gw_attr.lp_buffer_alloc = 0;
|
|
|
|
/* Get channel_mask from ch_map */
|
|
ch_map = copier_data->base_config.audio_fmt.ch_map;
|
|
for (i = 0; ch_map; i++) {
|
|
if ((ch_map & 0xf) != 0xf) {
|
|
ch_mask |= BIT(i);
|
|
ch_count++;
|
|
}
|
|
ch_map >>= 4;
|
|
}
|
|
|
|
step = ch_count / blob->alh_cfg.device_count;
|
|
mask = GENMASK(step - 1, 0);
|
|
/*
|
|
* Set each gtw_cfg.node_id to blob->alh_cfg.mapping[]
|
|
* for all widgets with the same stream name
|
|
*/
|
|
i = 0;
|
|
list_for_each_entry(w, &sdev->widget_list, list) {
|
|
u32 node_type;
|
|
|
|
if (w->widget->sname &&
|
|
strcmp(w->widget->sname, swidget->widget->sname))
|
|
continue;
|
|
|
|
dai = w->private;
|
|
alh_copier = (struct sof_ipc4_copier *)dai->private;
|
|
alh_data = &alh_copier->data;
|
|
node_type = SOF_IPC4_GET_NODE_TYPE(alh_data->gtw_cfg.node_id);
|
|
blob->alh_cfg.mapping[i].device = SOF_IPC4_NODE_TYPE(node_type);
|
|
blob->alh_cfg.mapping[i].device |=
|
|
SOF_IPC4_NODE_INDEX(alh_copier->dai_index);
|
|
|
|
/*
|
|
* The mapping[i] device in ALH blob should be the same as the
|
|
* dma_config_tlv[i] mapping device if a dma_config_tlv is present.
|
|
* The device id will be used for DMA tlv mapping purposes.
|
|
*/
|
|
if (ipc4_copier->dma_config_tlv[i].length) {
|
|
dma_config = &ipc4_copier->dma_config_tlv[i].dma_config;
|
|
blob->alh_cfg.mapping[i].device =
|
|
dma_config->dma_stream_channel_map.mapping[0].device;
|
|
}
|
|
|
|
/*
|
|
* Set the same channel mask for playback as the audio data is
|
|
* duplicated for all speakers. For capture, split the channels
|
|
* among the aggregated DAIs. For example, with 4 channels on 2
|
|
* aggregated DAIs, the channel_mask should be 0x3 and 0xc for the
|
|
* two DAI's.
|
|
* The channel masks used depend on the cpu_dais used in the
|
|
* dailink at the machine driver level, which actually comes from
|
|
* the tables in soc_acpi files depending on the _ADR and devID
|
|
* registers for each codec.
|
|
*/
|
|
if (w->id == snd_soc_dapm_dai_in)
|
|
blob->alh_cfg.mapping[i].channel_mask = ch_mask;
|
|
else
|
|
blob->alh_cfg.mapping[i].channel_mask = mask << (step * i);
|
|
|
|
i++;
|
|
}
|
|
if (blob->alh_cfg.device_count > 1) {
|
|
int group_id;
|
|
|
|
group_id = ida_alloc_max(&alh_group_ida, ALH_MULTI_GTW_COUNT - 1,
|
|
GFP_KERNEL);
|
|
|
|
if (group_id < 0)
|
|
return group_id;
|
|
|
|
/* add multi-gateway base */
|
|
group_id += ALH_MULTI_GTW_BASE;
|
|
copier_data->gtw_cfg.node_id &= ~SOF_IPC4_NODE_INDEX_MASK;
|
|
copier_data->gtw_cfg.node_id |= SOF_IPC4_NODE_INDEX(group_id);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/* modify the input params for the next widget */
|
|
ret = sof_ipc4_update_hw_params(sdev, pipeline_params,
|
|
&copier_data->out_format,
|
|
BIT(SNDRV_PCM_HW_PARAM_FORMAT) |
|
|
BIT(SNDRV_PCM_HW_PARAM_CHANNELS) |
|
|
BIT(SNDRV_PCM_HW_PARAM_RATE));
|
|
if (ret)
|
|
return ret;
|
|
|
|
/*
|
|
* Set the gateway dma_buffer_size to 2ms buffer size to meet the FW expectation. In the
|
|
* deep buffer case, set the dma_buffer_size depending on the deep_buffer_dma_ms set
|
|
* in topology.
|
|
*/
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_dai_in:
|
|
copier_data->gtw_cfg.dma_buffer_size =
|
|
SOF_IPC4_MIN_DMA_BUFFER_SIZE * copier_data->base_config.ibs;
|
|
break;
|
|
case snd_soc_dapm_aif_in:
|
|
copier_data->gtw_cfg.dma_buffer_size =
|
|
max((u32)SOF_IPC4_MIN_DMA_BUFFER_SIZE, deep_buffer_dma_ms) *
|
|
copier_data->base_config.ibs;
|
|
dev_dbg(sdev->dev, "copier %s, dma buffer%s: %u ms (%u bytes)",
|
|
swidget->widget->name,
|
|
deep_buffer_dma_ms ? " (using Deep Buffer)" : "",
|
|
max((u32)SOF_IPC4_MIN_DMA_BUFFER_SIZE, deep_buffer_dma_ms),
|
|
copier_data->gtw_cfg.dma_buffer_size);
|
|
break;
|
|
case snd_soc_dapm_dai_out:
|
|
case snd_soc_dapm_aif_out:
|
|
copier_data->gtw_cfg.dma_buffer_size =
|
|
SOF_IPC4_MIN_DMA_BUFFER_SIZE * copier_data->base_config.obs;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
data = &ipc4_copier->copier_config;
|
|
ipc_config_size = &ipc4_copier->ipc_config_size;
|
|
ipc_config_data = &ipc4_copier->ipc_config_data;
|
|
|
|
/* config_length is DWORD based */
|
|
gtw_cfg_config_length = copier_data->gtw_cfg.config_length * 4;
|
|
ipc_size = sizeof(*copier_data) + gtw_cfg_config_length;
|
|
|
|
dma_config_tlv_size = 0;
|
|
for (i = 0; i < SOF_IPC4_DMA_DEVICE_MAX_COUNT; i++) {
|
|
if (ipc4_copier->dma_config_tlv[i].type != SOF_IPC4_GTW_DMA_CONFIG_ID)
|
|
continue;
|
|
dma_config_tlv_size += ipc4_copier->dma_config_tlv[i].length;
|
|
dma_config_tlv_size +=
|
|
ipc4_copier->dma_config_tlv[i].dma_config.dma_priv_config_size;
|
|
dma_config_tlv_size += (sizeof(ipc4_copier->dma_config_tlv[i]) -
|
|
sizeof(ipc4_copier->dma_config_tlv[i].dma_config));
|
|
}
|
|
|
|
if (dma_config_tlv_size) {
|
|
ipc_size += dma_config_tlv_size;
|
|
|
|
/* we also need to increase the size at the gtw level */
|
|
copier_data->gtw_cfg.config_length += dma_config_tlv_size / 4;
|
|
}
|
|
|
|
dev_dbg(sdev->dev, "copier %s, IPC size is %d", swidget->widget->name, ipc_size);
|
|
|
|
*ipc_config_data = kzalloc(ipc_size, GFP_KERNEL);
|
|
if (!*ipc_config_data)
|
|
return -ENOMEM;
|
|
|
|
*ipc_config_size = ipc_size;
|
|
|
|
/* update pipeline memory usage */
|
|
sof_ipc4_update_resource_usage(sdev, swidget, &copier_data->base_config);
|
|
|
|
/* copy IPC data */
|
|
memcpy(*ipc_config_data, (void *)copier_data, sizeof(*copier_data));
|
|
if (gtw_cfg_config_length)
|
|
memcpy(*ipc_config_data + sizeof(*copier_data),
|
|
*data, gtw_cfg_config_length);
|
|
|
|
/* add DMA Config TLV, if configured */
|
|
if (dma_config_tlv_size)
|
|
memcpy(*ipc_config_data + sizeof(*copier_data) +
|
|
gtw_cfg_config_length,
|
|
&ipc4_copier->dma_config_tlv, dma_config_tlv_size);
|
|
|
|
/*
|
|
* Restore gateway config length now that IPC payload is prepared. This avoids
|
|
* counting the DMA CONFIG TLV multiple times
|
|
*/
|
|
copier_data->gtw_cfg.config_length = gtw_cfg_config_length / 4;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_prepare_gain_module(struct snd_sof_widget *swidget,
|
|
struct snd_pcm_hw_params *fe_params,
|
|
struct snd_sof_platform_stream_params *platform_params,
|
|
struct snd_pcm_hw_params *pipeline_params, int dir)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_gain *gain = swidget->private;
|
|
struct sof_ipc4_available_audio_format *available_fmt = &gain->available_fmt;
|
|
struct sof_ipc4_audio_format *in_fmt;
|
|
u32 out_ref_rate, out_ref_channels, out_ref_valid_bits;
|
|
int ret;
|
|
|
|
ret = sof_ipc4_init_input_audio_fmt(sdev, swidget, &gain->data.base_config,
|
|
pipeline_params, available_fmt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
in_fmt = &available_fmt->input_pin_fmts[ret].audio_fmt;
|
|
out_ref_rate = in_fmt->sampling_frequency;
|
|
out_ref_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(in_fmt->fmt_cfg);
|
|
out_ref_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(in_fmt->fmt_cfg);
|
|
|
|
ret = sof_ipc4_init_output_audio_fmt(sdev, &gain->data.base_config, available_fmt,
|
|
out_ref_rate, out_ref_channels, out_ref_valid_bits);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev, "Failed to initialize output format for %s",
|
|
swidget->widget->name);
|
|
return ret;
|
|
}
|
|
|
|
/* update pipeline memory usage */
|
|
sof_ipc4_update_resource_usage(sdev, swidget, &gain->data.base_config);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_prepare_mixer_module(struct snd_sof_widget *swidget,
|
|
struct snd_pcm_hw_params *fe_params,
|
|
struct snd_sof_platform_stream_params *platform_params,
|
|
struct snd_pcm_hw_params *pipeline_params, int dir)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_mixer *mixer = swidget->private;
|
|
struct sof_ipc4_available_audio_format *available_fmt = &mixer->available_fmt;
|
|
struct sof_ipc4_audio_format *in_fmt;
|
|
u32 out_ref_rate, out_ref_channels, out_ref_valid_bits;
|
|
int ret;
|
|
|
|
ret = sof_ipc4_init_input_audio_fmt(sdev, swidget, &mixer->base_config,
|
|
pipeline_params, available_fmt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
in_fmt = &available_fmt->input_pin_fmts[ret].audio_fmt;
|
|
out_ref_rate = in_fmt->sampling_frequency;
|
|
out_ref_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(in_fmt->fmt_cfg);
|
|
out_ref_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(in_fmt->fmt_cfg);
|
|
|
|
ret = sof_ipc4_init_output_audio_fmt(sdev, &mixer->base_config, available_fmt,
|
|
out_ref_rate, out_ref_channels, out_ref_valid_bits);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev, "Failed to initialize output format for %s",
|
|
swidget->widget->name);
|
|
return ret;
|
|
}
|
|
|
|
/* update pipeline memory usage */
|
|
sof_ipc4_update_resource_usage(sdev, swidget, &mixer->base_config);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_prepare_src_module(struct snd_sof_widget *swidget,
|
|
struct snd_pcm_hw_params *fe_params,
|
|
struct snd_sof_platform_stream_params *platform_params,
|
|
struct snd_pcm_hw_params *pipeline_params, int dir)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_src *src = swidget->private;
|
|
struct sof_ipc4_available_audio_format *available_fmt = &src->available_fmt;
|
|
struct sof_ipc4_audio_format *out_audio_fmt;
|
|
struct sof_ipc4_audio_format *in_audio_fmt;
|
|
u32 out_ref_rate, out_ref_channels, out_ref_valid_bits;
|
|
int output_format_index, input_format_index;
|
|
|
|
input_format_index = sof_ipc4_init_input_audio_fmt(sdev, swidget, &src->data.base_config,
|
|
pipeline_params, available_fmt);
|
|
if (input_format_index < 0)
|
|
return input_format_index;
|
|
|
|
/*
|
|
* For playback, the SRC sink rate will be configured based on the requested output
|
|
* format, which is restricted to only deal with DAI's with a single format for now.
|
|
*/
|
|
if (dir == SNDRV_PCM_STREAM_PLAYBACK && available_fmt->num_output_formats > 1) {
|
|
dev_err(sdev->dev, "Invalid number of output formats: %d for SRC %s\n",
|
|
available_fmt->num_output_formats, swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* SRC does not perform format conversion, so the output channels and valid bit depth must
|
|
* be the same as that of the input.
|
|
*/
|
|
in_audio_fmt = &available_fmt->input_pin_fmts[input_format_index].audio_fmt;
|
|
out_ref_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(in_audio_fmt->fmt_cfg);
|
|
out_ref_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(in_audio_fmt->fmt_cfg);
|
|
|
|
/*
|
|
* For capture, the SRC module should convert the rate to match the rate requested by the
|
|
* PCM hw_params. Set the reference params based on the fe_params unconditionally as it
|
|
* will be ignored for playback anyway.
|
|
*/
|
|
out_ref_rate = params_rate(fe_params);
|
|
|
|
output_format_index = sof_ipc4_init_output_audio_fmt(sdev, &src->data.base_config,
|
|
available_fmt, out_ref_rate,
|
|
out_ref_channels, out_ref_valid_bits);
|
|
if (output_format_index < 0) {
|
|
dev_err(sdev->dev, "Failed to initialize output format for %s",
|
|
swidget->widget->name);
|
|
return output_format_index;
|
|
}
|
|
|
|
/* update pipeline memory usage */
|
|
sof_ipc4_update_resource_usage(sdev, swidget, &src->data.base_config);
|
|
|
|
out_audio_fmt = &available_fmt->output_pin_fmts[output_format_index].audio_fmt;
|
|
src->data.sink_rate = out_audio_fmt->sampling_frequency;
|
|
|
|
/* update pipeline_params for sink widgets */
|
|
return sof_ipc4_update_hw_params(sdev, pipeline_params, out_audio_fmt,
|
|
BIT(SNDRV_PCM_HW_PARAM_FORMAT) |
|
|
BIT(SNDRV_PCM_HW_PARAM_CHANNELS) |
|
|
BIT(SNDRV_PCM_HW_PARAM_RATE));
|
|
}
|
|
|
|
static int
|
|
sof_ipc4_process_set_pin_formats(struct snd_sof_widget *swidget, int pin_type)
|
|
{
|
|
struct sof_ipc4_process *process = swidget->private;
|
|
struct sof_ipc4_base_module_cfg_ext *base_cfg_ext = process->base_config_ext;
|
|
struct sof_ipc4_available_audio_format *available_fmt = &process->available_fmt;
|
|
struct sof_ipc4_pin_format *pin_format, *format_list_to_search;
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
int num_pins, format_list_count;
|
|
int pin_format_offset = 0;
|
|
int i, j;
|
|
|
|
/* set number of pins, offset of pin format and format list to search based on pin type */
|
|
if (pin_type == SOF_PIN_TYPE_INPUT) {
|
|
num_pins = swidget->num_input_pins;
|
|
format_list_to_search = available_fmt->input_pin_fmts;
|
|
format_list_count = available_fmt->num_input_formats;
|
|
} else {
|
|
num_pins = swidget->num_output_pins;
|
|
pin_format_offset = swidget->num_input_pins;
|
|
format_list_to_search = available_fmt->output_pin_fmts;
|
|
format_list_count = available_fmt->num_output_formats;
|
|
}
|
|
|
|
for (i = pin_format_offset; i < num_pins + pin_format_offset; i++) {
|
|
pin_format = &base_cfg_ext->pin_formats[i];
|
|
|
|
/* Pin 0 audio formats are derived from the base config input/output format */
|
|
if (i == pin_format_offset) {
|
|
if (pin_type == SOF_PIN_TYPE_INPUT) {
|
|
pin_format->buffer_size = process->base_config.ibs;
|
|
pin_format->audio_fmt = process->base_config.audio_fmt;
|
|
} else {
|
|
pin_format->buffer_size = process->base_config.obs;
|
|
pin_format->audio_fmt = process->output_format;
|
|
}
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* For all other pins, find the pin formats from those set in topology. If there
|
|
* is more than one format specified for a pin, this will pick the first available
|
|
* one.
|
|
*/
|
|
for (j = 0; j < format_list_count; j++) {
|
|
struct sof_ipc4_pin_format *pin_format_item = &format_list_to_search[j];
|
|
|
|
if (pin_format_item->pin_index == i - pin_format_offset) {
|
|
*pin_format = *pin_format_item;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (j == format_list_count) {
|
|
dev_err(scomp->dev, "%s pin %d format not found for %s\n",
|
|
(pin_type == SOF_PIN_TYPE_INPUT) ? "input" : "output",
|
|
i - pin_format_offset, swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_process_add_base_cfg_extn(struct snd_sof_widget *swidget)
|
|
{
|
|
int ret, i;
|
|
|
|
/* copy input and output pin formats */
|
|
for (i = 0; i <= SOF_PIN_TYPE_OUTPUT; i++) {
|
|
ret = sof_ipc4_process_set_pin_formats(swidget, i);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_prepare_process_module(struct snd_sof_widget *swidget,
|
|
struct snd_pcm_hw_params *fe_params,
|
|
struct snd_sof_platform_stream_params *platform_params,
|
|
struct snd_pcm_hw_params *pipeline_params, int dir)
|
|
{
|
|
struct snd_soc_component *scomp = swidget->scomp;
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_process *process = swidget->private;
|
|
struct sof_ipc4_available_audio_format *available_fmt = &process->available_fmt;
|
|
struct sof_ipc4_audio_format *in_fmt;
|
|
u32 out_ref_rate, out_ref_channels, out_ref_valid_bits;
|
|
void *cfg = process->ipc_config_data;
|
|
int output_fmt_index;
|
|
int ret;
|
|
|
|
ret = sof_ipc4_init_input_audio_fmt(sdev, swidget, &process->base_config,
|
|
pipeline_params, available_fmt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
in_fmt = &available_fmt->input_pin_fmts[ret].audio_fmt;
|
|
out_ref_rate = in_fmt->sampling_frequency;
|
|
out_ref_channels = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(in_fmt->fmt_cfg);
|
|
out_ref_valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(in_fmt->fmt_cfg);
|
|
|
|
output_fmt_index = sof_ipc4_init_output_audio_fmt(sdev, &process->base_config,
|
|
available_fmt, out_ref_rate,
|
|
out_ref_channels, out_ref_valid_bits);
|
|
if (output_fmt_index < 0 && available_fmt->num_output_formats) {
|
|
dev_err(sdev->dev, "Failed to initialize output format for %s",
|
|
swidget->widget->name);
|
|
return output_fmt_index;
|
|
}
|
|
|
|
/* copy Pin 0 output format */
|
|
if (available_fmt->num_output_formats &&
|
|
output_fmt_index < available_fmt->num_output_formats &&
|
|
!available_fmt->output_pin_fmts[output_fmt_index].pin_index) {
|
|
memcpy(&process->output_format,
|
|
&available_fmt->output_pin_fmts[output_fmt_index].audio_fmt,
|
|
sizeof(struct sof_ipc4_audio_format));
|
|
|
|
/* modify the pipeline params with the pin 0 output format */
|
|
ret = sof_ipc4_update_hw_params(sdev, pipeline_params,
|
|
&process->output_format,
|
|
BIT(SNDRV_PCM_HW_PARAM_FORMAT) |
|
|
BIT(SNDRV_PCM_HW_PARAM_CHANNELS) |
|
|
BIT(SNDRV_PCM_HW_PARAM_RATE));
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
/* update pipeline memory usage */
|
|
sof_ipc4_update_resource_usage(sdev, swidget, &process->base_config);
|
|
|
|
/* ipc_config_data is composed of the base_config followed by an optional extension */
|
|
memcpy(cfg, &process->base_config, sizeof(struct sof_ipc4_base_module_cfg));
|
|
cfg += sizeof(struct sof_ipc4_base_module_cfg);
|
|
|
|
if (process->init_config == SOF_IPC4_MODULE_INIT_CONFIG_TYPE_BASE_CFG_WITH_EXT) {
|
|
struct sof_ipc4_base_module_cfg_ext *base_cfg_ext = process->base_config_ext;
|
|
|
|
ret = sof_ipc4_process_add_base_cfg_extn(swidget);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
memcpy(cfg, base_cfg_ext, process->base_config_ext_size);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_control_load_volume(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
|
|
{
|
|
struct sof_ipc4_control_data *control_data;
|
|
struct sof_ipc4_msg *msg;
|
|
int i;
|
|
|
|
scontrol->size = struct_size(control_data, chanv, scontrol->num_channels);
|
|
|
|
/* scontrol->ipc_control_data will be freed in sof_control_unload */
|
|
scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
|
|
if (!scontrol->ipc_control_data)
|
|
return -ENOMEM;
|
|
|
|
control_data = scontrol->ipc_control_data;
|
|
control_data->index = scontrol->index;
|
|
|
|
msg = &control_data->msg;
|
|
msg->primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_LARGE_CONFIG_SET);
|
|
msg->primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
msg->primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
/* volume controls with range 0-1 (off/on) are switch controls */
|
|
if (scontrol->max == 1)
|
|
msg->extension = SOF_IPC4_MOD_EXT_MSG_PARAM_ID(SOF_IPC4_SWITCH_CONTROL_PARAM_ID);
|
|
else
|
|
msg->extension = SOF_IPC4_MOD_EXT_MSG_PARAM_ID(SOF_IPC4_GAIN_PARAM_ID);
|
|
|
|
for (i = 0; i < scontrol->num_channels; i++) {
|
|
control_data->chanv[i].channel = i;
|
|
/*
|
|
* Default, initial values:
|
|
* - 0dB for volume controls
|
|
* - off (0) for switch controls - value already zero after
|
|
* memory allocation
|
|
*/
|
|
if (scontrol->max > 1)
|
|
control_data->chanv[i].value = SOF_IPC4_VOL_ZERO_DB;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_control_load_enum(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
|
|
{
|
|
struct sof_ipc4_control_data *control_data;
|
|
struct sof_ipc4_msg *msg;
|
|
int i;
|
|
|
|
scontrol->size = struct_size(control_data, chanv, scontrol->num_channels);
|
|
|
|
/* scontrol->ipc_control_data will be freed in sof_control_unload */
|
|
scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
|
|
if (!scontrol->ipc_control_data)
|
|
return -ENOMEM;
|
|
|
|
control_data = scontrol->ipc_control_data;
|
|
control_data->index = scontrol->index;
|
|
|
|
msg = &control_data->msg;
|
|
msg->primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_LARGE_CONFIG_SET);
|
|
msg->primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
msg->primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
msg->extension = SOF_IPC4_MOD_EXT_MSG_PARAM_ID(SOF_IPC4_ENUM_CONTROL_PARAM_ID);
|
|
|
|
/* Default, initial value for enums: first enum entry is selected (0) */
|
|
for (i = 0; i < scontrol->num_channels; i++)
|
|
control_data->chanv[i].channel = i;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_control_load_bytes(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
|
|
{
|
|
struct sof_ipc4_control_data *control_data;
|
|
struct sof_ipc4_msg *msg;
|
|
int ret;
|
|
|
|
if (scontrol->max_size < (sizeof(*control_data) + sizeof(struct sof_abi_hdr))) {
|
|
dev_err(sdev->dev, "insufficient size for a bytes control %s: %zu.\n",
|
|
scontrol->name, scontrol->max_size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (scontrol->priv_size > scontrol->max_size - sizeof(*control_data)) {
|
|
dev_err(sdev->dev, "scontrol %s bytes data size %zu exceeds max %zu.\n",
|
|
scontrol->name, scontrol->priv_size,
|
|
scontrol->max_size - sizeof(*control_data));
|
|
return -EINVAL;
|
|
}
|
|
|
|
scontrol->size = sizeof(struct sof_ipc4_control_data) + scontrol->priv_size;
|
|
|
|
scontrol->ipc_control_data = kzalloc(scontrol->max_size, GFP_KERNEL);
|
|
if (!scontrol->ipc_control_data)
|
|
return -ENOMEM;
|
|
|
|
control_data = scontrol->ipc_control_data;
|
|
control_data->index = scontrol->index;
|
|
if (scontrol->priv_size > 0) {
|
|
memcpy(control_data->data, scontrol->priv, scontrol->priv_size);
|
|
kfree(scontrol->priv);
|
|
scontrol->priv = NULL;
|
|
|
|
if (control_data->data->magic != SOF_IPC4_ABI_MAGIC) {
|
|
dev_err(sdev->dev, "Wrong ABI magic (%#x) for control: %s\n",
|
|
control_data->data->magic, scontrol->name);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
/* TODO: check the ABI version */
|
|
|
|
if (control_data->data->size + sizeof(struct sof_abi_hdr) !=
|
|
scontrol->priv_size) {
|
|
dev_err(sdev->dev, "Control %s conflict in bytes %zu vs. priv size %zu.\n",
|
|
scontrol->name,
|
|
control_data->data->size + sizeof(struct sof_abi_hdr),
|
|
scontrol->priv_size);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
}
|
|
|
|
msg = &control_data->msg;
|
|
msg->primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_LARGE_CONFIG_SET);
|
|
msg->primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
msg->primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
return 0;
|
|
|
|
err:
|
|
kfree(scontrol->ipc_control_data);
|
|
scontrol->ipc_control_data = NULL;
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_control_setup(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
|
|
{
|
|
switch (scontrol->info_type) {
|
|
case SND_SOC_TPLG_CTL_VOLSW:
|
|
case SND_SOC_TPLG_CTL_VOLSW_SX:
|
|
case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
|
|
return sof_ipc4_control_load_volume(sdev, scontrol);
|
|
case SND_SOC_TPLG_CTL_BYTES:
|
|
return sof_ipc4_control_load_bytes(sdev, scontrol);
|
|
case SND_SOC_TPLG_CTL_ENUM:
|
|
case SND_SOC_TPLG_CTL_ENUM_VALUE:
|
|
return sof_ipc4_control_load_enum(sdev, scontrol);
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
|
|
{
|
|
struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget;
|
|
struct sof_ipc4_fw_data *ipc4_data = sdev->private;
|
|
struct sof_ipc4_pipeline *pipeline;
|
|
struct sof_ipc4_msg *msg;
|
|
void *ipc_data = NULL;
|
|
u32 ipc_size = 0;
|
|
int ret;
|
|
|
|
switch (swidget->id) {
|
|
case snd_soc_dapm_scheduler:
|
|
pipeline = swidget->private;
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
dev_warn(sdev->dev, "use_chain_dma set for scheduler %s",
|
|
swidget->widget->name);
|
|
return 0;
|
|
}
|
|
|
|
dev_dbg(sdev->dev, "pipeline: %d memory pages: %d\n", swidget->pipeline_id,
|
|
pipeline->mem_usage);
|
|
|
|
msg = &pipeline->msg;
|
|
msg->primary |= pipeline->mem_usage;
|
|
|
|
swidget->instance_id = ida_alloc_max(&pipeline_ida, ipc4_data->max_num_pipelines,
|
|
GFP_KERNEL);
|
|
if (swidget->instance_id < 0) {
|
|
dev_err(sdev->dev, "failed to assign pipeline id for %s: %d\n",
|
|
swidget->widget->name, swidget->instance_id);
|
|
return swidget->instance_id;
|
|
}
|
|
msg->primary &= ~SOF_IPC4_GLB_PIPE_INSTANCE_MASK;
|
|
msg->primary |= SOF_IPC4_GLB_PIPE_INSTANCE_ID(swidget->instance_id);
|
|
break;
|
|
case snd_soc_dapm_aif_in:
|
|
case snd_soc_dapm_aif_out:
|
|
case snd_soc_dapm_buffer:
|
|
{
|
|
struct sof_ipc4_copier *ipc4_copier = swidget->private;
|
|
|
|
pipeline = pipe_widget->private;
|
|
if (pipeline->use_chain_dma)
|
|
return 0;
|
|
|
|
ipc_size = ipc4_copier->ipc_config_size;
|
|
ipc_data = ipc4_copier->ipc_config_data;
|
|
|
|
msg = &ipc4_copier->msg;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_dai_in:
|
|
case snd_soc_dapm_dai_out:
|
|
{
|
|
struct snd_sof_dai *dai = swidget->private;
|
|
struct sof_ipc4_copier *ipc4_copier = dai->private;
|
|
|
|
pipeline = pipe_widget->private;
|
|
if (pipeline->use_chain_dma)
|
|
return 0;
|
|
|
|
ipc_size = ipc4_copier->ipc_config_size;
|
|
ipc_data = ipc4_copier->ipc_config_data;
|
|
|
|
msg = &ipc4_copier->msg;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_pga:
|
|
{
|
|
struct sof_ipc4_gain *gain = swidget->private;
|
|
|
|
ipc_size = sizeof(gain->data);
|
|
ipc_data = &gain->data;
|
|
|
|
msg = &gain->msg;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_mixer:
|
|
{
|
|
struct sof_ipc4_mixer *mixer = swidget->private;
|
|
|
|
ipc_size = sizeof(mixer->base_config);
|
|
ipc_data = &mixer->base_config;
|
|
|
|
msg = &mixer->msg;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_src:
|
|
{
|
|
struct sof_ipc4_src *src = swidget->private;
|
|
|
|
ipc_size = sizeof(src->data);
|
|
ipc_data = &src->data;
|
|
|
|
msg = &src->msg;
|
|
break;
|
|
}
|
|
case snd_soc_dapm_effect:
|
|
{
|
|
struct sof_ipc4_process *process = swidget->private;
|
|
|
|
if (!process->ipc_config_size) {
|
|
dev_err(sdev->dev, "module %s has no config data!\n",
|
|
swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ipc_size = process->ipc_config_size;
|
|
ipc_data = process->ipc_config_data;
|
|
|
|
msg = &process->msg;
|
|
break;
|
|
}
|
|
default:
|
|
dev_err(sdev->dev, "widget type %d not supported", swidget->id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (swidget->id != snd_soc_dapm_scheduler) {
|
|
int module_id = msg->primary & SOF_IPC4_MOD_ID_MASK;
|
|
|
|
ret = sof_ipc4_widget_assign_instance_id(sdev, swidget);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev, "failed to assign instance id for %s\n",
|
|
swidget->widget->name);
|
|
return ret;
|
|
}
|
|
|
|
msg->primary &= ~SOF_IPC4_MOD_INSTANCE_MASK;
|
|
msg->primary |= SOF_IPC4_MOD_INSTANCE(swidget->instance_id);
|
|
|
|
msg->extension &= ~SOF_IPC4_MOD_EXT_PARAM_SIZE_MASK;
|
|
msg->extension |= ipc_size >> 2;
|
|
|
|
msg->extension &= ~SOF_IPC4_MOD_EXT_PPL_ID_MASK;
|
|
msg->extension |= SOF_IPC4_MOD_EXT_PPL_ID(pipe_widget->instance_id);
|
|
|
|
dev_dbg(sdev->dev, "Create widget %s (pipe %d) - ID %d, instance %d, core %d\n",
|
|
swidget->widget->name, swidget->pipeline_id, module_id,
|
|
swidget->instance_id, swidget->core);
|
|
} else {
|
|
dev_dbg(sdev->dev, "Create pipeline %s (pipe %d) - instance %d, core %d\n",
|
|
swidget->widget->name, swidget->pipeline_id,
|
|
swidget->instance_id, swidget->core);
|
|
}
|
|
|
|
msg->data_size = ipc_size;
|
|
msg->data_ptr = ipc_data;
|
|
|
|
ret = sof_ipc_tx_message_no_reply(sdev->ipc, msg, ipc_size);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev, "failed to create module %s\n", swidget->widget->name);
|
|
|
|
if (swidget->id != snd_soc_dapm_scheduler) {
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
|
|
ida_free(&fw_module->m_ida, swidget->instance_id);
|
|
} else {
|
|
ida_free(&pipeline_ida, swidget->instance_id);
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
|
|
{
|
|
struct sof_ipc4_fw_module *fw_module = swidget->module_info;
|
|
struct sof_ipc4_fw_data *ipc4_data = sdev->private;
|
|
int ret = 0;
|
|
|
|
mutex_lock(&ipc4_data->pipeline_state_mutex);
|
|
|
|
/* freeing a pipeline frees all the widgets associated with it */
|
|
if (swidget->id == snd_soc_dapm_scheduler) {
|
|
struct sof_ipc4_pipeline *pipeline = swidget->private;
|
|
struct sof_ipc4_msg msg = {{ 0 }};
|
|
u32 header;
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
dev_warn(sdev->dev, "use_chain_dma set for scheduler %s",
|
|
swidget->widget->name);
|
|
mutex_unlock(&ipc4_data->pipeline_state_mutex);
|
|
return 0;
|
|
}
|
|
|
|
header = SOF_IPC4_GLB_PIPE_INSTANCE_ID(swidget->instance_id);
|
|
header |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_GLB_DELETE_PIPELINE);
|
|
header |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
header |= SOF_IPC4_MSG_TARGET(SOF_IPC4_FW_GEN_MSG);
|
|
|
|
msg.primary = header;
|
|
|
|
ret = sof_ipc_tx_message_no_reply(sdev->ipc, &msg, 0);
|
|
if (ret < 0)
|
|
dev_err(sdev->dev, "failed to free pipeline widget %s\n",
|
|
swidget->widget->name);
|
|
|
|
pipeline->mem_usage = 0;
|
|
pipeline->state = SOF_IPC4_PIPE_UNINITIALIZED;
|
|
ida_free(&pipeline_ida, swidget->instance_id);
|
|
swidget->instance_id = -EINVAL;
|
|
} else {
|
|
struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline = pipe_widget->private;
|
|
|
|
if (!pipeline->use_chain_dma)
|
|
ida_free(&fw_module->m_ida, swidget->instance_id);
|
|
}
|
|
|
|
mutex_unlock(&ipc4_data->pipeline_state_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_get_queue_id(struct snd_sof_widget *src_widget,
|
|
struct snd_sof_widget *sink_widget, bool pin_type)
|
|
{
|
|
struct snd_sof_widget *current_swidget;
|
|
struct snd_soc_component *scomp;
|
|
struct ida *queue_ida;
|
|
const char *buddy_name;
|
|
char **pin_binding;
|
|
u32 num_pins;
|
|
int i;
|
|
|
|
if (pin_type == SOF_PIN_TYPE_OUTPUT) {
|
|
current_swidget = src_widget;
|
|
pin_binding = src_widget->output_pin_binding;
|
|
queue_ida = &src_widget->output_queue_ida;
|
|
num_pins = src_widget->num_output_pins;
|
|
buddy_name = sink_widget->widget->name;
|
|
} else {
|
|
current_swidget = sink_widget;
|
|
pin_binding = sink_widget->input_pin_binding;
|
|
queue_ida = &sink_widget->input_queue_ida;
|
|
num_pins = sink_widget->num_input_pins;
|
|
buddy_name = src_widget->widget->name;
|
|
}
|
|
|
|
scomp = current_swidget->scomp;
|
|
|
|
if (num_pins < 1) {
|
|
dev_err(scomp->dev, "invalid %s num_pins: %d for queue allocation for %s\n",
|
|
(pin_type == SOF_PIN_TYPE_OUTPUT ? "output" : "input"),
|
|
num_pins, current_swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* If there is only one input/output pin, queue id must be 0 */
|
|
if (num_pins == 1)
|
|
return 0;
|
|
|
|
/* Allocate queue ID from pin binding array if it is defined in topology. */
|
|
if (pin_binding) {
|
|
for (i = 0; i < num_pins; i++) {
|
|
if (!strcmp(pin_binding[i], buddy_name))
|
|
return i;
|
|
}
|
|
/*
|
|
* Fail if no queue ID found from pin binding array, so that we don't
|
|
* mixed use pin binding array and ida for queue ID allocation.
|
|
*/
|
|
dev_err(scomp->dev, "no %s queue id found from pin binding array for %s\n",
|
|
(pin_type == SOF_PIN_TYPE_OUTPUT ? "output" : "input"),
|
|
current_swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* If no pin binding array specified in topology, use ida to allocate one */
|
|
return ida_alloc_max(queue_ida, num_pins, GFP_KERNEL);
|
|
}
|
|
|
|
static void sof_ipc4_put_queue_id(struct snd_sof_widget *swidget, int queue_id,
|
|
bool pin_type)
|
|
{
|
|
struct ida *queue_ida;
|
|
char **pin_binding;
|
|
int num_pins;
|
|
|
|
if (pin_type == SOF_PIN_TYPE_OUTPUT) {
|
|
pin_binding = swidget->output_pin_binding;
|
|
queue_ida = &swidget->output_queue_ida;
|
|
num_pins = swidget->num_output_pins;
|
|
} else {
|
|
pin_binding = swidget->input_pin_binding;
|
|
queue_ida = &swidget->input_queue_ida;
|
|
num_pins = swidget->num_input_pins;
|
|
}
|
|
|
|
/* Nothing to free if queue ID is not allocated with ida. */
|
|
if (num_pins == 1 || pin_binding)
|
|
return;
|
|
|
|
ida_free(queue_ida, queue_id);
|
|
}
|
|
|
|
static int sof_ipc4_set_copier_sink_format(struct snd_sof_dev *sdev,
|
|
struct snd_sof_widget *src_widget,
|
|
struct snd_sof_widget *sink_widget,
|
|
struct snd_sof_route *sroute)
|
|
{
|
|
struct sof_ipc4_copier_config_set_sink_format format;
|
|
const struct sof_ipc_ops *iops = sdev->ipc->ops;
|
|
struct sof_ipc4_base_module_cfg *src_config;
|
|
const struct sof_ipc4_audio_format *pin_fmt;
|
|
struct sof_ipc4_fw_module *fw_module;
|
|
struct sof_ipc4_msg msg = {{ 0 }};
|
|
|
|
if (WIDGET_IS_DAI(src_widget->id)) {
|
|
struct snd_sof_dai *dai = src_widget->private;
|
|
|
|
src_config = dai->private;
|
|
} else {
|
|
src_config = src_widget->private;
|
|
}
|
|
|
|
fw_module = src_widget->module_info;
|
|
|
|
format.sink_id = sroute->src_queue_id;
|
|
memcpy(&format.source_fmt, &src_config->audio_fmt, sizeof(format.source_fmt));
|
|
|
|
pin_fmt = sof_ipc4_get_input_pin_audio_fmt(sink_widget, sroute->dst_queue_id);
|
|
if (!pin_fmt) {
|
|
dev_err(sdev->dev,
|
|
"Failed to get input audio format of %s:%d for output of %s:%d\n",
|
|
sink_widget->widget->name, sroute->dst_queue_id,
|
|
src_widget->widget->name, sroute->src_queue_id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
memcpy(&format.sink_fmt, pin_fmt, sizeof(format.sink_fmt));
|
|
|
|
msg.data_size = sizeof(format);
|
|
msg.data_ptr = &format;
|
|
|
|
msg.primary = fw_module->man4_module_entry.id;
|
|
msg.primary |= SOF_IPC4_MOD_INSTANCE(src_widget->instance_id);
|
|
msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
msg.extension =
|
|
SOF_IPC4_MOD_EXT_MSG_PARAM_ID(SOF_IPC4_COPIER_MODULE_CFG_PARAM_SET_SINK_FORMAT);
|
|
|
|
return iops->set_get_data(sdev, &msg, msg.data_size, true);
|
|
}
|
|
|
|
static int sof_ipc4_route_setup(struct snd_sof_dev *sdev, struct snd_sof_route *sroute)
|
|
{
|
|
struct snd_sof_widget *src_widget = sroute->src_widget;
|
|
struct snd_sof_widget *sink_widget = sroute->sink_widget;
|
|
struct snd_sof_widget *src_pipe_widget = src_widget->spipe->pipe_widget;
|
|
struct snd_sof_widget *sink_pipe_widget = sink_widget->spipe->pipe_widget;
|
|
struct sof_ipc4_fw_module *src_fw_module = src_widget->module_info;
|
|
struct sof_ipc4_fw_module *sink_fw_module = sink_widget->module_info;
|
|
struct sof_ipc4_pipeline *src_pipeline = src_pipe_widget->private;
|
|
struct sof_ipc4_pipeline *sink_pipeline = sink_pipe_widget->private;
|
|
struct sof_ipc4_msg msg = {{ 0 }};
|
|
u32 header, extension;
|
|
int ret;
|
|
|
|
/* no route set up if chain DMA is used */
|
|
if (src_pipeline->use_chain_dma || sink_pipeline->use_chain_dma) {
|
|
if (!src_pipeline->use_chain_dma || !sink_pipeline->use_chain_dma) {
|
|
dev_err(sdev->dev,
|
|
"use_chain_dma must be set for both src %s and sink %s pipelines\n",
|
|
src_widget->widget->name, sink_widget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
if (!src_fw_module || !sink_fw_module) {
|
|
dev_err(sdev->dev,
|
|
"cannot bind %s -> %s, no firmware module for: %s%s\n",
|
|
src_widget->widget->name, sink_widget->widget->name,
|
|
src_fw_module ? "" : " source",
|
|
sink_fw_module ? "" : " sink");
|
|
|
|
return -ENODEV;
|
|
}
|
|
|
|
sroute->src_queue_id = sof_ipc4_get_queue_id(src_widget, sink_widget,
|
|
SOF_PIN_TYPE_OUTPUT);
|
|
if (sroute->src_queue_id < 0) {
|
|
dev_err(sdev->dev,
|
|
"failed to get src_queue_id ID from source widget %s\n",
|
|
src_widget->widget->name);
|
|
return sroute->src_queue_id;
|
|
}
|
|
|
|
sroute->dst_queue_id = sof_ipc4_get_queue_id(src_widget, sink_widget,
|
|
SOF_PIN_TYPE_INPUT);
|
|
if (sroute->dst_queue_id < 0) {
|
|
dev_err(sdev->dev,
|
|
"failed to get dst_queue_id ID from sink widget %s\n",
|
|
sink_widget->widget->name);
|
|
sof_ipc4_put_queue_id(src_widget, sroute->src_queue_id,
|
|
SOF_PIN_TYPE_OUTPUT);
|
|
return sroute->dst_queue_id;
|
|
}
|
|
|
|
/* Pin 0 format is already set during copier module init */
|
|
if (sroute->src_queue_id > 0 && WIDGET_IS_COPIER(src_widget->id)) {
|
|
ret = sof_ipc4_set_copier_sink_format(sdev, src_widget,
|
|
sink_widget, sroute);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev,
|
|
"failed to set sink format for source %s:%d\n",
|
|
src_widget->widget->name, sroute->src_queue_id);
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
dev_dbg(sdev->dev, "bind %s:%d -> %s:%d\n",
|
|
src_widget->widget->name, sroute->src_queue_id,
|
|
sink_widget->widget->name, sroute->dst_queue_id);
|
|
|
|
header = src_fw_module->man4_module_entry.id;
|
|
header |= SOF_IPC4_MOD_INSTANCE(src_widget->instance_id);
|
|
header |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_BIND);
|
|
header |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
header |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
extension = sink_fw_module->man4_module_entry.id;
|
|
extension |= SOF_IPC4_MOD_EXT_DST_MOD_INSTANCE(sink_widget->instance_id);
|
|
extension |= SOF_IPC4_MOD_EXT_DST_MOD_QUEUE_ID(sroute->dst_queue_id);
|
|
extension |= SOF_IPC4_MOD_EXT_SRC_MOD_QUEUE_ID(sroute->src_queue_id);
|
|
|
|
msg.primary = header;
|
|
msg.extension = extension;
|
|
|
|
ret = sof_ipc_tx_message_no_reply(sdev->ipc, &msg, 0);
|
|
if (ret < 0) {
|
|
dev_err(sdev->dev, "failed to bind modules %s:%d -> %s:%d\n",
|
|
src_widget->widget->name, sroute->src_queue_id,
|
|
sink_widget->widget->name, sroute->dst_queue_id);
|
|
goto out;
|
|
}
|
|
|
|
return ret;
|
|
|
|
out:
|
|
sof_ipc4_put_queue_id(src_widget, sroute->src_queue_id, SOF_PIN_TYPE_OUTPUT);
|
|
sof_ipc4_put_queue_id(sink_widget, sroute->dst_queue_id, SOF_PIN_TYPE_INPUT);
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_route_free(struct snd_sof_dev *sdev, struct snd_sof_route *sroute)
|
|
{
|
|
struct snd_sof_widget *src_widget = sroute->src_widget;
|
|
struct snd_sof_widget *sink_widget = sroute->sink_widget;
|
|
struct sof_ipc4_fw_module *src_fw_module = src_widget->module_info;
|
|
struct sof_ipc4_fw_module *sink_fw_module = sink_widget->module_info;
|
|
struct sof_ipc4_msg msg = {{ 0 }};
|
|
struct snd_sof_widget *src_pipe_widget = src_widget->spipe->pipe_widget;
|
|
struct snd_sof_widget *sink_pipe_widget = sink_widget->spipe->pipe_widget;
|
|
struct sof_ipc4_pipeline *src_pipeline = src_pipe_widget->private;
|
|
struct sof_ipc4_pipeline *sink_pipeline = sink_pipe_widget->private;
|
|
u32 header, extension;
|
|
int ret = 0;
|
|
|
|
/* no route is set up if chain DMA is used */
|
|
if (src_pipeline->use_chain_dma || sink_pipeline->use_chain_dma)
|
|
return 0;
|
|
|
|
dev_dbg(sdev->dev, "unbind modules %s:%d -> %s:%d\n",
|
|
src_widget->widget->name, sroute->src_queue_id,
|
|
sink_widget->widget->name, sroute->dst_queue_id);
|
|
|
|
/*
|
|
* routes belonging to the same pipeline will be disconnected by the FW when the pipeline
|
|
* is freed. So avoid sending this IPC which will be ignored by the FW anyway.
|
|
*/
|
|
if (src_widget->spipe->pipe_widget == sink_widget->spipe->pipe_widget)
|
|
goto out;
|
|
|
|
header = src_fw_module->man4_module_entry.id;
|
|
header |= SOF_IPC4_MOD_INSTANCE(src_widget->instance_id);
|
|
header |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_MOD_UNBIND);
|
|
header |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST);
|
|
header |= SOF_IPC4_MSG_TARGET(SOF_IPC4_MODULE_MSG);
|
|
|
|
extension = sink_fw_module->man4_module_entry.id;
|
|
extension |= SOF_IPC4_MOD_EXT_DST_MOD_INSTANCE(sink_widget->instance_id);
|
|
extension |= SOF_IPC4_MOD_EXT_DST_MOD_QUEUE_ID(sroute->dst_queue_id);
|
|
extension |= SOF_IPC4_MOD_EXT_SRC_MOD_QUEUE_ID(sroute->src_queue_id);
|
|
|
|
msg.primary = header;
|
|
msg.extension = extension;
|
|
|
|
ret = sof_ipc_tx_message_no_reply(sdev->ipc, &msg, 0);
|
|
if (ret < 0)
|
|
dev_err(sdev->dev, "failed to unbind modules %s:%d -> %s:%d\n",
|
|
src_widget->widget->name, sroute->src_queue_id,
|
|
sink_widget->widget->name, sroute->dst_queue_id);
|
|
out:
|
|
sof_ipc4_put_queue_id(sink_widget, sroute->dst_queue_id, SOF_PIN_TYPE_INPUT);
|
|
sof_ipc4_put_queue_id(src_widget, sroute->src_queue_id, SOF_PIN_TYPE_OUTPUT);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int sof_ipc4_dai_config(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget,
|
|
unsigned int flags, struct snd_sof_dai_config_data *data)
|
|
{
|
|
struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget;
|
|
struct sof_ipc4_pipeline *pipeline = pipe_widget->private;
|
|
struct snd_sof_dai *dai = swidget->private;
|
|
struct sof_ipc4_gtw_attributes *gtw_attr;
|
|
struct sof_ipc4_copier_data *copier_data;
|
|
struct sof_ipc4_copier *ipc4_copier;
|
|
|
|
if (!dai || !dai->private) {
|
|
dev_err(sdev->dev, "Invalid DAI or DAI private data for %s\n",
|
|
swidget->widget->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ipc4_copier = (struct sof_ipc4_copier *)dai->private;
|
|
copier_data = &ipc4_copier->data;
|
|
|
|
if (!data)
|
|
return 0;
|
|
|
|
if (pipeline->use_chain_dma) {
|
|
pipeline->msg.primary &= ~SOF_IPC4_GLB_CHAIN_DMA_LINK_ID_MASK;
|
|
pipeline->msg.primary |= SOF_IPC4_GLB_CHAIN_DMA_LINK_ID(data->dai_data);
|
|
return 0;
|
|
}
|
|
|
|
switch (ipc4_copier->dai_type) {
|
|
case SOF_DAI_INTEL_HDA:
|
|
gtw_attr = ipc4_copier->gtw_attr;
|
|
gtw_attr->lp_buffer_alloc = pipeline->lp_mode;
|
|
if (flags & SOF_DAI_CONFIG_FLAGS_HW_PARAMS) {
|
|
copier_data->gtw_cfg.node_id &= ~SOF_IPC4_NODE_INDEX_MASK;
|
|
copier_data->gtw_cfg.node_id |= SOF_IPC4_NODE_INDEX(data->dai_data);
|
|
}
|
|
break;
|
|
case SOF_DAI_INTEL_ALH:
|
|
/*
|
|
* Do not clear the node ID when this op is invoked with
|
|
* SOF_DAI_CONFIG_FLAGS_HW_FREE. It is needed to free the group_ida during
|
|
* unprepare. The node_id for multi-gateway DAI's will be overwritten with the
|
|
* group_id during copier's ipc_prepare op.
|
|
*/
|
|
if (flags & SOF_DAI_CONFIG_FLAGS_HW_PARAMS) {
|
|
ipc4_copier->dai_index = data->dai_node_id;
|
|
copier_data->gtw_cfg.node_id &= ~SOF_IPC4_NODE_INDEX_MASK;
|
|
copier_data->gtw_cfg.node_id |= SOF_IPC4_NODE_INDEX(data->dai_node_id);
|
|
}
|
|
|
|
break;
|
|
case SOF_DAI_INTEL_DMIC:
|
|
case SOF_DAI_INTEL_SSP:
|
|
/* nothing to do for SSP/DMIC */
|
|
break;
|
|
default:
|
|
dev_err(sdev->dev, "%s: unsupported dai type %d\n", __func__,
|
|
ipc4_copier->dai_type);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_parse_manifest(struct snd_soc_component *scomp, int index,
|
|
struct snd_soc_tplg_manifest *man)
|
|
{
|
|
struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
|
|
struct sof_ipc4_fw_data *ipc4_data = sdev->private;
|
|
struct sof_manifest_tlv *manifest_tlv;
|
|
struct sof_manifest *manifest;
|
|
u32 size = le32_to_cpu(man->priv.size);
|
|
u8 *man_ptr = man->priv.data;
|
|
u32 len_check;
|
|
int i;
|
|
|
|
if (!size || size < SOF_IPC4_TPLG_ABI_SIZE) {
|
|
dev_err(scomp->dev, "%s: Invalid topology ABI size: %u\n",
|
|
__func__, size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
manifest = (struct sof_manifest *)man_ptr;
|
|
|
|
dev_info(scomp->dev,
|
|
"Topology: ABI %d:%d:%d Kernel ABI %u:%u:%u\n",
|
|
le16_to_cpu(manifest->abi_major), le16_to_cpu(manifest->abi_minor),
|
|
le16_to_cpu(manifest->abi_patch),
|
|
SOF_ABI_MAJOR, SOF_ABI_MINOR, SOF_ABI_PATCH);
|
|
|
|
/* TODO: Add ABI compatibility check */
|
|
|
|
/* no more data after the ABI version */
|
|
if (size <= SOF_IPC4_TPLG_ABI_SIZE)
|
|
return 0;
|
|
|
|
manifest_tlv = manifest->items;
|
|
len_check = sizeof(struct sof_manifest);
|
|
for (i = 0; i < le16_to_cpu(manifest->count); i++) {
|
|
len_check += sizeof(struct sof_manifest_tlv) + le32_to_cpu(manifest_tlv->size);
|
|
if (len_check > size)
|
|
return -EINVAL;
|
|
|
|
switch (le32_to_cpu(manifest_tlv->type)) {
|
|
case SOF_MANIFEST_DATA_TYPE_NHLT:
|
|
/* no NHLT in BIOS, so use the one from topology manifest */
|
|
if (ipc4_data->nhlt)
|
|
break;
|
|
ipc4_data->nhlt = devm_kmemdup(sdev->dev, manifest_tlv->data,
|
|
le32_to_cpu(manifest_tlv->size), GFP_KERNEL);
|
|
if (!ipc4_data->nhlt)
|
|
return -ENOMEM;
|
|
break;
|
|
default:
|
|
dev_warn(scomp->dev, "Skipping unknown manifest data type %d\n",
|
|
manifest_tlv->type);
|
|
break;
|
|
}
|
|
man_ptr += sizeof(struct sof_manifest_tlv) + le32_to_cpu(manifest_tlv->size);
|
|
manifest_tlv = (struct sof_manifest_tlv *)man_ptr;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_dai_get_param(struct snd_sof_dev *sdev, struct snd_sof_dai *dai, int param_type)
|
|
{
|
|
struct sof_ipc4_copier *ipc4_copier = dai->private;
|
|
struct snd_soc_tplg_hw_config *hw_config;
|
|
struct snd_sof_dai_link *slink;
|
|
bool dai_link_found = false;
|
|
bool hw_cfg_found = false;
|
|
int i;
|
|
|
|
if (!ipc4_copier)
|
|
return 0;
|
|
|
|
list_for_each_entry(slink, &sdev->dai_link_list, list) {
|
|
if (!strcmp(slink->link->name, dai->name)) {
|
|
dai_link_found = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!dai_link_found) {
|
|
dev_err(sdev->dev, "no DAI link found for DAI %s\n", dai->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
for (i = 0; i < slink->num_hw_configs; i++) {
|
|
hw_config = &slink->hw_configs[i];
|
|
if (dai->current_config == le32_to_cpu(hw_config->id)) {
|
|
hw_cfg_found = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (!hw_cfg_found) {
|
|
dev_err(sdev->dev, "no matching hw_config found for DAI %s\n", dai->name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (ipc4_copier->dai_type) {
|
|
case SOF_DAI_INTEL_SSP:
|
|
switch (param_type) {
|
|
case SOF_DAI_PARAM_INTEL_SSP_MCLK:
|
|
return le32_to_cpu(hw_config->mclk_rate);
|
|
case SOF_DAI_PARAM_INTEL_SSP_BCLK:
|
|
return le32_to_cpu(hw_config->bclk_rate);
|
|
case SOF_DAI_PARAM_INTEL_SSP_TDM_SLOTS:
|
|
return le32_to_cpu(hw_config->tdm_slots);
|
|
default:
|
|
dev_err(sdev->dev, "invalid SSP param %d\n", param_type);
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
dev_err(sdev->dev, "DAI type %d not supported yet!\n", ipc4_copier->dai_type);
|
|
break;
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static int sof_ipc4_tear_down_all_pipelines(struct snd_sof_dev *sdev, bool verify)
|
|
{
|
|
struct snd_sof_pcm *spcm;
|
|
int dir, ret;
|
|
|
|
/*
|
|
* This function is called during system suspend, we need to make sure
|
|
* that all streams have been freed up.
|
|
* Freeing might have been skipped when xrun happened just at the start
|
|
* of the suspend and it sent a SNDRV_PCM_TRIGGER_STOP to the active
|
|
* stream. This will call sof_pcm_stream_free() with
|
|
* free_widget_list = false which will leave the kernel and firmware out
|
|
* of sync during suspend/resume.
|
|
*
|
|
* This will also make sure that paused streams handled correctly.
|
|
*/
|
|
list_for_each_entry(spcm, &sdev->pcm_list, list) {
|
|
for_each_pcm_streams(dir) {
|
|
struct snd_pcm_substream *substream = spcm->stream[dir].substream;
|
|
|
|
if (!substream || !substream->runtime || spcm->stream[dir].suspend_ignored)
|
|
continue;
|
|
|
|
if (spcm->stream[dir].list) {
|
|
ret = sof_pcm_stream_free(sdev, substream, spcm, dir, true);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int sof_ipc4_link_setup(struct snd_sof_dev *sdev, struct snd_soc_dai_link *link)
|
|
{
|
|
if (link->no_pcm)
|
|
return 0;
|
|
|
|
/*
|
|
* set default trigger order for all links. Exceptions to
|
|
* the rule will be handled in sof_pcm_dai_link_fixup()
|
|
* For playback, the sequence is the following: start BE,
|
|
* start FE, stop FE, stop BE; for Capture the sequence is
|
|
* inverted start FE, start BE, stop BE, stop FE
|
|
*/
|
|
link->trigger[SNDRV_PCM_STREAM_PLAYBACK] = SND_SOC_DPCM_TRIGGER_POST;
|
|
link->trigger[SNDRV_PCM_STREAM_CAPTURE] = SND_SOC_DPCM_TRIGGER_PRE;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Tokens needed for different copier variants (aif, dai and buffer) */
|
|
static enum sof_tokens copier_token_list[] = {
|
|
SOF_COMP_TOKENS,
|
|
SOF_COPIER_TOKENS,
|
|
SOF_AUDIO_FMT_NUM_TOKENS,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS,
|
|
SOF_COMP_EXT_TOKENS,
|
|
|
|
SOF_COPIER_DEEP_BUFFER_TOKENS, /* for AIF copier */
|
|
SOF_DAI_TOKENS, /* for DAI copier */
|
|
};
|
|
|
|
static enum sof_tokens pipeline_token_list[] = {
|
|
SOF_SCHED_TOKENS,
|
|
SOF_PIPELINE_TOKENS,
|
|
};
|
|
|
|
static enum sof_tokens pga_token_list[] = {
|
|
SOF_COMP_TOKENS,
|
|
SOF_GAIN_TOKENS,
|
|
SOF_AUDIO_FMT_NUM_TOKENS,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS,
|
|
SOF_COMP_EXT_TOKENS,
|
|
};
|
|
|
|
static enum sof_tokens mixer_token_list[] = {
|
|
SOF_COMP_TOKENS,
|
|
SOF_AUDIO_FMT_NUM_TOKENS,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS,
|
|
SOF_COMP_EXT_TOKENS,
|
|
};
|
|
|
|
static enum sof_tokens src_token_list[] = {
|
|
SOF_COMP_TOKENS,
|
|
SOF_SRC_TOKENS,
|
|
SOF_AUDIO_FMT_NUM_TOKENS,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS,
|
|
SOF_COMP_EXT_TOKENS,
|
|
};
|
|
|
|
static enum sof_tokens process_token_list[] = {
|
|
SOF_COMP_TOKENS,
|
|
SOF_AUDIO_FMT_NUM_TOKENS,
|
|
SOF_IN_AUDIO_FORMAT_TOKENS,
|
|
SOF_OUT_AUDIO_FORMAT_TOKENS,
|
|
SOF_COMP_EXT_TOKENS,
|
|
};
|
|
|
|
static const struct sof_ipc_tplg_widget_ops tplg_ipc4_widget_ops[SND_SOC_DAPM_TYPE_COUNT] = {
|
|
[snd_soc_dapm_aif_in] = {sof_ipc4_widget_setup_pcm, sof_ipc4_widget_free_comp_pcm,
|
|
copier_token_list, ARRAY_SIZE(copier_token_list),
|
|
NULL, sof_ipc4_prepare_copier_module,
|
|
sof_ipc4_unprepare_copier_module},
|
|
[snd_soc_dapm_aif_out] = {sof_ipc4_widget_setup_pcm, sof_ipc4_widget_free_comp_pcm,
|
|
copier_token_list, ARRAY_SIZE(copier_token_list),
|
|
NULL, sof_ipc4_prepare_copier_module,
|
|
sof_ipc4_unprepare_copier_module},
|
|
[snd_soc_dapm_dai_in] = {sof_ipc4_widget_setup_comp_dai, sof_ipc4_widget_free_comp_dai,
|
|
copier_token_list, ARRAY_SIZE(copier_token_list), NULL,
|
|
sof_ipc4_prepare_copier_module,
|
|
sof_ipc4_unprepare_copier_module},
|
|
[snd_soc_dapm_dai_out] = {sof_ipc4_widget_setup_comp_dai, sof_ipc4_widget_free_comp_dai,
|
|
copier_token_list, ARRAY_SIZE(copier_token_list), NULL,
|
|
sof_ipc4_prepare_copier_module,
|
|
sof_ipc4_unprepare_copier_module},
|
|
[snd_soc_dapm_buffer] = {sof_ipc4_widget_setup_pcm, sof_ipc4_widget_free_comp_pcm,
|
|
copier_token_list, ARRAY_SIZE(copier_token_list),
|
|
NULL, sof_ipc4_prepare_copier_module,
|
|
sof_ipc4_unprepare_copier_module},
|
|
[snd_soc_dapm_scheduler] = {sof_ipc4_widget_setup_comp_pipeline,
|
|
sof_ipc4_widget_free_comp_pipeline,
|
|
pipeline_token_list, ARRAY_SIZE(pipeline_token_list), NULL,
|
|
NULL, NULL},
|
|
[snd_soc_dapm_pga] = {sof_ipc4_widget_setup_comp_pga, sof_ipc4_widget_free_comp_pga,
|
|
pga_token_list, ARRAY_SIZE(pga_token_list), NULL,
|
|
sof_ipc4_prepare_gain_module,
|
|
NULL},
|
|
[snd_soc_dapm_mixer] = {sof_ipc4_widget_setup_comp_mixer, sof_ipc4_widget_free_comp_mixer,
|
|
mixer_token_list, ARRAY_SIZE(mixer_token_list),
|
|
NULL, sof_ipc4_prepare_mixer_module,
|
|
NULL},
|
|
[snd_soc_dapm_src] = {sof_ipc4_widget_setup_comp_src, sof_ipc4_widget_free_comp_src,
|
|
src_token_list, ARRAY_SIZE(src_token_list),
|
|
NULL, sof_ipc4_prepare_src_module,
|
|
NULL},
|
|
[snd_soc_dapm_effect] = {sof_ipc4_widget_setup_comp_process,
|
|
sof_ipc4_widget_free_comp_process,
|
|
process_token_list, ARRAY_SIZE(process_token_list),
|
|
NULL, sof_ipc4_prepare_process_module,
|
|
NULL},
|
|
};
|
|
|
|
const struct sof_ipc_tplg_ops ipc4_tplg_ops = {
|
|
.widget = tplg_ipc4_widget_ops,
|
|
.token_list = ipc4_token_list,
|
|
.control_setup = sof_ipc4_control_setup,
|
|
.control = &tplg_ipc4_control_ops,
|
|
.widget_setup = sof_ipc4_widget_setup,
|
|
.widget_free = sof_ipc4_widget_free,
|
|
.route_setup = sof_ipc4_route_setup,
|
|
.route_free = sof_ipc4_route_free,
|
|
.dai_config = sof_ipc4_dai_config,
|
|
.parse_manifest = sof_ipc4_parse_manifest,
|
|
.dai_get_param = sof_ipc4_dai_get_param,
|
|
.tear_down_all_pipelines = sof_ipc4_tear_down_all_pipelines,
|
|
.link_setup = sof_ipc4_link_setup,
|
|
};
|