Orange Pi5 kernel

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