ASoC: SOF: ipc4-topology: Add widget_setup/widget_free ops

Define and set the widget_setup/widget_free ops for IPC4.

Co-developed-by: Rander Wang <rander.wang@linux.intel.com>
Signed-off-by: Rander Wang <rander.wang@linux.intel.com>
Co-developed-by: Bard Liao <yung-chuan.liao@linux.intel.com>
Signed-off-by: Bard Liao <yung-chuan.liao@linux.intel.com>
Signed-off-by: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>
Reviewed-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Reviewed-by: Bard Liao <yung-chuan.liao@linux.intel.com>
Reviewed-by: Péter Ujfalusi <peter.ujfalusi@linux.intel.com>
Link: https://lore.kernel.org/r/20220609032643.916882-13-ranjani.sridharan@linux.intel.com
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/sof/ipc4-topology.c b/sound/soc/sof/ipc4-topology.c
index 3cebd6f..44f65b8 100644 (file)
--- a/sound/soc/sof/ipc4-topology.c
+++ b/sound/soc/sof/ipc4-topology.c
@@ -1078,6 +1078,127 @@ static int sof_ipc4_control_setup(struct snd_sof_dev *sdev, struct snd_sof_contr
        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->pipe_widget;
+       struct sof_ipc4_pipeline *pipeline;
+       struct sof_ipc4_msg *msg;
+       void *ipc_data = NULL;
+       u32 ipc_size = 0;
+       int ret;
+
+       dev_dbg(sdev->dev, "Create widget %s instance %d - pipe %d - core %d\n",
+               swidget->widget->name, swidget->instance_id, swidget->pipeline_id, swidget->core);
+
+       switch (swidget->id) {
+       case snd_soc_dapm_scheduler:
+               pipeline = swidget->private;
+
+               dev_dbg(sdev->dev, "pipeline: %d memory pages: %d\n", swidget->pipeline_id,
+                       pipeline->mem_usage);
+
+               msg = &pipeline->msg;
+               msg->primary |= pipeline->mem_usage;
+               break;
+       case snd_soc_dapm_aif_in:
+       case snd_soc_dapm_aif_out:
+       {
+               struct sof_ipc4_copier *ipc4_copier = swidget->private;
+
+               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;
+
+               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(struct sof_ipc4_base_module_cfg) +
+                          sizeof(struct sof_ipc4_gain_data);
+               ipc_data = gain;
+
+               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;
+       }
+       default:
+               dev_err(sdev->dev, "widget type %d not supported", swidget->id);
+               return -EINVAL;
+       }
+
+       if (swidget->id != snd_soc_dapm_scheduler) {
+               pipeline = pipe_widget->private;
+               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_DOMAIN_MASK;
+               msg->extension |= SOF_IPC4_MOD_EXT_DOMAIN(pipeline->lp_mode);
+       }
+
+       msg->data_size = ipc_size;
+       msg->data_ptr = ipc_data;
+
+       ret = sof_ipc_tx_message(sdev->ipc, msg, ipc_size, NULL, 0);
+       if (ret < 0)
+               dev_err(sdev->dev, "failed to create module %s\n", swidget->widget->name);
+
+       return ret;
+}
+
+static int sof_ipc4_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
+{
+       int ret = 0;
+
+       /* 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;
+
+               header = SOF_IPC4_GLB_PIPE_INSTANCE_ID(swidget->pipeline_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(sdev->ipc, &msg, 0, NULL, 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;
+       }
+
+       return ret;
+}
+
 static enum sof_tokens host_token_list[] = {
        SOF_COMP_TOKENS,
        SOF_AUDIO_FMT_NUM_TOKENS,
@@ -1158,4 +1279,6 @@ const struct sof_ipc_tplg_ops ipc4_tplg_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,
 };