1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009 |
- // SPDX-License-Identifier: GPL-2.0-only
- //
- // Copyright(c) 2021 Intel Corporation. All rights reserved.
- //
- // Authors: Cezary Rojewski <[email protected]>
- // Amadeusz Slawinski <[email protected]>
- //
- #include <sound/intel-nhlt.h>
- #include <sound/pcm_params.h>
- #include <sound/soc.h>
- #include "avs.h"
- #include "path.h"
- #include "topology.h"
- /* Must be called with adev->comp_list_mutex held. */
- static struct avs_tplg *
- avs_path_find_tplg(struct avs_dev *adev, const char *name)
- {
- struct avs_soc_component *acomp;
- list_for_each_entry(acomp, &adev->comp_list, node)
- if (!strcmp(acomp->tplg->name, name))
- return acomp->tplg;
- return NULL;
- }
- static struct avs_path_module *
- avs_path_find_module(struct avs_path_pipeline *ppl, u32 template_id)
- {
- struct avs_path_module *mod;
- list_for_each_entry(mod, &ppl->mod_list, node)
- if (mod->template->id == template_id)
- return mod;
- return NULL;
- }
- static struct avs_path_pipeline *
- avs_path_find_pipeline(struct avs_path *path, u32 template_id)
- {
- struct avs_path_pipeline *ppl;
- list_for_each_entry(ppl, &path->ppl_list, node)
- if (ppl->template->id == template_id)
- return ppl;
- return NULL;
- }
- static struct avs_path *
- avs_path_find_path(struct avs_dev *adev, const char *name, u32 template_id)
- {
- struct avs_tplg_path_template *pos, *template = NULL;
- struct avs_tplg *tplg;
- struct avs_path *path;
- tplg = avs_path_find_tplg(adev, name);
- if (!tplg)
- return NULL;
- list_for_each_entry(pos, &tplg->path_tmpl_list, node) {
- if (pos->id == template_id) {
- template = pos;
- break;
- }
- }
- if (!template)
- return NULL;
- spin_lock(&adev->path_list_lock);
- /* Only one variant of given path template may be instantiated at a time. */
- list_for_each_entry(path, &adev->path_list, node) {
- if (path->template->owner == template) {
- spin_unlock(&adev->path_list_lock);
- return path;
- }
- }
- spin_unlock(&adev->path_list_lock);
- return NULL;
- }
- static bool avs_test_hw_params(struct snd_pcm_hw_params *params,
- struct avs_audio_format *fmt)
- {
- return (params_rate(params) == fmt->sampling_freq &&
- params_channels(params) == fmt->num_channels &&
- params_physical_width(params) == fmt->bit_depth &&
- params_width(params) == fmt->valid_bit_depth);
- }
- static struct avs_tplg_path *
- avs_path_find_variant(struct avs_dev *adev,
- struct avs_tplg_path_template *template,
- struct snd_pcm_hw_params *fe_params,
- struct snd_pcm_hw_params *be_params)
- {
- struct avs_tplg_path *variant;
- list_for_each_entry(variant, &template->path_list, node) {
- dev_dbg(adev->dev, "check FE rate %d chn %d vbd %d bd %d\n",
- variant->fe_fmt->sampling_freq, variant->fe_fmt->num_channels,
- variant->fe_fmt->valid_bit_depth, variant->fe_fmt->bit_depth);
- dev_dbg(adev->dev, "check BE rate %d chn %d vbd %d bd %d\n",
- variant->be_fmt->sampling_freq, variant->be_fmt->num_channels,
- variant->be_fmt->valid_bit_depth, variant->be_fmt->bit_depth);
- if (variant->fe_fmt && avs_test_hw_params(fe_params, variant->fe_fmt) &&
- variant->be_fmt && avs_test_hw_params(be_params, variant->be_fmt))
- return variant;
- }
- return NULL;
- }
- __maybe_unused
- static bool avs_dma_type_is_host(u32 dma_type)
- {
- return dma_type == AVS_DMA_HDA_HOST_OUTPUT ||
- dma_type == AVS_DMA_HDA_HOST_INPUT;
- }
- __maybe_unused
- static bool avs_dma_type_is_link(u32 dma_type)
- {
- return !avs_dma_type_is_host(dma_type);
- }
- __maybe_unused
- static bool avs_dma_type_is_output(u32 dma_type)
- {
- return dma_type == AVS_DMA_HDA_HOST_OUTPUT ||
- dma_type == AVS_DMA_HDA_LINK_OUTPUT ||
- dma_type == AVS_DMA_I2S_LINK_OUTPUT;
- }
- __maybe_unused
- static bool avs_dma_type_is_input(u32 dma_type)
- {
- return !avs_dma_type_is_output(dma_type);
- }
- static int avs_copier_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct nhlt_acpi_table *nhlt = adev->nhlt;
- struct avs_tplg_module *t = mod->template;
- struct avs_copier_cfg *cfg;
- struct nhlt_specific_cfg *ep_blob;
- union avs_connector_node_id node_id = {0};
- size_t cfg_size, data_size = 0;
- void *data = NULL;
- u32 dma_type;
- int ret;
- dma_type = t->cfg_ext->copier.dma_type;
- node_id.dma_type = dma_type;
- switch (dma_type) {
- struct avs_audio_format *fmt;
- int direction;
- case AVS_DMA_I2S_LINK_OUTPUT:
- case AVS_DMA_I2S_LINK_INPUT:
- if (avs_dma_type_is_input(dma_type))
- direction = SNDRV_PCM_STREAM_CAPTURE;
- else
- direction = SNDRV_PCM_STREAM_PLAYBACK;
- if (t->cfg_ext->copier.blob_fmt)
- fmt = t->cfg_ext->copier.blob_fmt;
- else if (direction == SNDRV_PCM_STREAM_CAPTURE)
- fmt = t->in_fmt;
- else
- fmt = t->cfg_ext->copier.out_fmt;
- ep_blob = intel_nhlt_get_endpoint_blob(adev->dev,
- nhlt, t->cfg_ext->copier.vindex.i2s.instance,
- NHLT_LINK_SSP, fmt->valid_bit_depth, fmt->bit_depth,
- fmt->num_channels, fmt->sampling_freq, direction,
- NHLT_DEVICE_I2S);
- if (!ep_blob) {
- dev_err(adev->dev, "no I2S ep_blob found\n");
- return -ENOENT;
- }
- data = ep_blob->caps;
- data_size = ep_blob->size;
- /* I2S gateway's vindex is statically assigned in topology */
- node_id.vindex = t->cfg_ext->copier.vindex.val;
- break;
- case AVS_DMA_DMIC_LINK_INPUT:
- direction = SNDRV_PCM_STREAM_CAPTURE;
- if (t->cfg_ext->copier.blob_fmt)
- fmt = t->cfg_ext->copier.blob_fmt;
- else
- fmt = t->in_fmt;
- ep_blob = intel_nhlt_get_endpoint_blob(adev->dev, nhlt, 0,
- NHLT_LINK_DMIC, fmt->valid_bit_depth,
- fmt->bit_depth, fmt->num_channels,
- fmt->sampling_freq, direction, NHLT_DEVICE_DMIC);
- if (!ep_blob) {
- dev_err(adev->dev, "no DMIC ep_blob found\n");
- return -ENOENT;
- }
- data = ep_blob->caps;
- data_size = ep_blob->size;
- /* DMIC gateway's vindex is statically assigned in topology */
- node_id.vindex = t->cfg_ext->copier.vindex.val;
- break;
- case AVS_DMA_HDA_HOST_OUTPUT:
- case AVS_DMA_HDA_HOST_INPUT:
- /* HOST gateway's vindex is dynamically assigned with DMA id */
- node_id.vindex = mod->owner->owner->dma_id;
- break;
- case AVS_DMA_HDA_LINK_OUTPUT:
- case AVS_DMA_HDA_LINK_INPUT:
- node_id.vindex = t->cfg_ext->copier.vindex.val |
- mod->owner->owner->dma_id;
- break;
- case INVALID_OBJECT_ID:
- default:
- node_id = INVALID_NODE_ID;
- break;
- }
- cfg_size = sizeof(*cfg) + data_size;
- /* Every config-BLOB contains gateway attributes. */
- if (data_size)
- cfg_size -= sizeof(cfg->gtw_cfg.config.attrs);
- cfg = kzalloc(cfg_size, GFP_KERNEL);
- if (!cfg)
- return -ENOMEM;
- cfg->base.cpc = t->cfg_base->cpc;
- cfg->base.ibs = t->cfg_base->ibs;
- cfg->base.obs = t->cfg_base->obs;
- cfg->base.is_pages = t->cfg_base->is_pages;
- cfg->base.audio_fmt = *t->in_fmt;
- cfg->out_fmt = *t->cfg_ext->copier.out_fmt;
- cfg->feature_mask = t->cfg_ext->copier.feature_mask;
- cfg->gtw_cfg.node_id = node_id;
- cfg->gtw_cfg.dma_buffer_size = t->cfg_ext->copier.dma_buffer_size;
- /* config_length in DWORDs */
- cfg->gtw_cfg.config_length = DIV_ROUND_UP(data_size, 4);
- if (data)
- memcpy(&cfg->gtw_cfg.config, data, data_size);
- mod->gtw_attrs = cfg->gtw_cfg.config.attrs;
- ret = avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, cfg, cfg_size,
- &mod->instance_id);
- kfree(cfg);
- return ret;
- }
- static int avs_updown_mix_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_updown_mixer_cfg cfg;
- int i;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.out_channel_config = t->cfg_ext->updown_mix.out_channel_config;
- cfg.coefficients_select = t->cfg_ext->updown_mix.coefficients_select;
- for (i = 0; i < AVS_CHANNELS_MAX; i++)
- cfg.coefficients[i] = t->cfg_ext->updown_mix.coefficients[i];
- cfg.channel_map = t->cfg_ext->updown_mix.channel_map;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_src_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_src_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.out_freq = t->cfg_ext->src.out_freq;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_asrc_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_asrc_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.out_freq = t->cfg_ext->asrc.out_freq;
- cfg.mode = t->cfg_ext->asrc.mode;
- cfg.disable_jitter_buffer = t->cfg_ext->asrc.disable_jitter_buffer;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_aec_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_aec_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.ref_fmt = *t->cfg_ext->aec.ref_fmt;
- cfg.out_fmt = *t->cfg_ext->aec.out_fmt;
- cfg.cpc_lp_mode = t->cfg_ext->aec.cpc_lp_mode;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_mux_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_mux_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.ref_fmt = *t->cfg_ext->mux.ref_fmt;
- cfg.out_fmt = *t->cfg_ext->mux.out_fmt;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_wov_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_wov_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.cpc_lp_mode = t->cfg_ext->wov.cpc_lp_mode;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_micsel_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_micsel_cfg cfg;
- cfg.base.cpc = t->cfg_base->cpc;
- cfg.base.ibs = t->cfg_base->ibs;
- cfg.base.obs = t->cfg_base->obs;
- cfg.base.is_pages = t->cfg_base->is_pages;
- cfg.base.audio_fmt = *t->in_fmt;
- cfg.out_fmt = *t->cfg_ext->micsel.out_fmt;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_modbase_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_modcfg_base cfg;
- cfg.cpc = t->cfg_base->cpc;
- cfg.ibs = t->cfg_base->ibs;
- cfg.obs = t->cfg_base->obs;
- cfg.is_pages = t->cfg_base->is_pages;
- cfg.audio_fmt = *t->in_fmt;
- return avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, &cfg, sizeof(cfg),
- &mod->instance_id);
- }
- static int avs_modext_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- struct avs_tplg_module *t = mod->template;
- struct avs_tplg_modcfg_ext *tcfg = t->cfg_ext;
- struct avs_modcfg_ext *cfg;
- size_t cfg_size, num_pins;
- int ret, i;
- num_pins = tcfg->generic.num_input_pins + tcfg->generic.num_output_pins;
- cfg_size = sizeof(*cfg) + sizeof(*cfg->pin_fmts) * num_pins;
- cfg = kzalloc(cfg_size, GFP_KERNEL);
- if (!cfg)
- return -ENOMEM;
- cfg->base.cpc = t->cfg_base->cpc;
- cfg->base.ibs = t->cfg_base->ibs;
- cfg->base.obs = t->cfg_base->obs;
- cfg->base.is_pages = t->cfg_base->is_pages;
- cfg->base.audio_fmt = *t->in_fmt;
- cfg->num_input_pins = tcfg->generic.num_input_pins;
- cfg->num_output_pins = tcfg->generic.num_output_pins;
- /* configure pin formats */
- for (i = 0; i < num_pins; i++) {
- struct avs_tplg_pin_format *tpin = &tcfg->generic.pin_fmts[i];
- struct avs_pin_format *pin = &cfg->pin_fmts[i];
- pin->pin_index = tpin->pin_index;
- pin->iobs = tpin->iobs;
- pin->audio_fmt = *tpin->fmt;
- }
- ret = avs_dsp_init_module(adev, mod->module_id, mod->owner->instance_id,
- t->core_id, t->domain, cfg, cfg_size,
- &mod->instance_id);
- kfree(cfg);
- return ret;
- }
- static int avs_probe_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- dev_err(adev->dev, "Probe module can't be instantiated by topology");
- return -EINVAL;
- }
- struct avs_module_create {
- guid_t *guid;
- int (*create)(struct avs_dev *adev, struct avs_path_module *mod);
- };
- static struct avs_module_create avs_module_create[] = {
- { &AVS_MIXIN_MOD_UUID, avs_modbase_create },
- { &AVS_MIXOUT_MOD_UUID, avs_modbase_create },
- { &AVS_KPBUFF_MOD_UUID, avs_modbase_create },
- { &AVS_COPIER_MOD_UUID, avs_copier_create },
- { &AVS_MICSEL_MOD_UUID, avs_micsel_create },
- { &AVS_MUX_MOD_UUID, avs_mux_create },
- { &AVS_UPDWMIX_MOD_UUID, avs_updown_mix_create },
- { &AVS_SRCINTC_MOD_UUID, avs_src_create },
- { &AVS_AEC_MOD_UUID, avs_aec_create },
- { &AVS_ASRC_MOD_UUID, avs_asrc_create },
- { &AVS_INTELWOV_MOD_UUID, avs_wov_create },
- { &AVS_PROBE_MOD_UUID, avs_probe_create },
- };
- static int avs_path_module_type_create(struct avs_dev *adev, struct avs_path_module *mod)
- {
- const guid_t *type = &mod->template->cfg_ext->type;
- for (int i = 0; i < ARRAY_SIZE(avs_module_create); i++)
- if (guid_equal(type, avs_module_create[i].guid))
- return avs_module_create[i].create(adev, mod);
- return avs_modext_create(adev, mod);
- }
- static void avs_path_module_free(struct avs_dev *adev, struct avs_path_module *mod)
- {
- kfree(mod);
- }
- static struct avs_path_module *
- avs_path_module_create(struct avs_dev *adev,
- struct avs_path_pipeline *owner,
- struct avs_tplg_module *template)
- {
- struct avs_path_module *mod;
- int module_id, ret;
- module_id = avs_get_module_id(adev, &template->cfg_ext->type);
- if (module_id < 0)
- return ERR_PTR(module_id);
- mod = kzalloc(sizeof(*mod), GFP_KERNEL);
- if (!mod)
- return ERR_PTR(-ENOMEM);
- mod->template = template;
- mod->module_id = module_id;
- mod->owner = owner;
- INIT_LIST_HEAD(&mod->node);
- ret = avs_path_module_type_create(adev, mod);
- if (ret) {
- dev_err(adev->dev, "module-type create failed: %d\n", ret);
- kfree(mod);
- return ERR_PTR(ret);
- }
- return mod;
- }
- static int avs_path_binding_arm(struct avs_dev *adev, struct avs_path_binding *binding)
- {
- struct avs_path_module *this_mod, *target_mod;
- struct avs_path_pipeline *target_ppl;
- struct avs_path *target_path;
- struct avs_tplg_binding *t;
- t = binding->template;
- this_mod = avs_path_find_module(binding->owner,
- t->mod_id);
- if (!this_mod) {
- dev_err(adev->dev, "path mod %d not found\n", t->mod_id);
- return -EINVAL;
- }
- /* update with target_tplg_name too */
- target_path = avs_path_find_path(adev, t->target_tplg_name,
- t->target_path_tmpl_id);
- if (!target_path) {
- dev_err(adev->dev, "target path %s:%d not found\n",
- t->target_tplg_name, t->target_path_tmpl_id);
- return -EINVAL;
- }
- target_ppl = avs_path_find_pipeline(target_path,
- t->target_ppl_id);
- if (!target_ppl) {
- dev_err(adev->dev, "target ppl %d not found\n", t->target_ppl_id);
- return -EINVAL;
- }
- target_mod = avs_path_find_module(target_ppl, t->target_mod_id);
- if (!target_mod) {
- dev_err(adev->dev, "target mod %d not found\n", t->target_mod_id);
- return -EINVAL;
- }
- if (t->is_sink) {
- binding->sink = this_mod;
- binding->sink_pin = t->mod_pin;
- binding->source = target_mod;
- binding->source_pin = t->target_mod_pin;
- } else {
- binding->sink = target_mod;
- binding->sink_pin = t->target_mod_pin;
- binding->source = this_mod;
- binding->source_pin = t->mod_pin;
- }
- return 0;
- }
- static void avs_path_binding_free(struct avs_dev *adev, struct avs_path_binding *binding)
- {
- kfree(binding);
- }
- static struct avs_path_binding *avs_path_binding_create(struct avs_dev *adev,
- struct avs_path_pipeline *owner,
- struct avs_tplg_binding *t)
- {
- struct avs_path_binding *binding;
- binding = kzalloc(sizeof(*binding), GFP_KERNEL);
- if (!binding)
- return ERR_PTR(-ENOMEM);
- binding->template = t;
- binding->owner = owner;
- INIT_LIST_HEAD(&binding->node);
- return binding;
- }
- static int avs_path_pipeline_arm(struct avs_dev *adev,
- struct avs_path_pipeline *ppl)
- {
- struct avs_path_module *mod;
- list_for_each_entry(mod, &ppl->mod_list, node) {
- struct avs_path_module *source, *sink;
- int ret;
- /*
- * Only one module (so it's implicitly last) or it is the last
- * one, either way we don't have next module to bind it to.
- */
- if (mod == list_last_entry(&ppl->mod_list,
- struct avs_path_module, node))
- break;
- /* bind current module to next module on list */
- source = mod;
- sink = list_next_entry(mod, node);
- if (!source || !sink)
- return -EINVAL;
- ret = avs_ipc_bind(adev, source->module_id, source->instance_id,
- sink->module_id, sink->instance_id, 0, 0);
- if (ret)
- return AVS_IPC_RET(ret);
- }
- return 0;
- }
- static void avs_path_pipeline_free(struct avs_dev *adev,
- struct avs_path_pipeline *ppl)
- {
- struct avs_path_binding *binding, *bsave;
- struct avs_path_module *mod, *save;
- list_for_each_entry_safe(binding, bsave, &ppl->binding_list, node) {
- list_del(&binding->node);
- avs_path_binding_free(adev, binding);
- }
- avs_dsp_delete_pipeline(adev, ppl->instance_id);
- /* Unload resources occupied by owned modules */
- list_for_each_entry_safe(mod, save, &ppl->mod_list, node) {
- avs_dsp_delete_module(adev, mod->module_id, mod->instance_id,
- mod->owner->instance_id,
- mod->template->core_id);
- avs_path_module_free(adev, mod);
- }
- list_del(&ppl->node);
- kfree(ppl);
- }
- static struct avs_path_pipeline *
- avs_path_pipeline_create(struct avs_dev *adev, struct avs_path *owner,
- struct avs_tplg_pipeline *template)
- {
- struct avs_path_pipeline *ppl;
- struct avs_tplg_pplcfg *cfg = template->cfg;
- struct avs_tplg_module *tmod;
- int ret, i;
- ppl = kzalloc(sizeof(*ppl), GFP_KERNEL);
- if (!ppl)
- return ERR_PTR(-ENOMEM);
- ppl->template = template;
- ppl->owner = owner;
- INIT_LIST_HEAD(&ppl->binding_list);
- INIT_LIST_HEAD(&ppl->mod_list);
- INIT_LIST_HEAD(&ppl->node);
- ret = avs_dsp_create_pipeline(adev, cfg->req_size, cfg->priority,
- cfg->lp, cfg->attributes,
- &ppl->instance_id);
- if (ret) {
- dev_err(adev->dev, "error creating pipeline %d\n", ret);
- kfree(ppl);
- return ERR_PTR(ret);
- }
- list_for_each_entry(tmod, &template->mod_list, node) {
- struct avs_path_module *mod;
- mod = avs_path_module_create(adev, ppl, tmod);
- if (IS_ERR(mod)) {
- ret = PTR_ERR(mod);
- dev_err(adev->dev, "error creating module %d\n", ret);
- goto init_err;
- }
- list_add_tail(&mod->node, &ppl->mod_list);
- }
- for (i = 0; i < template->num_bindings; i++) {
- struct avs_path_binding *binding;
- binding = avs_path_binding_create(adev, ppl, template->bindings[i]);
- if (IS_ERR(binding)) {
- ret = PTR_ERR(binding);
- dev_err(adev->dev, "error creating binding %d\n", ret);
- goto init_err;
- }
- list_add_tail(&binding->node, &ppl->binding_list);
- }
- return ppl;
- init_err:
- avs_path_pipeline_free(adev, ppl);
- return ERR_PTR(ret);
- }
- static int avs_path_init(struct avs_dev *adev, struct avs_path *path,
- struct avs_tplg_path *template, u32 dma_id)
- {
- struct avs_tplg_pipeline *tppl;
- path->owner = adev;
- path->template = template;
- path->dma_id = dma_id;
- INIT_LIST_HEAD(&path->ppl_list);
- INIT_LIST_HEAD(&path->node);
- /* create all the pipelines */
- list_for_each_entry(tppl, &template->ppl_list, node) {
- struct avs_path_pipeline *ppl;
- ppl = avs_path_pipeline_create(adev, path, tppl);
- if (IS_ERR(ppl))
- return PTR_ERR(ppl);
- list_add_tail(&ppl->node, &path->ppl_list);
- }
- spin_lock(&adev->path_list_lock);
- list_add_tail(&path->node, &adev->path_list);
- spin_unlock(&adev->path_list_lock);
- return 0;
- }
- static int avs_path_arm(struct avs_dev *adev, struct avs_path *path)
- {
- struct avs_path_pipeline *ppl;
- struct avs_path_binding *binding;
- int ret;
- list_for_each_entry(ppl, &path->ppl_list, node) {
- /*
- * Arm all ppl bindings before binding internal modules
- * as it costs no IPCs which isn't true for the latter.
- */
- list_for_each_entry(binding, &ppl->binding_list, node) {
- ret = avs_path_binding_arm(adev, binding);
- if (ret < 0)
- return ret;
- }
- ret = avs_path_pipeline_arm(adev, ppl);
- if (ret < 0)
- return ret;
- }
- return 0;
- }
- static void avs_path_free_unlocked(struct avs_path *path)
- {
- struct avs_path_pipeline *ppl, *save;
- spin_lock(&path->owner->path_list_lock);
- list_del(&path->node);
- spin_unlock(&path->owner->path_list_lock);
- list_for_each_entry_safe(ppl, save, &path->ppl_list, node)
- avs_path_pipeline_free(path->owner, ppl);
- kfree(path);
- }
- static struct avs_path *avs_path_create_unlocked(struct avs_dev *adev, u32 dma_id,
- struct avs_tplg_path *template)
- {
- struct avs_path *path;
- int ret;
- path = kzalloc(sizeof(*path), GFP_KERNEL);
- if (!path)
- return ERR_PTR(-ENOMEM);
- ret = avs_path_init(adev, path, template, dma_id);
- if (ret < 0)
- goto err;
- ret = avs_path_arm(adev, path);
- if (ret < 0)
- goto err;
- path->state = AVS_PPL_STATE_INVALID;
- return path;
- err:
- avs_path_free_unlocked(path);
- return ERR_PTR(ret);
- }
- void avs_path_free(struct avs_path *path)
- {
- struct avs_dev *adev = path->owner;
- mutex_lock(&adev->path_mutex);
- avs_path_free_unlocked(path);
- mutex_unlock(&adev->path_mutex);
- }
- struct avs_path *avs_path_create(struct avs_dev *adev, u32 dma_id,
- struct avs_tplg_path_template *template,
- struct snd_pcm_hw_params *fe_params,
- struct snd_pcm_hw_params *be_params)
- {
- struct avs_tplg_path *variant;
- struct avs_path *path;
- variant = avs_path_find_variant(adev, template, fe_params, be_params);
- if (!variant) {
- dev_err(adev->dev, "no matching variant found\n");
- return ERR_PTR(-ENOENT);
- }
- /* Serialize path and its components creation. */
- mutex_lock(&adev->path_mutex);
- /* Satisfy needs of avs_path_find_tplg(). */
- mutex_lock(&adev->comp_list_mutex);
- path = avs_path_create_unlocked(adev, dma_id, variant);
- mutex_unlock(&adev->comp_list_mutex);
- mutex_unlock(&adev->path_mutex);
- return path;
- }
- static int avs_path_bind_prepare(struct avs_dev *adev,
- struct avs_path_binding *binding)
- {
- const struct avs_audio_format *src_fmt, *sink_fmt;
- struct avs_tplg_module *tsource = binding->source->template;
- struct avs_path_module *source = binding->source;
- int ret;
- /*
- * only copier modules about to be bound
- * to output pin other than 0 need preparation
- */
- if (!binding->source_pin)
- return 0;
- if (!guid_equal(&tsource->cfg_ext->type, &AVS_COPIER_MOD_UUID))
- return 0;
- src_fmt = tsource->in_fmt;
- sink_fmt = binding->sink->template->in_fmt;
- ret = avs_ipc_copier_set_sink_format(adev, source->module_id,
- source->instance_id, binding->source_pin,
- src_fmt, sink_fmt);
- if (ret) {
- dev_err(adev->dev, "config copier failed: %d\n", ret);
- return AVS_IPC_RET(ret);
- }
- return 0;
- }
- int avs_path_bind(struct avs_path *path)
- {
- struct avs_path_pipeline *ppl;
- struct avs_dev *adev = path->owner;
- int ret;
- list_for_each_entry(ppl, &path->ppl_list, node) {
- struct avs_path_binding *binding;
- list_for_each_entry(binding, &ppl->binding_list, node) {
- struct avs_path_module *source, *sink;
- source = binding->source;
- sink = binding->sink;
- ret = avs_path_bind_prepare(adev, binding);
- if (ret < 0)
- return ret;
- ret = avs_ipc_bind(adev, source->module_id,
- source->instance_id, sink->module_id,
- sink->instance_id, binding->sink_pin,
- binding->source_pin);
- if (ret) {
- dev_err(adev->dev, "bind path failed: %d\n", ret);
- return AVS_IPC_RET(ret);
- }
- }
- }
- return 0;
- }
- int avs_path_unbind(struct avs_path *path)
- {
- struct avs_path_pipeline *ppl;
- struct avs_dev *adev = path->owner;
- int ret;
- list_for_each_entry(ppl, &path->ppl_list, node) {
- struct avs_path_binding *binding;
- list_for_each_entry(binding, &ppl->binding_list, node) {
- struct avs_path_module *source, *sink;
- source = binding->source;
- sink = binding->sink;
- ret = avs_ipc_unbind(adev, source->module_id,
- source->instance_id, sink->module_id,
- sink->instance_id, binding->sink_pin,
- binding->source_pin);
- if (ret) {
- dev_err(adev->dev, "unbind path failed: %d\n", ret);
- return AVS_IPC_RET(ret);
- }
- }
- }
- return 0;
- }
- int avs_path_reset(struct avs_path *path)
- {
- struct avs_path_pipeline *ppl;
- struct avs_dev *adev = path->owner;
- int ret;
- if (path->state == AVS_PPL_STATE_RESET)
- return 0;
- list_for_each_entry(ppl, &path->ppl_list, node) {
- ret = avs_ipc_set_pipeline_state(adev, ppl->instance_id,
- AVS_PPL_STATE_RESET);
- if (ret) {
- dev_err(adev->dev, "reset path failed: %d\n", ret);
- path->state = AVS_PPL_STATE_INVALID;
- return AVS_IPC_RET(ret);
- }
- }
- path->state = AVS_PPL_STATE_RESET;
- return 0;
- }
- int avs_path_pause(struct avs_path *path)
- {
- struct avs_path_pipeline *ppl;
- struct avs_dev *adev = path->owner;
- int ret;
- if (path->state == AVS_PPL_STATE_PAUSED)
- return 0;
- list_for_each_entry_reverse(ppl, &path->ppl_list, node) {
- ret = avs_ipc_set_pipeline_state(adev, ppl->instance_id,
- AVS_PPL_STATE_PAUSED);
- if (ret) {
- dev_err(adev->dev, "pause path failed: %d\n", ret);
- path->state = AVS_PPL_STATE_INVALID;
- return AVS_IPC_RET(ret);
- }
- }
- path->state = AVS_PPL_STATE_PAUSED;
- return 0;
- }
- int avs_path_run(struct avs_path *path, int trigger)
- {
- struct avs_path_pipeline *ppl;
- struct avs_dev *adev = path->owner;
- int ret;
- if (path->state == AVS_PPL_STATE_RUNNING && trigger == AVS_TPLG_TRIGGER_AUTO)
- return 0;
- list_for_each_entry(ppl, &path->ppl_list, node) {
- if (ppl->template->cfg->trigger != trigger)
- continue;
- ret = avs_ipc_set_pipeline_state(adev, ppl->instance_id,
- AVS_PPL_STATE_RUNNING);
- if (ret) {
- dev_err(adev->dev, "run path failed: %d\n", ret);
- path->state = AVS_PPL_STATE_INVALID;
- return AVS_IPC_RET(ret);
- }
- }
- path->state = AVS_PPL_STATE_RUNNING;
- return 0;
- }
|