probe.c (2887B)
1// SPDX-License-Identifier: GPL-2.0 2/* 3 * arch/sh/kernel/cpu/sh3/probe.c 4 * 5 * CPU Subtype Probing for SH-3. 6 * 7 * Copyright (C) 1999, 2000 Niibe Yutaka 8 * Copyright (C) 2002 Paul Mundt 9 */ 10 11#include <linux/init.h> 12#include <asm/processor.h> 13#include <asm/cache.h> 14#include <asm/io.h> 15 16void cpu_probe(void) 17{ 18 unsigned long addr0, addr1, data0, data1, data2, data3; 19 20 jump_to_uncached(); 21 /* 22 * Check if the entry shadows or not. 23 * When shadowed, it's 128-entry system. 24 * Otherwise, it's 256-entry system. 25 */ 26 addr0 = CACHE_OC_ADDRESS_ARRAY + (3 << 12); 27 addr1 = CACHE_OC_ADDRESS_ARRAY + (1 << 12); 28 29 /* First, write back & invalidate */ 30 data0 = __raw_readl(addr0); 31 __raw_writel(data0&~(SH_CACHE_VALID|SH_CACHE_UPDATED), addr0); 32 data1 = __raw_readl(addr1); 33 __raw_writel(data1&~(SH_CACHE_VALID|SH_CACHE_UPDATED), addr1); 34 35 /* Next, check if there's shadow or not */ 36 data0 = __raw_readl(addr0); 37 data0 ^= SH_CACHE_VALID; 38 __raw_writel(data0, addr0); 39 data1 = __raw_readl(addr1); 40 data2 = data1 ^ SH_CACHE_VALID; 41 __raw_writel(data2, addr1); 42 data3 = __raw_readl(addr0); 43 44 /* Lastly, invaliate them. */ 45 __raw_writel(data0&~SH_CACHE_VALID, addr0); 46 __raw_writel(data2&~SH_CACHE_VALID, addr1); 47 48 back_to_cached(); 49 50 boot_cpu_data.dcache.ways = 4; 51 boot_cpu_data.dcache.entry_shift = 4; 52 boot_cpu_data.dcache.linesz = L1_CACHE_BYTES; 53 boot_cpu_data.dcache.flags = 0; 54 55 /* 56 * 7709A/7729 has 16K cache (256-entry), while 7702 has only 57 * 2K(direct) 7702 is not supported (yet) 58 */ 59 if (data0 == data1 && data2 == data3) { /* Shadow */ 60 boot_cpu_data.dcache.way_incr = (1 << 11); 61 boot_cpu_data.dcache.entry_mask = 0x7f0; 62 boot_cpu_data.dcache.sets = 128; 63 boot_cpu_data.type = CPU_SH7708; 64 65 boot_cpu_data.flags |= CPU_HAS_MMU_PAGE_ASSOC; 66 } else { /* 7709A or 7729 */ 67 boot_cpu_data.dcache.way_incr = (1 << 12); 68 boot_cpu_data.dcache.entry_mask = 0xff0; 69 boot_cpu_data.dcache.sets = 256; 70 boot_cpu_data.type = CPU_SH7729; 71 72#if defined(CONFIG_CPU_SUBTYPE_SH7706) 73 boot_cpu_data.type = CPU_SH7706; 74#endif 75#if defined(CONFIG_CPU_SUBTYPE_SH7710) 76 boot_cpu_data.type = CPU_SH7710; 77#endif 78#if defined(CONFIG_CPU_SUBTYPE_SH7712) 79 boot_cpu_data.type = CPU_SH7712; 80#endif 81#if defined(CONFIG_CPU_SUBTYPE_SH7720) 82 boot_cpu_data.type = CPU_SH7720; 83#endif 84#if defined(CONFIG_CPU_SUBTYPE_SH7721) 85 boot_cpu_data.type = CPU_SH7721; 86#endif 87#if defined(CONFIG_CPU_SUBTYPE_SH7705) 88 boot_cpu_data.type = CPU_SH7705; 89 90#if defined(CONFIG_SH7705_CACHE_32KB) 91 boot_cpu_data.dcache.way_incr = (1 << 13); 92 boot_cpu_data.dcache.entry_mask = 0x1ff0; 93 boot_cpu_data.dcache.sets = 512; 94 __raw_writel(CCR_CACHE_32KB, CCR3_REG); 95#else 96 __raw_writel(CCR_CACHE_16KB, CCR3_REG); 97#endif 98#endif 99 } 100 101 /* 102 * SH-3 doesn't have separate caches 103 */ 104 boot_cpu_data.dcache.flags |= SH_CACHE_COMBINED; 105 boot_cpu_data.icache = boot_cpu_data.dcache; 106 107 boot_cpu_data.family = CPU_FAMILY_SH3; 108}