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); |