soc: rockchip: Add rockchip thunder boot sfc driver

This driver aimed at starting decompression as soon as
possible.

Change-Id: Iadf07e54047430153bc66fb1f92f85beaecf2c0d
Signed-off-by: Jon Lin <jon.lin@rock-chips.com>

drivers/soc/rockchip/Kconfig

@@ -128,10 +128,17 @@ config ROCKCHIP_THUNDER_BOOT_MMC
 	help
 	  Say y if boot from MMC.
 
+config ROCKCHIP_THUNDER_BOOT_SFC
+	bool "Rockchip Thunder Boot from SFC"
+	depends on ROCKCHIP_THUNDER_BOOT
+	help
+	  Say y if boot from SPI Flash from SFC controller.
+
 config ROCKCHIP_SCHED_PERFORMANCE_BIAS
 	bool "Rockchip task scheduler optimization"
 	default y
 	help
 	  Say y here to enable rockchip optimize task scheduler for performance bias,
 	  this would cause a little more power consumption.
+
 endif

drivers/soc/rockchip/Makefile

@@ -17,4 +17,5 @@ obj-$(CONFIG_ROCKCHIP_RAMDISK)	+= rockchip_ramdisk.o
 obj-$(CONFIG_ROCKCHIP_SUSPEND_MODE) += rockchip_pm_config.o
 obj-$(CONFIG_ROCKCHIP_SYSTEM_MONITOR) += rockchip_system_monitor.o
 obj-$(CONFIG_ROCKCHIP_THUNDER_BOOT_MMC) += rockchip_thunderboot_mmc.o
+obj-$(CONFIG_ROCKCHIP_THUNDER_BOOT_SFC) += rockchip_thunderboot_sfc.o
 obj-$(CONFIG_ROCKCHIP_DEBUG) += rockchip_debug.o

drivers/soc/rockchip/rockchip_thunderboot_sfc.c

@@ -0,0 +1,130 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (C) 2020 Rockchip Electronics Co., Ltd.
+ */
+#include <linux/iopoll.h>
+#include <linux/kernel.h>
+#include <linux/kthread.h>
+#include <linux/mm.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/of_device.h>
+#include <linux/platform_device.h>
+#include <linux/soc/rockchip/rockchip_decompress.h>
+
+#define SFC_ICLR	0x08
+#define SFC_SR		0x24
+#define SFC_RAWISR	0x28
+
+/* SFC_SR Register */
+#define SFC_BUSY	BIT(0)
+
+/* SFC_RAWISR Register */
+#define TRANSS_INT	BIT(4)
+
+static int rk_tb_sfc_thread(void *p)
+{
+	int ret = 0;
+	struct platform_device *pdev = p;
+	void __iomem *regs;
+	struct resource *res;
+	struct device_node *rds, *rdd;
+	struct device *dev = &pdev->dev;
+	u32 status;
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	regs = ioremap(res->start, resource_size(res));
+	if (!regs) {
+		dev_err(dev, "ioremap failed for resource %pR\n", res);
+		return -ENOMEM;
+	}
+
+	rds = of_parse_phandle(dev->of_node, "memory-region-src", 0);
+	rdd = of_parse_phandle(dev->of_node, "memory-region-dst", 0);
+
+	if (readl_poll_timeout(regs + SFC_RAWISR, status,
+			       status & TRANSS_INT, 100,
+			       1000 * USEC_PER_MSEC)) {
+		dev_err(dev, "DMA is still running!\n");
+		goto out;
+	} else {
+		writel_relaxed(0xFFFFFFFF, regs + SFC_ICLR);
+	}
+
+	if (readl_poll_timeout(regs + SFC_SR, status,
+			       !(status & SFC_BUSY), 100,
+			       100 * USEC_PER_MSEC)) {
+		dev_err(dev, "SFC time out!\n");
+		goto out;
+	}
+
+	/* Parse ramdisk addr and help start decompressing */
+	if (rds && rdd) {
+		struct resource src, dst;
+
+		if (of_address_to_resource(rds, 0, &src) >= 0 &&
+		    of_address_to_resource(rdd, 0, &dst) >= 0) {
+			/*
+			 * Decompress HW driver will free reserved area of
+			 * memory-region-src.
+			 */
+			ret = rk_decom_start(GZIP_MOD, src.start,
+					     dst.start,
+					     resource_size(&dst));
+			if (ret < 0)
+				dev_err(dev, "failed to start decom\n");
+		}
+	}
+
+out:
+	of_node_put(rds);
+	of_node_put(rdd);
+	iounmap(regs);
+
+	return 0;
+}
+
+static int __init rk_tb_sfc_probe(struct platform_device *pdev)
+{
+	int ret = 0;
+	struct task_struct *tsk;
+
+	tsk = kthread_run(rk_tb_sfc_thread, pdev, "tb_sfc");
+	if (IS_ERR(tsk)) {
+		ret = PTR_ERR(tsk);
+		dev_err(&pdev->dev, "start thread failed (%d)\n", ret);
+	}
+
+	return ret;
+}
+
+#ifdef CONFIG_OF
+static const struct of_device_id rk_tb_sfc_dt_match[] = {
+	{ .compatible = "rockchip,thunder-boot-sfc" },
+	{},
+};
+#endif
+
+static struct platform_driver rk_tb_sfc_driver = {
+	.driver		= {
+		.name	= "rockchip_thunder_boot_sfc",
+		.of_match_table = rk_tb_sfc_dt_match,
+	},
+};
+
+static int __init rk_tb_sfc_init(void)
+{
+	struct device_node *node;
+
+	node = of_find_matching_node(NULL, rk_tb_sfc_dt_match);
+	if (node) {
+		of_platform_device_create(node, NULL, NULL);
+		of_node_put(node);
+		return platform_driver_probe(&rk_tb_sfc_driver, rk_tb_sfc_probe);
+	}
+
+	return 0;
+}
+
+pure_initcall(rk_tb_sfc_init);