1e149ca29SPierre-Louis Bossart // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause) 2ee1e79b7SRanjani Sridharan // 3ee1e79b7SRanjani Sridharan // This file is provided under a dual BSD/GPLv2 license. When using or 4ee1e79b7SRanjani Sridharan // redistributing this file, you may do so under either license. 5ee1e79b7SRanjani Sridharan // 6ee1e79b7SRanjani Sridharan // Copyright(c) 2019 Intel Corporation. All rights reserved. 7ee1e79b7SRanjani Sridharan // 8ee1e79b7SRanjani Sridharan // Author: Ranjani Sridharan <ranjani.sridharan@linux.intel.com> 9ee1e79b7SRanjani Sridharan // 10ee1e79b7SRanjani Sridharan 11b30b60a2SPierre-Louis Bossart #include <linux/bitfield.h> 12ee1e79b7SRanjani Sridharan #include "sof-audio.h" 13ee1e79b7SRanjani Sridharan #include "ops.h" 14ee1e79b7SRanjani Sridharan 1593d71245SRanjani Sridharan static int sof_kcontrol_setup(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol) 1693d71245SRanjani Sridharan { 1793d71245SRanjani Sridharan int ipc_cmd, ctrl_type; 1893d71245SRanjani Sridharan int ret; 1993d71245SRanjani Sridharan 2093d71245SRanjani Sridharan /* reset readback offset for scontrol */ 2193d71245SRanjani Sridharan scontrol->readback_offset = 0; 2293d71245SRanjani Sridharan 2393d71245SRanjani Sridharan /* notify DSP of kcontrol values */ 2493d71245SRanjani Sridharan switch (scontrol->cmd) { 2593d71245SRanjani Sridharan case SOF_CTRL_CMD_VOLUME: 2693d71245SRanjani Sridharan case SOF_CTRL_CMD_ENUM: 2793d71245SRanjani Sridharan case SOF_CTRL_CMD_SWITCH: 2893d71245SRanjani Sridharan ipc_cmd = SOF_IPC_COMP_SET_VALUE; 2993d71245SRanjani Sridharan ctrl_type = SOF_CTRL_TYPE_VALUE_CHAN_SET; 3093d71245SRanjani Sridharan break; 3193d71245SRanjani Sridharan case SOF_CTRL_CMD_BINARY: 3293d71245SRanjani Sridharan ipc_cmd = SOF_IPC_COMP_SET_DATA; 3393d71245SRanjani Sridharan ctrl_type = SOF_CTRL_TYPE_DATA_SET; 3493d71245SRanjani Sridharan break; 3593d71245SRanjani Sridharan default: 3693d71245SRanjani Sridharan return 0; 3793d71245SRanjani Sridharan } 3893d71245SRanjani Sridharan 3993d71245SRanjani Sridharan ret = snd_sof_ipc_set_get_comp_data(scontrol, ipc_cmd, ctrl_type, scontrol->cmd, true); 4093d71245SRanjani Sridharan if (ret < 0) 4193d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed kcontrol value set for widget: %d\n", 4293d71245SRanjani Sridharan scontrol->comp_id); 4393d71245SRanjani Sridharan 4493d71245SRanjani Sridharan return ret; 4593d71245SRanjani Sridharan } 4693d71245SRanjani Sridharan 4793d71245SRanjani Sridharan static int sof_dai_config_setup(struct snd_sof_dev *sdev, struct snd_sof_dai *dai) 4893d71245SRanjani Sridharan { 4993d71245SRanjani Sridharan struct sof_ipc_dai_config *config; 5093d71245SRanjani Sridharan struct sof_ipc_reply reply; 5193d71245SRanjani Sridharan int ret; 5293d71245SRanjani Sridharan 5393d71245SRanjani Sridharan config = &dai->dai_config[dai->current_config]; 5493d71245SRanjani Sridharan if (!config) { 5593d71245SRanjani Sridharan dev_err(sdev->dev, "error: no config for DAI %s\n", dai->name); 5693d71245SRanjani Sridharan return -EINVAL; 5793d71245SRanjani Sridharan } 5893d71245SRanjani Sridharan 59b30b60a2SPierre-Louis Bossart /* set NONE flag to clear all previous settings */ 60b30b60a2SPierre-Louis Bossart config->flags = FIELD_PREP(SOF_DAI_CONFIG_FLAGS_MASK, SOF_DAI_CONFIG_FLAGS_NONE); 61b30b60a2SPierre-Louis Bossart 6293d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, config->hdr.cmd, config, config->hdr.size, 6393d71245SRanjani Sridharan &reply, sizeof(reply)); 6493d71245SRanjani Sridharan 6593d71245SRanjani Sridharan if (ret < 0) 6693d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed to set dai config for %s\n", dai->name); 6793d71245SRanjani Sridharan 6893d71245SRanjani Sridharan return ret; 6993d71245SRanjani Sridharan } 7093d71245SRanjani Sridharan 715f3aad73SRanjani Sridharan static int sof_widget_kcontrol_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 725f3aad73SRanjani Sridharan { 735f3aad73SRanjani Sridharan struct snd_sof_control *scontrol; 745f3aad73SRanjani Sridharan int ret; 755f3aad73SRanjani Sridharan 765f3aad73SRanjani Sridharan /* set up all controls for the widget */ 775f3aad73SRanjani Sridharan list_for_each_entry(scontrol, &sdev->kcontrol_list, list) 785f3aad73SRanjani Sridharan if (scontrol->comp_id == swidget->comp_id) { 795f3aad73SRanjani Sridharan ret = sof_kcontrol_setup(sdev, scontrol); 805f3aad73SRanjani Sridharan if (ret < 0) { 815f3aad73SRanjani Sridharan dev_err(sdev->dev, "error: fail to set up kcontrols for widget %s\n", 825f3aad73SRanjani Sridharan swidget->widget->name); 835f3aad73SRanjani Sridharan return ret; 845f3aad73SRanjani Sridharan } 855f3aad73SRanjani Sridharan } 865f3aad73SRanjani Sridharan 875f3aad73SRanjani Sridharan return 0; 885f3aad73SRanjani Sridharan } 895f3aad73SRanjani Sridharan 905fcdbb2dSRanjani Sridharan static void sof_reset_route_setup_status(struct snd_sof_dev *sdev, struct snd_sof_widget *widget) 915fcdbb2dSRanjani Sridharan { 925fcdbb2dSRanjani Sridharan struct snd_sof_route *sroute; 935fcdbb2dSRanjani Sridharan 945fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 955fcdbb2dSRanjani Sridharan if (sroute->src_widget == widget || sroute->sink_widget == widget) 965fcdbb2dSRanjani Sridharan sroute->setup = false; 975fcdbb2dSRanjani Sridharan } 985fcdbb2dSRanjani Sridharan 998b001416SRanjani Sridharan int sof_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 1008b001416SRanjani Sridharan { 1018b001416SRanjani Sridharan struct sof_ipc_free ipc_free = { 1028b001416SRanjani Sridharan .hdr = { 1038b001416SRanjani Sridharan .size = sizeof(ipc_free), 1048b001416SRanjani Sridharan .cmd = SOF_IPC_GLB_TPLG_MSG, 1058b001416SRanjani Sridharan }, 1068b001416SRanjani Sridharan .id = swidget->comp_id, 1078b001416SRanjani Sridharan }; 1088b001416SRanjani Sridharan struct sof_ipc_reply reply; 1099ea80748SRanjani Sridharan int ret, ret1, core; 1108b001416SRanjani Sridharan 1118b001416SRanjani Sridharan if (!swidget->private) 1128b001416SRanjani Sridharan return 0; 1138b001416SRanjani Sridharan 1148b001416SRanjani Sridharan /* only free when use_count is 0 */ 1158b001416SRanjani Sridharan if (--swidget->use_count) 1168b001416SRanjani Sridharan return 0; 1178b001416SRanjani Sridharan 1189ea80748SRanjani Sridharan core = swidget->core; 1199ea80748SRanjani Sridharan 1208b001416SRanjani Sridharan switch (swidget->id) { 1218b001416SRanjani Sridharan case snd_soc_dapm_scheduler: 1229ea80748SRanjani Sridharan { 1239ea80748SRanjani Sridharan const struct sof_ipc_pipe_new *pipeline = swidget->private; 1249ea80748SRanjani Sridharan 1259ea80748SRanjani Sridharan core = pipeline->core; 1268b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_PIPE_FREE; 1278b001416SRanjani Sridharan break; 1289ea80748SRanjani Sridharan } 1298b001416SRanjani Sridharan case snd_soc_dapm_buffer: 1308b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_BUFFER_FREE; 1318b001416SRanjani Sridharan break; 13296da1740SRanjani Sridharan case snd_soc_dapm_dai_in: 13396da1740SRanjani Sridharan case snd_soc_dapm_dai_out: 13496da1740SRanjani Sridharan { 13596da1740SRanjani Sridharan struct snd_sof_dai *dai = swidget->private; 13696da1740SRanjani Sridharan 13796da1740SRanjani Sridharan dai->configured = false; 13896da1740SRanjani Sridharan fallthrough; 13996da1740SRanjani Sridharan } 1408b001416SRanjani Sridharan default: 1418b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_COMP_FREE; 1428b001416SRanjani Sridharan break; 1438b001416SRanjani Sridharan } 1448b001416SRanjani Sridharan 1459ea80748SRanjani Sridharan /* continue to disable core even if IPC fails */ 1468b001416SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, ipc_free.hdr.cmd, &ipc_free, sizeof(ipc_free), 1478b001416SRanjani Sridharan &reply, sizeof(reply)); 1489ea80748SRanjani Sridharan if (ret < 0) 1498b001416SRanjani Sridharan dev_err(sdev->dev, "error: failed to free widget %s\n", swidget->widget->name); 1509ea80748SRanjani Sridharan 1519ea80748SRanjani Sridharan /* 1529ea80748SRanjani Sridharan * disable widget core. continue to route setup status and complete flag 1539ea80748SRanjani Sridharan * even if this fails and return the appropriate error 1549ea80748SRanjani Sridharan */ 1559ea80748SRanjani Sridharan ret1 = snd_sof_dsp_core_put(sdev, core); 1569ea80748SRanjani Sridharan if (ret1 < 0) { 1579ea80748SRanjani Sridharan dev_err(sdev->dev, "error: failed to disable target core: %d for widget %s\n", 1589ea80748SRanjani Sridharan core, swidget->widget->name); 1599ea80748SRanjani Sridharan if (!ret) 1609ea80748SRanjani Sridharan ret = ret1; 1618b001416SRanjani Sridharan } 1628b001416SRanjani Sridharan 1635fcdbb2dSRanjani Sridharan /* reset route setup status for all routes that contain this widget */ 1645fcdbb2dSRanjani Sridharan sof_reset_route_setup_status(sdev, swidget); 1658b001416SRanjani Sridharan swidget->complete = 0; 1669ea80748SRanjani Sridharan 1679ea80748SRanjani Sridharan if (!ret) 1688b001416SRanjani Sridharan dev_dbg(sdev->dev, "widget %s freed\n", swidget->widget->name); 1698b001416SRanjani Sridharan 1709ea80748SRanjani Sridharan return ret; 1718b001416SRanjani Sridharan } 1728b001416SRanjani Sridharan EXPORT_SYMBOL(sof_widget_free); 1738b001416SRanjani Sridharan 1748b001416SRanjani Sridharan int sof_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 17593d71245SRanjani Sridharan { 17693d71245SRanjani Sridharan struct sof_ipc_pipe_new *pipeline; 17793d71245SRanjani Sridharan struct sof_ipc_comp_reply r; 17893d71245SRanjani Sridharan struct sof_ipc_cmd_hdr *hdr; 17993d71245SRanjani Sridharan struct sof_ipc_comp *comp; 18093d71245SRanjani Sridharan struct snd_sof_dai *dai; 18193d71245SRanjani Sridharan size_t ipc_size; 18293d71245SRanjani Sridharan int ret; 1839ea80748SRanjani Sridharan int core; 18493d71245SRanjani Sridharan 18593d71245SRanjani Sridharan /* skip if there is no private data */ 18693d71245SRanjani Sridharan if (!swidget->private) 18793d71245SRanjani Sridharan return 0; 18893d71245SRanjani Sridharan 1898b001416SRanjani Sridharan /* widget already set up */ 1908b001416SRanjani Sridharan if (++swidget->use_count > 1) 1918b001416SRanjani Sridharan return 0; 1928b001416SRanjani Sridharan 1939ea80748SRanjani Sridharan /* set core ID */ 1949ea80748SRanjani Sridharan core = swidget->core; 1959ea80748SRanjani Sridharan if (swidget->id == snd_soc_dapm_scheduler) { 1969ea80748SRanjani Sridharan pipeline = swidget->private; 1979ea80748SRanjani Sridharan core = pipeline->core; 1989ea80748SRanjani Sridharan } 1999ea80748SRanjani Sridharan 2009ea80748SRanjani Sridharan /* enable widget core */ 2019ea80748SRanjani Sridharan ret = snd_sof_dsp_core_get(sdev, core); 20293d71245SRanjani Sridharan if (ret < 0) { 2039ea80748SRanjani Sridharan dev_err(sdev->dev, "error: failed to enable target core for widget %s\n", 2049ea80748SRanjani Sridharan swidget->widget->name); 2058b001416SRanjani Sridharan goto use_count_dec; 20693d71245SRanjani Sridharan } 20793d71245SRanjani Sridharan 20893d71245SRanjani Sridharan switch (swidget->id) { 20993d71245SRanjani Sridharan case snd_soc_dapm_dai_in: 21093d71245SRanjani Sridharan case snd_soc_dapm_dai_out: 21193d71245SRanjani Sridharan ipc_size = sizeof(struct sof_ipc_comp_dai) + sizeof(struct sof_ipc_comp_ext); 21293d71245SRanjani Sridharan comp = kzalloc(ipc_size, GFP_KERNEL); 2139ea80748SRanjani Sridharan if (!comp) { 2149ea80748SRanjani Sridharan ret = -ENOMEM; 2159ea80748SRanjani Sridharan goto core_put; 2169ea80748SRanjani Sridharan } 21793d71245SRanjani Sridharan 21893d71245SRanjani Sridharan dai = swidget->private; 2190acb48ddSRanjani Sridharan dai->configured = false; 22093d71245SRanjani Sridharan memcpy(comp, &dai->comp_dai, sizeof(struct sof_ipc_comp_dai)); 22193d71245SRanjani Sridharan 22293d71245SRanjani Sridharan /* append extended data to the end of the component */ 22393d71245SRanjani Sridharan memcpy((u8 *)comp + sizeof(struct sof_ipc_comp_dai), &swidget->comp_ext, 22493d71245SRanjani Sridharan sizeof(swidget->comp_ext)); 22593d71245SRanjani Sridharan 22693d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, comp->hdr.cmd, comp, ipc_size, &r, sizeof(r)); 22793d71245SRanjani Sridharan kfree(comp); 2285fcdbb2dSRanjani Sridharan if (ret < 0) { 2295fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: failed to load widget %s\n", 2305fcdbb2dSRanjani Sridharan swidget->widget->name); 2319ea80748SRanjani Sridharan goto core_put; 2325fcdbb2dSRanjani Sridharan } 2335fcdbb2dSRanjani Sridharan 2345fcdbb2dSRanjani Sridharan ret = sof_dai_config_setup(sdev, dai); 2355fcdbb2dSRanjani Sridharan if (ret < 0) { 2365fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: failed to load dai config for DAI %s\n", 2375fcdbb2dSRanjani Sridharan swidget->widget->name); 2389ea80748SRanjani Sridharan 2399ea80748SRanjani Sridharan /* 2409ea80748SRanjani Sridharan * widget use_count and core ref_count will both be decremented by 2419ea80748SRanjani Sridharan * sof_widget_free() 2429ea80748SRanjani Sridharan */ 2435fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 2445fcdbb2dSRanjani Sridharan return ret; 2455fcdbb2dSRanjani Sridharan } 24693d71245SRanjani Sridharan break; 24793d71245SRanjani Sridharan case snd_soc_dapm_scheduler: 24893d71245SRanjani Sridharan pipeline = swidget->private; 2497cc7b9baSRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, pipeline->hdr.cmd, pipeline, 2507cc7b9baSRanjani Sridharan sizeof(*pipeline), &r, sizeof(r)); 25193d71245SRanjani Sridharan break; 25293d71245SRanjani Sridharan default: 25393d71245SRanjani Sridharan hdr = swidget->private; 25493d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, hdr->cmd, swidget->private, hdr->size, 25593d71245SRanjani Sridharan &r, sizeof(r)); 25693d71245SRanjani Sridharan break; 25793d71245SRanjani Sridharan } 2585f3aad73SRanjani Sridharan if (ret < 0) { 25993d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed to load widget %s\n", swidget->widget->name); 2609ea80748SRanjani Sridharan goto core_put; 2615f3aad73SRanjani Sridharan } 2625f3aad73SRanjani Sridharan 2635f3aad73SRanjani Sridharan /* restore kcontrols for widget */ 2645f3aad73SRanjani Sridharan ret = sof_widget_kcontrol_setup(sdev, swidget); 2655f3aad73SRanjani Sridharan if (ret < 0) { 2665f3aad73SRanjani Sridharan dev_err(sdev->dev, "error: failed to restore kcontrols for widget %s\n", 2675f3aad73SRanjani Sridharan swidget->widget->name); 2689ea80748SRanjani Sridharan /* 2699ea80748SRanjani Sridharan * widget use_count and core ref_count will both be decremented by 2709ea80748SRanjani Sridharan * sof_widget_free() 2719ea80748SRanjani Sridharan */ 2725fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 2735f3aad73SRanjani Sridharan return ret; 2745f3aad73SRanjani Sridharan } 2755f3aad73SRanjani Sridharan 27693d71245SRanjani Sridharan dev_dbg(sdev->dev, "widget %s setup complete\n", swidget->widget->name); 27793d71245SRanjani Sridharan 2788b001416SRanjani Sridharan return 0; 2798b001416SRanjani Sridharan 2809ea80748SRanjani Sridharan core_put: 2819ea80748SRanjani Sridharan snd_sof_dsp_core_put(sdev, core); 2828b001416SRanjani Sridharan use_count_dec: 2838b001416SRanjani Sridharan swidget->use_count--; 28493d71245SRanjani Sridharan return ret; 28593d71245SRanjani Sridharan } 2868b001416SRanjani Sridharan EXPORT_SYMBOL(sof_widget_setup); 28793d71245SRanjani Sridharan 2885fcdbb2dSRanjani Sridharan static int sof_route_setup_ipc(struct snd_sof_dev *sdev, struct snd_sof_route *sroute) 2895fcdbb2dSRanjani Sridharan { 2905fcdbb2dSRanjani Sridharan struct sof_ipc_pipe_comp_connect *connect; 2915fcdbb2dSRanjani Sridharan struct sof_ipc_reply reply; 2925fcdbb2dSRanjani Sridharan int ret; 2935fcdbb2dSRanjani Sridharan 2945fcdbb2dSRanjani Sridharan /* skip if there's no private data */ 2955fcdbb2dSRanjani Sridharan if (!sroute->private) 2965fcdbb2dSRanjani Sridharan return 0; 2975fcdbb2dSRanjani Sridharan 2985fcdbb2dSRanjani Sridharan /* nothing to do if route is already set up */ 2995fcdbb2dSRanjani Sridharan if (sroute->setup) 3005fcdbb2dSRanjani Sridharan return 0; 3015fcdbb2dSRanjani Sridharan 3025fcdbb2dSRanjani Sridharan connect = sroute->private; 3035fcdbb2dSRanjani Sridharan 3045fcdbb2dSRanjani Sridharan dev_dbg(sdev->dev, "setting up route %s -> %s\n", 3055fcdbb2dSRanjani Sridharan sroute->src_widget->widget->name, 3065fcdbb2dSRanjani Sridharan sroute->sink_widget->widget->name); 3075fcdbb2dSRanjani Sridharan 3085fcdbb2dSRanjani Sridharan /* send ipc */ 3095fcdbb2dSRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, 3105fcdbb2dSRanjani Sridharan connect->hdr.cmd, 3115fcdbb2dSRanjani Sridharan connect, sizeof(*connect), 3125fcdbb2dSRanjani Sridharan &reply, sizeof(reply)); 3135fcdbb2dSRanjani Sridharan if (ret < 0) { 3145fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "%s: route setup failed %d\n", __func__, ret); 3155fcdbb2dSRanjani Sridharan return ret; 3165fcdbb2dSRanjani Sridharan } 3175fcdbb2dSRanjani Sridharan 3185fcdbb2dSRanjani Sridharan sroute->setup = true; 3195fcdbb2dSRanjani Sridharan 3205fcdbb2dSRanjani Sridharan return 0; 3215fcdbb2dSRanjani Sridharan } 3225fcdbb2dSRanjani Sridharan 3235fcdbb2dSRanjani Sridharan static int sof_route_setup(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *wsource, 3245fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *wsink) 3255fcdbb2dSRanjani Sridharan { 3265fcdbb2dSRanjani Sridharan struct snd_sof_widget *src_widget = wsource->dobj.private; 3275fcdbb2dSRanjani Sridharan struct snd_sof_widget *sink_widget = wsink->dobj.private; 3285fcdbb2dSRanjani Sridharan struct snd_sof_route *sroute; 3295fcdbb2dSRanjani Sridharan bool route_found = false; 3305fcdbb2dSRanjani Sridharan 3315fcdbb2dSRanjani Sridharan /* ignore routes involving virtual widgets in topology */ 3325fcdbb2dSRanjani Sridharan switch (src_widget->id) { 3335fcdbb2dSRanjani Sridharan case snd_soc_dapm_out_drv: 3345fcdbb2dSRanjani Sridharan case snd_soc_dapm_output: 3355fcdbb2dSRanjani Sridharan case snd_soc_dapm_input: 3365fcdbb2dSRanjani Sridharan return 0; 3375fcdbb2dSRanjani Sridharan default: 3385fcdbb2dSRanjani Sridharan break; 3395fcdbb2dSRanjani Sridharan } 3405fcdbb2dSRanjani Sridharan 3415fcdbb2dSRanjani Sridharan switch (sink_widget->id) { 3425fcdbb2dSRanjani Sridharan case snd_soc_dapm_out_drv: 3435fcdbb2dSRanjani Sridharan case snd_soc_dapm_output: 3445fcdbb2dSRanjani Sridharan case snd_soc_dapm_input: 3455fcdbb2dSRanjani Sridharan return 0; 3465fcdbb2dSRanjani Sridharan default: 3475fcdbb2dSRanjani Sridharan break; 3485fcdbb2dSRanjani Sridharan } 3495fcdbb2dSRanjani Sridharan 3505fcdbb2dSRanjani Sridharan /* find route matching source and sink widgets */ 3515fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 3525fcdbb2dSRanjani Sridharan if (sroute->src_widget == src_widget && sroute->sink_widget == sink_widget) { 3535fcdbb2dSRanjani Sridharan route_found = true; 3545fcdbb2dSRanjani Sridharan break; 3555fcdbb2dSRanjani Sridharan } 3565fcdbb2dSRanjani Sridharan 3575fcdbb2dSRanjani Sridharan if (!route_found) { 3585fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: cannot find SOF route for source %s -> %s sink\n", 3595fcdbb2dSRanjani Sridharan wsource->name, wsink->name); 3605fcdbb2dSRanjani Sridharan return -EINVAL; 3615fcdbb2dSRanjani Sridharan } 3625fcdbb2dSRanjani Sridharan 3635fcdbb2dSRanjani Sridharan return sof_route_setup_ipc(sdev, sroute); 3645fcdbb2dSRanjani Sridharan } 3655fcdbb2dSRanjani Sridharan 3665fcdbb2dSRanjani Sridharan static int sof_setup_pipeline_connections(struct snd_sof_dev *sdev, 3675fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list, int dir) 3685fcdbb2dSRanjani Sridharan { 3695fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 3705fcdbb2dSRanjani Sridharan struct snd_soc_dapm_path *p; 3715fcdbb2dSRanjani Sridharan int ret; 3725fcdbb2dSRanjani Sridharan int i; 3735fcdbb2dSRanjani Sridharan 3745fcdbb2dSRanjani Sridharan /* 3755fcdbb2dSRanjani Sridharan * Set up connections between widgets in the sink/source paths based on direction. 3765fcdbb2dSRanjani Sridharan * Some non-SOF widgets exist in topology either for compatibility or for the 3775fcdbb2dSRanjani Sridharan * purpose of connecting a pipeline from a host to a DAI in order to receive the DAPM 3785fcdbb2dSRanjani Sridharan * events. But they are not handled by the firmware. So ignore them. 3795fcdbb2dSRanjani Sridharan */ 3805fcdbb2dSRanjani Sridharan if (dir == SNDRV_PCM_STREAM_PLAYBACK) { 3815fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 3825fcdbb2dSRanjani Sridharan if (!widget->dobj.private) 3835fcdbb2dSRanjani Sridharan continue; 3845fcdbb2dSRanjani Sridharan 3855fcdbb2dSRanjani Sridharan snd_soc_dapm_widget_for_each_sink_path(widget, p) 3865fcdbb2dSRanjani Sridharan if (p->sink->dobj.private) { 3875fcdbb2dSRanjani Sridharan ret = sof_route_setup(sdev, widget, p->sink); 3885fcdbb2dSRanjani Sridharan if (ret < 0) 3895fcdbb2dSRanjani Sridharan return ret; 3905fcdbb2dSRanjani Sridharan } 3915fcdbb2dSRanjani Sridharan } 3925fcdbb2dSRanjani Sridharan } else { 3935fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 3945fcdbb2dSRanjani Sridharan if (!widget->dobj.private) 3955fcdbb2dSRanjani Sridharan continue; 3965fcdbb2dSRanjani Sridharan 3975fcdbb2dSRanjani Sridharan snd_soc_dapm_widget_for_each_source_path(widget, p) 3985fcdbb2dSRanjani Sridharan if (p->source->dobj.private) { 3995fcdbb2dSRanjani Sridharan ret = sof_route_setup(sdev, p->source, widget); 4005fcdbb2dSRanjani Sridharan if (ret < 0) 4015fcdbb2dSRanjani Sridharan return ret; 4025fcdbb2dSRanjani Sridharan } 4035fcdbb2dSRanjani Sridharan } 4045fcdbb2dSRanjani Sridharan } 4055fcdbb2dSRanjani Sridharan 4065fcdbb2dSRanjani Sridharan return 0; 4075fcdbb2dSRanjani Sridharan } 4085fcdbb2dSRanjani Sridharan 4095fcdbb2dSRanjani Sridharan int sof_widget_list_setup(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir) 4105fcdbb2dSRanjani Sridharan { 4115fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list; 4125fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 4135fcdbb2dSRanjani Sridharan int i, ret, num_widgets; 4145fcdbb2dSRanjani Sridharan 4155fcdbb2dSRanjani Sridharan /* nothing to set up */ 4165fcdbb2dSRanjani Sridharan if (!list) 4175fcdbb2dSRanjani Sridharan return 0; 4185fcdbb2dSRanjani Sridharan 4195fcdbb2dSRanjani Sridharan /* set up widgets in the list */ 4205fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, num_widgets, widget) { 4215fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4225fcdbb2dSRanjani Sridharan struct snd_sof_widget *pipe_widget; 4235fcdbb2dSRanjani Sridharan 4245fcdbb2dSRanjani Sridharan if (!swidget) 4255fcdbb2dSRanjani Sridharan continue; 4265fcdbb2dSRanjani Sridharan 4275fcdbb2dSRanjani Sridharan /* 4285fcdbb2dSRanjani Sridharan * The scheduler widget for a pipeline is not part of the connected DAPM 4295fcdbb2dSRanjani Sridharan * widget list and it needs to be set up before the widgets in the pipeline 4305fcdbb2dSRanjani Sridharan * are set up. The use_count for the scheduler widget is incremented for every 4315fcdbb2dSRanjani Sridharan * widget in a given pipeline to ensure that it is freed only after the last 4325fcdbb2dSRanjani Sridharan * widget in the pipeline is freed. 4335fcdbb2dSRanjani Sridharan */ 4345fcdbb2dSRanjani Sridharan pipe_widget = swidget->pipe_widget; 4355fcdbb2dSRanjani Sridharan if (!pipe_widget) { 4365fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: no pipeline widget found for %s\n", 4375fcdbb2dSRanjani Sridharan swidget->widget->name); 4385fcdbb2dSRanjani Sridharan ret = -EINVAL; 4395fcdbb2dSRanjani Sridharan goto widget_free; 4405fcdbb2dSRanjani Sridharan } 4415fcdbb2dSRanjani Sridharan 4425fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, pipe_widget); 4435fcdbb2dSRanjani Sridharan if (ret < 0) 4445fcdbb2dSRanjani Sridharan goto widget_free; 4455fcdbb2dSRanjani Sridharan 4465fcdbb2dSRanjani Sridharan /* set up the widget */ 4475fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, swidget); 4485fcdbb2dSRanjani Sridharan if (ret < 0) { 4495fcdbb2dSRanjani Sridharan sof_widget_free(sdev, pipe_widget); 4505fcdbb2dSRanjani Sridharan goto widget_free; 4515fcdbb2dSRanjani Sridharan } 4525fcdbb2dSRanjani Sridharan } 4535fcdbb2dSRanjani Sridharan 4545fcdbb2dSRanjani Sridharan /* 4555fcdbb2dSRanjani Sridharan * error in setting pipeline connections will result in route status being reset for 4565fcdbb2dSRanjani Sridharan * routes that were successfully set up when the widgets are freed. 4575fcdbb2dSRanjani Sridharan */ 4585fcdbb2dSRanjani Sridharan ret = sof_setup_pipeline_connections(sdev, list, dir); 4595fcdbb2dSRanjani Sridharan if (ret < 0) 4605fcdbb2dSRanjani Sridharan goto widget_free; 4615fcdbb2dSRanjani Sridharan 4625fcdbb2dSRanjani Sridharan /* complete pipelines */ 4635fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 4645fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4655fcdbb2dSRanjani Sridharan struct snd_sof_widget *pipe_widget; 4665fcdbb2dSRanjani Sridharan 4675fcdbb2dSRanjani Sridharan if (!swidget) 4685fcdbb2dSRanjani Sridharan continue; 4695fcdbb2dSRanjani Sridharan 4705fcdbb2dSRanjani Sridharan pipe_widget = swidget->pipe_widget; 4715fcdbb2dSRanjani Sridharan if (!pipe_widget) { 4725fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: no pipeline widget found for %s\n", 4735fcdbb2dSRanjani Sridharan swidget->widget->name); 4745fcdbb2dSRanjani Sridharan ret = -EINVAL; 4755fcdbb2dSRanjani Sridharan goto widget_free; 4765fcdbb2dSRanjani Sridharan } 4775fcdbb2dSRanjani Sridharan 4785fcdbb2dSRanjani Sridharan if (pipe_widget->complete) 4795fcdbb2dSRanjani Sridharan continue; 4805fcdbb2dSRanjani Sridharan 481d8a15e5fSPeter Ujfalusi pipe_widget->complete = snd_sof_complete_pipeline(sdev, pipe_widget); 4825fcdbb2dSRanjani Sridharan if (pipe_widget->complete < 0) { 4835fcdbb2dSRanjani Sridharan ret = pipe_widget->complete; 4845fcdbb2dSRanjani Sridharan goto widget_free; 4855fcdbb2dSRanjani Sridharan } 4865fcdbb2dSRanjani Sridharan } 4875fcdbb2dSRanjani Sridharan 4885fcdbb2dSRanjani Sridharan return 0; 4895fcdbb2dSRanjani Sridharan 4905fcdbb2dSRanjani Sridharan widget_free: 4915fcdbb2dSRanjani Sridharan /* free all widgets that have been set up successfully */ 4925fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 4935fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4945fcdbb2dSRanjani Sridharan 4955fcdbb2dSRanjani Sridharan if (!swidget) 4965fcdbb2dSRanjani Sridharan continue; 4975fcdbb2dSRanjani Sridharan 4985fcdbb2dSRanjani Sridharan if (!num_widgets--) 4995fcdbb2dSRanjani Sridharan break; 5005fcdbb2dSRanjani Sridharan 5015fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 5025fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget->pipe_widget); 5035fcdbb2dSRanjani Sridharan } 5045fcdbb2dSRanjani Sridharan 5055fcdbb2dSRanjani Sridharan return ret; 5065fcdbb2dSRanjani Sridharan } 5075fcdbb2dSRanjani Sridharan 5085fcdbb2dSRanjani Sridharan int sof_widget_list_free(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir) 5095fcdbb2dSRanjani Sridharan { 5105fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list; 5115fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 5125fcdbb2dSRanjani Sridharan int i, ret; 5135fcdbb2dSRanjani Sridharan int ret1 = 0; 5145fcdbb2dSRanjani Sridharan 5155fcdbb2dSRanjani Sridharan /* nothing to free */ 5165fcdbb2dSRanjani Sridharan if (!list) 5175fcdbb2dSRanjani Sridharan return 0; 5185fcdbb2dSRanjani Sridharan 5195fcdbb2dSRanjani Sridharan /* 5205fcdbb2dSRanjani Sridharan * Free widgets in the list. This can fail but continue freeing other widgets to keep 5215fcdbb2dSRanjani Sridharan * use_counts balanced. 5225fcdbb2dSRanjani Sridharan */ 5235fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 5245fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 5255fcdbb2dSRanjani Sridharan 5265fcdbb2dSRanjani Sridharan if (!swidget) 5275fcdbb2dSRanjani Sridharan continue; 5285fcdbb2dSRanjani Sridharan 5295fcdbb2dSRanjani Sridharan /* 5305fcdbb2dSRanjani Sridharan * free widget and its pipe_widget. Either of these can fail, but free as many as 5315fcdbb2dSRanjani Sridharan * possible before freeing the list and returning the error. 5325fcdbb2dSRanjani Sridharan */ 5335fcdbb2dSRanjani Sridharan ret = sof_widget_free(sdev, swidget); 5345fcdbb2dSRanjani Sridharan if (ret < 0) 5355fcdbb2dSRanjani Sridharan ret1 = ret; 5365fcdbb2dSRanjani Sridharan 5375fcdbb2dSRanjani Sridharan ret = sof_widget_free(sdev, swidget->pipe_widget); 5385fcdbb2dSRanjani Sridharan if (ret < 0) 5395fcdbb2dSRanjani Sridharan ret1 = ret; 5405fcdbb2dSRanjani Sridharan } 5415fcdbb2dSRanjani Sridharan 5425fcdbb2dSRanjani Sridharan snd_soc_dapm_dai_free_widgets(&list); 5435fcdbb2dSRanjani Sridharan spcm->stream[dir].list = NULL; 5445fcdbb2dSRanjani Sridharan 5455fcdbb2dSRanjani Sridharan return ret1; 5465fcdbb2dSRanjani Sridharan } 5475fcdbb2dSRanjani Sridharan 548de23a838SRanjani Sridharan /* 549de23a838SRanjani Sridharan * helper to determine if there are only D0i3 compatible 550de23a838SRanjani Sridharan * streams active 551de23a838SRanjani Sridharan */ 552de23a838SRanjani Sridharan bool snd_sof_dsp_only_d0i3_compatible_stream_active(struct snd_sof_dev *sdev) 553de23a838SRanjani Sridharan { 554de23a838SRanjani Sridharan struct snd_pcm_substream *substream; 555de23a838SRanjani Sridharan struct snd_sof_pcm *spcm; 556de23a838SRanjani Sridharan bool d0i3_compatible_active = false; 557de23a838SRanjani Sridharan int dir; 558de23a838SRanjani Sridharan 559de23a838SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 560525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 561de23a838SRanjani Sridharan substream = spcm->stream[dir].substream; 562de23a838SRanjani Sridharan if (!substream || !substream->runtime) 563de23a838SRanjani Sridharan continue; 564de23a838SRanjani Sridharan 565de23a838SRanjani Sridharan /* 5668932f0cbSRandy Dunlap * substream->runtime being not NULL indicates 567de23a838SRanjani Sridharan * that the stream is open. No need to check the 568de23a838SRanjani Sridharan * stream state. 569de23a838SRanjani Sridharan */ 570de23a838SRanjani Sridharan if (!spcm->stream[dir].d0i3_compatible) 571de23a838SRanjani Sridharan return false; 572de23a838SRanjani Sridharan 573de23a838SRanjani Sridharan d0i3_compatible_active = true; 574de23a838SRanjani Sridharan } 575de23a838SRanjani Sridharan } 576de23a838SRanjani Sridharan 577de23a838SRanjani Sridharan return d0i3_compatible_active; 578de23a838SRanjani Sridharan } 579de23a838SRanjani Sridharan EXPORT_SYMBOL(snd_sof_dsp_only_d0i3_compatible_stream_active); 580de23a838SRanjani Sridharan 581700d1677SRanjani Sridharan bool snd_sof_stream_suspend_ignored(struct snd_sof_dev *sdev) 582ee1e79b7SRanjani Sridharan { 583ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 584ee1e79b7SRanjani Sridharan 585ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 586ee1e79b7SRanjani Sridharan if (spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].suspend_ignored || 587ee1e79b7SRanjani Sridharan spcm->stream[SNDRV_PCM_STREAM_CAPTURE].suspend_ignored) 588ee1e79b7SRanjani Sridharan return true; 589ee1e79b7SRanjani Sridharan } 590ee1e79b7SRanjani Sridharan 591ee1e79b7SRanjani Sridharan return false; 592ee1e79b7SRanjani Sridharan } 593ee1e79b7SRanjani Sridharan 594ee1e79b7SRanjani Sridharan int sof_set_hw_params_upon_resume(struct device *dev) 595ee1e79b7SRanjani Sridharan { 596ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = dev_get_drvdata(dev); 597ee1e79b7SRanjani Sridharan struct snd_pcm_substream *substream; 598ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 599ee1e79b7SRanjani Sridharan snd_pcm_state_t state; 600ee1e79b7SRanjani Sridharan int dir; 601ee1e79b7SRanjani Sridharan 602ee1e79b7SRanjani Sridharan /* 603ee1e79b7SRanjani Sridharan * SOF requires hw_params to be set-up internally upon resume. 604ee1e79b7SRanjani Sridharan * So, set the flag to indicate this for those streams that 605ee1e79b7SRanjani Sridharan * have been suspended. 606ee1e79b7SRanjani Sridharan */ 607ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 608525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 6093f06501eSRanjani Sridharan /* 6103f06501eSRanjani Sridharan * do not reset hw_params upon resume for streams that 6113f06501eSRanjani Sridharan * were kept running during suspend 6123f06501eSRanjani Sridharan */ 6133f06501eSRanjani Sridharan if (spcm->stream[dir].suspend_ignored) 6143f06501eSRanjani Sridharan continue; 6153f06501eSRanjani Sridharan 616ee1e79b7SRanjani Sridharan substream = spcm->stream[dir].substream; 617ee1e79b7SRanjani Sridharan if (!substream || !substream->runtime) 618ee1e79b7SRanjani Sridharan continue; 619ee1e79b7SRanjani Sridharan 620ee1e79b7SRanjani Sridharan state = substream->runtime->status->state; 621ee1e79b7SRanjani Sridharan if (state == SNDRV_PCM_STATE_SUSPENDED) 622ee1e79b7SRanjani Sridharan spcm->prepared[dir] = false; 623ee1e79b7SRanjani Sridharan } 624ee1e79b7SRanjani Sridharan } 625ee1e79b7SRanjani Sridharan 626ee1e79b7SRanjani Sridharan /* set internal flag for BE */ 627ee1e79b7SRanjani Sridharan return snd_sof_dsp_hw_params_upon_resume(sdev); 628ee1e79b7SRanjani Sridharan } 629ee1e79b7SRanjani Sridharan 630d1c6c4a9SGuennadi Liakhovetski const struct sof_ipc_pipe_new *snd_sof_pipeline_find(struct snd_sof_dev *sdev, 631d1c6c4a9SGuennadi Liakhovetski int pipeline_id) 632d1c6c4a9SGuennadi Liakhovetski { 633d1c6c4a9SGuennadi Liakhovetski const struct snd_sof_widget *swidget; 634d1c6c4a9SGuennadi Liakhovetski 635d1c6c4a9SGuennadi Liakhovetski list_for_each_entry(swidget, &sdev->widget_list, list) 636d1c6c4a9SGuennadi Liakhovetski if (swidget->id == snd_soc_dapm_scheduler) { 637d1c6c4a9SGuennadi Liakhovetski const struct sof_ipc_pipe_new *pipeline = 638d1c6c4a9SGuennadi Liakhovetski swidget->private; 639d1c6c4a9SGuennadi Liakhovetski if (pipeline->pipeline_id == pipeline_id) 640d1c6c4a9SGuennadi Liakhovetski return pipeline; 641d1c6c4a9SGuennadi Liakhovetski } 642d1c6c4a9SGuennadi Liakhovetski 643d1c6c4a9SGuennadi Liakhovetski return NULL; 644d1c6c4a9SGuennadi Liakhovetski } 645d1c6c4a9SGuennadi Liakhovetski 646d8a15e5fSPeter Ujfalusi int sof_set_up_pipelines(struct snd_sof_dev *sdev, bool verify) 647ee1e79b7SRanjani Sridharan { 64801429183SPierre-Louis Bossart struct sof_ipc_fw_version *v = &sdev->fw_ready.version; 649ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 650ee1e79b7SRanjani Sridharan struct snd_sof_route *sroute; 651ee1e79b7SRanjani Sridharan int ret; 652ee1e79b7SRanjani Sridharan 653ee1e79b7SRanjani Sridharan /* restore pipeline components */ 65401429183SPierre-Louis Bossart list_for_each_entry(swidget, &sdev->widget_list, list) { 6555fcdbb2dSRanjani Sridharan /* only set up the widgets belonging to static pipelines */ 656c0e7969cSRanjani Sridharan if (!verify && swidget->dynamic_pipeline_widget) 657ee1e79b7SRanjani Sridharan continue; 658ee1e79b7SRanjani Sridharan 65901429183SPierre-Louis Bossart /* 66001429183SPierre-Louis Bossart * For older firmware, skip scheduler widgets in this loop, 66101429183SPierre-Louis Bossart * sof_widget_setup() will be called in the 'complete pipeline' loop 66201429183SPierre-Louis Bossart */ 66301429183SPierre-Louis Bossart if (v->abi_version < SOF_ABI_VER(3, 19, 0) && 66401429183SPierre-Louis Bossart swidget->id == snd_soc_dapm_scheduler) 66501429183SPierre-Louis Bossart continue; 66601429183SPierre-Louis Bossart 6675fcdbb2dSRanjani Sridharan /* update DAI config. The IPC will be sent in sof_widget_setup() */ 6685fcdbb2dSRanjani Sridharan if (WIDGET_IS_DAI(swidget->id)) { 6695fcdbb2dSRanjani Sridharan struct snd_sof_dai *dai = swidget->private; 6705fcdbb2dSRanjani Sridharan struct sof_ipc_dai_config *config; 671ee1e79b7SRanjani Sridharan 6725fcdbb2dSRanjani Sridharan if (!dai || !dai->dai_config) 6735fcdbb2dSRanjani Sridharan continue; 674ee1e79b7SRanjani Sridharan 6755fcdbb2dSRanjani Sridharan config = dai->dai_config; 676ee1e79b7SRanjani Sridharan /* 677ee1e79b7SRanjani Sridharan * The link DMA channel would be invalidated for running 678ee1e79b7SRanjani Sridharan * streams but not for streams that were in the PAUSED 679ee1e79b7SRanjani Sridharan * state during suspend. So invalidate it here before setting 680ee1e79b7SRanjani Sridharan * the dai config in the DSP. 681ee1e79b7SRanjani Sridharan */ 682ee1e79b7SRanjani Sridharan if (config->type == SOF_DAI_INTEL_HDA) 683ee1e79b7SRanjani Sridharan config->hda.link_dma_ch = DMA_CHAN_INVALID; 6845fcdbb2dSRanjani Sridharan } 685ee1e79b7SRanjani Sridharan 6865fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, swidget); 68793d71245SRanjani Sridharan if (ret < 0) 688ee1e79b7SRanjani Sridharan return ret; 689ee1e79b7SRanjani Sridharan } 690ee1e79b7SRanjani Sridharan 6915fcdbb2dSRanjani Sridharan /* restore pipeline connections */ 6925fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) { 6935fcdbb2dSRanjani Sridharan 6945fcdbb2dSRanjani Sridharan /* only set up routes belonging to static pipelines */ 695c0e7969cSRanjani Sridharan if (!verify && (sroute->src_widget->dynamic_pipeline_widget || 696c0e7969cSRanjani Sridharan sroute->sink_widget->dynamic_pipeline_widget)) 6975fcdbb2dSRanjani Sridharan continue; 6985fcdbb2dSRanjani Sridharan 6995fcdbb2dSRanjani Sridharan ret = sof_route_setup_ipc(sdev, sroute); 7005fcdbb2dSRanjani Sridharan if (ret < 0) { 7015fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "%s: restore pipeline connections failed\n", __func__); 7025fcdbb2dSRanjani Sridharan return ret; 7035fcdbb2dSRanjani Sridharan } 7045fcdbb2dSRanjani Sridharan } 7055fcdbb2dSRanjani Sridharan 706ee1e79b7SRanjani Sridharan /* complete pipeline */ 707ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 708ee1e79b7SRanjani Sridharan switch (swidget->id) { 709ee1e79b7SRanjani Sridharan case snd_soc_dapm_scheduler: 7105fcdbb2dSRanjani Sridharan /* only complete static pipelines */ 711c0e7969cSRanjani Sridharan if (!verify && swidget->dynamic_pipeline_widget) 7125fcdbb2dSRanjani Sridharan continue; 7135fcdbb2dSRanjani Sridharan 71401429183SPierre-Louis Bossart if (v->abi_version < SOF_ABI_VER(3, 19, 0)) { 71501429183SPierre-Louis Bossart ret = sof_widget_setup(sdev, swidget); 71601429183SPierre-Louis Bossart if (ret < 0) 71701429183SPierre-Louis Bossart return ret; 71801429183SPierre-Louis Bossart } 71901429183SPierre-Louis Bossart 720ee1e79b7SRanjani Sridharan swidget->complete = 721d8a15e5fSPeter Ujfalusi snd_sof_complete_pipeline(sdev, swidget); 722ee1e79b7SRanjani Sridharan break; 723ee1e79b7SRanjani Sridharan default: 724ee1e79b7SRanjani Sridharan break; 725ee1e79b7SRanjani Sridharan } 726ee1e79b7SRanjani Sridharan } 727ee1e79b7SRanjani Sridharan 7285f3aad73SRanjani Sridharan return 0; 729ee1e79b7SRanjani Sridharan } 730ee1e79b7SRanjani Sridharan 731*d9a72465SRanjani Sridharan int sof_pcm_stream_free(struct snd_sof_dev *sdev, struct snd_pcm_substream *substream, 732*d9a72465SRanjani Sridharan struct snd_sof_pcm *spcm, int dir, bool free_widget_list) 733*d9a72465SRanjani Sridharan { 734*d9a72465SRanjani Sridharan int ret; 735*d9a72465SRanjani Sridharan 736*d9a72465SRanjani Sridharan /* Send PCM_FREE IPC to reset pipeline */ 737*d9a72465SRanjani Sridharan ret = sof_pcm_dsp_pcm_free(substream, sdev, spcm); 738*d9a72465SRanjani Sridharan if (ret < 0) 739*d9a72465SRanjani Sridharan return ret; 740*d9a72465SRanjani Sridharan 741*d9a72465SRanjani Sridharan /* stop the DMA */ 742*d9a72465SRanjani Sridharan ret = snd_sof_pcm_platform_hw_free(sdev, substream); 743*d9a72465SRanjani Sridharan if (ret < 0) 744*d9a72465SRanjani Sridharan return ret; 745*d9a72465SRanjani Sridharan 746*d9a72465SRanjani Sridharan /* free widget list */ 747*d9a72465SRanjani Sridharan if (free_widget_list) { 748*d9a72465SRanjani Sridharan ret = sof_widget_list_free(sdev, spcm, dir); 749*d9a72465SRanjani Sridharan if (ret < 0) 750*d9a72465SRanjani Sridharan dev_err(sdev->dev, "failed to free widgets during suspend\n"); 751*d9a72465SRanjani Sridharan } 752*d9a72465SRanjani Sridharan 753*d9a72465SRanjani Sridharan return ret; 754*d9a72465SRanjani Sridharan } 755*d9a72465SRanjani Sridharan 7568b001416SRanjani Sridharan /* 75796da1740SRanjani Sridharan * Free the PCM, its associated widgets and set the prepared flag to false for all PCMs that 75896da1740SRanjani Sridharan * did not get suspended(ex: paused streams) so the widgets can be set up again during resume. 75996da1740SRanjani Sridharan */ 76096da1740SRanjani Sridharan static int sof_tear_down_left_over_pipelines(struct snd_sof_dev *sdev) 76196da1740SRanjani Sridharan { 76296da1740SRanjani Sridharan struct snd_sof_widget *swidget; 76396da1740SRanjani Sridharan struct snd_sof_pcm *spcm; 76496da1740SRanjani Sridharan int dir, ret; 76596da1740SRanjani Sridharan 76696da1740SRanjani Sridharan /* 76796da1740SRanjani Sridharan * free all PCMs and their associated DAPM widgets if their connected DAPM widget 76896da1740SRanjani Sridharan * list is not NULL. This should only be true for paused streams at this point. 76996da1740SRanjani Sridharan * This is equivalent to the handling of FE DAI suspend trigger for running streams. 77096da1740SRanjani Sridharan */ 77196da1740SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) 77296da1740SRanjani Sridharan for_each_pcm_streams(dir) { 77396da1740SRanjani Sridharan struct snd_pcm_substream *substream = spcm->stream[dir].substream; 77496da1740SRanjani Sridharan 77596da1740SRanjani Sridharan if (!substream || !substream->runtime) 77696da1740SRanjani Sridharan continue; 77796da1740SRanjani Sridharan 77896da1740SRanjani Sridharan if (spcm->stream[dir].list) { 779*d9a72465SRanjani Sridharan ret = sof_pcm_stream_free(sdev, substream, spcm, dir, true); 78096da1740SRanjani Sridharan if (ret < 0) 78196da1740SRanjani Sridharan return ret; 78296da1740SRanjani Sridharan } 78396da1740SRanjani Sridharan } 78496da1740SRanjani Sridharan 78596da1740SRanjani Sridharan /* 78696da1740SRanjani Sridharan * free any left over DAI widgets. This is equivalent to the handling of suspend trigger 78796da1740SRanjani Sridharan * for the BE DAI for running streams. 78896da1740SRanjani Sridharan */ 78996da1740SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) 79096da1740SRanjani Sridharan if (WIDGET_IS_DAI(swidget->id) && swidget->use_count == 1) { 79196da1740SRanjani Sridharan ret = sof_widget_free(sdev, swidget); 79296da1740SRanjani Sridharan if (ret < 0) 79396da1740SRanjani Sridharan return ret; 79496da1740SRanjani Sridharan } 79596da1740SRanjani Sridharan 79696da1740SRanjani Sridharan return 0; 79796da1740SRanjani Sridharan } 79896da1740SRanjani Sridharan 79996da1740SRanjani Sridharan /* 800b2ebcf42SRanjani Sridharan * For older firmware, this function doesn't free widgets for static pipelines during suspend. 801b2ebcf42SRanjani Sridharan * It only resets use_count for all widgets. 8028b001416SRanjani Sridharan */ 803d8a15e5fSPeter Ujfalusi int sof_tear_down_pipelines(struct snd_sof_dev *sdev, bool verify) 8040a2dea1fSRanjani Sridharan { 805b2ebcf42SRanjani Sridharan struct sof_ipc_fw_version *v = &sdev->fw_ready.version; 8068b001416SRanjani Sridharan struct snd_sof_widget *swidget; 8070a2dea1fSRanjani Sridharan struct snd_sof_route *sroute; 808c0e7969cSRanjani Sridharan int ret; 8090a2dea1fSRanjani Sridharan 8100a2dea1fSRanjani Sridharan /* 811c0e7969cSRanjani Sridharan * This function is called during suspend and for one-time topology verification during 812c0e7969cSRanjani Sridharan * first boot. In both cases, there is no need to protect swidget->use_count and 81396da1740SRanjani Sridharan * sroute->setup because during suspend all running streams are suspended and during 81496da1740SRanjani Sridharan * topology loading the sound card unavailable to open PCMs. 8150a2dea1fSRanjani Sridharan */ 81601429183SPierre-Louis Bossart list_for_each_entry(swidget, &sdev->widget_list, list) { 817b2ebcf42SRanjani Sridharan if (swidget->dynamic_pipeline_widget) 818b2ebcf42SRanjani Sridharan continue; 819b2ebcf42SRanjani Sridharan 820b2ebcf42SRanjani Sridharan /* Do not free widgets for static pipelines with FW ABI older than 3.19 */ 821b2ebcf42SRanjani Sridharan if (!verify && !swidget->dynamic_pipeline_widget && 822b2ebcf42SRanjani Sridharan v->abi_version < SOF_ABI_VER(3, 19, 0)) { 8238b001416SRanjani Sridharan swidget->use_count = 0; 824b2ebcf42SRanjani Sridharan swidget->complete = 0; 825c0e7969cSRanjani Sridharan continue; 826c0e7969cSRanjani Sridharan } 827c0e7969cSRanjani Sridharan 828c0e7969cSRanjani Sridharan ret = sof_widget_free(sdev, swidget); 829c0e7969cSRanjani Sridharan if (ret < 0) 830c0e7969cSRanjani Sridharan return ret; 831c0e7969cSRanjani Sridharan } 8328b001416SRanjani Sridharan 83396da1740SRanjani Sridharan /* 83496da1740SRanjani Sridharan * Tear down all pipelines associated with PCMs that did not get suspended 83596da1740SRanjani Sridharan * and unset the prepare flag so that they can be set up again during resume. 83696da1740SRanjani Sridharan * Skip this step for older firmware. 83796da1740SRanjani Sridharan */ 83896da1740SRanjani Sridharan if (!verify && v->abi_version >= SOF_ABI_VER(3, 19, 0)) { 83996da1740SRanjani Sridharan ret = sof_tear_down_left_over_pipelines(sdev); 84096da1740SRanjani Sridharan if (ret < 0) { 84196da1740SRanjani Sridharan dev_err(sdev->dev, "failed to tear down paused pipelines\n"); 84296da1740SRanjani Sridharan return ret; 84396da1740SRanjani Sridharan } 84496da1740SRanjani Sridharan } 84596da1740SRanjani Sridharan 8460a2dea1fSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 8470a2dea1fSRanjani Sridharan sroute->setup = false; 848c0e7969cSRanjani Sridharan 849c0e7969cSRanjani Sridharan return 0; 8500a2dea1fSRanjani Sridharan } 8510a2dea1fSRanjani Sridharan 852ee1e79b7SRanjani Sridharan /* 853ee1e79b7SRanjani Sridharan * Generic object lookup APIs. 854ee1e79b7SRanjani Sridharan */ 855ee1e79b7SRanjani Sridharan 856ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_name(struct snd_soc_component *scomp, 857ee1e79b7SRanjani Sridharan const char *name) 858ee1e79b7SRanjani Sridharan { 859ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 860ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 861ee1e79b7SRanjani Sridharan 862ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 863ee1e79b7SRanjani Sridharan /* match with PCM dai name */ 864ee1e79b7SRanjani Sridharan if (strcmp(spcm->pcm.dai_name, name) == 0) 865ee1e79b7SRanjani Sridharan return spcm; 866ee1e79b7SRanjani Sridharan 867ee1e79b7SRanjani Sridharan /* match with playback caps name if set */ 868ee1e79b7SRanjani Sridharan if (*spcm->pcm.caps[0].name && 869ee1e79b7SRanjani Sridharan !strcmp(spcm->pcm.caps[0].name, name)) 870ee1e79b7SRanjani Sridharan return spcm; 871ee1e79b7SRanjani Sridharan 872ee1e79b7SRanjani Sridharan /* match with capture caps name if set */ 873ee1e79b7SRanjani Sridharan if (*spcm->pcm.caps[1].name && 874ee1e79b7SRanjani Sridharan !strcmp(spcm->pcm.caps[1].name, name)) 875ee1e79b7SRanjani Sridharan return spcm; 876ee1e79b7SRanjani Sridharan } 877ee1e79b7SRanjani Sridharan 878ee1e79b7SRanjani Sridharan return NULL; 879ee1e79b7SRanjani Sridharan } 880ee1e79b7SRanjani Sridharan 881ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_comp(struct snd_soc_component *scomp, 882ee1e79b7SRanjani Sridharan unsigned int comp_id, 883ee1e79b7SRanjani Sridharan int *direction) 884ee1e79b7SRanjani Sridharan { 885ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 886ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 887ee1e79b7SRanjani Sridharan int dir; 888ee1e79b7SRanjani Sridharan 889ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 890525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 891ee1e79b7SRanjani Sridharan if (spcm->stream[dir].comp_id == comp_id) { 892ee1e79b7SRanjani Sridharan *direction = dir; 893ee1e79b7SRanjani Sridharan return spcm; 894ee1e79b7SRanjani Sridharan } 895ee1e79b7SRanjani Sridharan } 896ee1e79b7SRanjani Sridharan } 897ee1e79b7SRanjani Sridharan 898ee1e79b7SRanjani Sridharan return NULL; 899ee1e79b7SRanjani Sridharan } 900ee1e79b7SRanjani Sridharan 901ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_pcm_id(struct snd_soc_component *scomp, 902ee1e79b7SRanjani Sridharan unsigned int pcm_id) 903ee1e79b7SRanjani Sridharan { 904ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 905ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 906ee1e79b7SRanjani Sridharan 907ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 908ee1e79b7SRanjani Sridharan if (le32_to_cpu(spcm->pcm.pcm_id) == pcm_id) 909ee1e79b7SRanjani Sridharan return spcm; 910ee1e79b7SRanjani Sridharan } 911ee1e79b7SRanjani Sridharan 912ee1e79b7SRanjani Sridharan return NULL; 913ee1e79b7SRanjani Sridharan } 914ee1e79b7SRanjani Sridharan 915ee1e79b7SRanjani Sridharan struct snd_sof_widget *snd_sof_find_swidget(struct snd_soc_component *scomp, 916ee1e79b7SRanjani Sridharan const char *name) 917ee1e79b7SRanjani Sridharan { 918ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 919ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 920ee1e79b7SRanjani Sridharan 921ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 922ee1e79b7SRanjani Sridharan if (strcmp(name, swidget->widget->name) == 0) 923ee1e79b7SRanjani Sridharan return swidget; 924ee1e79b7SRanjani Sridharan } 925ee1e79b7SRanjani Sridharan 926ee1e79b7SRanjani Sridharan return NULL; 927ee1e79b7SRanjani Sridharan } 928ee1e79b7SRanjani Sridharan 929ee1e79b7SRanjani Sridharan /* find widget by stream name and direction */ 930ee1e79b7SRanjani Sridharan struct snd_sof_widget * 931ee1e79b7SRanjani Sridharan snd_sof_find_swidget_sname(struct snd_soc_component *scomp, 932ee1e79b7SRanjani Sridharan const char *pcm_name, int dir) 933ee1e79b7SRanjani Sridharan { 934ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 935ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 936ee1e79b7SRanjani Sridharan enum snd_soc_dapm_type type; 937ee1e79b7SRanjani Sridharan 938ee1e79b7SRanjani Sridharan if (dir == SNDRV_PCM_STREAM_PLAYBACK) 939ee1e79b7SRanjani Sridharan type = snd_soc_dapm_aif_in; 940ee1e79b7SRanjani Sridharan else 941ee1e79b7SRanjani Sridharan type = snd_soc_dapm_aif_out; 942ee1e79b7SRanjani Sridharan 943ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 944ee1e79b7SRanjani Sridharan if (!strcmp(pcm_name, swidget->widget->sname) && 945ee1e79b7SRanjani Sridharan swidget->id == type) 946ee1e79b7SRanjani Sridharan return swidget; 947ee1e79b7SRanjani Sridharan } 948ee1e79b7SRanjani Sridharan 949ee1e79b7SRanjani Sridharan return NULL; 950ee1e79b7SRanjani Sridharan } 951ee1e79b7SRanjani Sridharan 952ee1e79b7SRanjani Sridharan struct snd_sof_dai *snd_sof_find_dai(struct snd_soc_component *scomp, 953ee1e79b7SRanjani Sridharan const char *name) 954ee1e79b7SRanjani Sridharan { 955ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 956ee1e79b7SRanjani Sridharan struct snd_sof_dai *dai; 957ee1e79b7SRanjani Sridharan 958ee1e79b7SRanjani Sridharan list_for_each_entry(dai, &sdev->dai_list, list) { 959ee1e79b7SRanjani Sridharan if (dai->name && (strcmp(name, dai->name) == 0)) 960ee1e79b7SRanjani Sridharan return dai; 961ee1e79b7SRanjani Sridharan } 962ee1e79b7SRanjani Sridharan 963ee1e79b7SRanjani Sridharan return NULL; 964ee1e79b7SRanjani Sridharan } 965ee1e79b7SRanjani Sridharan 966bc619cfcSBrent Lu #define SOF_DAI_CLK_INTEL_SSP_MCLK 0 967bc619cfcSBrent Lu #define SOF_DAI_CLK_INTEL_SSP_BCLK 1 968bc619cfcSBrent Lu 969bc619cfcSBrent Lu static int sof_dai_get_clk(struct snd_soc_pcm_runtime *rtd, int clk_type) 970b951b51eSKeyon Jie { 971b951b51eSKeyon Jie struct snd_soc_component *component = 972b951b51eSKeyon Jie snd_soc_rtdcom_lookup(rtd, SOF_AUDIO_PCM_DRV_NAME); 973b951b51eSKeyon Jie struct snd_sof_dai *dai = 974b951b51eSKeyon Jie snd_sof_find_dai(component, (char *)rtd->dai_link->name); 975b951b51eSKeyon Jie 976b951b51eSKeyon Jie /* use the tplg configured mclk if existed */ 977b951b51eSKeyon Jie if (!dai || !dai->dai_config) 978b951b51eSKeyon Jie return 0; 979b951b51eSKeyon Jie 980b951b51eSKeyon Jie switch (dai->dai_config->type) { 981b951b51eSKeyon Jie case SOF_DAI_INTEL_SSP: 982bc619cfcSBrent Lu switch (clk_type) { 983bc619cfcSBrent Lu case SOF_DAI_CLK_INTEL_SSP_MCLK: 984b951b51eSKeyon Jie return dai->dai_config->ssp.mclk_rate; 985bc619cfcSBrent Lu case SOF_DAI_CLK_INTEL_SSP_BCLK: 986bc619cfcSBrent Lu return dai->dai_config->ssp.bclk_rate; 987bc619cfcSBrent Lu default: 988bc619cfcSBrent Lu dev_err(rtd->dev, "fail to get SSP clk %d rate\n", 989bc619cfcSBrent Lu clk_type); 990bc619cfcSBrent Lu return -EINVAL; 991bc619cfcSBrent Lu } 992bc619cfcSBrent Lu break; 993b951b51eSKeyon Jie default: 994b951b51eSKeyon Jie /* not yet implemented for platforms other than the above */ 995bc619cfcSBrent Lu dev_err(rtd->dev, "DAI type %d not supported yet!\n", 996b951b51eSKeyon Jie dai->dai_config->type); 997b951b51eSKeyon Jie return -EINVAL; 998b951b51eSKeyon Jie } 999b951b51eSKeyon Jie } 1000bc619cfcSBrent Lu 1001bc619cfcSBrent Lu /* 1002bc619cfcSBrent Lu * Helper to get SSP MCLK from a pcm_runtime. 1003bc619cfcSBrent Lu * Return 0 if not exist. 1004bc619cfcSBrent Lu */ 1005bc619cfcSBrent Lu int sof_dai_get_mclk(struct snd_soc_pcm_runtime *rtd) 1006bc619cfcSBrent Lu { 1007bc619cfcSBrent Lu return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_MCLK); 1008bc619cfcSBrent Lu } 1009b951b51eSKeyon Jie EXPORT_SYMBOL(sof_dai_get_mclk); 1010b951b51eSKeyon Jie 1011b951b51eSKeyon Jie /* 1012bc619cfcSBrent Lu * Helper to get SSP BCLK from a pcm_runtime. 1013bc619cfcSBrent Lu * Return 0 if not exist. 1014bc619cfcSBrent Lu */ 1015bc619cfcSBrent Lu int sof_dai_get_bclk(struct snd_soc_pcm_runtime *rtd) 1016bc619cfcSBrent Lu { 1017bc619cfcSBrent Lu return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_BCLK); 1018bc619cfcSBrent Lu } 1019bc619cfcSBrent Lu EXPORT_SYMBOL(sof_dai_get_bclk); 1020bc619cfcSBrent Lu 1021bc619cfcSBrent Lu /* 1022285880a2SDaniel Baluta * SOF Driver enumeration. 1023285880a2SDaniel Baluta */ 1024285880a2SDaniel Baluta int sof_machine_check(struct snd_sof_dev *sdev) 1025285880a2SDaniel Baluta { 1026285880a2SDaniel Baluta struct snd_sof_pdata *sof_pdata = sdev->pdata; 1027285880a2SDaniel Baluta const struct sof_dev_desc *desc = sof_pdata->desc; 1028285880a2SDaniel Baluta struct snd_soc_acpi_mach *mach; 1029285880a2SDaniel Baluta 10304c1cc83fSPierre-Louis Bossart if (!IS_ENABLED(CONFIG_SND_SOC_SOF_FORCE_NOCODEC_MODE)) { 1031285880a2SDaniel Baluta 1032285880a2SDaniel Baluta /* find machine */ 1033285880a2SDaniel Baluta snd_sof_machine_select(sdev); 1034285880a2SDaniel Baluta if (sof_pdata->machine) { 103517e9d6b0SPierre-Louis Bossart snd_sof_set_mach_params(sof_pdata->machine, sdev); 1036285880a2SDaniel Baluta return 0; 1037285880a2SDaniel Baluta } 1038285880a2SDaniel Baluta 10394c1cc83fSPierre-Louis Bossart if (!IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC)) { 1040285880a2SDaniel Baluta dev_err(sdev->dev, "error: no matching ASoC machine driver found - aborting probe\n"); 1041285880a2SDaniel Baluta return -ENODEV; 10424c1cc83fSPierre-Louis Bossart } 10434c1cc83fSPierre-Louis Bossart } else { 104464e2c37eSPierre-Louis Bossart dev_warn(sdev->dev, "Force to use nocodec mode\n"); 10454c1cc83fSPierre-Louis Bossart } 10464c1cc83fSPierre-Louis Bossart 1047285880a2SDaniel Baluta /* select nocodec mode */ 1048285880a2SDaniel Baluta dev_warn(sdev->dev, "Using nocodec machine driver\n"); 1049285880a2SDaniel Baluta mach = devm_kzalloc(sdev->dev, sizeof(*mach), GFP_KERNEL); 1050285880a2SDaniel Baluta if (!mach) 1051285880a2SDaniel Baluta return -ENOMEM; 1052285880a2SDaniel Baluta 1053d612b455SRanjani Sridharan mach->drv_name = "sof-nocodec"; 1054d612b455SRanjani Sridharan sof_pdata->tplg_filename = desc->nocodec_tplg_filename; 1055d612b455SRanjani Sridharan 1056285880a2SDaniel Baluta sof_pdata->machine = mach; 105717e9d6b0SPierre-Louis Bossart snd_sof_set_mach_params(sof_pdata->machine, sdev); 1058285880a2SDaniel Baluta 1059285880a2SDaniel Baluta return 0; 1060285880a2SDaniel Baluta } 1061285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_check); 1062285880a2SDaniel Baluta 1063285880a2SDaniel Baluta int sof_machine_register(struct snd_sof_dev *sdev, void *pdata) 1064285880a2SDaniel Baluta { 1065db69bcf9SGuennadi Liakhovetski struct snd_sof_pdata *plat_data = pdata; 1066285880a2SDaniel Baluta const char *drv_name; 1067285880a2SDaniel Baluta const void *mach; 1068285880a2SDaniel Baluta int size; 1069285880a2SDaniel Baluta 1070285880a2SDaniel Baluta drv_name = plat_data->machine->drv_name; 1071db69bcf9SGuennadi Liakhovetski mach = plat_data->machine; 1072285880a2SDaniel Baluta size = sizeof(*plat_data->machine); 1073285880a2SDaniel Baluta 1074285880a2SDaniel Baluta /* register machine driver, pass machine info as pdata */ 1075285880a2SDaniel Baluta plat_data->pdev_mach = 1076285880a2SDaniel Baluta platform_device_register_data(sdev->dev, drv_name, 1077285880a2SDaniel Baluta PLATFORM_DEVID_NONE, mach, size); 1078285880a2SDaniel Baluta if (IS_ERR(plat_data->pdev_mach)) 1079285880a2SDaniel Baluta return PTR_ERR(plat_data->pdev_mach); 1080285880a2SDaniel Baluta 1081285880a2SDaniel Baluta dev_dbg(sdev->dev, "created machine %s\n", 1082285880a2SDaniel Baluta dev_name(&plat_data->pdev_mach->dev)); 1083285880a2SDaniel Baluta 1084285880a2SDaniel Baluta return 0; 1085285880a2SDaniel Baluta } 1086285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_register); 1087285880a2SDaniel Baluta 1088285880a2SDaniel Baluta void sof_machine_unregister(struct snd_sof_dev *sdev, void *pdata) 1089285880a2SDaniel Baluta { 1090db69bcf9SGuennadi Liakhovetski struct snd_sof_pdata *plat_data = pdata; 1091285880a2SDaniel Baluta 1092285880a2SDaniel Baluta if (!IS_ERR_OR_NULL(plat_data->pdev_mach)) 1093285880a2SDaniel Baluta platform_device_unregister(plat_data->pdev_mach); 1094285880a2SDaniel Baluta } 1095285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_unregister); 1096