Lines Matching full:scp
27 * scp_get() - get a reference to SCP.
29 * @pdev: the platform device of the module requesting SCP platform
30 * device for using SCP API.
32 * Return: Return NULL if failed. otherwise reference to SCP.
40 scp_node = of_parse_phandle(dev->of_node, "mediatek,scp", 0); in scp_get()
42 dev_err(dev, "can't get SCP node\n"); in scp_get()
50 dev_err(dev, "SCP pdev failed\n"); in scp_get()
59 * scp_put() - "free" the SCP
61 * @scp: mtk_scp structure from scp_get().
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_elf_read_ipi_buf_addr(struct mtk_scp *scp,
126 static int scp_ipi_init(struct mtk_scp *scp, const struct firmware *fw) in scp_ipi_init() argument
132 ret = scp_elf_read_ipi_buf_addr(scp, fw, &offset); in scp_ipi_init()
135 offset = scp->data->ipi_buf_offset; in scp_ipi_init()
139 dev_info(scp->dev, "IPI buf addr %#010zx\n", offset); in scp_ipi_init()
141 scp->recv_buf = (struct mtk_share_obj __iomem *) in scp_ipi_init()
142 (scp->sram_base + offset); in scp_ipi_init()
143 scp->send_buf = (struct mtk_share_obj __iomem *) in scp_ipi_init()
144 (scp->sram_base + offset + sizeof(*scp->recv_buf)); in scp_ipi_init()
145 memset_io(scp->recv_buf, 0, sizeof(*scp->recv_buf)); in scp_ipi_init()
146 memset_io(scp->send_buf, 0, sizeof(*scp->send_buf)); in scp_ipi_init()
151 static void mt8183_scp_reset_assert(struct mtk_scp *scp) in mt8183_scp_reset_assert() argument
155 val = readl(scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_assert()
157 writel(val, scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_assert()
160 static void mt8183_scp_reset_deassert(struct mtk_scp *scp) in mt8183_scp_reset_deassert() argument
164 val = readl(scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_deassert()
166 writel(val, scp->reg_base + MT8183_SW_RSTN); in mt8183_scp_reset_deassert()
169 static void mt8192_scp_reset_assert(struct mtk_scp *scp) in mt8192_scp_reset_assert() argument
171 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_SET); in mt8192_scp_reset_assert()
174 static void mt8192_scp_reset_deassert(struct mtk_scp *scp) in mt8192_scp_reset_deassert() argument
176 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_CLR); in mt8192_scp_reset_deassert()
179 static void mt8183_scp_irq_handler(struct mtk_scp *scp) in mt8183_scp_irq_handler() argument
183 scp_to_host = readl(scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_irq_handler()
185 scp_ipi_handler(scp); in mt8183_scp_irq_handler()
187 scp_wdt_handler(scp, scp_to_host); in mt8183_scp_irq_handler()
189 /* SCP won't send another interrupt until we set SCP_TO_HOST to 0. */ in mt8183_scp_irq_handler()
191 scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_irq_handler()
194 static void mt8192_scp_irq_handler(struct mtk_scp *scp) in mt8192_scp_irq_handler() argument
198 scp_to_host = readl(scp->reg_base + MT8192_SCP2APMCU_IPC_SET); in mt8192_scp_irq_handler()
201 scp_ipi_handler(scp); in mt8192_scp_irq_handler()
204 * SCP won't send another interrupt until we clear in mt8192_scp_irq_handler()
208 scp->reg_base + MT8192_SCP2APMCU_IPC_CLR); in mt8192_scp_irq_handler()
210 scp_wdt_handler(scp, scp_to_host); in mt8192_scp_irq_handler()
211 writel(1, scp->reg_base + MT8192_CORE0_WDT_IRQ); in mt8192_scp_irq_handler()
217 struct mtk_scp *scp = priv; in scp_irq_handler() local
220 ret = clk_prepare_enable(scp->clk); in scp_irq_handler()
222 dev_err(scp->dev, "failed to enable clocks\n"); in scp_irq_handler()
226 scp->data->scp_irq_handler(scp); in scp_irq_handler()
228 clk_disable_unprepare(scp->clk); in scp_irq_handler()
289 static int scp_elf_read_ipi_buf_addr(struct mtk_scp *scp, in scp_elf_read_ipi_buf_addr() argument
315 static int mt8183_scp_before_load(struct mtk_scp *scp) in mt8183_scp_before_load() argument
317 /* Clear SCP to host interrupt */ in mt8183_scp_before_load()
318 writel(MT8183_SCP_IPC_INT_BIT, scp->reg_base + MT8183_SCP_TO_HOST); in mt8183_scp_before_load()
321 writel(0x0, scp->reg_base + MT8183_SCP_CLK_SW_SEL); in mt8183_scp_before_load()
322 writel(0x0, scp->reg_base + MT8183_SCP_CLK_DIV_SEL); in mt8183_scp_before_load()
325 writel(0x0, scp->reg_base + MT8183_SCP_L1_SRAM_PD); in mt8183_scp_before_load()
326 writel(0x0, scp->reg_base + MT8183_SCP_TCM_TAIL_SRAM_PD); in mt8183_scp_before_load()
328 /* Turn on the power of SCP's SRAM before using it. */ in mt8183_scp_before_load()
329 writel(0x0, scp->reg_base + MT8183_SCP_SRAM_PDN); in mt8183_scp_before_load()
332 * Set I-cache and D-cache size before loading SCP FW. in mt8183_scp_before_load()
333 * SCP SRAM logical address may change when cache size setting differs. in mt8183_scp_before_load()
336 scp->reg_base + MT8183_SCP_CACHE_CON); in mt8183_scp_before_load()
337 writel(MT8183_SCP_CACHESIZE_8KB, scp->reg_base + MT8183_SCP_DCACHE_CON); in mt8183_scp_before_load()
360 static int mt8192_scp_before_load(struct mtk_scp *scp) in mt8192_scp_before_load() argument
363 writel(0xff, scp->reg_base + MT8192_SCP2SPM_IPC_CLR); in mt8192_scp_before_load()
365 writel(1, scp->reg_base + MT8192_CORE0_SW_RSTN_SET); in mt8192_scp_before_load()
368 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_0); in mt8192_scp_before_load()
369 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_1); in mt8192_scp_before_load()
370 mt8192_power_on_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_2); in mt8192_scp_before_load()
371 mt8192_power_on_sram(scp->reg_base + MT8192_L1TCM_SRAM_PDN); in mt8192_scp_before_load()
372 mt8192_power_on_sram(scp->reg_base + MT8192_CPU0_SRAM_PD); in mt8192_scp_before_load()
375 writel(0xff, scp->reg_base + MT8192_CORE0_MEM_ATT_PREDEF); in mt8192_scp_before_load()
382 struct mtk_scp *scp = rproc->priv; in scp_load() local
383 struct device *dev = scp->dev; in scp_load()
386 ret = clk_prepare_enable(scp->clk); in scp_load()
392 /* Hold SCP in reset while loading FW. */ in scp_load()
393 scp->data->scp_reset_assert(scp); in scp_load()
395 ret = scp->data->scp_before_load(scp); in scp_load()
401 clk_disable_unprepare(scp->clk); in scp_load()
408 struct mtk_scp *scp = rproc->priv; in scp_parse_fw() local
409 struct device *dev = scp->dev; in scp_parse_fw()
412 ret = clk_prepare_enable(scp->clk); in scp_parse_fw()
418 ret = scp_ipi_init(scp, fw); in scp_parse_fw()
419 clk_disable_unprepare(scp->clk); in scp_parse_fw()
425 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_start() local
426 struct device *dev = scp->dev; in scp_start()
427 struct scp_run *run = &scp->run; in scp_start()
430 ret = clk_prepare_enable(scp->clk); in scp_start()
438 scp->data->scp_reset_deassert(scp); in scp_start()
446 dev_err(dev, "wait SCP initialization timeout!\n"); in scp_start()
451 dev_err(dev, "wait SCP interrupted by a signal!\n"); in scp_start()
455 clk_disable_unprepare(scp->clk); in scp_start()
456 dev_info(dev, "SCP is ready. FW version %s\n", run->fw_ver); in scp_start()
461 scp->data->scp_reset_assert(scp); in scp_start()
462 clk_disable_unprepare(scp->clk); in scp_start()
466 static void *mt8183_scp_da_to_va(struct mtk_scp *scp, u64 da, size_t len) in mt8183_scp_da_to_va() argument
470 if (da < scp->sram_size) { in mt8183_scp_da_to_va()
472 if (offset >= 0 && (offset + len) <= scp->sram_size) in mt8183_scp_da_to_va()
473 return (void __force *)scp->sram_base + offset; in mt8183_scp_da_to_va()
474 } else if (scp->dram_size) { in mt8183_scp_da_to_va()
475 offset = da - scp->dma_addr; in mt8183_scp_da_to_va()
476 if (offset >= 0 && (offset + len) <= scp->dram_size) in mt8183_scp_da_to_va()
477 return scp->cpu_addr + offset; in mt8183_scp_da_to_va()
483 static void *mt8192_scp_da_to_va(struct mtk_scp *scp, u64 da, size_t len) in mt8192_scp_da_to_va() argument
487 if (da >= scp->sram_phys && in mt8192_scp_da_to_va()
488 (da + len) <= scp->sram_phys + scp->sram_size) { in mt8192_scp_da_to_va()
489 offset = da - scp->sram_phys; in mt8192_scp_da_to_va()
490 return (void __force *)scp->sram_base + offset; in mt8192_scp_da_to_va()
494 if (scp->l1tcm_size && in mt8192_scp_da_to_va()
495 da >= scp->l1tcm_phys && in mt8192_scp_da_to_va()
496 (da + len) <= scp->l1tcm_phys + scp->l1tcm_size) { in mt8192_scp_da_to_va()
497 offset = da - scp->l1tcm_phys; in mt8192_scp_da_to_va()
498 return (void __force *)scp->l1tcm_base + offset; in mt8192_scp_da_to_va()
502 if (scp->dram_size && in mt8192_scp_da_to_va()
503 da >= scp->dma_addr && in mt8192_scp_da_to_va()
504 (da + len) <= scp->dma_addr + scp->dram_size) { in mt8192_scp_da_to_va()
505 offset = da - scp->dma_addr; in mt8192_scp_da_to_va()
506 return scp->cpu_addr + offset; in mt8192_scp_da_to_va()
514 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_da_to_va() local
516 return scp->data->scp_da_to_va(scp, da, len); in scp_da_to_va()
519 static void mt8183_scp_stop(struct mtk_scp *scp) in mt8183_scp_stop() argument
521 /* Disable SCP watchdog */ in mt8183_scp_stop()
522 writel(0, scp->reg_base + MT8183_WDT_CFG); in mt8183_scp_stop()
525 static void mt8192_scp_stop(struct mtk_scp *scp) in mt8192_scp_stop() argument
528 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_0); in mt8192_scp_stop()
529 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_1); in mt8192_scp_stop()
530 mt8192_power_off_sram(scp->reg_base + MT8192_L2TCM_SRAM_PD_2); in mt8192_scp_stop()
531 mt8192_power_off_sram(scp->reg_base + MT8192_L1TCM_SRAM_PDN); in mt8192_scp_stop()
532 mt8192_power_off_sram(scp->reg_base + MT8192_CPU0_SRAM_PD); in mt8192_scp_stop()
534 /* Disable SCP watchdog */ in mt8192_scp_stop()
535 writel(0, scp->reg_base + MT8192_CORE0_WDT_CFG); in mt8192_scp_stop()
540 struct mtk_scp *scp = (struct mtk_scp *)rproc->priv; in scp_stop() local
543 ret = clk_prepare_enable(scp->clk); in scp_stop()
545 dev_err(scp->dev, "failed to enable clocks\n"); in scp_stop()
549 scp->data->scp_reset_assert(scp); in scp_stop()
550 scp->data->scp_stop(scp); in scp_stop()
551 clk_disable_unprepare(scp->clk); in scp_stop()
565 * scp_get_device() - get device struct of SCP
567 * @scp: mtk_scp structure
569 struct device *scp_get_device(struct mtk_scp *scp) in scp_get_device() argument
571 return scp->dev; in scp_get_device()
576 * scp_get_rproc() - get rproc struct of SCP
578 * @scp: mtk_scp structure
580 struct rproc *scp_get_rproc(struct mtk_scp *scp) in scp_get_rproc() argument
582 return scp->rproc; in scp_get_rproc()
589 * @scp: mtk_scp structure
593 unsigned int scp_get_vdec_hw_capa(struct mtk_scp *scp) in scp_get_vdec_hw_capa() argument
595 return scp->run.dec_capability; in scp_get_vdec_hw_capa()
602 * @scp: mtk_scp structure
606 unsigned int scp_get_venc_hw_capa(struct mtk_scp *scp) in scp_get_venc_hw_capa() argument
608 return scp->run.enc_capability; in scp_get_venc_hw_capa()
615 * @scp: mtk_scp structure
616 * @mem_addr: SCP views memory address
618 * Mapping the SCP's SRAM address /
626 void *scp_mapping_dm_addr(struct mtk_scp *scp, u32 mem_addr) in scp_mapping_dm_addr() argument
630 ptr = scp_da_to_va(scp->rproc, mem_addr, 0, NULL); in scp_mapping_dm_addr()
638 static int scp_map_memory_region(struct mtk_scp *scp) in scp_map_memory_region() argument
642 ret = of_reserved_mem_device_init(scp->dev); in scp_map_memory_region()
646 dev_info(scp->dev, "skipping reserved memory initialization."); in scp_map_memory_region()
651 dev_err(scp->dev, "failed to assign memory-region: %d\n", ret); in scp_map_memory_region()
655 /* Reserved SCP code size */ in scp_map_memory_region()
656 scp->dram_size = MAX_CODE_SIZE; in scp_map_memory_region()
657 scp->cpu_addr = dma_alloc_coherent(scp->dev, scp->dram_size, in scp_map_memory_region()
658 &scp->dma_addr, GFP_KERNEL); in scp_map_memory_region()
659 if (!scp->cpu_addr) in scp_map_memory_region()
665 static void scp_unmap_memory_region(struct mtk_scp *scp) in scp_unmap_memory_region() argument
667 if (scp->dram_size == 0) in scp_unmap_memory_region()
670 dma_free_coherent(scp->dev, scp->dram_size, scp->cpu_addr, in scp_unmap_memory_region()
671 scp->dma_addr); in scp_unmap_memory_region()
672 of_reserved_mem_device_release(scp->dev); in scp_unmap_memory_region()
678 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_register_ipi() local
680 return scp_ipi_register(scp, id, handler, priv); in scp_register_ipi()
685 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_unregister_ipi() local
687 scp_ipi_unregister(scp, id); in scp_unregister_ipi()
693 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_send_ipi() local
695 return scp_ipi_send(scp, id, buf, len, wait); in scp_send_ipi()
705 static void scp_add_rpmsg_subdev(struct mtk_scp *scp) in scp_add_rpmsg_subdev() argument
707 scp->rpmsg_subdev = in scp_add_rpmsg_subdev()
708 mtk_rpmsg_create_rproc_subdev(to_platform_device(scp->dev), in scp_add_rpmsg_subdev()
710 if (scp->rpmsg_subdev) in scp_add_rpmsg_subdev()
711 rproc_add_subdev(scp->rproc, scp->rpmsg_subdev); in scp_add_rpmsg_subdev()
714 static void scp_remove_rpmsg_subdev(struct mtk_scp *scp) in scp_remove_rpmsg_subdev() argument
716 if (scp->rpmsg_subdev) { in scp_remove_rpmsg_subdev()
717 rproc_remove_subdev(scp->rproc, scp->rpmsg_subdev); in scp_remove_rpmsg_subdev()
718 mtk_rpmsg_destroy_rproc_subdev(scp->rpmsg_subdev); in scp_remove_rpmsg_subdev()
719 scp->rpmsg_subdev = NULL; in scp_remove_rpmsg_subdev()
727 struct mtk_scp *scp; in scp_probe() local
730 char *fw_name = "scp.img"; in scp_probe()
737 sizeof(*scp)); in scp_probe()
743 scp = (struct mtk_scp *)rproc->priv; in scp_probe()
744 scp->rproc = rproc; in scp_probe()
745 scp->dev = dev; in scp_probe()
746 scp->data = of_device_get_match_data(dev); in scp_probe()
747 platform_set_drvdata(pdev, scp); in scp_probe()
750 scp->sram_base = devm_ioremap_resource(dev, res); in scp_probe()
751 if (IS_ERR((__force void *)scp->sram_base)) { in scp_probe()
753 ret = PTR_ERR((__force void *)scp->sram_base); in scp_probe()
756 scp->sram_size = resource_size(res); in scp_probe()
757 scp->sram_phys = res->start; in scp_probe()
761 scp->l1tcm_base = devm_ioremap_resource(dev, res); in scp_probe()
762 if (IS_ERR((__force void *)scp->l1tcm_base)) { in scp_probe()
763 ret = PTR_ERR((__force void *)scp->l1tcm_base); in scp_probe()
769 scp->l1tcm_size = resource_size(res); in scp_probe()
770 scp->l1tcm_phys = res->start; in scp_probe()
773 mutex_init(&scp->send_lock); in scp_probe()
775 mutex_init(&scp->ipi_desc[i].lock); in scp_probe()
777 scp->reg_base = devm_platform_ioremap_resource_byname(pdev, "cfg"); in scp_probe()
778 if (IS_ERR((__force void *)scp->reg_base)) { in scp_probe()
780 ret = PTR_ERR((__force void *)scp->reg_base); in scp_probe()
784 ret = scp_map_memory_region(scp); in scp_probe()
788 scp->clk = devm_clk_get(dev, "main"); in scp_probe()
789 if (IS_ERR(scp->clk)) { in scp_probe()
791 ret = PTR_ERR(scp->clk); in scp_probe()
795 /* register SCP initialization IPI */ in scp_probe()
796 ret = scp_ipi_register(scp, SCP_IPI_INIT, scp_init_ipi_handler, scp); in scp_probe()
802 init_waitqueue_head(&scp->run.wq); in scp_probe()
803 init_waitqueue_head(&scp->ack_wq); in scp_probe()
805 scp_add_rpmsg_subdev(scp); in scp_probe()
809 pdev->name, scp); in scp_probe()
823 scp_remove_rpmsg_subdev(scp); in scp_probe()
824 scp_ipi_unregister(scp, SCP_IPI_INIT); in scp_probe()
826 scp_unmap_memory_region(scp); in scp_probe()
829 mutex_destroy(&scp->ipi_desc[i].lock); in scp_probe()
830 mutex_destroy(&scp->send_lock); in scp_probe()
839 struct mtk_scp *scp = platform_get_drvdata(pdev); in scp_remove() local
842 rproc_del(scp->rproc); in scp_remove()
843 scp_remove_rpmsg_subdev(scp); in scp_remove()
844 scp_ipi_unregister(scp, SCP_IPI_INIT); in scp_remove()
845 scp_unmap_memory_region(scp); in scp_remove()
847 mutex_destroy(&scp->ipi_desc[i].lock); in scp_remove()
848 mutex_destroy(&scp->send_lock); in scp_remove()
849 rproc_free(scp->rproc); in scp_remove()
878 { .compatible = "mediatek,mt8183-scp", .data = &mt8183_of_data },
879 { .compatible = "mediatek,mt8192-scp", .data = &mt8192_of_data },
888 .name = "mtk-scp",
896 MODULE_DESCRIPTION("MediaTek SCP control driver");