2 files changed, 60 insertions, 0 deletions

diff --git a/arch/arm/mach-prima2/Makefile b/arch/arm/mach-prima2/Makefile
index f2fba666c109..7af7fc05d565 100644
--- a/arch/arm/mach-prima2/Makefile
+++ b/arch/arm/mach-prima2/Makefile
@@ -4,3 +4,4 @@ obj-y += clock.o
 obj-y += rstc.o
 obj-y += prima2.o
 obj-$(CONFIG_DEBUG_LL) += lluart.o
+obj-$(CONFIG_CACHE_L2X0) += l2x0.o
diff --git a/arch/arm/mach-prima2/l2x0.c b/arch/arm/mach-prima2/l2x0.c
new file mode 100644
index 000000000000..9cda2057bcfb
--- /dev/null
+++ b/arch/arm/mach-prima2/l2x0.c
@@ -0,0 +1,59 @@
+/*
+ * l2 cache initialization for CSR SiRFprimaII
+ *
+ * Copyright (c) 2011 Cambridge Silicon Radio Limited, a CSR plc group company.
+ *
+ * Licensed under GPLv2 or later.
+ */
+
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/io.h>
+#include <linux/errno.h>
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <asm/hardware/cache-l2x0.h>
+#include <mach/memory.h>
+
+#define L2X0_ADDR_FILTERING_START       0xC00
+#define L2X0_ADDR_FILTERING_END         0xC04
+
+static struct of_device_id l2x_ids[]  = {
+        { .compatible = "arm,pl310-cache" },
+};
+
+static int __init sirfsoc_of_l2x_init(void)
+{
+        struct device_node *np;
+        void __iomem *sirfsoc_l2x_base;
+
+        np = of_find_matching_node(NULL, l2x_ids);
+        if (!np)
+                panic("unable to find compatible l2x node in dtb\n");
+
+        sirfsoc_l2x_base = of_iomap(np, 0);
+        if (!sirfsoc_l2x_base)
+                panic("unable to map l2x cpu registers\n");
+
+        of_node_put(np);
+
+        if (!(readl_relaxed(sirfsoc_l2x_base + L2X0_CTRL) & 1)) {
+                /*
+                 * set the physical memory windows L2 cache will cover
+                 */
+                writel_relaxed(PLAT_PHYS_OFFSET + 1024 * 1024 * 1024,
+                        sirfsoc_l2x_base + L2X0_ADDR_FILTERING_END);
+                writel_relaxed(PLAT_PHYS_OFFSET | 0x1,
+                        sirfsoc_l2x_base + L2X0_ADDR_FILTERING_START);
+
+                writel_relaxed(0,
+                        sirfsoc_l2x_base + L2X0_TAG_LATENCY_CTRL);
+                writel_relaxed(0,
+                        sirfsoc_l2x_base + L2X0_DATA_LATENCY_CTRL);
+        }
+        l2x0_init((void __iomem *)sirfsoc_l2x_base, 0x00040000,
+                0x00000000);
+
+        return 0;
+}
+early_initcall(sirfsoc_of_l2x_init);