From 25acf71835f3b0bfd0ecbb613bdfa071f11da69a Mon Sep 17 00:00:00 2001
From: hxy <hxy@rock-chips.com>
Date: Sat, 10 Mar 2012 15:55:32 +0800
Subject: [PATCH] add L2 cache controller driver

---
 arch/arm/mach-rk30/common.c | 41 +++++++++++++++++++++++++++++++++++++
 1 file changed, 41 insertions(+)

diff --git a/arch/arm/mach-rk30/common.c b/arch/arm/mach-rk30/common.c
index c223e414a6b6..ae11da0df2cd 100755
--- a/arch/arm/mach-rk30/common.c
+++ b/arch/arm/mach-rk30/common.c
@@ -5,6 +5,7 @@
 
 #include <asm/hardware/gic.h>
 #include <asm/mach/arch.h>
+#include <asm/hardware/cache-l2x0.h>
 
 #include <plat/sram.h>
 #include <mach/board.h>
@@ -12,6 +13,44 @@
 #include <mach/iomux.h>
 #include <mach/fiq.h>
 
+
+
+static void __init rk30_l2_cache_init(void)
+{
+#ifdef CONFIG_CACHE_L2X0
+	u32 aux_ctrl, aux_ctrl_mask;
+
+	//Tag Ram Latency All 1-cycle
+	writel_relaxed(0x0, RK30_L2C_BASE + L2X0_TAG_LATENCY_CTRL);
+	// Data Ram Latency [10:8] 1-cycle [6:4] 4-cycles [2:0] 2 cycles
+	writel_relaxed(0x031, RK30_L2C_BASE + L2X0_DATA_LATENCY_CTRL);
+	/*
+         * 16-way associativity, parity disabled
+         * Way size - 32KB
+         */
+	aux_ctrl = ((1 << L2X0_AUX_CTRL_ASSOCIATIVITY_SHIFT) | // 16-way
+			(0x1 << 25) | 	// round-robin
+			(0x1 << 0) |		// Full Line of Zero Enable
+			(0x1 << L2X0_AUX_CTRL_NS_LOCKDOWN_SHIFT) |
+			(0x2 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT) | // 32KB way-size
+			(0x1 << L2X0_AUX_CTRL_DATA_PREFETCH_SHIFT) |
+			(0x1 << L2X0_AUX_CTRL_INSTR_PREFETCH_SHIFT) |
+			(0x1 << L2X0_AUX_CTRL_EARLY_BRESP_SHIFT) );
+
+	aux_ctrl_mask = ~((1 << L2X0_AUX_CTRL_ASSOCIATIVITY_SHIFT) | // 16-way
+			(0x1 << 25) | 	// round-robin
+			(0x1 << 0) |		// Full Line of Zero Enable
+			(0x1 << L2X0_AUX_CTRL_NS_LOCKDOWN_SHIFT) |
+			(0x7 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT) | // 32KB way-size
+			(0x1 << L2X0_AUX_CTRL_DATA_PREFETCH_SHIFT) |
+			(0x1 << L2X0_AUX_CTRL_INSTR_PREFETCH_SHIFT) |
+			(0x1 << L2X0_AUX_CTRL_EARLY_BRESP_SHIFT) );
+
+	l2x0_init(RK30_L2C_BASE, aux_ctrl, aux_ctrl_mask);
+#endif
+}
+
+
 void __init rk30_init_irq(void)
 {
 	gic_init(0, IRQ_LOCALTIMER, RK30_GICD_BASE, RK30_GICC_BASE);
@@ -27,6 +66,7 @@ void __init rk30_map_io(void)
 	rk29_setup_early_printk();
 	rk29_sram_init();
 	rk30_clock_init();
+	rk30_l2_cache_init();
 	rk30_iomux_init();
 }
 
@@ -37,3 +77,4 @@ void __init rk30_fixup(struct machine_desc *desc, struct tag *tags,
 	mi->bank[0].start = PLAT_PHYS_OFFSET;
 	mi->bank[0].size = SZ_128M;
 }
+
-- 
2.34.1