| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * arch/sh/mm/cache-sh2.c | 
 | 3 |  * | 
 | 4 |  * Copyright (C) 2002 Paul Mundt | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 5 |  * Copyright (C) 2008 Yoshinori Sato | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 |  * | 
 | 7 |  * Released under the terms of the GNU GPL v2.0. | 
 | 8 |  */ | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 9 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | #include <linux/init.h> | 
 | 11 | #include <linux/mm.h> | 
 | 12 |  | 
 | 13 | #include <asm/cache.h> | 
 | 14 | #include <asm/addrspace.h> | 
 | 15 | #include <asm/processor.h> | 
 | 16 | #include <asm/cacheflush.h> | 
 | 17 | #include <asm/io.h> | 
 | 18 |  | 
| Paul Mundt | 109b44a | 2009-08-15 12:35:15 +0900 | [diff] [blame] | 19 | static void sh2__flush_wback_region(void *start, int size) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | { | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 21 | 	unsigned long v; | 
 | 22 | 	unsigned long begin, end; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 |  | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 24 | 	begin = (unsigned long)start & ~(L1_CACHE_BYTES-1); | 
 | 25 | 	end = ((unsigned long)start + size + L1_CACHE_BYTES-1) | 
 | 26 | 		& ~(L1_CACHE_BYTES-1); | 
 | 27 | 	for (v = begin; v < end; v+=L1_CACHE_BYTES) { | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 28 | 		unsigned long addr = CACHE_OC_ADDRESS_ARRAY | (v & 0x00000ff0); | 
 | 29 | 		int way; | 
 | 30 | 		for (way = 0; way < 4; way++) { | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 31 | 			unsigned long data =  __raw_readl(addr | (way << 12)); | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 32 | 			if ((data & CACHE_PHYSADDR_MASK) == (v & CACHE_PHYSADDR_MASK)) { | 
 | 33 | 				data &= ~SH_CACHE_UPDATED; | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 34 | 				__raw_writel(data, addr | (way << 12)); | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 35 | 			} | 
 | 36 | 		} | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 37 | 	} | 
 | 38 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 |  | 
| Paul Mundt | 109b44a | 2009-08-15 12:35:15 +0900 | [diff] [blame] | 40 | static void sh2__flush_purge_region(void *start, int size) | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 41 | { | 
 | 42 | 	unsigned long v; | 
 | 43 | 	unsigned long begin, end; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 |  | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 45 | 	begin = (unsigned long)start & ~(L1_CACHE_BYTES-1); | 
 | 46 | 	end = ((unsigned long)start + size + L1_CACHE_BYTES-1) | 
 | 47 | 		& ~(L1_CACHE_BYTES-1); | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 48 |  | 
 | 49 | 	for (v = begin; v < end; v+=L1_CACHE_BYTES) | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 50 | 		__raw_writel((v & CACHE_PHYSADDR_MASK), | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 51 | 			  CACHE_OC_ADDRESS_ARRAY | (v & 0x00000ff0) | 0x00000008); | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 52 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 |  | 
| Paul Mundt | 109b44a | 2009-08-15 12:35:15 +0900 | [diff] [blame] | 54 | static void sh2__flush_invalidate_region(void *start, int size) | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 55 | { | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 56 | #ifdef CONFIG_CACHE_WRITEBACK | 
 | 57 | 	/* | 
 | 58 | 	 * SH-2 does not support individual line invalidation, only a | 
 | 59 | 	 * global invalidate. | 
 | 60 | 	 */ | 
 | 61 | 	unsigned long ccr; | 
 | 62 | 	unsigned long flags; | 
 | 63 | 	local_irq_save(flags); | 
 | 64 | 	jump_to_uncached(); | 
 | 65 |  | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 66 | 	ccr = __raw_readl(CCR); | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 67 | 	ccr |= CCR_CACHE_INVALIDATE; | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 68 | 	__raw_writel(ccr, CCR); | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 69 |  | 
 | 70 | 	back_to_cached(); | 
 | 71 | 	local_irq_restore(flags); | 
 | 72 | #else | 
| Yoshinori Sato | 9d4436a | 2006-11-05 15:40:13 +0900 | [diff] [blame] | 73 | 	unsigned long v; | 
 | 74 | 	unsigned long begin, end; | 
 | 75 |  | 
 | 76 | 	begin = (unsigned long)start & ~(L1_CACHE_BYTES-1); | 
 | 77 | 	end = ((unsigned long)start + size + L1_CACHE_BYTES-1) | 
 | 78 | 		& ~(L1_CACHE_BYTES-1); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 |  | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 80 | 	for (v = begin; v < end; v+=L1_CACHE_BYTES) | 
| Paul Mundt | 9d56dd3 | 2010-01-26 12:58:40 +0900 | [diff] [blame] | 81 | 		__raw_writel((v & CACHE_PHYSADDR_MASK), | 
| Yoshinori Sato | cce2d45 | 2008-08-04 16:33:47 +0900 | [diff] [blame] | 82 | 			  CACHE_OC_ADDRESS_ARRAY | (v & 0x00000ff0) | 0x00000008); | 
 | 83 | #endif | 
 | 84 | } | 
| Paul Mundt | 109b44a | 2009-08-15 12:35:15 +0900 | [diff] [blame] | 85 |  | 
 | 86 | void __init sh2_cache_init(void) | 
 | 87 | { | 
 | 88 | 	__flush_wback_region		= sh2__flush_wback_region; | 
 | 89 | 	__flush_purge_region		= sh2__flush_purge_region; | 
 | 90 | 	__flush_invalidate_region	= sh2__flush_invalidate_region; | 
 | 91 | } |