hc
2023-12-11 6778948f9de86c3cfaf36725a7c87dcff9ba247f
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
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
/* SPDX-License-Identifier: GPL-2.0 */
#ifndef _SPARC_TRAP_BLOCK_H
#define _SPARC_TRAP_BLOCK_H
 
#include <linux/threads.h>
 
#include <asm/hypervisor.h>
#include <asm/asi.h>
 
#ifndef __ASSEMBLY__
 
/* Trap handling code needs to get at a few critical values upon
 * trap entry and to process TSB misses.  These cannot be in the
 * per_cpu() area as we really need to lock them into the TLB and
 * thus make them part of the main kernel image.  As a result we
 * try to make this as small as possible.
 *
 * This is padded out and aligned to 64-bytes to avoid false sharing
 * on SMP.
 */
 
/* If you modify the size of this structure, please update
 * TRAP_BLOCK_SZ_SHIFT below.
 */
struct thread_info;
struct trap_per_cpu {
/* D-cache line 1: Basic thread information, cpu and device mondo queues */
   struct thread_info    *thread;
   unsigned long        pgd_paddr;
   unsigned long        cpu_mondo_pa;
   unsigned long        dev_mondo_pa;
 
/* D-cache line 2: Error Mondo Queue and kernel buffer pointers */
   unsigned long        resum_mondo_pa;
   unsigned long        resum_kernel_buf_pa;
   unsigned long        nonresum_mondo_pa;
   unsigned long        nonresum_kernel_buf_pa;
 
/* Dcache lines 3, 4, 5, and 6: Hypervisor Fault Status */
   struct hv_fault_status    fault_info;
 
/* Dcache line 7: Physical addresses of CPU send mondo block and CPU list.  */
   unsigned long        cpu_mondo_block_pa;
   unsigned long        cpu_list_pa;
   unsigned long        tsb_huge;
   unsigned long        tsb_huge_temp;
 
/* Dcache line 8: IRQ work list, and keep trap_block a power-of-2 in size.  */
   unsigned long        irq_worklist_pa;
   unsigned int        cpu_mondo_qmask;
   unsigned int        dev_mondo_qmask;
   unsigned int        resum_qmask;
   unsigned int        nonresum_qmask;
   unsigned long        __per_cpu_base;
} __attribute__((aligned(64)));
extern struct trap_per_cpu trap_block[NR_CPUS];
void init_cur_cpu_trap(struct thread_info *);
void setup_tba(void);
extern int ncpus_probed;
extern u64 cpu_mondo_counter[NR_CPUS];
 
unsigned long real_hard_smp_processor_id(void);
 
struct cpuid_patch_entry {
   unsigned int    addr;
   unsigned int    cheetah_safari[4];
   unsigned int    cheetah_jbus[4];
   unsigned int    starfire[4];
   unsigned int    sun4v[4];
};
extern struct cpuid_patch_entry __cpuid_patch, __cpuid_patch_end;
 
struct sun4v_1insn_patch_entry {
   unsigned int    addr;
   unsigned int    insn;
};
extern struct sun4v_1insn_patch_entry __sun4v_1insn_patch,
   __sun4v_1insn_patch_end;
extern struct sun4v_1insn_patch_entry __fast_win_ctrl_1insn_patch,
   __fast_win_ctrl_1insn_patch_end;
extern struct sun4v_1insn_patch_entry __sun_m7_1insn_patch,
   __sun_m7_1insn_patch_end;
 
struct sun4v_2insn_patch_entry {
   unsigned int    addr;
   unsigned int    insns[2];
};
extern struct sun4v_2insn_patch_entry __sun4v_2insn_patch,
   __sun4v_2insn_patch_end;
extern struct sun4v_2insn_patch_entry __sun_m7_2insn_patch,
   __sun_m7_2insn_patch_end;
 
 
#endif /* !(__ASSEMBLY__) */
 
#define TRAP_PER_CPU_THREAD        0x00
#define TRAP_PER_CPU_PGD_PADDR        0x08
#define TRAP_PER_CPU_CPU_MONDO_PA    0x10
#define TRAP_PER_CPU_DEV_MONDO_PA    0x18
#define TRAP_PER_CPU_RESUM_MONDO_PA    0x20
#define TRAP_PER_CPU_RESUM_KBUF_PA    0x28
#define TRAP_PER_CPU_NONRESUM_MONDO_PA    0x30
#define TRAP_PER_CPU_NONRESUM_KBUF_PA    0x38
#define TRAP_PER_CPU_FAULT_INFO        0x40
#define TRAP_PER_CPU_CPU_MONDO_BLOCK_PA    0xc0
#define TRAP_PER_CPU_CPU_LIST_PA    0xc8
#define TRAP_PER_CPU_TSB_HUGE        0xd0
#define TRAP_PER_CPU_TSB_HUGE_TEMP    0xd8
#define TRAP_PER_CPU_IRQ_WORKLIST_PA    0xe0
#define TRAP_PER_CPU_CPU_MONDO_QMASK    0xe8
#define TRAP_PER_CPU_DEV_MONDO_QMASK    0xec
#define TRAP_PER_CPU_RESUM_QMASK    0xf0
#define TRAP_PER_CPU_NONRESUM_QMASK    0xf4
#define TRAP_PER_CPU_PER_CPU_BASE    0xf8
 
