1
2
3
4
5
6
7
8
9
10
11#include <asm/pdc.h>
12#include <asm/psw.h>
13#include <asm/assembly.h>
14#include <asm/asm-offsets.h>
15
16#include <linux/linkage.h>
17
18
19 .section .bss
20
21 .export pdc_result
22 .export pdc_result2
23 .align 8
24pdc_result:
25 .block ASM_PDC_RESULT_SIZE
26pdc_result2:
27 .block ASM_PDC_RESULT_SIZE
28
29 .export real_stack
30 .export real32_stack
31 .export real64_stack
32 .align 64
33real_stack:
34real32_stack:
35real64_stack:
36 .block 8192
37
38#ifdef CONFIG_64BIT
39# define REG_SZ 8
40#else
41# define REG_SZ 4
42#endif
43
44#define N_SAVED_REGS 9
45
46save_cr_space:
47 .block REG_SZ * N_SAVED_REGS
48save_cr_end:
49
50
51
52
53
54 .text
55
56
57
58
59
60
61
62
63
64ENTRY(real32_call_asm)
65 STREG %rp, -RP_OFFSET(%sp)
66#ifdef CONFIG_64BIT
67 callee_save
68 ldo 2*REG_SZ(%sp), %sp
69 STREG %r27, -1*REG_SZ(%sp)
70 STREG %r29, -2*REG_SZ(%sp)
71#endif
72 STREG %sp, -REG_SZ(%arg0)
73 copy %arg0, %sp
74
75
76 copy %arg2, %r31
77
78
79
80 ldw 0(%arg1), %arg0
81 ldw -8(%arg1), %arg2
82 ldw -12(%arg1), %arg3
83 ldw -4(%arg1), %arg1
84
85 tophys_r1 %sp
86
87 b,l rfi_virt2real,%r2
88 nop
89
90 b,l save_control_regs,%r2
91 nop
92
93#ifdef CONFIG_64BIT
94 rsm PSW_SM_W, %r0
95#endif
96
97 load32 PA(ric_ret), %r2
98 bv 0(%r31)
99 nop
100ric_ret:
101#ifdef CONFIG_64BIT
102 ssm PSW_SM_W, %r0
103#endif
104
105 b,l restore_control_regs, %r2
106 nop
107
108 b,l rfi_real2virt,%r2
109 nop
110
111 tovirt_r1 %sp
112 LDREG -REG_SZ(%sp), %sp
113#ifdef CONFIG_64BIT
114 LDREG -1*REG_SZ(%sp), %r27
115 LDREG -2*REG_SZ(%sp), %r29
116 ldo -2*REG_SZ(%sp), %sp
117 callee_rest
118#endif
119 LDREG -RP_OFFSET(%sp), %rp
120 bv 0(%rp)
121 nop
122ENDPROC(real32_call_asm)
123
124
125# define PUSH_CR(r, where) mfctl r, %r1 ! STREG,ma %r1, REG_SZ(where)
126# define POP_CR(r, where) LDREG,mb -REG_SZ(where), %r1 ! mtctl %r1, r
127
128 .text
129save_control_regs:
130 load32 PA(save_cr_space), %r28
131 PUSH_CR(%cr24, %r28)
132 PUSH_CR(%cr25, %r28)
133 PUSH_CR(%cr26, %r28)
134 PUSH_CR(%cr27, %r28)
135 PUSH_CR(%cr28, %r28)
136 PUSH_CR(%cr29, %r28)
137 PUSH_CR(%cr30, %r28)
138 PUSH_CR(%cr31, %r28)
139 PUSH_CR(%cr15, %r28)
140 bv 0(%r2)
141 nop
142
143restore_control_regs:
144 load32 PA(save_cr_end), %r26
145 POP_CR(%cr15, %r26)
146 POP_CR(%cr31, %r26)
147 POP_CR(%cr30, %r26)
148 POP_CR(%cr29, %r26)
149 POP_CR(%cr28, %r26)
150 POP_CR(%cr27, %r26)
151 POP_CR(%cr26, %r26)
152 POP_CR(%cr25, %r26)
153 POP_CR(%cr24, %r26)
154 bv 0(%r2)
155 nop
156
157
158
159
160 .text
161 .align 128
162rfi_virt2real:
163
164 rsm PSW_SM_I,%r0
165 load32 PA(rfi_v2r_1), %r1
166 nop
167 nop
168 nop
169 nop
170 nop
171
172 rsm PSW_SM_Q,%r0
173 mtctl %r0, %cr17
174 mtctl %r0, %cr17
175 mtctl %r1, %cr18
176 ldo 4(%r1), %r1
177 mtctl %r1, %cr18
178 load32 REAL_MODE_PSW, %r1
179 mtctl %r1, %cr22
180 rfi
181
182 nop
183 nop
184 nop
185 nop
186 nop
187 nop
188 nop
189 nop
190rfi_v2r_1:
191 tophys_r1 %r2
192 bv 0(%r2)
193 nop
194
195 .text
196 .align 128
197rfi_real2virt:
198 rsm PSW_SM_I,%r0
199 load32 (rfi_r2v_1), %r1
200 nop
201 nop
202 nop
203 nop
204 nop
205
206 rsm PSW_SM_Q,%r0
207 mtctl %r0, %cr17
208 mtctl %r0, %cr17
209 mtctl %r1, %cr18
210 ldo 4(%r1), %r1
211 mtctl %r1, %cr18
212 load32 KERNEL_PSW, %r1
213 mtctl %r1, %cr22
214 rfi
215
216 nop
217 nop
218 nop
219 nop
220 nop
221 nop
222 nop
223 nop
224rfi_r2v_1:
225 tovirt_r1 %r2
226 bv 0(%r2)
227 nop
228
229#ifdef CONFIG_64BIT
230
231
232
233 .text
234
235
236
237
238
239
240
241ENTRY(real64_call_asm)
242 std %rp, -0x10(%sp)
243 std %sp, -8(%arg0)
244 copy %arg0, %sp
245
246
247 copy %arg2, %r31
248
249
250 ldo 64(%arg1), %r29
251
252
253
254 ldd 0*REG_SZ(%arg1), %arg0
255 ldd 2*REG_SZ(%arg1), %arg2
256 ldd 3*REG_SZ(%arg1), %arg3
257 ldd 4*REG_SZ(%arg1), %r22
258 ldd 5*REG_SZ(%arg1), %r21
259 ldd 6*REG_SZ(%arg1), %r20
260 ldd 7*REG_SZ(%arg1), %r19
261 ldd 1*REG_SZ(%arg1), %arg1
262
263 tophys_r1 %sp
264
265 b,l rfi_virt2real,%r2
266 nop
267
268 b,l save_control_regs,%r2
269 nop
270
271 load32 PA(r64_ret), %r2
272 bv 0(%r31)
273 nop
274r64_ret:
275
276 b,l restore_control_regs, %r2
277 nop
278
279 b,l rfi_real2virt,%r2
280 nop
281
282 tovirt_r1 %sp
283 ldd -8(%sp), %sp
284 ldd -0x10(%sp), %rp
285 bv 0(%rp)
286 nop
287ENDPROC(real64_call_asm)
288
289#endif
290
291 .text
292
293
294
295
296ENTRY(__canonicalize_funcptr_for_compare)
297#ifdef CONFIG_64BIT
298 bve (%r2)
299#else
300 bv %r0(%r2)
301#endif
302 copy %r26,%r28
303ENDPROC(__canonicalize_funcptr_for_compare)
304
305