Lines Matching refs:scp
63 void scp_put(struct mtk_scp *scp) in scp_put() argument
65 put_device(scp->dev); in scp_put()
69 static void scp_wdt_handler(struct mtk_scp *scp, u32 scp_to_host) in scp_wdt_handler() argument
71 dev_err(scp->dev, "SCP watchdog timeout! 0x%x", scp_to_host); in scp_wdt_handler()
72 rproc_report_crash(scp->rproc, RPROC_WATCHDOG); in scp_wdt_handler()
77 struct mtk_scp *scp = (struct mtk_scp *)priv; in scp_init_ipi_handler() local
80 scp->run.signaled = run->signaled; in scp_init_ipi_handler()
81 strscpy(scp->run.fw_ver, run->fw_ver, SCP_FW_VER_LEN); in scp_init_ipi_handler()
82 scp->run.dec_capability = run->dec_capability; in scp_init_ipi_handler()
83 scp->run.enc_capability = run->enc_capability; in scp_init_ipi_handler()
84 wake_up_interruptible(&scp->run.wq); in scp_init_ipi_handler()
87 static void scp_ipi_handler(struct mtk_scp *scp) in scp_ipi_handler() argument
89 struct mtk_share_obj __iomem *rcv_obj = scp->recv_buf; in scp_ipi_handler()
90 struct scp_ipi_desc *ipi_desc = scp->ipi_desc; in scp_ipi_handler()
97 dev_err(scp->dev, "ipi message too long (len %d, max %d)", len, in scp_ipi_handler()
102 dev_err(scp->dev, "No such ipi id = %d\n", id); in scp_ipi_handler()
106 scp_ipi_lock(scp, id); in scp_ipi_handler()
109 dev_err(scp->dev, "No such ipi id = %d\n", id); in scp_ipi_handler()
110 scp_ipi_unlock(scp, id); in scp_ipi_handler()
116 scp_ipi_unlock(scp, id); in scp_ipi_handler()
118 scp->ipi_id_ack[id] = true; in scp_ipi_handler()
119 wake_up(&scp->ack_wq); in scp_ipi_handler()
122 static int scp_ipi_init(struct mtk_scp *scp) in scp_ipi_init() argument
128 scp->recv_buf = in scp_ipi_init()
129 (struct mtk_share_obj __iomem *)(scp->sram_base + recv_offset); in scp_ipi_init()
130 scp->send_buf = in scp_ipi_init()
131 (struct mtk_share_obj __iomem *)(scp->sram_base + send_offset); in scp_ipi_init()
132 memset_io(scp->recv_buf, 0, sizeof(*scp->recv_buf)); in scp_ipi_init()
133 memset_io(scp->send_buf, 0, sizeof(*scp->send_buf)); in scp_ipi_init()
138 static void mt8183_scp_reset_assert(struct mtk_scp *scp) in mt8183_scp_reset_assert() argument
142 val = readl(scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_assert()
144 writel(val, scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_assert()
147 static void mt8183_scp_reset_deassert(struct mtk_scp *scp) in mt8183_scp_reset_deassert() argument
151 val = readl(scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_deassert()
153 writel(val, scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_deassert()
156 static void mt8192_scp_reset_assert(struct mtk_scp *scp) in mt8192_scp_reset_assert() argument
158 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_SET); in mt8192_scp_reset_assert()
161 static void mt8192_scp_reset_deassert(struct mtk_scp *scp) in mt8192_scp_reset_deassert() argument
163 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_CLR); in mt8192_scp_reset_deassert()
166 static void mt8183_scp_irq_handler(struct mtk_scp *scp) in mt8183_scp_irq_handler() argument
170 scp_to_host = readl(scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_irq_handler()
172 scp_ipi_handler(scp); in mt8183_scp_irq_handler()
174 scp_wdt_handler(scp, scp_to_host); in mt8183_scp_irq_handler()
178 scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_irq_handler()
181 static void mt8192_scp_irq_handler(struct mtk_scp *scp) in mt8192_scp_irq_handler() argument
185 scp_to_host = readl(scp->reg_base + MT8192_SCP2APMCU_IPC_SET); in mt8192_scp_irq_handler()
188 scp_ipi_handler(scp); in mt8192_scp_irq_handler()
195 scp->reg_base + MT8192_SCP2APMCU_IPC_CLR); in mt8192_scp_irq_handler()
197 scp_wdt_handler(scp, scp_to_host); in mt8192_scp_irq_handler()
198 writel(1, scp->reg_base + MT8192_CORE0_WDT_IRQ); in mt8192_scp_irq_handler()
204 struct mtk_scp *scp = priv; in scp_irq_handler() local
207 ret = clk_prepare_enable(scp->clk); in scp_irq_handler()
209 dev_err(scp->dev, "failed to enable clocks\n"); in scp_irq_handler()
213 scp->data->scp_irq_handler(scp); in scp_irq_handler()
215 clk_disable_unprepare(scp->clk); in scp_irq_handler()
276 static int mt8183_scp_before_load(struct mtk_scp *scp) in mt8183_scp_before_load() argument
279 writel(MT8183_SCP_IPC_INT_BIT, scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_before_load()
282 writel(0x0, scp->reg_base + MT8183_SCP_CLK_SW_SEL); in mt8183_scp_before_load()
283 writel(0x0, scp->reg_base + MT8183_SCP_CLK_DIV_SEL); in mt8183_scp_before_load()
286 writel(0x0, scp->reg_base + MT8183_SCP_L1_SRAM_PD); in mt8183_scp_before_load()
287 writel(0x0, scp->reg_base + MT8183_SCP_TCM_TAIL_SRAM_PD); in mt8183_scp_before_load()
290 writel(0x0, scp->reg_base + MT8183_SCP_SRAM_PDN); in mt8183_scp_before_load()
297 scp->reg_base + MT8183_SCP_CACHE_CON); in mt8183_scp_before_load()
298 writel(MT8183_SCP_CACHESIZE_8KB, scp->reg_base + MT8183_SCP_DCACHE_CON); in mt8183_scp_before_load()
321 static int mt8192_scp_before_load(struct mtk_scp *scp) in mt8192_scp_before_load() argument
324 writel(0xff, scp->reg_base + MT8192_SCP2SPM_IPC_CLR); in mt8192_scp_before_load()
326 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_SET); in mt8192_scp_before_load()
329 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_0); in mt8192_scp_before_load()
330 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_1); in mt8192_scp_before_load()
331 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_2); in mt8192_scp_before_load()
332 mt8192_power_on_sram(scp->reg_base + MT8192_L1TCM_SRAM_PDN); in mt8192_scp_before_load()
333 mt8192_power_on_sram(scp->reg_base + MT8192_CPU0_SRAM_PD); in mt8192_scp_before_load()
340 struct mtk_scp *scp = rproc->priv; in scp_load() local
341 struct device *dev = scp->dev; in scp_load()
344 ret = clk_prepare_enable(scp->clk); in scp_load()
351 scp->data->scp_reset_assert(scp); in scp_load()
353 ret = scp->data->scp_before_load(scp); in scp_load()
359 clk_disable_unprepare(scp->clk); in scp_load()
366 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_start() local
367 struct device *dev = scp->dev; in scp_start()
368 struct scp_run *run = &scp->run; in scp_start()
371 ret = clk_prepare_enable(scp->clk); in scp_start()
379 scp->data->scp_reset_deassert(scp); in scp_start()
396 clk_disable_unprepare(scp->clk); in scp_start()
402 scp->data->scp_reset_assert(scp); in scp_start()
403 clk_disable_unprepare(scp->clk); in scp_start()
409 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_da_to_va() local
412 if (da < scp->sram_size) { in scp_da_to_va()
414 if (offset >= 0 && (offset + len) < scp->sram_size) in scp_da_to_va()
415 return (void __force *)scp->sram_base + offset; in scp_da_to_va()
416 } else if (scp->dram_size) { in scp_da_to_va()
417 offset = da - scp->dma_addr; in scp_da_to_va()
418 if (offset >= 0 && (offset + len) < scp->dram_size) in scp_da_to_va()
419 return (void __force *)scp->cpu_addr + offset; in scp_da_to_va()
425 static void mt8183_scp_stop(struct mtk_scp *scp) in mt8183_scp_stop() argument
428 writel(0, scp->reg_base + MT8183_WDT_CFG); in mt8183_scp_stop()
431 static void mt8192_scp_stop(struct mtk_scp *scp) in mt8192_scp_stop() argument
434 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_0); in mt8192_scp_stop()
435 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_1); in mt8192_scp_stop()
436 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_2); in mt8192_scp_stop()
437 mt8192_power_off_sram(scp->reg_base + MT8192_L1TCM_SRAM_PDN); in mt8192_scp_stop()
438 mt8192_power_off_sram(scp->reg_base + MT8192_CPU0_SRAM_PD); in mt8192_scp_stop()
441 writel(0, scp->reg_base + MT8192_CORE0_WDT_CFG); in mt8192_scp_stop()
446 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_stop() local
449 ret = clk_prepare_enable(scp->clk); in scp_stop()
451 dev_err(scp->dev, "failed to enable clocks\n"); in scp_stop()
455 scp->data->scp_reset_assert(scp); in scp_stop()
456 scp->data->scp_stop(scp); in scp_stop()
457 clk_disable_unprepare(scp->clk); in scp_stop()
474 struct device *scp_get_device(struct mtk_scp *scp) in scp_get_device() argument
476 return scp->dev; in scp_get_device()
485 struct rproc *scp_get_rproc(struct mtk_scp *scp) in scp_get_rproc() argument
487 return scp->rproc; in scp_get_rproc()
498 unsigned int scp_get_vdec_hw_capa(struct mtk_scp *scp) in scp_get_vdec_hw_capa() argument
500 return scp->run.dec_capability; in scp_get_vdec_hw_capa()
511 unsigned int scp_get_venc_hw_capa(struct mtk_scp *scp) in scp_get_venc_hw_capa() argument
513 return scp->run.enc_capability; in scp_get_venc_hw_capa()
531 void *scp_mapping_dm_addr(struct mtk_scp *scp, u32 mem_addr) in scp_mapping_dm_addr() argument
535 ptr = scp_da_to_va(scp->rproc, mem_addr, 0); in scp_mapping_dm_addr()
543 static int scp_map_memory_region(struct mtk_scp *scp) in scp_map_memory_region() argument
547 ret = of_reserved_mem_device_init(scp->dev); in scp_map_memory_region()
551 dev_info(scp->dev, "skipping reserved memory initialization."); in scp_map_memory_region()
556 dev_err(scp->dev, "failed to assign memory-region: %d\n", ret); in scp_map_memory_region()
561 scp->dram_size = MAX_CODE_SIZE; in scp_map_memory_region()
562 scp->cpu_addr = dma_alloc_coherent(scp->dev, scp->dram_size, in scp_map_memory_region()
563 &scp->dma_addr, GFP_KERNEL); in scp_map_memory_region()
564 if (!scp->cpu_addr) in scp_map_memory_region()
570 static void scp_unmap_memory_region(struct mtk_scp *scp) in scp_unmap_memory_region() argument
572 if (scp->dram_size == 0) in scp_unmap_memory_region()
575 dma_free_coherent(scp->dev, scp->dram_size, scp->cpu_addr, in scp_unmap_memory_region()
576 scp->dma_addr); in scp_unmap_memory_region()
577 of_reserved_mem_device_release(scp->dev); in scp_unmap_memory_region()
583 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_register_ipi() local
585 return scp_ipi_register(scp, id, handler, priv); in scp_register_ipi()
590 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_unregister_ipi() local
592 scp_ipi_unregister(scp, id); in scp_unregister_ipi()
598 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_send_ipi() local
600 return scp_ipi_send(scp, id, buf, len, wait); in scp_send_ipi()
610 static void scp_add_rpmsg_subdev(struct mtk_scp *scp) in scp_add_rpmsg_subdev() argument
612 scp->rpmsg_subdev = in scp_add_rpmsg_subdev()
613 mtk_rpmsg_create_rproc_subdev(to_platform_device(scp->dev), in scp_add_rpmsg_subdev()
615 if (scp->rpmsg_subdev) in scp_add_rpmsg_subdev()
616 rproc_add_subdev(scp->rproc, scp->rpmsg_subdev); in scp_add_rpmsg_subdev()
619 static void scp_remove_rpmsg_subdev(struct mtk_scp *scp) in scp_remove_rpmsg_subdev() argument
621 if (scp->rpmsg_subdev) { in scp_remove_rpmsg_subdev()
622 rproc_remove_subdev(scp->rproc, scp->rpmsg_subdev); in scp_remove_rpmsg_subdev()
623 mtk_rpmsg_destroy_rproc_subdev(scp->rpmsg_subdev); in scp_remove_rpmsg_subdev()
624 scp->rpmsg_subdev = NULL; in scp_remove_rpmsg_subdev()
632 struct mtk_scp *scp; in scp_probe() local
642 sizeof(*scp)); in scp_probe()
648 scp = (struct mtk_scp *)rproc->priv; in scp_probe()
649 scp->rproc = rproc; in scp_probe()
650 scp->dev = dev; in scp_probe()
651 scp->data = of_device_get_match_data(dev); in scp_probe()
652 platform_set_drvdata(pdev, scp); in scp_probe()
655 scp->sram_base = devm_ioremap_resource(dev, res); in scp_probe()
656 if (IS_ERR((__force void *)scp->sram_base)) { in scp_probe()
658 ret = PTR_ERR((__force void *)scp->sram_base); in scp_probe()
661 scp->sram_size = resource_size(res); in scp_probe()
663 mutex_init(&scp->send_lock); in scp_probe()
665 mutex_init(&scp->ipi_desc[i].lock); in scp_probe()
668 scp->reg_base = devm_ioremap_resource(dev, res); in scp_probe()
669 if (IS_ERR((__force void *)scp->reg_base)) { in scp_probe()
671 ret = PTR_ERR((__force void *)scp->reg_base); in scp_probe()
675 ret = scp_map_memory_region(scp); in scp_probe()
679 scp->clk = devm_clk_get(dev, "main"); in scp_probe()
680 if (IS_ERR(scp->clk)) { in scp_probe()
682 ret = PTR_ERR(scp->clk); in scp_probe()
686 ret = clk_prepare_enable(scp->clk); in scp_probe()
692 ret = scp_ipi_init(scp); in scp_probe()
693 clk_disable_unprepare(scp->clk); in scp_probe()
700 ret = scp_ipi_register(scp, SCP_IPI_INIT, scp_init_ipi_handler, scp); in scp_probe()
706 init_waitqueue_head(&scp->run.wq); in scp_probe()
707 init_waitqueue_head(&scp->ack_wq); in scp_probe()
709 scp_add_rpmsg_subdev(scp); in scp_probe()
713 pdev->name, scp); in scp_probe()
727 scp_remove_rpmsg_subdev(scp); in scp_probe()
728 scp_ipi_unregister(scp, SCP_IPI_INIT); in scp_probe()
730 scp_unmap_memory_region(scp); in scp_probe()
733 mutex_destroy(&scp->ipi_desc[i].lock); in scp_probe()
734 mutex_destroy(&scp->send_lock); in scp_probe()
743 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_remove() local
746 rproc_del(scp->rproc); in scp_remove()
747 scp_remove_rpmsg_subdev(scp); in scp_remove()
748 scp_ipi_unregister(scp, SCP_IPI_INIT); in scp_remove()
749 scp_unmap_memory_region(scp); in scp_remove()
751 mutex_destroy(&scp->ipi_desc[i].lock); in scp_remove()
752 mutex_destroy(&scp->send_lock); in scp_remove()
753 rproc_free(scp->rproc); in scp_remove()