hc
2024-05-10 61598093bbdd283a7edc367d900f223070ead8d2
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
76
77
78
79
80
81
82
83
84
85
86
/*
 * 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.
 *
 * Copyright (C) 2005 Embedded Alley Solutions, Inc
 * Copyright (C) 2005 Ralf Baechle (ralf@linux-mips.org)
 * Copyright (C) 2009 Jiajie Chen (chenjiajie@cse.buaa.edu.cn)
 * Copyright (C) 2012 Huacai Chen (chenhc@lemote.com)
 */
#ifndef __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H
#define __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H
 
#include <asm/cpu.h>
 
/*
 * Override macros used in arch/mips/kernel/head.S.
 */
   .macro    kernel_entry_setup
   .set    push
   .set    mips64
   /* Set LPA on LOONGSON3 config3 */
   mfc0    t0, CP0_CONFIG3
   or    t0, (0x1 << 7)
   mtc0    t0, CP0_CONFIG3
   /* Set ELPA on LOONGSON3 pagegrain */
   mfc0    t0, CP0_PAGEGRAIN
   or    t0, (0x1 << 29)
   mtc0    t0, CP0_PAGEGRAIN
   /* Enable STFill Buffer */
   mfc0    t0, CP0_PRID
   /* Loongson-3A R4+ */
   andi    t1, t0, PRID_IMP_MASK
   li    t2, PRID_IMP_LOONGSON_64G
   beq     t1, t2, 1f
   nop
   /* Loongson-3A R2/R3 */
   andi    t0, (PRID_IMP_MASK | PRID_REV_MASK)
   slti    t0, t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0)
   bnez    t0, 2f
   nop
1:
   mfc0    t0, CP0_CONFIG6
   or    t0, 0x100
   mtc0    t0, CP0_CONFIG6
2:
   _ehb
   .set    pop
   .endm
 
/*
 * Do SMP slave processor setup.
 */
   .macro    smp_slave_setup
   .set    push
   .set    mips64
   /* Set LPA on LOONGSON3 config3 */
   mfc0    t0, CP0_CONFIG3
   or    t0, (0x1 << 7)
   mtc0    t0, CP0_CONFIG3
   /* Set ELPA on LOONGSON3 pagegrain */
   mfc0    t0, CP0_PAGEGRAIN
   or    t0, (0x1 << 29)
   mtc0    t0, CP0_PAGEGRAIN
   /* Enable STFill Buffer */
   mfc0    t0, CP0_PRID
   /* Loongson-3A R4+ */
   andi    t1, t0, PRID_IMP_MASK
   li    t2, PRID_IMP_LOONGSON_64G
   beq     t1, t2, 1f
   nop
   /* Loongson-3A R2/R3 */
   andi    t0, (PRID_IMP_MASK | PRID_REV_MASK)
   slti    t0, t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0)
   bnez    t0, 2f
   nop
1:
   mfc0    t0, CP0_CONFIG6
   or    t0, 0x100
   mtc0    t0, CP0_CONFIG6
2:
   _ehb
   .set    pop
   .endm
 
#endif /* __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H */