hc
2023-02-14 0cc9b7c44253c93447ddf73e206fbdbb3d9f16b1
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
/*
 * arch/sh/kernel/cpu/sh5/probe.c
 *
 * CPU Subtype Probing for SH-5.
 *
 * Copyright (C) 2000, 2001  Paolo Alberelli
 * Copyright (C) 2003 - 2007  Paul Mundt
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 */
#include <linux/init.h>
#include <linux/io.h>
#include <linux/string.h>
#include <asm/processor.h>
#include <asm/cache.h>
#include <asm/tlb.h>
 
void cpu_probe(void)
{
   unsigned long long cir;
 
   /*
    * Do peeks in real mode to avoid having to set up a mapping for
    * the WPC registers. On SH5-101 cut2, such a mapping would be
    * exposed to an address translation erratum which would make it
    * hard to set up correctly.
    */
   cir = peek_real_address_q(0x0d000008);
   if ((cir & 0xffff) == 0x5103)
       boot_cpu_data.type = CPU_SH5_103;
   else if (((cir >> 32) & 0xffff) == 0x51e2)
       /* CPU.VCR aliased at CIR address on SH5-101 */
       boot_cpu_data.type = CPU_SH5_101;
 
   boot_cpu_data.family = CPU_FAMILY_SH5;
 
   /*
    * First, setup some sane values for the I-cache.
    */
   boot_cpu_data.icache.ways        = 4;
   boot_cpu_data.icache.sets        = 256;
   boot_cpu_data.icache.linesz        = L1_CACHE_BYTES;
   boot_cpu_data.icache.way_incr        = (1 << 13);
   boot_cpu_data.icache.entry_shift    = 5;
   boot_cpu_data.icache.way_size        = boot_cpu_data.icache.sets *
                         boot_cpu_data.icache.linesz;
   boot_cpu_data.icache.entry_mask        = 0x1fe0;
   boot_cpu_data.icache.flags        = 0;
 
   /*
    * Next, setup some sane values for the D-cache.
    *
    * On the SH5, these are pretty consistent with the I-cache settings,
    * so we just copy over the existing definitions.. these can be fixed
    * up later, especially if we add runtime CPU probing.
    *
    * Though in the meantime it saves us from having to duplicate all of
    * the above definitions..
    */
   boot_cpu_data.dcache        = boot_cpu_data.icache;
 
   /*
    * Setup any cache-related flags here
    */
#if defined(CONFIG_CACHE_WRITETHROUGH)
   set_bit(SH_CACHE_MODE_WT, &(boot_cpu_data.dcache.flags));
#elif defined(CONFIG_CACHE_WRITEBACK)
   set_bit(SH_CACHE_MODE_WB, &(boot_cpu_data.dcache.flags));
#endif
 
   /* Setup some I/D TLB defaults */
   sh64_tlb_init();
}