162306a36Sopenharmony_ci// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause) 262306a36Sopenharmony_ci// 362306a36Sopenharmony_ci// Copyright(c) 2021 Mediatek Inc. All rights reserved. 462306a36Sopenharmony_ci// 562306a36Sopenharmony_ci// Author: YC Hung <yc.hung@mediatek.com> 662306a36Sopenharmony_ci// 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci/* 962306a36Sopenharmony_ci * Hardware interface for audio DSP on mt8195 1062306a36Sopenharmony_ci */ 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_ci#include <linux/delay.h> 1362306a36Sopenharmony_ci#include <linux/firmware.h> 1462306a36Sopenharmony_ci#include <linux/io.h> 1562306a36Sopenharmony_ci#include <linux/of_address.h> 1662306a36Sopenharmony_ci#include <linux/of_irq.h> 1762306a36Sopenharmony_ci#include <linux/of_platform.h> 1862306a36Sopenharmony_ci#include <linux/of_reserved_mem.h> 1962306a36Sopenharmony_ci#include <linux/module.h> 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#include <sound/sof.h> 2262306a36Sopenharmony_ci#include <sound/sof/xtensa.h> 2362306a36Sopenharmony_ci#include "../../ops.h" 2462306a36Sopenharmony_ci#include "../../sof-of-dev.h" 2562306a36Sopenharmony_ci#include "../../sof-audio.h" 2662306a36Sopenharmony_ci#include "../adsp_helper.h" 2762306a36Sopenharmony_ci#include "../mtk-adsp-common.h" 2862306a36Sopenharmony_ci#include "mt8195.h" 2962306a36Sopenharmony_ci#include "mt8195-clk.h" 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_cistatic int mt8195_get_mailbox_offset(struct snd_sof_dev *sdev) 3262306a36Sopenharmony_ci{ 3362306a36Sopenharmony_ci return MBOX_OFFSET; 3462306a36Sopenharmony_ci} 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_cistatic int mt8195_get_window_offset(struct snd_sof_dev *sdev, u32 id) 3762306a36Sopenharmony_ci{ 3862306a36Sopenharmony_ci return MBOX_OFFSET; 3962306a36Sopenharmony_ci} 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_cistatic int mt8195_send_msg(struct snd_sof_dev *sdev, 4262306a36Sopenharmony_ci struct snd_sof_ipc_msg *msg) 4362306a36Sopenharmony_ci{ 4462306a36Sopenharmony_ci struct adsp_priv *priv = sdev->pdata->hw_pdata; 4562306a36Sopenharmony_ci 4662306a36Sopenharmony_ci sof_mailbox_write(sdev, sdev->host_box.offset, msg->msg_data, 4762306a36Sopenharmony_ci msg->msg_size); 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci return mtk_adsp_ipc_send(priv->dsp_ipc, MTK_ADSP_IPC_REQ, MTK_ADSP_IPC_OP_REQ); 5062306a36Sopenharmony_ci} 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_cistatic void mt8195_dsp_handle_reply(struct mtk_adsp_ipc *ipc) 5362306a36Sopenharmony_ci{ 5462306a36Sopenharmony_ci struct adsp_priv *priv = mtk_adsp_ipc_get_data(ipc); 5562306a36Sopenharmony_ci unsigned long flags; 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci spin_lock_irqsave(&priv->sdev->ipc_lock, flags); 5862306a36Sopenharmony_ci snd_sof_ipc_process_reply(priv->sdev, 0); 5962306a36Sopenharmony_ci spin_unlock_irqrestore(&priv->sdev->ipc_lock, flags); 6062306a36Sopenharmony_ci} 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_cistatic void mt8195_dsp_handle_request(struct mtk_adsp_ipc *ipc) 6362306a36Sopenharmony_ci{ 6462306a36Sopenharmony_ci struct adsp_priv *priv = mtk_adsp_ipc_get_data(ipc); 6562306a36Sopenharmony_ci u32 p; /* panic code */ 6662306a36Sopenharmony_ci int ret; 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci /* Read the message from the debug box. */ 6962306a36Sopenharmony_ci sof_mailbox_read(priv->sdev, priv->sdev->debug_box.offset + 4, 7062306a36Sopenharmony_ci &p, sizeof(p)); 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_ci /* Check to see if the message is a panic code 0x0dead*** */ 7362306a36Sopenharmony_ci if ((p & SOF_IPC_PANIC_MAGIC_MASK) == SOF_IPC_PANIC_MAGIC) { 7462306a36Sopenharmony_ci snd_sof_dsp_panic(priv->sdev, p, true); 7562306a36Sopenharmony_ci } else { 7662306a36Sopenharmony_ci snd_sof_ipc_msgs_rx(priv->sdev); 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci /* tell DSP cmd is done */ 7962306a36Sopenharmony_ci ret = mtk_adsp_ipc_send(priv->dsp_ipc, MTK_ADSP_IPC_RSP, MTK_ADSP_IPC_OP_RSP); 8062306a36Sopenharmony_ci if (ret) 8162306a36Sopenharmony_ci dev_err(priv->dev, "request send ipc failed"); 8262306a36Sopenharmony_ci } 8362306a36Sopenharmony_ci} 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_cistatic struct mtk_adsp_ipc_ops dsp_ops = { 8662306a36Sopenharmony_ci .handle_reply = mt8195_dsp_handle_reply, 8762306a36Sopenharmony_ci .handle_request = mt8195_dsp_handle_request, 8862306a36Sopenharmony_ci}; 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistatic int platform_parse_resource(struct platform_device *pdev, void *data) 9162306a36Sopenharmony_ci{ 9262306a36Sopenharmony_ci struct resource *mmio; 9362306a36Sopenharmony_ci struct resource res; 9462306a36Sopenharmony_ci struct device_node *mem_region; 9562306a36Sopenharmony_ci struct device *dev = &pdev->dev; 9662306a36Sopenharmony_ci struct mtk_adsp_chip_info *adsp = data; 9762306a36Sopenharmony_ci int ret; 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci mem_region = of_parse_phandle(dev->of_node, "memory-region", 0); 10062306a36Sopenharmony_ci if (!mem_region) { 10162306a36Sopenharmony_ci dev_err(dev, "no dma memory-region phandle\n"); 10262306a36Sopenharmony_ci return -ENODEV; 10362306a36Sopenharmony_ci } 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_ci ret = of_address_to_resource(mem_region, 0, &res); 10662306a36Sopenharmony_ci of_node_put(mem_region); 10762306a36Sopenharmony_ci if (ret) { 10862306a36Sopenharmony_ci dev_err(dev, "of_address_to_resource dma failed\n"); 10962306a36Sopenharmony_ci return ret; 11062306a36Sopenharmony_ci } 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci dev_dbg(dev, "DMA %pR\n", &res); 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci adsp->pa_shared_dram = (phys_addr_t)res.start; 11562306a36Sopenharmony_ci adsp->shared_size = resource_size(&res); 11662306a36Sopenharmony_ci if (adsp->pa_shared_dram & DRAM_REMAP_MASK) { 11762306a36Sopenharmony_ci dev_err(dev, "adsp shared dma memory(%#x) is not 4K-aligned\n", 11862306a36Sopenharmony_ci (u32)adsp->pa_shared_dram); 11962306a36Sopenharmony_ci return -EINVAL; 12062306a36Sopenharmony_ci } 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_ci ret = of_reserved_mem_device_init(dev); 12362306a36Sopenharmony_ci if (ret) { 12462306a36Sopenharmony_ci dev_err(dev, "of_reserved_mem_device_init failed\n"); 12562306a36Sopenharmony_ci return ret; 12662306a36Sopenharmony_ci } 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci mem_region = of_parse_phandle(dev->of_node, "memory-region", 1); 12962306a36Sopenharmony_ci if (!mem_region) { 13062306a36Sopenharmony_ci dev_err(dev, "no memory-region sysmem phandle\n"); 13162306a36Sopenharmony_ci return -ENODEV; 13262306a36Sopenharmony_ci } 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_ci ret = of_address_to_resource(mem_region, 0, &res); 13562306a36Sopenharmony_ci of_node_put(mem_region); 13662306a36Sopenharmony_ci if (ret) { 13762306a36Sopenharmony_ci dev_err(dev, "of_address_to_resource sysmem failed\n"); 13862306a36Sopenharmony_ci return ret; 13962306a36Sopenharmony_ci } 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci adsp->pa_dram = (phys_addr_t)res.start; 14262306a36Sopenharmony_ci adsp->dramsize = resource_size(&res); 14362306a36Sopenharmony_ci if (adsp->pa_dram & DRAM_REMAP_MASK) { 14462306a36Sopenharmony_ci dev_err(dev, "adsp memory(%#x) is not 4K-aligned\n", 14562306a36Sopenharmony_ci (u32)adsp->pa_dram); 14662306a36Sopenharmony_ci return -EINVAL; 14762306a36Sopenharmony_ci } 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_ci if (adsp->dramsize < TOTAL_SIZE_SHARED_DRAM_FROM_TAIL) { 15062306a36Sopenharmony_ci dev_err(dev, "adsp memory(%#x) is not enough for share\n", 15162306a36Sopenharmony_ci adsp->dramsize); 15262306a36Sopenharmony_ci return -EINVAL; 15362306a36Sopenharmony_ci } 15462306a36Sopenharmony_ci 15562306a36Sopenharmony_ci dev_dbg(dev, "dram pbase=%pa, dramsize=%#x\n", 15662306a36Sopenharmony_ci &adsp->pa_dram, adsp->dramsize); 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci /* Parse CFG base */ 15962306a36Sopenharmony_ci mmio = platform_get_resource_byname(pdev, IORESOURCE_MEM, "cfg"); 16062306a36Sopenharmony_ci if (!mmio) { 16162306a36Sopenharmony_ci dev_err(dev, "no ADSP-CFG register resource\n"); 16262306a36Sopenharmony_ci return -ENXIO; 16362306a36Sopenharmony_ci } 16462306a36Sopenharmony_ci /* remap for DSP register accessing */ 16562306a36Sopenharmony_ci adsp->va_cfgreg = devm_ioremap_resource(dev, mmio); 16662306a36Sopenharmony_ci if (IS_ERR(adsp->va_cfgreg)) 16762306a36Sopenharmony_ci return PTR_ERR(adsp->va_cfgreg); 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_ci adsp->pa_cfgreg = (phys_addr_t)mmio->start; 17062306a36Sopenharmony_ci adsp->cfgregsize = resource_size(mmio); 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_ci dev_dbg(dev, "cfgreg-vbase=%p, cfgregsize=%#x\n", 17362306a36Sopenharmony_ci adsp->va_cfgreg, adsp->cfgregsize); 17462306a36Sopenharmony_ci 17562306a36Sopenharmony_ci /* Parse SRAM */ 17662306a36Sopenharmony_ci mmio = platform_get_resource_byname(pdev, IORESOURCE_MEM, "sram"); 17762306a36Sopenharmony_ci if (!mmio) { 17862306a36Sopenharmony_ci dev_err(dev, "no SRAM resource\n"); 17962306a36Sopenharmony_ci return -ENXIO; 18062306a36Sopenharmony_ci } 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci adsp->pa_sram = (phys_addr_t)mmio->start; 18362306a36Sopenharmony_ci adsp->sramsize = resource_size(mmio); 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci dev_dbg(dev, "sram pbase=%pa,%#x\n", &adsp->pa_sram, adsp->sramsize); 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci return ret; 18862306a36Sopenharmony_ci} 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_cistatic int adsp_sram_power_on(struct device *dev, bool on) 19162306a36Sopenharmony_ci{ 19262306a36Sopenharmony_ci void __iomem *va_dspsysreg; 19362306a36Sopenharmony_ci u32 srampool_con; 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_ci va_dspsysreg = ioremap(ADSP_SRAM_POOL_CON, 0x4); 19662306a36Sopenharmony_ci if (!va_dspsysreg) { 19762306a36Sopenharmony_ci dev_err(dev, "failed to ioremap sram pool base %#x\n", 19862306a36Sopenharmony_ci ADSP_SRAM_POOL_CON); 19962306a36Sopenharmony_ci return -ENOMEM; 20062306a36Sopenharmony_ci } 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci srampool_con = readl(va_dspsysreg); 20362306a36Sopenharmony_ci if (on) 20462306a36Sopenharmony_ci writel(srampool_con & ~DSP_SRAM_POOL_PD_MASK, va_dspsysreg); 20562306a36Sopenharmony_ci else 20662306a36Sopenharmony_ci writel(srampool_con | DSP_SRAM_POOL_PD_MASK, va_dspsysreg); 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci iounmap(va_dspsysreg); 20962306a36Sopenharmony_ci return 0; 21062306a36Sopenharmony_ci} 21162306a36Sopenharmony_ci 21262306a36Sopenharmony_ci/* Init the basic DSP DRAM address */ 21362306a36Sopenharmony_cistatic int adsp_memory_remap_init(struct device *dev, struct mtk_adsp_chip_info *adsp) 21462306a36Sopenharmony_ci{ 21562306a36Sopenharmony_ci void __iomem *vaddr_emi_map; 21662306a36Sopenharmony_ci int offset; 21762306a36Sopenharmony_ci 21862306a36Sopenharmony_ci if (!adsp) 21962306a36Sopenharmony_ci return -ENXIO; 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ci vaddr_emi_map = devm_ioremap(dev, DSP_EMI_MAP_ADDR, 0x4); 22262306a36Sopenharmony_ci if (!vaddr_emi_map) { 22362306a36Sopenharmony_ci dev_err(dev, "failed to ioremap emi map base %#x\n", 22462306a36Sopenharmony_ci DSP_EMI_MAP_ADDR); 22562306a36Sopenharmony_ci return -ENOMEM; 22662306a36Sopenharmony_ci } 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci offset = adsp->pa_dram - DRAM_PHYS_BASE_FROM_DSP_VIEW; 22962306a36Sopenharmony_ci adsp->dram_offset = offset; 23062306a36Sopenharmony_ci offset >>= DRAM_REMAP_SHIFT; 23162306a36Sopenharmony_ci dev_dbg(dev, "adsp->pa_dram %pa, offset %#x\n", &adsp->pa_dram, offset); 23262306a36Sopenharmony_ci writel(offset, vaddr_emi_map); 23362306a36Sopenharmony_ci if (offset != readl(vaddr_emi_map)) { 23462306a36Sopenharmony_ci dev_err(dev, "write emi map fail : %#x\n", readl(vaddr_emi_map)); 23562306a36Sopenharmony_ci return -EIO; 23662306a36Sopenharmony_ci } 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci return 0; 23962306a36Sopenharmony_ci} 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_cistatic int adsp_shared_base_ioremap(struct platform_device *pdev, void *data) 24262306a36Sopenharmony_ci{ 24362306a36Sopenharmony_ci struct device *dev = &pdev->dev; 24462306a36Sopenharmony_ci struct mtk_adsp_chip_info *adsp = data; 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci /* remap shared-dram base to be non-cachable */ 24762306a36Sopenharmony_ci adsp->shared_dram = devm_ioremap(dev, adsp->pa_shared_dram, 24862306a36Sopenharmony_ci adsp->shared_size); 24962306a36Sopenharmony_ci if (!adsp->shared_dram) { 25062306a36Sopenharmony_ci dev_err(dev, "failed to ioremap base %pa size %#x\n", 25162306a36Sopenharmony_ci adsp->shared_dram, adsp->shared_size); 25262306a36Sopenharmony_ci return -ENOMEM; 25362306a36Sopenharmony_ci } 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_ci dev_dbg(dev, "shared-dram vbase=%p, phy addr :%pa, size=%#x\n", 25662306a36Sopenharmony_ci adsp->shared_dram, &adsp->pa_shared_dram, adsp->shared_size); 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci return 0; 25962306a36Sopenharmony_ci} 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_cistatic int mt8195_run(struct snd_sof_dev *sdev) 26262306a36Sopenharmony_ci{ 26362306a36Sopenharmony_ci u32 adsp_bootup_addr; 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci adsp_bootup_addr = SRAM_PHYS_BASE_FROM_DSP_VIEW; 26662306a36Sopenharmony_ci dev_dbg(sdev->dev, "HIFIxDSP boot from base : 0x%08X\n", adsp_bootup_addr); 26762306a36Sopenharmony_ci sof_hifixdsp_boot_sequence(sdev, adsp_bootup_addr); 26862306a36Sopenharmony_ci 26962306a36Sopenharmony_ci return 0; 27062306a36Sopenharmony_ci} 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_cistatic int mt8195_dsp_probe(struct snd_sof_dev *sdev) 27362306a36Sopenharmony_ci{ 27462306a36Sopenharmony_ci struct platform_device *pdev = container_of(sdev->dev, struct platform_device, dev); 27562306a36Sopenharmony_ci struct adsp_priv *priv; 27662306a36Sopenharmony_ci int ret; 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); 27962306a36Sopenharmony_ci if (!priv) 28062306a36Sopenharmony_ci return -ENOMEM; 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci sdev->pdata->hw_pdata = priv; 28362306a36Sopenharmony_ci priv->dev = sdev->dev; 28462306a36Sopenharmony_ci priv->sdev = sdev; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci priv->adsp = devm_kzalloc(&pdev->dev, sizeof(struct mtk_adsp_chip_info), GFP_KERNEL); 28762306a36Sopenharmony_ci if (!priv->adsp) 28862306a36Sopenharmony_ci return -ENOMEM; 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci ret = platform_parse_resource(pdev, priv->adsp); 29162306a36Sopenharmony_ci if (ret) 29262306a36Sopenharmony_ci return ret; 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_ci ret = mt8195_adsp_init_clock(sdev); 29562306a36Sopenharmony_ci if (ret) { 29662306a36Sopenharmony_ci dev_err(sdev->dev, "mt8195_adsp_init_clock failed\n"); 29762306a36Sopenharmony_ci return -EINVAL; 29862306a36Sopenharmony_ci } 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci ret = adsp_clock_on(sdev); 30162306a36Sopenharmony_ci if (ret) { 30262306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_clock_on fail!\n"); 30362306a36Sopenharmony_ci return -EINVAL; 30462306a36Sopenharmony_ci } 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_ci ret = adsp_sram_power_on(sdev->dev, true); 30762306a36Sopenharmony_ci if (ret) { 30862306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_sram_power_on fail!\n"); 30962306a36Sopenharmony_ci goto exit_clk_disable; 31062306a36Sopenharmony_ci } 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci ret = adsp_memory_remap_init(&pdev->dev, priv->adsp); 31362306a36Sopenharmony_ci if (ret) { 31462306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_memory_remap_init fail!\n"); 31562306a36Sopenharmony_ci goto err_adsp_sram_power_off; 31662306a36Sopenharmony_ci } 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_ci sdev->bar[SOF_FW_BLK_TYPE_IRAM] = devm_ioremap(sdev->dev, 31962306a36Sopenharmony_ci priv->adsp->pa_sram, 32062306a36Sopenharmony_ci priv->adsp->sramsize); 32162306a36Sopenharmony_ci if (!sdev->bar[SOF_FW_BLK_TYPE_IRAM]) { 32262306a36Sopenharmony_ci dev_err(sdev->dev, "failed to ioremap base %pa size %#x\n", 32362306a36Sopenharmony_ci &priv->adsp->pa_sram, priv->adsp->sramsize); 32462306a36Sopenharmony_ci ret = -EINVAL; 32562306a36Sopenharmony_ci goto err_adsp_sram_power_off; 32662306a36Sopenharmony_ci } 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_ci priv->adsp->va_sram = sdev->bar[SOF_FW_BLK_TYPE_IRAM]; 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_ci sdev->bar[SOF_FW_BLK_TYPE_SRAM] = devm_ioremap(sdev->dev, 33162306a36Sopenharmony_ci priv->adsp->pa_dram, 33262306a36Sopenharmony_ci priv->adsp->dramsize); 33362306a36Sopenharmony_ci if (!sdev->bar[SOF_FW_BLK_TYPE_SRAM]) { 33462306a36Sopenharmony_ci dev_err(sdev->dev, "failed to ioremap base %pa size %#x\n", 33562306a36Sopenharmony_ci &priv->adsp->pa_dram, priv->adsp->dramsize); 33662306a36Sopenharmony_ci ret = -EINVAL; 33762306a36Sopenharmony_ci goto err_adsp_sram_power_off; 33862306a36Sopenharmony_ci } 33962306a36Sopenharmony_ci priv->adsp->va_dram = sdev->bar[SOF_FW_BLK_TYPE_SRAM]; 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci ret = adsp_shared_base_ioremap(pdev, priv->adsp); 34262306a36Sopenharmony_ci if (ret) { 34362306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_shared_base_ioremap fail!\n"); 34462306a36Sopenharmony_ci goto err_adsp_sram_power_off; 34562306a36Sopenharmony_ci } 34662306a36Sopenharmony_ci 34762306a36Sopenharmony_ci sdev->bar[DSP_REG_BAR] = priv->adsp->va_cfgreg; 34862306a36Sopenharmony_ci 34962306a36Sopenharmony_ci sdev->mmio_bar = SOF_FW_BLK_TYPE_SRAM; 35062306a36Sopenharmony_ci sdev->mailbox_bar = SOF_FW_BLK_TYPE_SRAM; 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci /* set default mailbox offset for FW ready message */ 35362306a36Sopenharmony_ci sdev->dsp_box.offset = mt8195_get_mailbox_offset(sdev); 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci priv->ipc_dev = platform_device_register_data(&pdev->dev, "mtk-adsp-ipc", 35662306a36Sopenharmony_ci PLATFORM_DEVID_NONE, 35762306a36Sopenharmony_ci pdev, sizeof(*pdev)); 35862306a36Sopenharmony_ci if (IS_ERR(priv->ipc_dev)) { 35962306a36Sopenharmony_ci ret = PTR_ERR(priv->ipc_dev); 36062306a36Sopenharmony_ci dev_err(sdev->dev, "failed to register mtk-adsp-ipc device\n"); 36162306a36Sopenharmony_ci goto err_adsp_sram_power_off; 36262306a36Sopenharmony_ci } 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_ci priv->dsp_ipc = dev_get_drvdata(&priv->ipc_dev->dev); 36562306a36Sopenharmony_ci if (!priv->dsp_ipc) { 36662306a36Sopenharmony_ci ret = -EPROBE_DEFER; 36762306a36Sopenharmony_ci dev_err(sdev->dev, "failed to get drvdata\n"); 36862306a36Sopenharmony_ci goto exit_pdev_unregister; 36962306a36Sopenharmony_ci } 37062306a36Sopenharmony_ci 37162306a36Sopenharmony_ci mtk_adsp_ipc_set_data(priv->dsp_ipc, priv); 37262306a36Sopenharmony_ci priv->dsp_ipc->ops = &dsp_ops; 37362306a36Sopenharmony_ci 37462306a36Sopenharmony_ci return 0; 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ciexit_pdev_unregister: 37762306a36Sopenharmony_ci platform_device_unregister(priv->ipc_dev); 37862306a36Sopenharmony_cierr_adsp_sram_power_off: 37962306a36Sopenharmony_ci adsp_sram_power_on(&pdev->dev, false); 38062306a36Sopenharmony_ciexit_clk_disable: 38162306a36Sopenharmony_ci adsp_clock_off(sdev); 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci return ret; 38462306a36Sopenharmony_ci} 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_cistatic int mt8195_dsp_shutdown(struct snd_sof_dev *sdev) 38762306a36Sopenharmony_ci{ 38862306a36Sopenharmony_ci return snd_sof_suspend(sdev->dev); 38962306a36Sopenharmony_ci} 39062306a36Sopenharmony_ci 39162306a36Sopenharmony_cistatic int mt8195_dsp_remove(struct snd_sof_dev *sdev) 39262306a36Sopenharmony_ci{ 39362306a36Sopenharmony_ci struct platform_device *pdev = container_of(sdev->dev, struct platform_device, dev); 39462306a36Sopenharmony_ci struct adsp_priv *priv = sdev->pdata->hw_pdata; 39562306a36Sopenharmony_ci 39662306a36Sopenharmony_ci platform_device_unregister(priv->ipc_dev); 39762306a36Sopenharmony_ci adsp_sram_power_on(&pdev->dev, false); 39862306a36Sopenharmony_ci adsp_clock_off(sdev); 39962306a36Sopenharmony_ci 40062306a36Sopenharmony_ci return 0; 40162306a36Sopenharmony_ci} 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_cistatic int mt8195_dsp_suspend(struct snd_sof_dev *sdev, u32 target_state) 40462306a36Sopenharmony_ci{ 40562306a36Sopenharmony_ci struct platform_device *pdev = container_of(sdev->dev, struct platform_device, dev); 40662306a36Sopenharmony_ci int ret; 40762306a36Sopenharmony_ci u32 reset_sw, dbg_pc; 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci /* wait dsp enter idle, timeout is 1 second */ 41062306a36Sopenharmony_ci ret = snd_sof_dsp_read_poll_timeout(sdev, DSP_REG_BAR, 41162306a36Sopenharmony_ci DSP_RESET_SW, reset_sw, 41262306a36Sopenharmony_ci ((reset_sw & ADSP_PWAIT) == ADSP_PWAIT), 41362306a36Sopenharmony_ci SUSPEND_DSP_IDLE_POLL_INTERVAL_US, 41462306a36Sopenharmony_ci SUSPEND_DSP_IDLE_TIMEOUT_US); 41562306a36Sopenharmony_ci if (ret < 0) { 41662306a36Sopenharmony_ci dbg_pc = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGPC); 41762306a36Sopenharmony_ci dev_warn(sdev->dev, "dsp not idle, powering off anyway : swrest %#x, pc %#x, ret %d\n", 41862306a36Sopenharmony_ci reset_sw, dbg_pc, ret); 41962306a36Sopenharmony_ci } 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_ci /* stall and reset dsp */ 42262306a36Sopenharmony_ci sof_hifixdsp_shutdown(sdev); 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci /* power down adsp sram */ 42562306a36Sopenharmony_ci ret = adsp_sram_power_on(&pdev->dev, false); 42662306a36Sopenharmony_ci if (ret) { 42762306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_sram_power_off fail!\n"); 42862306a36Sopenharmony_ci return ret; 42962306a36Sopenharmony_ci } 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci /* turn off adsp clock */ 43262306a36Sopenharmony_ci return adsp_clock_off(sdev); 43362306a36Sopenharmony_ci} 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_cistatic int mt8195_dsp_resume(struct snd_sof_dev *sdev) 43662306a36Sopenharmony_ci{ 43762306a36Sopenharmony_ci int ret; 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci /* turn on adsp clock */ 44062306a36Sopenharmony_ci ret = adsp_clock_on(sdev); 44162306a36Sopenharmony_ci if (ret) { 44262306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_clock_on fail!\n"); 44362306a36Sopenharmony_ci return ret; 44462306a36Sopenharmony_ci } 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci /* power on adsp sram */ 44762306a36Sopenharmony_ci ret = adsp_sram_power_on(sdev->dev, true); 44862306a36Sopenharmony_ci if (ret) 44962306a36Sopenharmony_ci dev_err(sdev->dev, "adsp_sram_power_on fail!\n"); 45062306a36Sopenharmony_ci 45162306a36Sopenharmony_ci return ret; 45262306a36Sopenharmony_ci} 45362306a36Sopenharmony_ci 45462306a36Sopenharmony_ci/* on mt8195 there is 1 to 1 match between type and BAR idx */ 45562306a36Sopenharmony_cistatic int mt8195_get_bar_index(struct snd_sof_dev *sdev, u32 type) 45662306a36Sopenharmony_ci{ 45762306a36Sopenharmony_ci return type; 45862306a36Sopenharmony_ci} 45962306a36Sopenharmony_ci 46062306a36Sopenharmony_cistatic int mt8195_pcm_hw_params(struct snd_sof_dev *sdev, 46162306a36Sopenharmony_ci struct snd_pcm_substream *substream, 46262306a36Sopenharmony_ci struct snd_pcm_hw_params *params, 46362306a36Sopenharmony_ci struct snd_sof_platform_stream_params *platform_params) 46462306a36Sopenharmony_ci{ 46562306a36Sopenharmony_ci platform_params->cont_update_posn = 1; 46662306a36Sopenharmony_ci 46762306a36Sopenharmony_ci return 0; 46862306a36Sopenharmony_ci} 46962306a36Sopenharmony_ci 47062306a36Sopenharmony_cistatic snd_pcm_uframes_t mt8195_pcm_pointer(struct snd_sof_dev *sdev, 47162306a36Sopenharmony_ci struct snd_pcm_substream *substream) 47262306a36Sopenharmony_ci{ 47362306a36Sopenharmony_ci int ret; 47462306a36Sopenharmony_ci snd_pcm_uframes_t pos; 47562306a36Sopenharmony_ci struct snd_sof_pcm *spcm; 47662306a36Sopenharmony_ci struct sof_ipc_stream_posn posn; 47762306a36Sopenharmony_ci struct snd_sof_pcm_stream *stream; 47862306a36Sopenharmony_ci struct snd_soc_component *scomp = sdev->component; 47962306a36Sopenharmony_ci struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream); 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_ci spcm = snd_sof_find_spcm_dai(scomp, rtd); 48262306a36Sopenharmony_ci if (!spcm) { 48362306a36Sopenharmony_ci dev_warn_ratelimited(sdev->dev, "warn: can't find PCM with DAI ID %d\n", 48462306a36Sopenharmony_ci rtd->dai_link->id); 48562306a36Sopenharmony_ci return 0; 48662306a36Sopenharmony_ci } 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci stream = &spcm->stream[substream->stream]; 48962306a36Sopenharmony_ci ret = snd_sof_ipc_msg_data(sdev, stream, &posn, sizeof(posn)); 49062306a36Sopenharmony_ci if (ret < 0) { 49162306a36Sopenharmony_ci dev_warn(sdev->dev, "failed to read stream position: %d\n", ret); 49262306a36Sopenharmony_ci return 0; 49362306a36Sopenharmony_ci } 49462306a36Sopenharmony_ci 49562306a36Sopenharmony_ci memcpy(&stream->posn, &posn, sizeof(posn)); 49662306a36Sopenharmony_ci pos = spcm->stream[substream->stream].posn.host_posn; 49762306a36Sopenharmony_ci pos = bytes_to_frames(substream->runtime, pos); 49862306a36Sopenharmony_ci 49962306a36Sopenharmony_ci return pos; 50062306a36Sopenharmony_ci} 50162306a36Sopenharmony_ci 50262306a36Sopenharmony_cistatic void mt8195_adsp_dump(struct snd_sof_dev *sdev, u32 flags) 50362306a36Sopenharmony_ci{ 50462306a36Sopenharmony_ci u32 dbg_pc, dbg_data, dbg_bus0, dbg_bus1, dbg_inst; 50562306a36Sopenharmony_ci u32 dbg_ls0stat, dbg_ls1stat, faultbus, faultinfo, swrest; 50662306a36Sopenharmony_ci 50762306a36Sopenharmony_ci /* dump debug registers */ 50862306a36Sopenharmony_ci dbg_pc = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGPC); 50962306a36Sopenharmony_ci dbg_data = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGDATA); 51062306a36Sopenharmony_ci dbg_bus0 = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGBUS0); 51162306a36Sopenharmony_ci dbg_bus1 = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGBUS1); 51262306a36Sopenharmony_ci dbg_inst = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGINST); 51362306a36Sopenharmony_ci dbg_ls0stat = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGLS0STAT); 51462306a36Sopenharmony_ci dbg_ls1stat = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PDEBUGLS1STAT); 51562306a36Sopenharmony_ci faultbus = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PFAULTBUS); 51662306a36Sopenharmony_ci faultinfo = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_PFAULTINFO); 51762306a36Sopenharmony_ci swrest = snd_sof_dsp_read(sdev, DSP_REG_BAR, DSP_RESET_SW); 51862306a36Sopenharmony_ci 51962306a36Sopenharmony_ci dev_info(sdev->dev, "adsp dump : pc %#x, data %#x, bus0 %#x, bus1 %#x, swrest %#x", 52062306a36Sopenharmony_ci dbg_pc, dbg_data, dbg_bus0, dbg_bus1, swrest); 52162306a36Sopenharmony_ci dev_info(sdev->dev, "dbg_inst %#x, ls0stat %#x, ls1stat %#x, faultbus %#x, faultinfo %#x", 52262306a36Sopenharmony_ci dbg_inst, dbg_ls0stat, dbg_ls1stat, faultbus, faultinfo); 52362306a36Sopenharmony_ci 52462306a36Sopenharmony_ci mtk_adsp_dump(sdev, flags); 52562306a36Sopenharmony_ci} 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_cistatic struct snd_soc_dai_driver mt8195_dai[] = { 52862306a36Sopenharmony_ci{ 52962306a36Sopenharmony_ci .name = "SOF_DL2", 53062306a36Sopenharmony_ci .playback = { 53162306a36Sopenharmony_ci .channels_min = 1, 53262306a36Sopenharmony_ci .channels_max = 2, 53362306a36Sopenharmony_ci }, 53462306a36Sopenharmony_ci}, 53562306a36Sopenharmony_ci{ 53662306a36Sopenharmony_ci .name = "SOF_DL3", 53762306a36Sopenharmony_ci .playback = { 53862306a36Sopenharmony_ci .channels_min = 1, 53962306a36Sopenharmony_ci .channels_max = 2, 54062306a36Sopenharmony_ci }, 54162306a36Sopenharmony_ci}, 54262306a36Sopenharmony_ci{ 54362306a36Sopenharmony_ci .name = "SOF_UL4", 54462306a36Sopenharmony_ci .capture = { 54562306a36Sopenharmony_ci .channels_min = 1, 54662306a36Sopenharmony_ci .channels_max = 2, 54762306a36Sopenharmony_ci }, 54862306a36Sopenharmony_ci}, 54962306a36Sopenharmony_ci{ 55062306a36Sopenharmony_ci .name = "SOF_UL5", 55162306a36Sopenharmony_ci .capture = { 55262306a36Sopenharmony_ci .channels_min = 1, 55362306a36Sopenharmony_ci .channels_max = 2, 55462306a36Sopenharmony_ci }, 55562306a36Sopenharmony_ci}, 55662306a36Sopenharmony_ci}; 55762306a36Sopenharmony_ci 55862306a36Sopenharmony_ci/* mt8195 ops */ 55962306a36Sopenharmony_cistatic struct snd_sof_dsp_ops sof_mt8195_ops = { 56062306a36Sopenharmony_ci /* probe and remove */ 56162306a36Sopenharmony_ci .probe = mt8195_dsp_probe, 56262306a36Sopenharmony_ci .remove = mt8195_dsp_remove, 56362306a36Sopenharmony_ci .shutdown = mt8195_dsp_shutdown, 56462306a36Sopenharmony_ci 56562306a36Sopenharmony_ci /* DSP core boot */ 56662306a36Sopenharmony_ci .run = mt8195_run, 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_ci /* Block IO */ 56962306a36Sopenharmony_ci .block_read = sof_block_read, 57062306a36Sopenharmony_ci .block_write = sof_block_write, 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci /* Mailbox IO */ 57362306a36Sopenharmony_ci .mailbox_read = sof_mailbox_read, 57462306a36Sopenharmony_ci .mailbox_write = sof_mailbox_write, 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_ci /* Register IO */ 57762306a36Sopenharmony_ci .write = sof_io_write, 57862306a36Sopenharmony_ci .read = sof_io_read, 57962306a36Sopenharmony_ci .write64 = sof_io_write64, 58062306a36Sopenharmony_ci .read64 = sof_io_read64, 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci /* ipc */ 58362306a36Sopenharmony_ci .send_msg = mt8195_send_msg, 58462306a36Sopenharmony_ci .get_mailbox_offset = mt8195_get_mailbox_offset, 58562306a36Sopenharmony_ci .get_window_offset = mt8195_get_window_offset, 58662306a36Sopenharmony_ci .ipc_msg_data = sof_ipc_msg_data, 58762306a36Sopenharmony_ci .set_stream_data_offset = sof_set_stream_data_offset, 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_ci /* misc */ 59062306a36Sopenharmony_ci .get_bar_index = mt8195_get_bar_index, 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_ci /* stream callbacks */ 59362306a36Sopenharmony_ci .pcm_open = sof_stream_pcm_open, 59462306a36Sopenharmony_ci .pcm_hw_params = mt8195_pcm_hw_params, 59562306a36Sopenharmony_ci .pcm_pointer = mt8195_pcm_pointer, 59662306a36Sopenharmony_ci .pcm_close = sof_stream_pcm_close, 59762306a36Sopenharmony_ci 59862306a36Sopenharmony_ci /* firmware loading */ 59962306a36Sopenharmony_ci .load_firmware = snd_sof_load_firmware_memcpy, 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci /* Firmware ops */ 60262306a36Sopenharmony_ci .dsp_arch_ops = &sof_xtensa_arch_ops, 60362306a36Sopenharmony_ci 60462306a36Sopenharmony_ci /* Debug information */ 60562306a36Sopenharmony_ci .dbg_dump = mt8195_adsp_dump, 60662306a36Sopenharmony_ci .debugfs_add_region_item = snd_sof_debugfs_add_region_item_iomem, 60762306a36Sopenharmony_ci 60862306a36Sopenharmony_ci /* DAI drivers */ 60962306a36Sopenharmony_ci .drv = mt8195_dai, 61062306a36Sopenharmony_ci .num_drv = ARRAY_SIZE(mt8195_dai), 61162306a36Sopenharmony_ci 61262306a36Sopenharmony_ci /* PM */ 61362306a36Sopenharmony_ci .suspend = mt8195_dsp_suspend, 61462306a36Sopenharmony_ci .resume = mt8195_dsp_resume, 61562306a36Sopenharmony_ci 61662306a36Sopenharmony_ci /* ALSA HW info flags */ 61762306a36Sopenharmony_ci .hw_info = SNDRV_PCM_INFO_MMAP | 61862306a36Sopenharmony_ci SNDRV_PCM_INFO_MMAP_VALID | 61962306a36Sopenharmony_ci SNDRV_PCM_INFO_INTERLEAVED | 62062306a36Sopenharmony_ci SNDRV_PCM_INFO_PAUSE | 62162306a36Sopenharmony_ci SNDRV_PCM_INFO_NO_PERIOD_WAKEUP, 62262306a36Sopenharmony_ci}; 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_cistatic struct snd_sof_of_mach sof_mt8195_machs[] = { 62562306a36Sopenharmony_ci { 62662306a36Sopenharmony_ci .compatible = "google,tomato", 62762306a36Sopenharmony_ci .sof_tplg_filename = "sof-mt8195-mt6359-rt1019-rt5682-dts.tplg" 62862306a36Sopenharmony_ci }, { 62962306a36Sopenharmony_ci .compatible = "mediatek,mt8195", 63062306a36Sopenharmony_ci .sof_tplg_filename = "sof-mt8195.tplg" 63162306a36Sopenharmony_ci }, { 63262306a36Sopenharmony_ci /* sentinel */ 63362306a36Sopenharmony_ci } 63462306a36Sopenharmony_ci}; 63562306a36Sopenharmony_ci 63662306a36Sopenharmony_cistatic const struct sof_dev_desc sof_of_mt8195_desc = { 63762306a36Sopenharmony_ci .of_machines = sof_mt8195_machs, 63862306a36Sopenharmony_ci .ipc_supported_mask = BIT(SOF_IPC), 63962306a36Sopenharmony_ci .ipc_default = SOF_IPC, 64062306a36Sopenharmony_ci .default_fw_path = { 64162306a36Sopenharmony_ci [SOF_IPC] = "mediatek/sof", 64262306a36Sopenharmony_ci }, 64362306a36Sopenharmony_ci .default_tplg_path = { 64462306a36Sopenharmony_ci [SOF_IPC] = "mediatek/sof-tplg", 64562306a36Sopenharmony_ci }, 64662306a36Sopenharmony_ci .default_fw_filename = { 64762306a36Sopenharmony_ci [SOF_IPC] = "sof-mt8195.ri", 64862306a36Sopenharmony_ci }, 64962306a36Sopenharmony_ci .nocodec_tplg_filename = "sof-mt8195-nocodec.tplg", 65062306a36Sopenharmony_ci .ops = &sof_mt8195_ops, 65162306a36Sopenharmony_ci .ipc_timeout = 1000, 65262306a36Sopenharmony_ci}; 65362306a36Sopenharmony_ci 65462306a36Sopenharmony_cistatic const struct of_device_id sof_of_mt8195_ids[] = { 65562306a36Sopenharmony_ci { .compatible = "mediatek,mt8195-dsp", .data = &sof_of_mt8195_desc}, 65662306a36Sopenharmony_ci { } 65762306a36Sopenharmony_ci}; 65862306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, sof_of_mt8195_ids); 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci/* DT driver definition */ 66162306a36Sopenharmony_cistatic struct platform_driver snd_sof_of_mt8195_driver = { 66262306a36Sopenharmony_ci .probe = sof_of_probe, 66362306a36Sopenharmony_ci .remove = sof_of_remove, 66462306a36Sopenharmony_ci .shutdown = sof_of_shutdown, 66562306a36Sopenharmony_ci .driver = { 66662306a36Sopenharmony_ci .name = "sof-audio-of-mt8195", 66762306a36Sopenharmony_ci .pm = &sof_of_pm, 66862306a36Sopenharmony_ci .of_match_table = sof_of_mt8195_ids, 66962306a36Sopenharmony_ci }, 67062306a36Sopenharmony_ci}; 67162306a36Sopenharmony_cimodule_platform_driver(snd_sof_of_mt8195_driver); 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ciMODULE_IMPORT_NS(SND_SOC_SOF_XTENSA); 67462306a36Sopenharmony_ciMODULE_IMPORT_NS(SND_SOC_SOF_MTK_COMMON); 67562306a36Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL"); 676