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 ret; 1893d71245SRanjani Sridharan 1993d71245SRanjani Sridharan /* reset readback offset for scontrol */ 2093d71245SRanjani Sridharan scontrol->readback_offset = 0; 2193d71245SRanjani Sridharan 2247d7328fSPeter Ujfalusi ret = snd_sof_ipc_set_get_comp_data(scontrol, true); 2393d71245SRanjani Sridharan if (ret < 0) 2493d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed kcontrol value set for widget: %d\n", 2593d71245SRanjani Sridharan scontrol->comp_id); 2693d71245SRanjani Sridharan 2793d71245SRanjani Sridharan return ret; 2893d71245SRanjani Sridharan } 2993d71245SRanjani Sridharan 3093d71245SRanjani Sridharan static int sof_dai_config_setup(struct snd_sof_dev *sdev, struct snd_sof_dai *dai) 3193d71245SRanjani Sridharan { 3293d71245SRanjani Sridharan struct sof_ipc_dai_config *config; 3393d71245SRanjani Sridharan struct sof_ipc_reply reply; 3493d71245SRanjani Sridharan int ret; 3593d71245SRanjani Sridharan 3693d71245SRanjani Sridharan config = &dai->dai_config[dai->current_config]; 3793d71245SRanjani Sridharan if (!config) { 3893d71245SRanjani Sridharan dev_err(sdev->dev, "error: no config for DAI %s\n", dai->name); 3993d71245SRanjani Sridharan return -EINVAL; 4093d71245SRanjani Sridharan } 4193d71245SRanjani Sridharan 42b30b60a2SPierre-Louis Bossart /* set NONE flag to clear all previous settings */ 43a0f84dfbSRanjani Sridharan config->flags = SOF_DAI_CONFIG_FLAGS_NONE; 44b30b60a2SPierre-Louis Bossart 4593d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, config->hdr.cmd, config, config->hdr.size, 4693d71245SRanjani Sridharan &reply, sizeof(reply)); 4793d71245SRanjani Sridharan 4893d71245SRanjani Sridharan if (ret < 0) 4993d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed to set dai config for %s\n", dai->name); 5093d71245SRanjani Sridharan 5193d71245SRanjani Sridharan return ret; 5293d71245SRanjani Sridharan } 5393d71245SRanjani Sridharan 545f3aad73SRanjani Sridharan static int sof_widget_kcontrol_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 555f3aad73SRanjani Sridharan { 565f3aad73SRanjani Sridharan struct snd_sof_control *scontrol; 575f3aad73SRanjani Sridharan int ret; 585f3aad73SRanjani Sridharan 595f3aad73SRanjani Sridharan /* set up all controls for the widget */ 605f3aad73SRanjani Sridharan list_for_each_entry(scontrol, &sdev->kcontrol_list, list) 615f3aad73SRanjani Sridharan if (scontrol->comp_id == swidget->comp_id) { 62fc5adc2bSRanjani Sridharan /* set kcontrol data in DSP */ 635f3aad73SRanjani Sridharan ret = sof_kcontrol_setup(sdev, scontrol); 645f3aad73SRanjani Sridharan if (ret < 0) { 655f3aad73SRanjani Sridharan dev_err(sdev->dev, "error: fail to set up kcontrols for widget %s\n", 665f3aad73SRanjani Sridharan swidget->widget->name); 675f3aad73SRanjani Sridharan return ret; 685f3aad73SRanjani Sridharan } 69fc5adc2bSRanjani Sridharan 70fc5adc2bSRanjani Sridharan /* 71fc5adc2bSRanjani Sridharan * Read back the data from the DSP for static widgets. This is particularly 72fc5adc2bSRanjani Sridharan * useful for binary kcontrols associated with static pipeline widgets to 73fc5adc2bSRanjani Sridharan * initialize the data size to match that in the DSP. 74fc5adc2bSRanjani Sridharan */ 75fc5adc2bSRanjani Sridharan if (swidget->dynamic_pipeline_widget) 76fc5adc2bSRanjani Sridharan continue; 77fc5adc2bSRanjani Sridharan 78fc5adc2bSRanjani Sridharan ret = snd_sof_ipc_set_get_comp_data(scontrol, false); 79fc5adc2bSRanjani Sridharan if (ret < 0) 80fc5adc2bSRanjani Sridharan dev_warn(sdev->dev, "Failed kcontrol get for control in widget %s\n", 81fc5adc2bSRanjani Sridharan swidget->widget->name); 825f3aad73SRanjani Sridharan } 835f3aad73SRanjani Sridharan 845f3aad73SRanjani Sridharan return 0; 855f3aad73SRanjani Sridharan } 865f3aad73SRanjani Sridharan 875fcdbb2dSRanjani Sridharan static void sof_reset_route_setup_status(struct snd_sof_dev *sdev, struct snd_sof_widget *widget) 885fcdbb2dSRanjani Sridharan { 895fcdbb2dSRanjani Sridharan struct snd_sof_route *sroute; 905fcdbb2dSRanjani Sridharan 915fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 925fcdbb2dSRanjani Sridharan if (sroute->src_widget == widget || sroute->sink_widget == widget) 935fcdbb2dSRanjani Sridharan sroute->setup = false; 945fcdbb2dSRanjani Sridharan } 955fcdbb2dSRanjani Sridharan 968b001416SRanjani Sridharan int sof_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 978b001416SRanjani Sridharan { 988b001416SRanjani Sridharan struct sof_ipc_free ipc_free = { 998b001416SRanjani Sridharan .hdr = { 1008b001416SRanjani Sridharan .size = sizeof(ipc_free), 1018b001416SRanjani Sridharan .cmd = SOF_IPC_GLB_TPLG_MSG, 1028b001416SRanjani Sridharan }, 1038b001416SRanjani Sridharan .id = swidget->comp_id, 1048b001416SRanjani Sridharan }; 1058b001416SRanjani Sridharan struct sof_ipc_reply reply; 1069ea80748SRanjani Sridharan int ret, ret1, core; 1078b001416SRanjani Sridharan 1088b001416SRanjani Sridharan if (!swidget->private) 1098b001416SRanjani Sridharan return 0; 1108b001416SRanjani Sridharan 1118b001416SRanjani Sridharan /* only free when use_count is 0 */ 1128b001416SRanjani Sridharan if (--swidget->use_count) 1138b001416SRanjani Sridharan return 0; 1148b001416SRanjani Sridharan 1159ea80748SRanjani Sridharan core = swidget->core; 1169ea80748SRanjani Sridharan 1178b001416SRanjani Sridharan switch (swidget->id) { 1188b001416SRanjani Sridharan case snd_soc_dapm_scheduler: 1199ea80748SRanjani Sridharan { 1209ea80748SRanjani Sridharan const struct sof_ipc_pipe_new *pipeline = swidget->private; 1219ea80748SRanjani Sridharan 1229ea80748SRanjani Sridharan core = pipeline->core; 1238b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_PIPE_FREE; 1248b001416SRanjani Sridharan break; 1259ea80748SRanjani Sridharan } 1268b001416SRanjani Sridharan case snd_soc_dapm_buffer: 1278b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_BUFFER_FREE; 1288b001416SRanjani Sridharan break; 12996da1740SRanjani Sridharan case snd_soc_dapm_dai_in: 13096da1740SRanjani Sridharan case snd_soc_dapm_dai_out: 13196da1740SRanjani Sridharan { 13296da1740SRanjani Sridharan struct snd_sof_dai *dai = swidget->private; 13396da1740SRanjani Sridharan 13496da1740SRanjani Sridharan dai->configured = false; 13596da1740SRanjani Sridharan fallthrough; 13696da1740SRanjani Sridharan } 1378b001416SRanjani Sridharan default: 1388b001416SRanjani Sridharan ipc_free.hdr.cmd |= SOF_IPC_TPLG_COMP_FREE; 1398b001416SRanjani Sridharan break; 1408b001416SRanjani Sridharan } 1418b001416SRanjani Sridharan 1429ea80748SRanjani Sridharan /* continue to disable core even if IPC fails */ 1438b001416SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, ipc_free.hdr.cmd, &ipc_free, sizeof(ipc_free), 1448b001416SRanjani Sridharan &reply, sizeof(reply)); 1459ea80748SRanjani Sridharan if (ret < 0) 1468b001416SRanjani Sridharan dev_err(sdev->dev, "error: failed to free widget %s\n", swidget->widget->name); 1479ea80748SRanjani Sridharan 1489ea80748SRanjani Sridharan /* 1499ea80748SRanjani Sridharan * disable widget core. continue to route setup status and complete flag 1509ea80748SRanjani Sridharan * even if this fails and return the appropriate error 1519ea80748SRanjani Sridharan */ 1529ea80748SRanjani Sridharan ret1 = snd_sof_dsp_core_put(sdev, core); 1539ea80748SRanjani Sridharan if (ret1 < 0) { 1549ea80748SRanjani Sridharan dev_err(sdev->dev, "error: failed to disable target core: %d for widget %s\n", 1559ea80748SRanjani Sridharan core, swidget->widget->name); 1569ea80748SRanjani Sridharan if (!ret) 1579ea80748SRanjani Sridharan ret = ret1; 1588b001416SRanjani Sridharan } 1598b001416SRanjani Sridharan 1605fcdbb2dSRanjani Sridharan /* reset route setup status for all routes that contain this widget */ 1615fcdbb2dSRanjani Sridharan sof_reset_route_setup_status(sdev, swidget); 1628b001416SRanjani Sridharan swidget->complete = 0; 1639ea80748SRanjani Sridharan 1649ea80748SRanjani Sridharan if (!ret) 1658b001416SRanjani Sridharan dev_dbg(sdev->dev, "widget %s freed\n", swidget->widget->name); 1668b001416SRanjani Sridharan 1679ea80748SRanjani Sridharan return ret; 1688b001416SRanjani Sridharan } 1698b001416SRanjani Sridharan EXPORT_SYMBOL(sof_widget_free); 1708b001416SRanjani Sridharan 1718b001416SRanjani Sridharan int sof_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget) 17293d71245SRanjani Sridharan { 17393d71245SRanjani Sridharan struct sof_ipc_pipe_new *pipeline; 17493d71245SRanjani Sridharan struct sof_ipc_comp_reply r; 17593d71245SRanjani Sridharan struct sof_ipc_cmd_hdr *hdr; 17693d71245SRanjani Sridharan struct sof_ipc_comp *comp; 17793d71245SRanjani Sridharan struct snd_sof_dai *dai; 17893d71245SRanjani Sridharan size_t ipc_size; 17993d71245SRanjani Sridharan int ret; 1809ea80748SRanjani Sridharan int core; 18193d71245SRanjani Sridharan 18293d71245SRanjani Sridharan /* skip if there is no private data */ 18393d71245SRanjani Sridharan if (!swidget->private) 18493d71245SRanjani Sridharan return 0; 18593d71245SRanjani Sridharan 1868b001416SRanjani Sridharan /* widget already set up */ 1878b001416SRanjani Sridharan if (++swidget->use_count > 1) 1888b001416SRanjani Sridharan return 0; 1898b001416SRanjani Sridharan 1909ea80748SRanjani Sridharan /* set core ID */ 1919ea80748SRanjani Sridharan core = swidget->core; 1929ea80748SRanjani Sridharan if (swidget->id == snd_soc_dapm_scheduler) { 1939ea80748SRanjani Sridharan pipeline = swidget->private; 1949ea80748SRanjani Sridharan core = pipeline->core; 1959ea80748SRanjani Sridharan } 1969ea80748SRanjani Sridharan 1979ea80748SRanjani Sridharan /* enable widget core */ 1989ea80748SRanjani Sridharan ret = snd_sof_dsp_core_get(sdev, core); 19993d71245SRanjani Sridharan if (ret < 0) { 2009ea80748SRanjani Sridharan dev_err(sdev->dev, "error: failed to enable target core for widget %s\n", 2019ea80748SRanjani Sridharan swidget->widget->name); 2028b001416SRanjani Sridharan goto use_count_dec; 20393d71245SRanjani Sridharan } 20493d71245SRanjani Sridharan 20593d71245SRanjani Sridharan switch (swidget->id) { 20693d71245SRanjani Sridharan case snd_soc_dapm_dai_in: 20793d71245SRanjani Sridharan case snd_soc_dapm_dai_out: 20893d71245SRanjani Sridharan ipc_size = sizeof(struct sof_ipc_comp_dai) + sizeof(struct sof_ipc_comp_ext); 20993d71245SRanjani Sridharan comp = kzalloc(ipc_size, GFP_KERNEL); 2109ea80748SRanjani Sridharan if (!comp) { 2119ea80748SRanjani Sridharan ret = -ENOMEM; 2129ea80748SRanjani Sridharan goto core_put; 2139ea80748SRanjani Sridharan } 21493d71245SRanjani Sridharan 21593d71245SRanjani Sridharan dai = swidget->private; 2160acb48ddSRanjani Sridharan dai->configured = false; 21793d71245SRanjani Sridharan memcpy(comp, &dai->comp_dai, sizeof(struct sof_ipc_comp_dai)); 21893d71245SRanjani Sridharan 21993d71245SRanjani Sridharan /* append extended data to the end of the component */ 22093d71245SRanjani Sridharan memcpy((u8 *)comp + sizeof(struct sof_ipc_comp_dai), &swidget->comp_ext, 22193d71245SRanjani Sridharan sizeof(swidget->comp_ext)); 22293d71245SRanjani Sridharan 22393d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, comp->hdr.cmd, comp, ipc_size, &r, sizeof(r)); 22493d71245SRanjani Sridharan kfree(comp); 2255fcdbb2dSRanjani Sridharan if (ret < 0) { 2265fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: failed to load widget %s\n", 2275fcdbb2dSRanjani Sridharan swidget->widget->name); 2289ea80748SRanjani Sridharan goto core_put; 2295fcdbb2dSRanjani Sridharan } 2305fcdbb2dSRanjani Sridharan 2315fcdbb2dSRanjani Sridharan ret = sof_dai_config_setup(sdev, dai); 2325fcdbb2dSRanjani Sridharan if (ret < 0) { 2335fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: failed to load dai config for DAI %s\n", 2345fcdbb2dSRanjani Sridharan swidget->widget->name); 2359ea80748SRanjani Sridharan 2369ea80748SRanjani Sridharan /* 2379ea80748SRanjani Sridharan * widget use_count and core ref_count will both be decremented by 2389ea80748SRanjani Sridharan * sof_widget_free() 2399ea80748SRanjani Sridharan */ 2405fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 2415fcdbb2dSRanjani Sridharan return ret; 2425fcdbb2dSRanjani Sridharan } 24393d71245SRanjani Sridharan break; 24493d71245SRanjani Sridharan case snd_soc_dapm_scheduler: 24593d71245SRanjani Sridharan pipeline = swidget->private; 2467cc7b9baSRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, pipeline->hdr.cmd, pipeline, 2477cc7b9baSRanjani Sridharan sizeof(*pipeline), &r, sizeof(r)); 24893d71245SRanjani Sridharan break; 24993d71245SRanjani Sridharan default: 25093d71245SRanjani Sridharan hdr = swidget->private; 25193d71245SRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, hdr->cmd, swidget->private, hdr->size, 25293d71245SRanjani Sridharan &r, sizeof(r)); 25393d71245SRanjani Sridharan break; 25493d71245SRanjani Sridharan } 2555f3aad73SRanjani Sridharan if (ret < 0) { 25693d71245SRanjani Sridharan dev_err(sdev->dev, "error: failed to load widget %s\n", swidget->widget->name); 2579ea80748SRanjani Sridharan goto core_put; 2585f3aad73SRanjani Sridharan } 2595f3aad73SRanjani Sridharan 2605f3aad73SRanjani Sridharan /* restore kcontrols for widget */ 2615f3aad73SRanjani Sridharan ret = sof_widget_kcontrol_setup(sdev, swidget); 2625f3aad73SRanjani Sridharan if (ret < 0) { 2635f3aad73SRanjani Sridharan dev_err(sdev->dev, "error: failed to restore kcontrols for widget %s\n", 2645f3aad73SRanjani Sridharan swidget->widget->name); 2659ea80748SRanjani Sridharan /* 2669ea80748SRanjani Sridharan * widget use_count and core ref_count will both be decremented by 2679ea80748SRanjani Sridharan * sof_widget_free() 2689ea80748SRanjani Sridharan */ 2695fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 2705f3aad73SRanjani Sridharan return ret; 2715f3aad73SRanjani Sridharan } 2725f3aad73SRanjani Sridharan 27393d71245SRanjani Sridharan dev_dbg(sdev->dev, "widget %s setup complete\n", swidget->widget->name); 27493d71245SRanjani Sridharan 2758b001416SRanjani Sridharan return 0; 2768b001416SRanjani Sridharan 2779ea80748SRanjani Sridharan core_put: 2789ea80748SRanjani Sridharan snd_sof_dsp_core_put(sdev, core); 2798b001416SRanjani Sridharan use_count_dec: 2808b001416SRanjani Sridharan swidget->use_count--; 28193d71245SRanjani Sridharan return ret; 28293d71245SRanjani Sridharan } 2838b001416SRanjani Sridharan EXPORT_SYMBOL(sof_widget_setup); 28493d71245SRanjani Sridharan 2855fcdbb2dSRanjani Sridharan static int sof_route_setup_ipc(struct snd_sof_dev *sdev, struct snd_sof_route *sroute) 2865fcdbb2dSRanjani Sridharan { 2875fcdbb2dSRanjani Sridharan struct sof_ipc_pipe_comp_connect *connect; 2885fcdbb2dSRanjani Sridharan struct sof_ipc_reply reply; 2895fcdbb2dSRanjani Sridharan int ret; 2905fcdbb2dSRanjani Sridharan 2915fcdbb2dSRanjani Sridharan /* skip if there's no private data */ 2925fcdbb2dSRanjani Sridharan if (!sroute->private) 2935fcdbb2dSRanjani Sridharan return 0; 2945fcdbb2dSRanjani Sridharan 2955fcdbb2dSRanjani Sridharan /* nothing to do if route is already set up */ 2965fcdbb2dSRanjani Sridharan if (sroute->setup) 2975fcdbb2dSRanjani Sridharan return 0; 2985fcdbb2dSRanjani Sridharan 2995fcdbb2dSRanjani Sridharan connect = sroute->private; 3005fcdbb2dSRanjani Sridharan 3015fcdbb2dSRanjani Sridharan dev_dbg(sdev->dev, "setting up route %s -> %s\n", 3025fcdbb2dSRanjani Sridharan sroute->src_widget->widget->name, 3035fcdbb2dSRanjani Sridharan sroute->sink_widget->widget->name); 3045fcdbb2dSRanjani Sridharan 3055fcdbb2dSRanjani Sridharan /* send ipc */ 3065fcdbb2dSRanjani Sridharan ret = sof_ipc_tx_message(sdev->ipc, 3075fcdbb2dSRanjani Sridharan connect->hdr.cmd, 3085fcdbb2dSRanjani Sridharan connect, sizeof(*connect), 3095fcdbb2dSRanjani Sridharan &reply, sizeof(reply)); 3105fcdbb2dSRanjani Sridharan if (ret < 0) { 3115fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "%s: route setup failed %d\n", __func__, ret); 3125fcdbb2dSRanjani Sridharan return ret; 3135fcdbb2dSRanjani Sridharan } 3145fcdbb2dSRanjani Sridharan 3155fcdbb2dSRanjani Sridharan sroute->setup = true; 3165fcdbb2dSRanjani Sridharan 3175fcdbb2dSRanjani Sridharan return 0; 3185fcdbb2dSRanjani Sridharan } 3195fcdbb2dSRanjani Sridharan 3205fcdbb2dSRanjani Sridharan static int sof_route_setup(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *wsource, 3215fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *wsink) 3225fcdbb2dSRanjani Sridharan { 3235fcdbb2dSRanjani Sridharan struct snd_sof_widget *src_widget = wsource->dobj.private; 3245fcdbb2dSRanjani Sridharan struct snd_sof_widget *sink_widget = wsink->dobj.private; 3255fcdbb2dSRanjani Sridharan struct snd_sof_route *sroute; 3265fcdbb2dSRanjani Sridharan bool route_found = false; 3275fcdbb2dSRanjani Sridharan 3285fcdbb2dSRanjani Sridharan /* ignore routes involving virtual widgets in topology */ 3295fcdbb2dSRanjani Sridharan switch (src_widget->id) { 3305fcdbb2dSRanjani Sridharan case snd_soc_dapm_out_drv: 3315fcdbb2dSRanjani Sridharan case snd_soc_dapm_output: 3325fcdbb2dSRanjani Sridharan case snd_soc_dapm_input: 3335fcdbb2dSRanjani Sridharan return 0; 3345fcdbb2dSRanjani Sridharan default: 3355fcdbb2dSRanjani Sridharan break; 3365fcdbb2dSRanjani Sridharan } 3375fcdbb2dSRanjani Sridharan 3385fcdbb2dSRanjani Sridharan switch (sink_widget->id) { 3395fcdbb2dSRanjani Sridharan case snd_soc_dapm_out_drv: 3405fcdbb2dSRanjani Sridharan case snd_soc_dapm_output: 3415fcdbb2dSRanjani Sridharan case snd_soc_dapm_input: 3425fcdbb2dSRanjani Sridharan return 0; 3435fcdbb2dSRanjani Sridharan default: 3445fcdbb2dSRanjani Sridharan break; 3455fcdbb2dSRanjani Sridharan } 3465fcdbb2dSRanjani Sridharan 3475fcdbb2dSRanjani Sridharan /* find route matching source and sink widgets */ 3485fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 3495fcdbb2dSRanjani Sridharan if (sroute->src_widget == src_widget && sroute->sink_widget == sink_widget) { 3505fcdbb2dSRanjani Sridharan route_found = true; 3515fcdbb2dSRanjani Sridharan break; 3525fcdbb2dSRanjani Sridharan } 3535fcdbb2dSRanjani Sridharan 3545fcdbb2dSRanjani Sridharan if (!route_found) { 3555fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: cannot find SOF route for source %s -> %s sink\n", 3565fcdbb2dSRanjani Sridharan wsource->name, wsink->name); 3575fcdbb2dSRanjani Sridharan return -EINVAL; 3585fcdbb2dSRanjani Sridharan } 3595fcdbb2dSRanjani Sridharan 3605fcdbb2dSRanjani Sridharan return sof_route_setup_ipc(sdev, sroute); 3615fcdbb2dSRanjani Sridharan } 3625fcdbb2dSRanjani Sridharan 3635fcdbb2dSRanjani Sridharan static int sof_setup_pipeline_connections(struct snd_sof_dev *sdev, 3645fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list, int dir) 3655fcdbb2dSRanjani Sridharan { 3665fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 3675fcdbb2dSRanjani Sridharan struct snd_soc_dapm_path *p; 3685fcdbb2dSRanjani Sridharan int ret; 3695fcdbb2dSRanjani Sridharan int i; 3705fcdbb2dSRanjani Sridharan 3715fcdbb2dSRanjani Sridharan /* 3725fcdbb2dSRanjani Sridharan * Set up connections between widgets in the sink/source paths based on direction. 3735fcdbb2dSRanjani Sridharan * Some non-SOF widgets exist in topology either for compatibility or for the 3745fcdbb2dSRanjani Sridharan * purpose of connecting a pipeline from a host to a DAI in order to receive the DAPM 3755fcdbb2dSRanjani Sridharan * events. But they are not handled by the firmware. So ignore them. 3765fcdbb2dSRanjani Sridharan */ 3775fcdbb2dSRanjani Sridharan if (dir == SNDRV_PCM_STREAM_PLAYBACK) { 3785fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 3795fcdbb2dSRanjani Sridharan if (!widget->dobj.private) 3805fcdbb2dSRanjani Sridharan continue; 3815fcdbb2dSRanjani Sridharan 3825fcdbb2dSRanjani Sridharan snd_soc_dapm_widget_for_each_sink_path(widget, p) 3835fcdbb2dSRanjani Sridharan if (p->sink->dobj.private) { 3845fcdbb2dSRanjani Sridharan ret = sof_route_setup(sdev, widget, p->sink); 3855fcdbb2dSRanjani Sridharan if (ret < 0) 3865fcdbb2dSRanjani Sridharan return ret; 3875fcdbb2dSRanjani Sridharan } 3885fcdbb2dSRanjani Sridharan } 3895fcdbb2dSRanjani Sridharan } else { 3905fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 3915fcdbb2dSRanjani Sridharan if (!widget->dobj.private) 3925fcdbb2dSRanjani Sridharan continue; 3935fcdbb2dSRanjani Sridharan 3945fcdbb2dSRanjani Sridharan snd_soc_dapm_widget_for_each_source_path(widget, p) 3955fcdbb2dSRanjani Sridharan if (p->source->dobj.private) { 3965fcdbb2dSRanjani Sridharan ret = sof_route_setup(sdev, p->source, widget); 3975fcdbb2dSRanjani Sridharan if (ret < 0) 3985fcdbb2dSRanjani Sridharan return ret; 3995fcdbb2dSRanjani Sridharan } 4005fcdbb2dSRanjani Sridharan } 4015fcdbb2dSRanjani Sridharan } 4025fcdbb2dSRanjani Sridharan 4035fcdbb2dSRanjani Sridharan return 0; 4045fcdbb2dSRanjani Sridharan } 4055fcdbb2dSRanjani Sridharan 4065fcdbb2dSRanjani Sridharan int sof_widget_list_setup(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir) 4075fcdbb2dSRanjani Sridharan { 4085fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list; 4095fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 4105fcdbb2dSRanjani Sridharan int i, ret, num_widgets; 4115fcdbb2dSRanjani Sridharan 4125fcdbb2dSRanjani Sridharan /* nothing to set up */ 4135fcdbb2dSRanjani Sridharan if (!list) 4145fcdbb2dSRanjani Sridharan return 0; 4155fcdbb2dSRanjani Sridharan 4165fcdbb2dSRanjani Sridharan /* set up widgets in the list */ 4175fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, num_widgets, widget) { 4185fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4195fcdbb2dSRanjani Sridharan struct snd_sof_widget *pipe_widget; 4205fcdbb2dSRanjani Sridharan 4215fcdbb2dSRanjani Sridharan if (!swidget) 4225fcdbb2dSRanjani Sridharan continue; 4235fcdbb2dSRanjani Sridharan 4245fcdbb2dSRanjani Sridharan /* 4255fcdbb2dSRanjani Sridharan * The scheduler widget for a pipeline is not part of the connected DAPM 4265fcdbb2dSRanjani Sridharan * widget list and it needs to be set up before the widgets in the pipeline 4275fcdbb2dSRanjani Sridharan * are set up. The use_count for the scheduler widget is incremented for every 4285fcdbb2dSRanjani Sridharan * widget in a given pipeline to ensure that it is freed only after the last 4295fcdbb2dSRanjani Sridharan * widget in the pipeline is freed. 4305fcdbb2dSRanjani Sridharan */ 4315fcdbb2dSRanjani Sridharan pipe_widget = swidget->pipe_widget; 4325fcdbb2dSRanjani Sridharan if (!pipe_widget) { 4335fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: no pipeline widget found for %s\n", 4345fcdbb2dSRanjani Sridharan swidget->widget->name); 4355fcdbb2dSRanjani Sridharan ret = -EINVAL; 4365fcdbb2dSRanjani Sridharan goto widget_free; 4375fcdbb2dSRanjani Sridharan } 4385fcdbb2dSRanjani Sridharan 4395fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, pipe_widget); 4405fcdbb2dSRanjani Sridharan if (ret < 0) 4415fcdbb2dSRanjani Sridharan goto widget_free; 4425fcdbb2dSRanjani Sridharan 4435fcdbb2dSRanjani Sridharan /* set up the widget */ 4445fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, swidget); 4455fcdbb2dSRanjani Sridharan if (ret < 0) { 4465fcdbb2dSRanjani Sridharan sof_widget_free(sdev, pipe_widget); 4475fcdbb2dSRanjani Sridharan goto widget_free; 4485fcdbb2dSRanjani Sridharan } 4495fcdbb2dSRanjani Sridharan } 4505fcdbb2dSRanjani Sridharan 4515fcdbb2dSRanjani Sridharan /* 4525fcdbb2dSRanjani Sridharan * error in setting pipeline connections will result in route status being reset for 4535fcdbb2dSRanjani Sridharan * routes that were successfully set up when the widgets are freed. 4545fcdbb2dSRanjani Sridharan */ 4555fcdbb2dSRanjani Sridharan ret = sof_setup_pipeline_connections(sdev, list, dir); 4565fcdbb2dSRanjani Sridharan if (ret < 0) 4575fcdbb2dSRanjani Sridharan goto widget_free; 4585fcdbb2dSRanjani Sridharan 4595fcdbb2dSRanjani Sridharan /* complete pipelines */ 4605fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 4615fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4625fcdbb2dSRanjani Sridharan struct snd_sof_widget *pipe_widget; 4635fcdbb2dSRanjani Sridharan 4645fcdbb2dSRanjani Sridharan if (!swidget) 4655fcdbb2dSRanjani Sridharan continue; 4665fcdbb2dSRanjani Sridharan 4675fcdbb2dSRanjani Sridharan pipe_widget = swidget->pipe_widget; 4685fcdbb2dSRanjani Sridharan if (!pipe_widget) { 4695fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "error: no pipeline widget found for %s\n", 4705fcdbb2dSRanjani Sridharan swidget->widget->name); 4715fcdbb2dSRanjani Sridharan ret = -EINVAL; 4725fcdbb2dSRanjani Sridharan goto widget_free; 4735fcdbb2dSRanjani Sridharan } 4745fcdbb2dSRanjani Sridharan 4755fcdbb2dSRanjani Sridharan if (pipe_widget->complete) 4765fcdbb2dSRanjani Sridharan continue; 4775fcdbb2dSRanjani Sridharan 478d8a15e5fSPeter Ujfalusi pipe_widget->complete = snd_sof_complete_pipeline(sdev, pipe_widget); 4795fcdbb2dSRanjani Sridharan if (pipe_widget->complete < 0) { 4805fcdbb2dSRanjani Sridharan ret = pipe_widget->complete; 4815fcdbb2dSRanjani Sridharan goto widget_free; 4825fcdbb2dSRanjani Sridharan } 4835fcdbb2dSRanjani Sridharan } 4845fcdbb2dSRanjani Sridharan 4855fcdbb2dSRanjani Sridharan return 0; 4865fcdbb2dSRanjani Sridharan 4875fcdbb2dSRanjani Sridharan widget_free: 4885fcdbb2dSRanjani Sridharan /* free all widgets that have been set up successfully */ 4895fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 4905fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 4915fcdbb2dSRanjani Sridharan 4925fcdbb2dSRanjani Sridharan if (!swidget) 4935fcdbb2dSRanjani Sridharan continue; 4945fcdbb2dSRanjani Sridharan 4955fcdbb2dSRanjani Sridharan if (!num_widgets--) 4965fcdbb2dSRanjani Sridharan break; 4975fcdbb2dSRanjani Sridharan 4985fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget); 4995fcdbb2dSRanjani Sridharan sof_widget_free(sdev, swidget->pipe_widget); 5005fcdbb2dSRanjani Sridharan } 5015fcdbb2dSRanjani Sridharan 5025fcdbb2dSRanjani Sridharan return ret; 5035fcdbb2dSRanjani Sridharan } 5045fcdbb2dSRanjani Sridharan 5055fcdbb2dSRanjani Sridharan int sof_widget_list_free(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir) 5065fcdbb2dSRanjani Sridharan { 5075fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list; 5085fcdbb2dSRanjani Sridharan struct snd_soc_dapm_widget *widget; 5095fcdbb2dSRanjani Sridharan int i, ret; 5105fcdbb2dSRanjani Sridharan int ret1 = 0; 5115fcdbb2dSRanjani Sridharan 5125fcdbb2dSRanjani Sridharan /* nothing to free */ 5135fcdbb2dSRanjani Sridharan if (!list) 5145fcdbb2dSRanjani Sridharan return 0; 5155fcdbb2dSRanjani Sridharan 5165fcdbb2dSRanjani Sridharan /* 5175fcdbb2dSRanjani Sridharan * Free widgets in the list. This can fail but continue freeing other widgets to keep 5185fcdbb2dSRanjani Sridharan * use_counts balanced. 5195fcdbb2dSRanjani Sridharan */ 5205fcdbb2dSRanjani Sridharan for_each_dapm_widgets(list, i, widget) { 5215fcdbb2dSRanjani Sridharan struct snd_sof_widget *swidget = widget->dobj.private; 5225fcdbb2dSRanjani Sridharan 5235fcdbb2dSRanjani Sridharan if (!swidget) 5245fcdbb2dSRanjani Sridharan continue; 5255fcdbb2dSRanjani Sridharan 5265fcdbb2dSRanjani Sridharan /* 5275fcdbb2dSRanjani Sridharan * free widget and its pipe_widget. Either of these can fail, but free as many as 5285fcdbb2dSRanjani Sridharan * possible before freeing the list and returning the error. 5295fcdbb2dSRanjani Sridharan */ 5305fcdbb2dSRanjani Sridharan ret = sof_widget_free(sdev, swidget); 5315fcdbb2dSRanjani Sridharan if (ret < 0) 5325fcdbb2dSRanjani Sridharan ret1 = ret; 5335fcdbb2dSRanjani Sridharan 5345fcdbb2dSRanjani Sridharan ret = sof_widget_free(sdev, swidget->pipe_widget); 5355fcdbb2dSRanjani Sridharan if (ret < 0) 5365fcdbb2dSRanjani Sridharan ret1 = ret; 5375fcdbb2dSRanjani Sridharan } 5385fcdbb2dSRanjani Sridharan 5395fcdbb2dSRanjani Sridharan snd_soc_dapm_dai_free_widgets(&list); 5405fcdbb2dSRanjani Sridharan spcm->stream[dir].list = NULL; 5415fcdbb2dSRanjani Sridharan 5425fcdbb2dSRanjani Sridharan return ret1; 5435fcdbb2dSRanjani Sridharan } 5445fcdbb2dSRanjani Sridharan 545de23a838SRanjani Sridharan /* 546de23a838SRanjani Sridharan * helper to determine if there are only D0i3 compatible 547de23a838SRanjani Sridharan * streams active 548de23a838SRanjani Sridharan */ 549de23a838SRanjani Sridharan bool snd_sof_dsp_only_d0i3_compatible_stream_active(struct snd_sof_dev *sdev) 550de23a838SRanjani Sridharan { 551de23a838SRanjani Sridharan struct snd_pcm_substream *substream; 552de23a838SRanjani Sridharan struct snd_sof_pcm *spcm; 553de23a838SRanjani Sridharan bool d0i3_compatible_active = false; 554de23a838SRanjani Sridharan int dir; 555de23a838SRanjani Sridharan 556de23a838SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 557525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 558de23a838SRanjani Sridharan substream = spcm->stream[dir].substream; 559de23a838SRanjani Sridharan if (!substream || !substream->runtime) 560de23a838SRanjani Sridharan continue; 561de23a838SRanjani Sridharan 562de23a838SRanjani Sridharan /* 5638932f0cbSRandy Dunlap * substream->runtime being not NULL indicates 564de23a838SRanjani Sridharan * that the stream is open. No need to check the 565de23a838SRanjani Sridharan * stream state. 566de23a838SRanjani Sridharan */ 567de23a838SRanjani Sridharan if (!spcm->stream[dir].d0i3_compatible) 568de23a838SRanjani Sridharan return false; 569de23a838SRanjani Sridharan 570de23a838SRanjani Sridharan d0i3_compatible_active = true; 571de23a838SRanjani Sridharan } 572de23a838SRanjani Sridharan } 573de23a838SRanjani Sridharan 574de23a838SRanjani Sridharan return d0i3_compatible_active; 575de23a838SRanjani Sridharan } 576de23a838SRanjani Sridharan EXPORT_SYMBOL(snd_sof_dsp_only_d0i3_compatible_stream_active); 577de23a838SRanjani Sridharan 578700d1677SRanjani Sridharan bool snd_sof_stream_suspend_ignored(struct snd_sof_dev *sdev) 579ee1e79b7SRanjani Sridharan { 580ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 581ee1e79b7SRanjani Sridharan 582ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 583ee1e79b7SRanjani Sridharan if (spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].suspend_ignored || 584ee1e79b7SRanjani Sridharan spcm->stream[SNDRV_PCM_STREAM_CAPTURE].suspend_ignored) 585ee1e79b7SRanjani Sridharan return true; 586ee1e79b7SRanjani Sridharan } 587ee1e79b7SRanjani Sridharan 588ee1e79b7SRanjani Sridharan return false; 589ee1e79b7SRanjani Sridharan } 590ee1e79b7SRanjani Sridharan 591ee1e79b7SRanjani Sridharan int sof_set_hw_params_upon_resume(struct device *dev) 592ee1e79b7SRanjani Sridharan { 593ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = dev_get_drvdata(dev); 594ee1e79b7SRanjani Sridharan struct snd_pcm_substream *substream; 595ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 596ee1e79b7SRanjani Sridharan snd_pcm_state_t state; 597ee1e79b7SRanjani Sridharan int dir; 598ee1e79b7SRanjani Sridharan 599ee1e79b7SRanjani Sridharan /* 600ee1e79b7SRanjani Sridharan * SOF requires hw_params to be set-up internally upon resume. 601ee1e79b7SRanjani Sridharan * So, set the flag to indicate this for those streams that 602ee1e79b7SRanjani Sridharan * have been suspended. 603ee1e79b7SRanjani Sridharan */ 604ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 605525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 6063f06501eSRanjani Sridharan /* 6073f06501eSRanjani Sridharan * do not reset hw_params upon resume for streams that 6083f06501eSRanjani Sridharan * were kept running during suspend 6093f06501eSRanjani Sridharan */ 6103f06501eSRanjani Sridharan if (spcm->stream[dir].suspend_ignored) 6113f06501eSRanjani Sridharan continue; 6123f06501eSRanjani Sridharan 613ee1e79b7SRanjani Sridharan substream = spcm->stream[dir].substream; 614ee1e79b7SRanjani Sridharan if (!substream || !substream->runtime) 615ee1e79b7SRanjani Sridharan continue; 616ee1e79b7SRanjani Sridharan 617ee1e79b7SRanjani Sridharan state = substream->runtime->status->state; 618ee1e79b7SRanjani Sridharan if (state == SNDRV_PCM_STATE_SUSPENDED) 619ee1e79b7SRanjani Sridharan spcm->prepared[dir] = false; 620ee1e79b7SRanjani Sridharan } 621ee1e79b7SRanjani Sridharan } 622ee1e79b7SRanjani Sridharan 623ee1e79b7SRanjani Sridharan /* set internal flag for BE */ 624ee1e79b7SRanjani Sridharan return snd_sof_dsp_hw_params_upon_resume(sdev); 625ee1e79b7SRanjani Sridharan } 626ee1e79b7SRanjani Sridharan 627d1c6c4a9SGuennadi Liakhovetski const struct sof_ipc_pipe_new *snd_sof_pipeline_find(struct snd_sof_dev *sdev, 628d1c6c4a9SGuennadi Liakhovetski int pipeline_id) 629d1c6c4a9SGuennadi Liakhovetski { 630d1c6c4a9SGuennadi Liakhovetski const struct snd_sof_widget *swidget; 631d1c6c4a9SGuennadi Liakhovetski 632d1c6c4a9SGuennadi Liakhovetski list_for_each_entry(swidget, &sdev->widget_list, list) 633d1c6c4a9SGuennadi Liakhovetski if (swidget->id == snd_soc_dapm_scheduler) { 634d1c6c4a9SGuennadi Liakhovetski const struct sof_ipc_pipe_new *pipeline = 635d1c6c4a9SGuennadi Liakhovetski swidget->private; 636d1c6c4a9SGuennadi Liakhovetski if (pipeline->pipeline_id == pipeline_id) 637d1c6c4a9SGuennadi Liakhovetski return pipeline; 638d1c6c4a9SGuennadi Liakhovetski } 639d1c6c4a9SGuennadi Liakhovetski 640d1c6c4a9SGuennadi Liakhovetski return NULL; 641d1c6c4a9SGuennadi Liakhovetski } 642d1c6c4a9SGuennadi Liakhovetski 643d8a15e5fSPeter Ujfalusi int sof_set_up_pipelines(struct snd_sof_dev *sdev, bool verify) 644ee1e79b7SRanjani Sridharan { 64501429183SPierre-Louis Bossart struct sof_ipc_fw_version *v = &sdev->fw_ready.version; 646ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 647ee1e79b7SRanjani Sridharan struct snd_sof_route *sroute; 648ee1e79b7SRanjani Sridharan int ret; 649ee1e79b7SRanjani Sridharan 650ee1e79b7SRanjani Sridharan /* restore pipeline components */ 65101429183SPierre-Louis Bossart list_for_each_entry(swidget, &sdev->widget_list, list) { 6525fcdbb2dSRanjani Sridharan /* only set up the widgets belonging to static pipelines */ 653c0e7969cSRanjani Sridharan if (!verify && swidget->dynamic_pipeline_widget) 654ee1e79b7SRanjani Sridharan continue; 655ee1e79b7SRanjani Sridharan 65601429183SPierre-Louis Bossart /* 65701429183SPierre-Louis Bossart * For older firmware, skip scheduler widgets in this loop, 65801429183SPierre-Louis Bossart * sof_widget_setup() will be called in the 'complete pipeline' loop 65901429183SPierre-Louis Bossart */ 66001429183SPierre-Louis Bossart if (v->abi_version < SOF_ABI_VER(3, 19, 0) && 66101429183SPierre-Louis Bossart swidget->id == snd_soc_dapm_scheduler) 66201429183SPierre-Louis Bossart continue; 66301429183SPierre-Louis Bossart 6645fcdbb2dSRanjani Sridharan /* update DAI config. The IPC will be sent in sof_widget_setup() */ 6655fcdbb2dSRanjani Sridharan if (WIDGET_IS_DAI(swidget->id)) { 6665fcdbb2dSRanjani Sridharan struct snd_sof_dai *dai = swidget->private; 6675fcdbb2dSRanjani Sridharan struct sof_ipc_dai_config *config; 668ee1e79b7SRanjani Sridharan 6695fcdbb2dSRanjani Sridharan if (!dai || !dai->dai_config) 6705fcdbb2dSRanjani Sridharan continue; 671ee1e79b7SRanjani Sridharan 6725fcdbb2dSRanjani Sridharan config = dai->dai_config; 673ee1e79b7SRanjani Sridharan /* 674ee1e79b7SRanjani Sridharan * The link DMA channel would be invalidated for running 675ee1e79b7SRanjani Sridharan * streams but not for streams that were in the PAUSED 676ee1e79b7SRanjani Sridharan * state during suspend. So invalidate it here before setting 677ee1e79b7SRanjani Sridharan * the dai config in the DSP. 678ee1e79b7SRanjani Sridharan */ 679ee1e79b7SRanjani Sridharan if (config->type == SOF_DAI_INTEL_HDA) 680ee1e79b7SRanjani Sridharan config->hda.link_dma_ch = DMA_CHAN_INVALID; 6815fcdbb2dSRanjani Sridharan } 682ee1e79b7SRanjani Sridharan 6835fcdbb2dSRanjani Sridharan ret = sof_widget_setup(sdev, swidget); 68493d71245SRanjani Sridharan if (ret < 0) 685ee1e79b7SRanjani Sridharan return ret; 686ee1e79b7SRanjani Sridharan } 687ee1e79b7SRanjani Sridharan 6885fcdbb2dSRanjani Sridharan /* restore pipeline connections */ 6895fcdbb2dSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) { 6905fcdbb2dSRanjani Sridharan 6915fcdbb2dSRanjani Sridharan /* only set up routes belonging to static pipelines */ 692c0e7969cSRanjani Sridharan if (!verify && (sroute->src_widget->dynamic_pipeline_widget || 693c0e7969cSRanjani Sridharan sroute->sink_widget->dynamic_pipeline_widget)) 6945fcdbb2dSRanjani Sridharan continue; 6955fcdbb2dSRanjani Sridharan 6965fcdbb2dSRanjani Sridharan ret = sof_route_setup_ipc(sdev, sroute); 6975fcdbb2dSRanjani Sridharan if (ret < 0) { 6985fcdbb2dSRanjani Sridharan dev_err(sdev->dev, "%s: restore pipeline connections failed\n", __func__); 6995fcdbb2dSRanjani Sridharan return ret; 7005fcdbb2dSRanjani Sridharan } 7015fcdbb2dSRanjani Sridharan } 7025fcdbb2dSRanjani Sridharan 703ee1e79b7SRanjani Sridharan /* complete pipeline */ 704ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 705ee1e79b7SRanjani Sridharan switch (swidget->id) { 706ee1e79b7SRanjani Sridharan case snd_soc_dapm_scheduler: 7075fcdbb2dSRanjani Sridharan /* only complete static pipelines */ 708c0e7969cSRanjani Sridharan if (!verify && swidget->dynamic_pipeline_widget) 7095fcdbb2dSRanjani Sridharan continue; 7105fcdbb2dSRanjani Sridharan 71101429183SPierre-Louis Bossart if (v->abi_version < SOF_ABI_VER(3, 19, 0)) { 71201429183SPierre-Louis Bossart ret = sof_widget_setup(sdev, swidget); 71301429183SPierre-Louis Bossart if (ret < 0) 71401429183SPierre-Louis Bossart return ret; 71501429183SPierre-Louis Bossart } 71601429183SPierre-Louis Bossart 717ee1e79b7SRanjani Sridharan swidget->complete = 718d8a15e5fSPeter Ujfalusi snd_sof_complete_pipeline(sdev, swidget); 719ee1e79b7SRanjani Sridharan break; 720ee1e79b7SRanjani Sridharan default: 721ee1e79b7SRanjani Sridharan break; 722ee1e79b7SRanjani Sridharan } 723ee1e79b7SRanjani Sridharan } 724ee1e79b7SRanjani Sridharan 7255f3aad73SRanjani Sridharan return 0; 726ee1e79b7SRanjani Sridharan } 727ee1e79b7SRanjani Sridharan 728d9a72465SRanjani Sridharan int sof_pcm_stream_free(struct snd_sof_dev *sdev, struct snd_pcm_substream *substream, 729d9a72465SRanjani Sridharan struct snd_sof_pcm *spcm, int dir, bool free_widget_list) 730d9a72465SRanjani Sridharan { 731d9a72465SRanjani Sridharan int ret; 732d9a72465SRanjani Sridharan 733d9a72465SRanjani Sridharan /* Send PCM_FREE IPC to reset pipeline */ 734d9a72465SRanjani Sridharan ret = sof_pcm_dsp_pcm_free(substream, sdev, spcm); 735d9a72465SRanjani Sridharan if (ret < 0) 736d9a72465SRanjani Sridharan return ret; 737d9a72465SRanjani Sridharan 738d9a72465SRanjani Sridharan /* stop the DMA */ 739d9a72465SRanjani Sridharan ret = snd_sof_pcm_platform_hw_free(sdev, substream); 740d9a72465SRanjani Sridharan if (ret < 0) 741d9a72465SRanjani Sridharan return ret; 742d9a72465SRanjani Sridharan 743d9a72465SRanjani Sridharan /* free widget list */ 744d9a72465SRanjani Sridharan if (free_widget_list) { 745d9a72465SRanjani Sridharan ret = sof_widget_list_free(sdev, spcm, dir); 746d9a72465SRanjani Sridharan if (ret < 0) 747d9a72465SRanjani Sridharan dev_err(sdev->dev, "failed to free widgets during suspend\n"); 748d9a72465SRanjani Sridharan } 749d9a72465SRanjani Sridharan 750d9a72465SRanjani Sridharan return ret; 751d9a72465SRanjani Sridharan } 752d9a72465SRanjani Sridharan 7538b001416SRanjani Sridharan /* 75496da1740SRanjani Sridharan * Free the PCM, its associated widgets and set the prepared flag to false for all PCMs that 75596da1740SRanjani Sridharan * did not get suspended(ex: paused streams) so the widgets can be set up again during resume. 75696da1740SRanjani Sridharan */ 75796da1740SRanjani Sridharan static int sof_tear_down_left_over_pipelines(struct snd_sof_dev *sdev) 75896da1740SRanjani Sridharan { 75996da1740SRanjani Sridharan struct snd_sof_widget *swidget; 76096da1740SRanjani Sridharan struct snd_sof_pcm *spcm; 76196da1740SRanjani Sridharan int dir, ret; 76296da1740SRanjani Sridharan 76396da1740SRanjani Sridharan /* 76496da1740SRanjani Sridharan * free all PCMs and their associated DAPM widgets if their connected DAPM widget 76596da1740SRanjani Sridharan * list is not NULL. This should only be true for paused streams at this point. 76696da1740SRanjani Sridharan * This is equivalent to the handling of FE DAI suspend trigger for running streams. 76796da1740SRanjani Sridharan */ 76896da1740SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) 76996da1740SRanjani Sridharan for_each_pcm_streams(dir) { 77096da1740SRanjani Sridharan struct snd_pcm_substream *substream = spcm->stream[dir].substream; 77196da1740SRanjani Sridharan 77296da1740SRanjani Sridharan if (!substream || !substream->runtime) 77396da1740SRanjani Sridharan continue; 77496da1740SRanjani Sridharan 77596da1740SRanjani Sridharan if (spcm->stream[dir].list) { 776d9a72465SRanjani Sridharan ret = sof_pcm_stream_free(sdev, substream, spcm, dir, true); 77796da1740SRanjani Sridharan if (ret < 0) 77896da1740SRanjani Sridharan return ret; 77996da1740SRanjani Sridharan } 78096da1740SRanjani Sridharan } 78196da1740SRanjani Sridharan 78296da1740SRanjani Sridharan /* 78396da1740SRanjani Sridharan * free any left over DAI widgets. This is equivalent to the handling of suspend trigger 78496da1740SRanjani Sridharan * for the BE DAI for running streams. 78596da1740SRanjani Sridharan */ 78696da1740SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) 78796da1740SRanjani Sridharan if (WIDGET_IS_DAI(swidget->id) && swidget->use_count == 1) { 78896da1740SRanjani Sridharan ret = sof_widget_free(sdev, swidget); 78996da1740SRanjani Sridharan if (ret < 0) 79096da1740SRanjani Sridharan return ret; 79196da1740SRanjani Sridharan } 79296da1740SRanjani Sridharan 79396da1740SRanjani Sridharan return 0; 79496da1740SRanjani Sridharan } 79596da1740SRanjani Sridharan 79696da1740SRanjani Sridharan /* 797b2ebcf42SRanjani Sridharan * For older firmware, this function doesn't free widgets for static pipelines during suspend. 798b2ebcf42SRanjani Sridharan * It only resets use_count for all widgets. 7998b001416SRanjani Sridharan */ 800d8a15e5fSPeter Ujfalusi int sof_tear_down_pipelines(struct snd_sof_dev *sdev, bool verify) 8010a2dea1fSRanjani Sridharan { 802b2ebcf42SRanjani Sridharan struct sof_ipc_fw_version *v = &sdev->fw_ready.version; 8038b001416SRanjani Sridharan struct snd_sof_widget *swidget; 8040a2dea1fSRanjani Sridharan struct snd_sof_route *sroute; 805c0e7969cSRanjani Sridharan int ret; 8060a2dea1fSRanjani Sridharan 8070a2dea1fSRanjani Sridharan /* 808c0e7969cSRanjani Sridharan * This function is called during suspend and for one-time topology verification during 809c0e7969cSRanjani Sridharan * first boot. In both cases, there is no need to protect swidget->use_count and 81096da1740SRanjani Sridharan * sroute->setup because during suspend all running streams are suspended and during 81196da1740SRanjani Sridharan * topology loading the sound card unavailable to open PCMs. 8120a2dea1fSRanjani Sridharan */ 81301429183SPierre-Louis Bossart list_for_each_entry(swidget, &sdev->widget_list, list) { 814b2ebcf42SRanjani Sridharan if (swidget->dynamic_pipeline_widget) 815b2ebcf42SRanjani Sridharan continue; 816b2ebcf42SRanjani Sridharan 817b2ebcf42SRanjani Sridharan /* Do not free widgets for static pipelines with FW ABI older than 3.19 */ 818b2ebcf42SRanjani Sridharan if (!verify && !swidget->dynamic_pipeline_widget && 819b2ebcf42SRanjani Sridharan v->abi_version < SOF_ABI_VER(3, 19, 0)) { 8208b001416SRanjani Sridharan swidget->use_count = 0; 821b2ebcf42SRanjani Sridharan swidget->complete = 0; 822c0e7969cSRanjani Sridharan continue; 823c0e7969cSRanjani Sridharan } 824c0e7969cSRanjani Sridharan 825c0e7969cSRanjani Sridharan ret = sof_widget_free(sdev, swidget); 826c0e7969cSRanjani Sridharan if (ret < 0) 827c0e7969cSRanjani Sridharan return ret; 828c0e7969cSRanjani Sridharan } 8298b001416SRanjani Sridharan 83096da1740SRanjani Sridharan /* 83196da1740SRanjani Sridharan * Tear down all pipelines associated with PCMs that did not get suspended 83296da1740SRanjani Sridharan * and unset the prepare flag so that they can be set up again during resume. 83396da1740SRanjani Sridharan * Skip this step for older firmware. 83496da1740SRanjani Sridharan */ 83596da1740SRanjani Sridharan if (!verify && v->abi_version >= SOF_ABI_VER(3, 19, 0)) { 83696da1740SRanjani Sridharan ret = sof_tear_down_left_over_pipelines(sdev); 83796da1740SRanjani Sridharan if (ret < 0) { 83896da1740SRanjani Sridharan dev_err(sdev->dev, "failed to tear down paused pipelines\n"); 83996da1740SRanjani Sridharan return ret; 84096da1740SRanjani Sridharan } 84196da1740SRanjani Sridharan } 84296da1740SRanjani Sridharan 8430a2dea1fSRanjani Sridharan list_for_each_entry(sroute, &sdev->route_list, list) 8440a2dea1fSRanjani Sridharan sroute->setup = false; 845c0e7969cSRanjani Sridharan 846c0e7969cSRanjani Sridharan return 0; 8470a2dea1fSRanjani Sridharan } 8480a2dea1fSRanjani Sridharan 849ee1e79b7SRanjani Sridharan /* 850ee1e79b7SRanjani Sridharan * Generic object lookup APIs. 851ee1e79b7SRanjani Sridharan */ 852ee1e79b7SRanjani Sridharan 853ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_name(struct snd_soc_component *scomp, 854ee1e79b7SRanjani Sridharan const char *name) 855ee1e79b7SRanjani Sridharan { 856ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 857ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 858ee1e79b7SRanjani Sridharan 859ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 860ee1e79b7SRanjani Sridharan /* match with PCM dai name */ 861ee1e79b7SRanjani Sridharan if (strcmp(spcm->pcm.dai_name, name) == 0) 862ee1e79b7SRanjani Sridharan return spcm; 863ee1e79b7SRanjani Sridharan 864ee1e79b7SRanjani Sridharan /* match with playback caps name if set */ 865ee1e79b7SRanjani Sridharan if (*spcm->pcm.caps[0].name && 866ee1e79b7SRanjani Sridharan !strcmp(spcm->pcm.caps[0].name, name)) 867ee1e79b7SRanjani Sridharan return spcm; 868ee1e79b7SRanjani Sridharan 869ee1e79b7SRanjani Sridharan /* match with capture caps name if set */ 870ee1e79b7SRanjani Sridharan if (*spcm->pcm.caps[1].name && 871ee1e79b7SRanjani Sridharan !strcmp(spcm->pcm.caps[1].name, name)) 872ee1e79b7SRanjani Sridharan return spcm; 873ee1e79b7SRanjani Sridharan } 874ee1e79b7SRanjani Sridharan 875ee1e79b7SRanjani Sridharan return NULL; 876ee1e79b7SRanjani Sridharan } 877ee1e79b7SRanjani Sridharan 878ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_comp(struct snd_soc_component *scomp, 879ee1e79b7SRanjani Sridharan unsigned int comp_id, 880ee1e79b7SRanjani Sridharan int *direction) 881ee1e79b7SRanjani Sridharan { 882ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 883ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 884ee1e79b7SRanjani Sridharan int dir; 885ee1e79b7SRanjani Sridharan 886ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 887525c4107SKuninori Morimoto for_each_pcm_streams(dir) { 888ee1e79b7SRanjani Sridharan if (spcm->stream[dir].comp_id == comp_id) { 889ee1e79b7SRanjani Sridharan *direction = dir; 890ee1e79b7SRanjani Sridharan return spcm; 891ee1e79b7SRanjani Sridharan } 892ee1e79b7SRanjani Sridharan } 893ee1e79b7SRanjani Sridharan } 894ee1e79b7SRanjani Sridharan 895ee1e79b7SRanjani Sridharan return NULL; 896ee1e79b7SRanjani Sridharan } 897ee1e79b7SRanjani Sridharan 898ee1e79b7SRanjani Sridharan struct snd_sof_pcm *snd_sof_find_spcm_pcm_id(struct snd_soc_component *scomp, 899ee1e79b7SRanjani Sridharan unsigned int pcm_id) 900ee1e79b7SRanjani Sridharan { 901ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 902ee1e79b7SRanjani Sridharan struct snd_sof_pcm *spcm; 903ee1e79b7SRanjani Sridharan 904ee1e79b7SRanjani Sridharan list_for_each_entry(spcm, &sdev->pcm_list, list) { 905ee1e79b7SRanjani Sridharan if (le32_to_cpu(spcm->pcm.pcm_id) == pcm_id) 906ee1e79b7SRanjani Sridharan return spcm; 907ee1e79b7SRanjani Sridharan } 908ee1e79b7SRanjani Sridharan 909ee1e79b7SRanjani Sridharan return NULL; 910ee1e79b7SRanjani Sridharan } 911ee1e79b7SRanjani Sridharan 912ee1e79b7SRanjani Sridharan struct snd_sof_widget *snd_sof_find_swidget(struct snd_soc_component *scomp, 913ee1e79b7SRanjani Sridharan const char *name) 914ee1e79b7SRanjani Sridharan { 915ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 916ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 917ee1e79b7SRanjani Sridharan 918ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 919ee1e79b7SRanjani Sridharan if (strcmp(name, swidget->widget->name) == 0) 920ee1e79b7SRanjani Sridharan return swidget; 921ee1e79b7SRanjani Sridharan } 922ee1e79b7SRanjani Sridharan 923ee1e79b7SRanjani Sridharan return NULL; 924ee1e79b7SRanjani Sridharan } 925ee1e79b7SRanjani Sridharan 926ee1e79b7SRanjani Sridharan /* find widget by stream name and direction */ 927ee1e79b7SRanjani Sridharan struct snd_sof_widget * 928ee1e79b7SRanjani Sridharan snd_sof_find_swidget_sname(struct snd_soc_component *scomp, 929ee1e79b7SRanjani Sridharan const char *pcm_name, int dir) 930ee1e79b7SRanjani Sridharan { 931ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 932ee1e79b7SRanjani Sridharan struct snd_sof_widget *swidget; 933ee1e79b7SRanjani Sridharan enum snd_soc_dapm_type type; 934ee1e79b7SRanjani Sridharan 935ee1e79b7SRanjani Sridharan if (dir == SNDRV_PCM_STREAM_PLAYBACK) 936ee1e79b7SRanjani Sridharan type = snd_soc_dapm_aif_in; 937ee1e79b7SRanjani Sridharan else 938ee1e79b7SRanjani Sridharan type = snd_soc_dapm_aif_out; 939ee1e79b7SRanjani Sridharan 940ee1e79b7SRanjani Sridharan list_for_each_entry(swidget, &sdev->widget_list, list) { 941ee1e79b7SRanjani Sridharan if (!strcmp(pcm_name, swidget->widget->sname) && 942ee1e79b7SRanjani Sridharan swidget->id == type) 943ee1e79b7SRanjani Sridharan return swidget; 944ee1e79b7SRanjani Sridharan } 945ee1e79b7SRanjani Sridharan 946ee1e79b7SRanjani Sridharan return NULL; 947ee1e79b7SRanjani Sridharan } 948ee1e79b7SRanjani Sridharan 949ee1e79b7SRanjani Sridharan struct snd_sof_dai *snd_sof_find_dai(struct snd_soc_component *scomp, 950ee1e79b7SRanjani Sridharan const char *name) 951ee1e79b7SRanjani Sridharan { 952ee1e79b7SRanjani Sridharan struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp); 953ee1e79b7SRanjani Sridharan struct snd_sof_dai *dai; 954ee1e79b7SRanjani Sridharan 955ee1e79b7SRanjani Sridharan list_for_each_entry(dai, &sdev->dai_list, list) { 956ee1e79b7SRanjani Sridharan if (dai->name && (strcmp(name, dai->name) == 0)) 957ee1e79b7SRanjani Sridharan return dai; 958ee1e79b7SRanjani Sridharan } 959ee1e79b7SRanjani Sridharan 960ee1e79b7SRanjani Sridharan return NULL; 961ee1e79b7SRanjani Sridharan } 962ee1e79b7SRanjani Sridharan 963bc619cfcSBrent Lu #define SOF_DAI_CLK_INTEL_SSP_MCLK 0 964bc619cfcSBrent Lu #define SOF_DAI_CLK_INTEL_SSP_BCLK 1 965bc619cfcSBrent Lu 966bc619cfcSBrent Lu static int sof_dai_get_clk(struct snd_soc_pcm_runtime *rtd, int clk_type) 967b951b51eSKeyon Jie { 968b951b51eSKeyon Jie struct snd_soc_component *component = 969b951b51eSKeyon Jie snd_soc_rtdcom_lookup(rtd, SOF_AUDIO_PCM_DRV_NAME); 970b951b51eSKeyon Jie struct snd_sof_dai *dai = 971b951b51eSKeyon Jie snd_sof_find_dai(component, (char *)rtd->dai_link->name); 972b951b51eSKeyon Jie 973b951b51eSKeyon Jie /* use the tplg configured mclk if existed */ 974b951b51eSKeyon Jie if (!dai || !dai->dai_config) 975b951b51eSKeyon Jie return 0; 976b951b51eSKeyon Jie 977b951b51eSKeyon Jie switch (dai->dai_config->type) { 978b951b51eSKeyon Jie case SOF_DAI_INTEL_SSP: 979bc619cfcSBrent Lu switch (clk_type) { 980bc619cfcSBrent Lu case SOF_DAI_CLK_INTEL_SSP_MCLK: 981b951b51eSKeyon Jie return dai->dai_config->ssp.mclk_rate; 982bc619cfcSBrent Lu case SOF_DAI_CLK_INTEL_SSP_BCLK: 983bc619cfcSBrent Lu return dai->dai_config->ssp.bclk_rate; 984bc619cfcSBrent Lu default: 985bc619cfcSBrent Lu dev_err(rtd->dev, "fail to get SSP clk %d rate\n", 986bc619cfcSBrent Lu clk_type); 987bc619cfcSBrent Lu return -EINVAL; 988bc619cfcSBrent Lu } 989bc619cfcSBrent Lu break; 990b951b51eSKeyon Jie default: 991b951b51eSKeyon Jie /* not yet implemented for platforms other than the above */ 992bc619cfcSBrent Lu dev_err(rtd->dev, "DAI type %d not supported yet!\n", 993b951b51eSKeyon Jie dai->dai_config->type); 994b951b51eSKeyon Jie return -EINVAL; 995b951b51eSKeyon Jie } 996b951b51eSKeyon Jie } 997bc619cfcSBrent Lu 998bc619cfcSBrent Lu /* 999bc619cfcSBrent Lu * Helper to get SSP MCLK from a pcm_runtime. 1000bc619cfcSBrent Lu * Return 0 if not exist. 1001bc619cfcSBrent Lu */ 1002bc619cfcSBrent Lu int sof_dai_get_mclk(struct snd_soc_pcm_runtime *rtd) 1003bc619cfcSBrent Lu { 1004bc619cfcSBrent Lu return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_MCLK); 1005bc619cfcSBrent Lu } 1006b951b51eSKeyon Jie EXPORT_SYMBOL(sof_dai_get_mclk); 1007b951b51eSKeyon Jie 1008b951b51eSKeyon Jie /* 1009bc619cfcSBrent Lu * Helper to get SSP BCLK from a pcm_runtime. 1010bc619cfcSBrent Lu * Return 0 if not exist. 1011bc619cfcSBrent Lu */ 1012bc619cfcSBrent Lu int sof_dai_get_bclk(struct snd_soc_pcm_runtime *rtd) 1013bc619cfcSBrent Lu { 1014bc619cfcSBrent Lu return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_BCLK); 1015bc619cfcSBrent Lu } 1016bc619cfcSBrent Lu EXPORT_SYMBOL(sof_dai_get_bclk); 1017bc619cfcSBrent Lu 1018bc619cfcSBrent Lu /* 1019285880a2SDaniel Baluta * SOF Driver enumeration. 1020285880a2SDaniel Baluta */ 1021285880a2SDaniel Baluta int sof_machine_check(struct snd_sof_dev *sdev) 1022285880a2SDaniel Baluta { 1023285880a2SDaniel Baluta struct snd_sof_pdata *sof_pdata = sdev->pdata; 1024285880a2SDaniel Baluta const struct sof_dev_desc *desc = sof_pdata->desc; 1025285880a2SDaniel Baluta struct snd_soc_acpi_mach *mach; 1026285880a2SDaniel Baluta 10274c1cc83fSPierre-Louis Bossart if (!IS_ENABLED(CONFIG_SND_SOC_SOF_FORCE_NOCODEC_MODE)) { 1028285880a2SDaniel Baluta 1029285880a2SDaniel Baluta /* find machine */ 1030*cb515f10SGuennadi Liakhovetski mach = snd_sof_machine_select(sdev); 1031*cb515f10SGuennadi Liakhovetski if (mach) { 1032*cb515f10SGuennadi Liakhovetski sof_pdata->machine = mach; 1033*cb515f10SGuennadi Liakhovetski snd_sof_set_mach_params(mach, sdev); 1034285880a2SDaniel Baluta return 0; 1035285880a2SDaniel Baluta } 1036285880a2SDaniel Baluta 10374c1cc83fSPierre-Louis Bossart if (!IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC)) { 1038285880a2SDaniel Baluta dev_err(sdev->dev, "error: no matching ASoC machine driver found - aborting probe\n"); 1039285880a2SDaniel Baluta return -ENODEV; 10404c1cc83fSPierre-Louis Bossart } 10414c1cc83fSPierre-Louis Bossart } else { 104264e2c37eSPierre-Louis Bossart dev_warn(sdev->dev, "Force to use nocodec mode\n"); 10434c1cc83fSPierre-Louis Bossart } 10444c1cc83fSPierre-Louis Bossart 1045285880a2SDaniel Baluta /* select nocodec mode */ 1046285880a2SDaniel Baluta dev_warn(sdev->dev, "Using nocodec machine driver\n"); 1047285880a2SDaniel Baluta mach = devm_kzalloc(sdev->dev, sizeof(*mach), GFP_KERNEL); 1048285880a2SDaniel Baluta if (!mach) 1049285880a2SDaniel Baluta return -ENOMEM; 1050285880a2SDaniel Baluta 1051d612b455SRanjani Sridharan mach->drv_name = "sof-nocodec"; 1052d612b455SRanjani Sridharan sof_pdata->tplg_filename = desc->nocodec_tplg_filename; 1053d612b455SRanjani Sridharan 1054285880a2SDaniel Baluta sof_pdata->machine = mach; 1055*cb515f10SGuennadi Liakhovetski snd_sof_set_mach_params(mach, sdev); 1056285880a2SDaniel Baluta 1057285880a2SDaniel Baluta return 0; 1058285880a2SDaniel Baluta } 1059285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_check); 1060285880a2SDaniel Baluta 1061285880a2SDaniel Baluta int sof_machine_register(struct snd_sof_dev *sdev, void *pdata) 1062285880a2SDaniel Baluta { 1063db69bcf9SGuennadi Liakhovetski struct snd_sof_pdata *plat_data = pdata; 1064285880a2SDaniel Baluta const char *drv_name; 1065285880a2SDaniel Baluta const void *mach; 1066285880a2SDaniel Baluta int size; 1067285880a2SDaniel Baluta 1068285880a2SDaniel Baluta drv_name = plat_data->machine->drv_name; 1069db69bcf9SGuennadi Liakhovetski mach = plat_data->machine; 1070285880a2SDaniel Baluta size = sizeof(*plat_data->machine); 1071285880a2SDaniel Baluta 1072285880a2SDaniel Baluta /* register machine driver, pass machine info as pdata */ 1073285880a2SDaniel Baluta plat_data->pdev_mach = 1074285880a2SDaniel Baluta platform_device_register_data(sdev->dev, drv_name, 1075285880a2SDaniel Baluta PLATFORM_DEVID_NONE, mach, size); 1076285880a2SDaniel Baluta if (IS_ERR(plat_data->pdev_mach)) 1077285880a2SDaniel Baluta return PTR_ERR(plat_data->pdev_mach); 1078285880a2SDaniel Baluta 1079285880a2SDaniel Baluta dev_dbg(sdev->dev, "created machine %s\n", 1080285880a2SDaniel Baluta dev_name(&plat_data->pdev_mach->dev)); 1081285880a2SDaniel Baluta 1082285880a2SDaniel Baluta return 0; 1083285880a2SDaniel Baluta } 1084285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_register); 1085285880a2SDaniel Baluta 1086285880a2SDaniel Baluta void sof_machine_unregister(struct snd_sof_dev *sdev, void *pdata) 1087285880a2SDaniel Baluta { 1088db69bcf9SGuennadi Liakhovetski struct snd_sof_pdata *plat_data = pdata; 1089285880a2SDaniel Baluta 1090285880a2SDaniel Baluta if (!IS_ERR_OR_NULL(plat_data->pdev_mach)) 1091285880a2SDaniel Baluta platform_device_unregister(plat_data->pdev_mach); 1092285880a2SDaniel Baluta } 1093285880a2SDaniel Baluta EXPORT_SYMBOL(sof_machine_unregister); 1094