blob: dc12394295d5e5e8a6798e9295225aeb50b5039d [file] [log] [blame]
Linus Walleij458eef2f2011-08-12 13:41:50 +02001/*
2 * Copyright (C) ST-Ericsson SA 2011
3 *
4 * License terms: GNU General Public License (GPL) version 2
5 */
6
7#include <linux/io.h>
Lee Jonesf1949ea2012-03-08 09:02:02 +00008#include <linux/of.h>
9
Linus Walleij458eef2f2011-08-12 13:41:50 +020010#include <asm/cacheflush.h>
11#include <asm/hardware/cache-l2x0.h>
12#include <mach/hardware.h>
13#include <mach/id.h>
14
15static void __iomem *l2x0_base;
16
Arnd Bergmanna3849a42011-10-08 21:47:06 +020017static int __init ux500_l2x0_unlock(void)
18{
19 int i;
20
21 /*
22 * Unlock Data and Instruction Lock if locked. Ux500 U-Boot versions
23 * apparently locks both caches before jumping to the kernel. The
24 * l2x0 core will not touch the unlock registers if the l2x0 is
25 * already enabled, so we do it right here instead. The PL310 has
26 * 8 sets of registers, one per possible CPU.
27 */
28 for (i = 0; i < 8; i++) {
29 writel_relaxed(0x0, l2x0_base + L2X0_LOCKDOWN_WAY_D_BASE +
30 i * L2X0_LOCKDOWN_STRIDE);
31 writel_relaxed(0x0, l2x0_base + L2X0_LOCKDOWN_WAY_I_BASE +
32 i * L2X0_LOCKDOWN_STRIDE);
33 }
34 return 0;
35}
36
37static int __init ux500_l2x0_init(void)
Linus Walleij458eef2f2011-08-12 13:41:50 +020038{
Linus Walleijbc71c092012-01-23 11:54:44 +010039 u32 aux_val = 0x3e000000;
40
Arnd Bergmann815aceb2012-05-14 16:29:32 +020041 if (cpu_is_u8500_family())
Linus Walleij458eef2f2011-08-12 13:41:50 +020042 l2x0_base = __io_address(U8500_L2CC_BASE);
43 else
44 ux500_unknown_soc();
45
Arnd Bergmanna3849a42011-10-08 21:47:06 +020046 /* Unlock before init */
47 ux500_l2x0_unlock();
48
Linus Walleijbc71c092012-01-23 11:54:44 +010049 /* DB9540's L2 has 128KB way size */
50 if (cpu_is_u9540())
51 /* 128KB way size */
52 aux_val |= (0x4 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT);
53 else
54 /* 64KB way size */
55 aux_val |= (0x3 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT);
56
Linus Walleij458eef2f2011-08-12 13:41:50 +020057 /* 64KB way size, 8 way associativity, force WA */
Lee Jonesf1949ea2012-03-08 09:02:02 +000058 if (of_have_populated_dt())
Linus Walleijbc71c092012-01-23 11:54:44 +010059 l2x0_of_init(aux_val, 0xc0000fff);
Lee Jonesf1949ea2012-03-08 09:02:02 +000060 else
Linus Walleijbc71c092012-01-23 11:54:44 +010061 l2x0_init(l2x0_base, aux_val, 0xc0000fff);
Linus Walleij458eef2f2011-08-12 13:41:50 +020062
srinidhi kasagardd821822012-01-17 11:29:39 +053063 /*
64 * We can't disable l2 as we are in non secure mode, currently
65 * this seems be called only during kexec path. So let's
66 * override outer.disable with nasty assignment until we have
67 * some SMI service available.
68 */
69 outer_cache.disable = NULL;
Linus Walleij458eef2f2011-08-12 13:41:50 +020070
71 return 0;
72}
73
74early_initcall(ux500_l2x0_init);