60 lines
1.5 KiB
C
60 lines
1.5 KiB
C
|
/*
|
||
|
* 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);
|