CRIS v32: Add L2 cache initialization code.

1 files changed, 29 insertions, 0 deletions

diff --git a/arch/cris/arch-v32/mm/l2cache.c b/arch/cris/arch-v32/mm/l2cache.c
new file mode 100644
index 000000000000..332ff10dcc6b
--- /dev/null
+++ b/arch/cris/arch-v32/mm/l2cache.c
@@ -0,0 +1,29 @@
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/string.h>
+#include <memmap.h>
+#include <hwregs/reg_map.h>
+#include <hwregs/reg_rdwr.h>
+#include <hwregs/l2cache_defs.h>
+#include <asm/io.h>
+
+#define L2CACHE_SIZE 64
+
+int __init l2cache_init(void)
+{
+        reg_l2cache_rw_ctrl ctrl = {0};
+        reg_l2cache_rw_cfg cfg = {.en = regk_l2cache_yes};
+
+        ctrl.csize = L2CACHE_SIZE;
+        ctrl.cbase = L2CACHE_SIZE / 4 + (L2CACHE_SIZE % 4 ? 1 : 0);
+        REG_WR(l2cache, regi_l2cache, rw_ctrl, ctrl);
+
+        /* Flush the tag memory */
+        memset((void *)(MEM_INTMEM_START | MEM_NON_CACHEABLE), 0, 2*1024);
+
+        /* Enable the cache */
+        REG_WR(l2cache, regi_l2cache, rw_cfg, cfg);
+
+        return 0;
+}
+