LXR linux/arch/arm/mach-ux500/cache-l2x0.c

   1/*
   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>
   8#include <linux/of.h>
   9
  10#include <asm/cacheflush.h>
  11#include <asm/hardware/cache-l2x0.h>
  12
  13#include "db8500-regs.h"
  14#include "id.h"
  15
  16static void __iomem *l2x0_base;
  17
  18static int __init ux500_l2x0_unlock(void)
  19{
  20        int i;
  21
  22        /*
  23         * Unlock Data and Instruction Lock if locked. Ux500 U-Boot versions
  24         * apparently locks both caches before jumping to the kernel. The
  25         * l2x0 core will not touch the unlock registers if the l2x0 is
  26         * already enabled, so we do it right here instead. The PL310 has
  27         * 8 sets of registers, one per possible CPU.
  28         */
  29        for (i = 0; i < 8; i++) {
  30                writel_relaxed(0x0, l2x0_base + L2X0_LOCKDOWN_WAY_D_BASE +
  31                               i * L2X0_LOCKDOWN_STRIDE);
  32                writel_relaxed(0x0, l2x0_base + L2X0_LOCKDOWN_WAY_I_BASE +
  33                               i * L2X0_LOCKDOWN_STRIDE);
  34        }
  35        return 0;
  36}
  37
  38static int __init ux500_l2x0_init(void)
  39{
  40        u32 aux_val = 0x3e000000;
  41
  42        if (cpu_is_u8500_family() || cpu_is_ux540_family())
  43                l2x0_base = __io_address(U8500_L2CC_BASE);
  44        else
  45                /* Non-Ux500 platform */
  46                return -ENODEV;
  47
  48        /* Unlock before init */
  49        ux500_l2x0_unlock();
  50
  51        /* DBx540's L2 has 128KB way size */
  52        if (cpu_is_ux540_family())
  53                /* 128KB way size */
  54                aux_val |= (0x4 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT);
  55        else
  56                /* 64KB way size */
  57                aux_val |= (0x3 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT);
  58
  59        /* 64KB way size, 8 way associativity, force WA */
  60        if (of_have_populated_dt())
  61                l2x0_of_init(aux_val, 0xc0000fff);
  62        else
  63                l2x0_init(l2x0_base, aux_val, 0xc0000fff);
  64
  65        /*
  66         * We can't disable l2 as we are in non secure mode, currently
  67         * this seems be called only during kexec path. So let's
  68         * override outer.disable with nasty assignment until we have
  69         * some SMI service available.
  70         */
  71        outer_cache.disable = NULL;
  72
  73        return 0;
  74}
  75
  76early_initcall(ux500_l2x0_init);
  77