Lines Matching +full:dsp +full:- +full:ctrl
1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
3 // Copyright 2021-2022 NXP
7 // Hardware interface for audio DSP on i.MX8ULP
9 #include <linux/arm-smccc.h>
12 #include <linux/firmware/imx/dsp.h>
26 #include "../sof-of-dev.h"
27 #include "imx-common.h"
47 /* DSP IPC handler */
58 /* Controls the HiFi4 DSP Reset: 1 in reset, 0 out of reset */ in imx8ulp_sim_lpav_start()
59 regmap_update_bits(priv->regmap, SYSCTRL0, RESET_BIT, 0); in imx8ulp_sim_lpav_start()
61 /* Reset HiFi4 DSP Debug logic: 1 debug reset, 0 out of reset*/ in imx8ulp_sim_lpav_start()
62 regmap_update_bits(priv->regmap, SYSCTRL0, DEBUG_LOGIC_BIT, 0); in imx8ulp_sim_lpav_start()
64 /* Stall HIFI4 DSP Execution: 1 stall, 0 run */ in imx8ulp_sim_lpav_start()
65 regmap_update_bits(priv->regmap, SYSCTRL0, EXECUTE_BIT, 0); in imx8ulp_sim_lpav_start()
83 spin_lock_irqsave(&priv->sdev->ipc_lock, flags); in imx8ulp_dsp_handle_reply()
85 snd_sof_ipc_process_reply(priv->sdev, 0); in imx8ulp_dsp_handle_reply()
87 spin_unlock_irqrestore(&priv->sdev->ipc_lock, flags); in imx8ulp_dsp_handle_reply()
96 sof_mailbox_read(priv->sdev, priv->sdev->debug_box.offset + 4, &p, sizeof(p)); in imx8ulp_dsp_handle_request()
100 snd_sof_dsp_panic(priv->sdev, p, true); in imx8ulp_dsp_handle_request()
102 snd_sof_ipc_msgs_rx(priv->sdev); in imx8ulp_dsp_handle_request()
112 struct imx8ulp_priv *priv = sdev->pdata->hw_pdata; in imx8ulp_send_msg()
114 sof_mailbox_write(sdev, sdev->host_box.offset, msg->msg_data, in imx8ulp_send_msg()
115 msg->msg_size); in imx8ulp_send_msg()
116 imx_dsp_ring_doorbell(priv->dsp_ipc, 0); in imx8ulp_send_msg()
123 struct imx8ulp_priv *priv = sdev->pdata->hw_pdata; in imx8ulp_run()
132 struct imx8ulp_priv *priv = sdev->pdata->hw_pdata; in imx8ulp_reset()
136 regmap_update_bits(priv->regmap, SYSCTRL0, PLAT_CLK_BIT, PLAT_CLK_BIT); in imx8ulp_reset()
139 regmap_update_bits(priv->regmap, SYSCTRL0, PB_CLK_BIT, PB_CLK_BIT); in imx8ulp_reset()
142 regmap_update_bits(priv->regmap, SYSCTRL0, HIFI4_CLK_BIT, HIFI4_CLK_BIT); in imx8ulp_reset()
144 regmap_update_bits(priv->regmap, SYSCTRL0, RESET_BIT, RESET_BIT); in imx8ulp_reset()
147 /* Stall HIFI4 DSP Execution: 1 stall, 0 not stall */ in imx8ulp_reset()
148 regmap_update_bits(priv->regmap, SYSCTRL0, EXECUTE_BIT, EXECUTE_BIT); in imx8ulp_reset()
158 struct platform_device *pdev = to_platform_device(sdev->dev); in imx8ulp_probe()
159 struct device_node *np = pdev->dev.of_node; in imx8ulp_probe()
167 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); in imx8ulp_probe()
169 return -ENOMEM; in imx8ulp_probe()
171 sdev->num_cores = 1; in imx8ulp_probe()
172 sdev->pdata->hw_pdata = priv; in imx8ulp_probe()
173 priv->dev = sdev->dev; in imx8ulp_probe()
174 priv->sdev = sdev; in imx8ulp_probe()
176 /* System integration module(SIM) control dsp configuration */ in imx8ulp_probe()
177 priv->regmap = syscon_regmap_lookup_by_phandle(np, "fsl,dsp-ctrl"); in imx8ulp_probe()
178 if (IS_ERR(priv->regmap)) in imx8ulp_probe()
179 return PTR_ERR(priv->regmap); in imx8ulp_probe()
181 priv->ipc_dev = platform_device_register_data(sdev->dev, "imx-dsp", in imx8ulp_probe()
184 if (IS_ERR(priv->ipc_dev)) in imx8ulp_probe()
185 return PTR_ERR(priv->ipc_dev); in imx8ulp_probe()
187 priv->dsp_ipc = dev_get_drvdata(&priv->ipc_dev->dev); in imx8ulp_probe()
188 if (!priv->dsp_ipc) { in imx8ulp_probe()
189 /* DSP IPC driver not probed yet, try later */ in imx8ulp_probe()
190 ret = -EPROBE_DEFER; in imx8ulp_probe()
191 dev_err(sdev->dev, "Failed to get drvdata\n"); in imx8ulp_probe()
195 imx_dsp_set_data(priv->dsp_ipc, priv); in imx8ulp_probe()
196 priv->dsp_ipc->ops = &dsp_ops; in imx8ulp_probe()
198 /* DSP base */ in imx8ulp_probe()
201 base = mmio->start; in imx8ulp_probe()
204 dev_err(sdev->dev, "error: failed to get DSP base at idx 0\n"); in imx8ulp_probe()
205 ret = -EINVAL; in imx8ulp_probe()
209 sdev->bar[SOF_FW_BLK_TYPE_IRAM] = devm_ioremap(sdev->dev, base, size); in imx8ulp_probe()
210 if (!sdev->bar[SOF_FW_BLK_TYPE_IRAM]) { in imx8ulp_probe()
211 dev_err(sdev->dev, "failed to ioremap base 0x%x size 0x%x\n", in imx8ulp_probe()
213 ret = -ENODEV; in imx8ulp_probe()
216 sdev->mmio_bar = SOF_FW_BLK_TYPE_IRAM; in imx8ulp_probe()
218 res_node = of_parse_phandle(np, "memory-reserved", 0); in imx8ulp_probe()
220 dev_err(&pdev->dev, "failed to get memory region node\n"); in imx8ulp_probe()
221 ret = -ENODEV; in imx8ulp_probe()
228 dev_err(&pdev->dev, "failed to get reserved region address\n"); in imx8ulp_probe()
232 sdev->bar[SOF_FW_BLK_TYPE_SRAM] = devm_ioremap_wc(sdev->dev, res.start, in imx8ulp_probe()
234 if (!sdev->bar[SOF_FW_BLK_TYPE_SRAM]) { in imx8ulp_probe()
235 dev_err(sdev->dev, "failed to ioremap mem 0x%x size 0x%x\n", in imx8ulp_probe()
237 ret = -ENOMEM; in imx8ulp_probe()
240 sdev->mailbox_bar = SOF_FW_BLK_TYPE_SRAM; in imx8ulp_probe()
243 sdev->dsp_box.offset = MBOX_OFFSET; in imx8ulp_probe()
245 ret = of_reserved_mem_device_init(sdev->dev); in imx8ulp_probe()
247 dev_err(&pdev->dev, "failed to init reserved memory region %d\n", ret); in imx8ulp_probe()
251 ret = devm_clk_bulk_get_all(sdev->dev, &priv->clks); in imx8ulp_probe()
253 dev_err(sdev->dev, "failed to fetch clocks: %d\n", ret); in imx8ulp_probe()
256 priv->clk_num = ret; in imx8ulp_probe()
258 ret = clk_bulk_prepare_enable(priv->clk_num, priv->clks); in imx8ulp_probe()
260 dev_err(sdev->dev, "failed to enable clocks: %d\n", ret); in imx8ulp_probe()
267 platform_device_unregister(priv->ipc_dev); in imx8ulp_probe()
274 struct imx8ulp_priv *priv = sdev->pdata->hw_pdata; in imx8ulp_remove()
276 clk_bulk_disable_unprepare(priv->clk_num, priv->clks); in imx8ulp_remove()
277 platform_device_unregister(priv->ipc_dev); in imx8ulp_remove()
289 struct imx8ulp_priv *priv = (struct imx8ulp_priv *)sdev->pdata->hw_pdata; in imx8ulp_suspend()
291 /*Stall DSP, release in .run() */ in imx8ulp_suspend()
292 regmap_update_bits(priv->regmap, SYSCTRL0, EXECUTE_BIT, EXECUTE_BIT); in imx8ulp_suspend()
295 imx_dsp_free_channel(priv->dsp_ipc, i); in imx8ulp_suspend()
297 clk_bulk_disable_unprepare(priv->clk_num, priv->clks); in imx8ulp_suspend()
304 struct imx8ulp_priv *priv = (struct imx8ulp_priv *)sdev->pdata->hw_pdata; in imx8ulp_resume()
307 ret = clk_bulk_prepare_enable(priv->clk_num, priv->clks); in imx8ulp_resume()
309 dev_err(sdev->dev, "failed to enable clocks: %d\n", ret); in imx8ulp_resume()
314 imx_dsp_request_channel(priv->dsp_ipc, i); in imx8ulp_resume()
350 if (!pm_runtime_suspended(sdev->dev)) in imx8ulp_dsp_suspend()
365 if (pm_runtime_suspended(sdev->dev)) { in imx8ulp_dsp_resume()
366 pm_runtime_disable(sdev->dev); in imx8ulp_dsp_resume()
367 pm_runtime_set_active(sdev->dev); in imx8ulp_dsp_resume()
368 pm_runtime_mark_last_busy(sdev->dev); in imx8ulp_dsp_resume()
369 pm_runtime_enable(sdev->dev); in imx8ulp_dsp_resume()
370 pm_runtime_idle(sdev->dev); in imx8ulp_dsp_resume()
404 sdev->dsp_power_state = *target_state; in imx8ulp_dsp_set_power_state()
414 /* DSP core boot */
476 .compatible = "fsl,imx8ulp-evk",
477 .sof_tplg_filename = "sof-imx8ulp-btsco.tplg",
478 .drv_name = "asoc-audio-graph-card2",
491 [SOF_IPC_TYPE_3] = "imx/sof-tplg",
494 [SOF_IPC_TYPE_3] = "sof-imx8ulp.ri",
496 .nocodec_tplg_filename = "sof-imx8ulp-nocodec.tplg",
501 { .compatible = "fsl,imx8ulp-dsp", .data = &sof_of_imx8ulp_desc},
511 .name = "sof-audio-of-imx8ulp",