// SPDX-License-Identifier: GPL-2.0 /* Copyright (c) 2018 Rockchip Electronics Co. Ltd. */ #include #include #include #include #include #include #include #include #include #include #include #ifdef CONFIG_OF #include #endif #include "sfc.h" #include "rkflash_api.h" #include "rkflash_blk.h" #define RKSFC_VERSION_AND_DATE "rksfc_base v1.1 2016-01-08" #define RKSFC_CLK_MAX_RATE (150 * 1000 * 1000) struct rksfc_info { void __iomem *reg_base; int irq; int clk_rate; struct clk *clk; /* sfc clk*/ struct clk *ahb_clk; /* ahb clk gate*/ }; static struct rksfc_info g_sfc_info; static struct device *g_sfc_dev; static struct completion sfc_irq_complete; unsigned long rksfc_dma_map_single(unsigned long ptr, int size, int dir) { #ifdef CONFIG_ARM64 __dma_map_area((void *)ptr, size, dir); return ((unsigned long)virt_to_phys((void *)ptr)); #else return dma_map_single(NULL, (void *)ptr, size , dir ? DMA_TO_DEVICE : DMA_FROM_DEVICE); #endif } void rksfc_dma_unmap_single(unsigned long ptr, int size, int dir) { #ifdef CONFIG_ARM64 __dma_unmap_area(phys_to_virt(ptr), size, dir); #else dma_unmap_single(NULL, (dma_addr_t)ptr, size , dir ? DMA_TO_DEVICE : DMA_FROM_DEVICE); #endif } int rksfc_get_reg_addr(unsigned long *p_sfc_addr) { *p_sfc_addr = (unsigned long)g_sfc_info.reg_base; return 0; } static irqreturn_t rksfc_interrupt(int irq, void *dev_id) { sfc_clean_irq(); complete(&sfc_irq_complete); return IRQ_HANDLED; } void rksfc_irq_flag_init(void) { init_completion(&sfc_irq_complete); } void rksfc_wait_for_irq_completed(void) { wait_for_completion_timeout(&sfc_irq_complete, msecs_to_jiffies(10)); } static int rksfc_irq_config(int mode, void *pfun) { int ret = 0; int irq = g_sfc_info.irq; if (mode) ret = request_irq(irq, pfun, 0, "rksfc", g_sfc_info.reg_base); else free_irq(irq, NULL); return ret; } static int rksfc_irq_init(void) { init_completion(&sfc_irq_complete); rksfc_irq_config(1, rksfc_interrupt); return 0; } static int rksfc_irq_deinit(void) { rksfc_irq_config(0, rksfc_interrupt); return 0; } static int rksfc_probe(struct platform_device *pdev) { int irq; struct resource *mem; void __iomem *membase; int ret; g_sfc_dev = &pdev->dev; mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); membase = devm_ioremap_resource(&pdev->dev, mem); if (!membase) { dev_err(&pdev->dev, "no reg resource?\n"); return -1; } irq = platform_get_irq(pdev, 0); if (irq < 0) { dev_err(&pdev->dev, "no irq resource?\n"); return irq; } g_sfc_info.irq = irq; g_sfc_info.reg_base = membase; g_sfc_info.ahb_clk = devm_clk_get(&pdev->dev, "hclk_sfc"); g_sfc_info.clk = devm_clk_get(&pdev->dev, "clk_sfc"); if (unlikely(IS_ERR(g_sfc_info.clk)) || unlikely(IS_ERR(g_sfc_info.ahb_clk))) { dev_err(&pdev->dev, "%s get clk error\n", __func__); return -1; } clk_prepare_enable(g_sfc_info.ahb_clk); g_sfc_info.clk_rate = clk_get_rate(g_sfc_info.clk); if (g_sfc_info.clk_rate > RKSFC_CLK_MAX_RATE) { clk_set_rate(g_sfc_info.clk, RKSFC_CLK_MAX_RATE); g_sfc_info.clk_rate = clk_get_rate(g_sfc_info.clk); } clk_prepare_enable(g_sfc_info.clk); dev_info(&pdev->dev, "%s clk rate = %d\n", __func__, g_sfc_info.clk_rate); rksfc_irq_init(); ret = rkflash_dev_init(g_sfc_info.reg_base, FLASH_CON_TYPE_SFC); return ret; } static int rksfc_suspend(struct platform_device *pdev, pm_message_t state) { return rkflash_dev_suspend(); } static int rksfc_resume(struct platform_device *pdev) { return rkflash_dev_resume(g_sfc_info.reg_base); } static void rksfc_shutdown(struct platform_device *pdev) { rkflash_dev_shutdown(); } #ifdef CONFIG_OF static const struct of_device_id of_rksfc_match[] = { {.compatible = "rockchip,sfc"}, {} }; #endif static struct platform_driver rksfc_driver = { .probe = rksfc_probe, .suspend = rksfc_suspend, .resume = rksfc_resume, .shutdown = rksfc_shutdown, .driver = { .name = "rksfc", #ifdef CONFIG_OF .of_match_table = of_rksfc_match, #endif }, }; static void __exit rksfc_driver_exit(void) { rkflash_dev_exit(); rksfc_irq_deinit(); platform_driver_unregister(&rksfc_driver); } static int __init rksfc_driver_init(void) { int ret = 0; pr_err("%s\n", RKSFC_VERSION_AND_DATE); ret = platform_driver_register(&rksfc_driver); return ret; } module_init(rksfc_driver_init); module_exit(rksfc_driver_exit); MODULE_ALIAS(DRIVER_NAME);