#define TRAP_BLOCK_SZ_SHIFT        8
 
#include <asm/scratchpad.h>
 
#define __GET_CPUID(REG)                \
   /* Spitfire implementation (default). */    \
661:    ldxa        [%g0] ASI_UPA_CONFIG, REG;    \
   srlx        REG, 17, REG;            \
    and        REG, 0x1f, REG;            \
   nop;                        \
   .section    .cpuid_patch, "ax";        \
   /* Instruction location. */            \
   .word        661b;                \
   /* Cheetah Safari implementation. */        \
   ldxa        [%g0] ASI_SAFARI_CONFIG, REG;    \
   srlx        REG, 17, REG;            \
   and        REG, 0x3ff, REG;        \
   nop;                        \
   /* Cheetah JBUS implementation. */        \
   ldxa        [%g0] ASI_JBUS_CONFIG, REG;    \
   srlx        REG, 17, REG;            \
   and        REG, 0x1f, REG;            \
   nop;                        \
   /* Starfire implementation. */            \
   sethi        %hi(0x1fff40000d0 >> 9), REG;    \
   sllx        REG, 9, REG;            \
   or        REG, 0xd0, REG;            \
   lduwa        [REG] ASI_PHYS_BYPASS_EC_E, REG;\
   /* sun4v implementation. */            \
   mov        SCRATCHPAD_CPUID, REG;        \
   ldxa        [REG] ASI_SCRATCHPAD, REG;    \
   nop;                        \
   nop;                        \
   .previous;
 
#ifdef CONFIG_SMP
 
#define TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   __GET_CPUID(TMP)            \
   sethi    %hi(trap_block), DEST;        \
   sllx    TMP, TRAP_BLOCK_SZ_SHIFT, TMP;    \
   or    DEST, %lo(trap_block), DEST;    \
   add    DEST, TMP, DEST;        \
 
/* Clobbers TMP, current address space PGD phys address into DEST.  */
#define TRAP_LOAD_PGD_PHYS(DEST, TMP)        \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   ldx    [DEST + TRAP_PER_CPU_PGD_PADDR], DEST;
 
/* Clobbers TMP, loads local processor's IRQ work area into DEST.  */
#define TRAP_LOAD_IRQ_WORK_PA(DEST, TMP)    \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   add    DEST, TRAP_PER_CPU_IRQ_WORKLIST_PA, DEST;
 
/* Clobbers TMP, loads DEST with current thread info pointer.  */
#define TRAP_LOAD_THREAD_REG(DEST, TMP)        \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   ldx    [DEST + TRAP_PER_CPU_THREAD], DEST;
 
/* Given the current thread info pointer in THR, load the per-cpu
 * area base of the current processor into DEST.  REG1, REG2, and REG3 are
 * clobbered.
 *
 * You absolutely cannot use DEST as a temporary in this code.  The
 * reason is that traps can happen during execution, and return from
 * trap will load the fully resolved DEST per-cpu base.  This can corrupt
 * the calculations done by the macro mid-stream.
 */
#define LOAD_PER_CPU_BASE(DEST, THR, REG1, REG2, REG3)    \
   lduh    [THR + TI_CPU], REG1;            \
   sethi    %hi(trap_block), REG2;            \
   sllx    REG1, TRAP_BLOCK_SZ_SHIFT, REG1;    \
   or    REG2, %lo(trap_block), REG2;        \
   add    REG2, REG1, REG2;            \
   ldx    [REG2 + TRAP_PER_CPU_PER_CPU_BASE], DEST;
 
#else
 
#define TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   sethi    %hi(trap_block), DEST;        \
   or    DEST, %lo(trap_block), DEST;    \
 
/* Uniprocessor versions, we know the cpuid is zero.  */
#define TRAP_LOAD_PGD_PHYS(DEST, TMP)        \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   ldx    [DEST + TRAP_PER_CPU_PGD_PADDR], DEST;
 
/* Clobbers TMP, loads local processor's IRQ work area into DEST.  */
#define TRAP_LOAD_IRQ_WORK_PA(DEST, TMP)    \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   add    DEST, TRAP_PER_CPU_IRQ_WORKLIST_PA, DEST;
 
#define TRAP_LOAD_THREAD_REG(DEST, TMP)        \
   TRAP_LOAD_TRAP_BLOCK(DEST, TMP)        \
   ldx    [DEST + TRAP_PER_CPU_THREAD], DEST;
 
/* No per-cpu areas on uniprocessor, so no need to load DEST.  */
#define LOAD_PER_CPU_BASE(DEST, THR, REG1, REG2, REG3)
 
#endif /* !(CONFIG_SMP) */
 
#endif /* _SPARC_TRAP_BLOCK_H */