51 lines
		
	
	
	
		
			1.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			51 lines
		
	
	
	
		
			1.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * arch/sh/mm/cache-sh2.c | ||
|  |  * | ||
|  |  * Copyright (C) 2002 Paul Mundt | ||
|  |  * | ||
|  |  * Released under the terms of the GNU GPL v2.0. | ||
|  |  */ | ||
|  | #include <linux/init.h>
 | ||
|  | #include <linux/mm.h>
 | ||
|  | 
 | ||
|  | #include <asm/cache.h>
 | ||
|  | #include <asm/addrspace.h>
 | ||
|  | #include <asm/processor.h>
 | ||
|  | #include <asm/cacheflush.h>
 | ||
|  | #include <asm/io.h>
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Calculate the OC address and set the way bit on the SH-2. | ||
|  |  * | ||
|  |  * We must have already jump_to_P2()'ed prior to calling this | ||
|  |  * function, since we rely on CCR manipulation to do the | ||
|  |  * Right Thing(tm). | ||
|  |  */ | ||
|  | unsigned long __get_oc_addr(unsigned long set, unsigned long way) | ||
|  | { | ||
|  | 	unsigned long ccr; | ||
|  | 
 | ||
|  | 	/*
 | ||
|  | 	 * On SH-2 the way bit isn't tracked in the address field | ||
|  | 	 * if we're doing address array access .. instead, we need | ||
|  | 	 * to manually switch out the way in the CCR. | ||
|  | 	 */ | ||
|  | 	ccr = ctrl_inl(CCR); | ||
|  | 	ccr &= ~0x00c0; | ||
|  | 	ccr |= way << cpu_data->dcache.way_shift; | ||
|  | 
 | ||
|  | 	/*
 | ||
|  | 	 * Despite the number of sets being halved, we end up losing | ||
|  | 	 * the first 2 ways to OCRAM instead of the last 2 (if we're | ||
|  | 	 * 4-way). As a result, forcibly setting the W1 bit handily | ||
|  | 	 * bumps us up 2 ways. | ||
|  | 	 */ | ||
|  | 	if (ccr & CCR_CACHE_ORA) | ||
|  | 		ccr |= 1 << (cpu_data->dcache.way_shift + 1); | ||
|  | 
 | ||
|  | 	ctrl_outl(ccr, CCR); | ||
|  | 
 | ||
|  | 	return CACHE_OC_ADDRESS_ARRAY | (set << cpu_data->dcache.entry_shift); | ||
|  | } | ||
|  | 
 |