root / hw / spapr_hcall.c @ 6c7796e5
History | View | Annotate | Download (14.1 kB)
1 | 9fdf0c29 | David Gibson | #include "sysemu.h" |
---|---|---|---|
2 | 9fdf0c29 | David Gibson | #include "cpu.h" |
3 | 9fdf0c29 | David Gibson | #include "qemu-char.h" |
4 | f43e3525 | David Gibson | #include "sysemu.h" |
5 | f43e3525 | David Gibson | #include "qemu-char.h" |
6 | ed120055 | David Gibson | #include "exec.h" |
7 | ed120055 | David Gibson | #include "helper_regs.h" |
8 | 9fdf0c29 | David Gibson | #include "hw/spapr.h" |
9 | 9fdf0c29 | David Gibson | |
10 | f43e3525 | David Gibson | #define HPTES_PER_GROUP 8 |
11 | f43e3525 | David Gibson | |
12 | f43e3525 | David Gibson | #define HPTE_V_SSIZE_SHIFT 62 |
13 | f43e3525 | David Gibson | #define HPTE_V_AVPN_SHIFT 7 |
14 | f43e3525 | David Gibson | #define HPTE_V_AVPN 0x3fffffffffffff80ULL |
15 | f43e3525 | David Gibson | #define HPTE_V_AVPN_VAL(x) (((x) & HPTE_V_AVPN) >> HPTE_V_AVPN_SHIFT)
|
16 | f43e3525 | David Gibson | #define HPTE_V_COMPARE(x, y) (!(((x) ^ (y)) & 0xffffffffffffff80UL)) |
17 | f43e3525 | David Gibson | #define HPTE_V_BOLTED 0x0000000000000010ULL |
18 | f43e3525 | David Gibson | #define HPTE_V_LOCK 0x0000000000000008ULL |
19 | f43e3525 | David Gibson | #define HPTE_V_LARGE 0x0000000000000004ULL |
20 | f43e3525 | David Gibson | #define HPTE_V_SECONDARY 0x0000000000000002ULL |
21 | f43e3525 | David Gibson | #define HPTE_V_VALID 0x0000000000000001ULL |
22 | f43e3525 | David Gibson | |
23 | f43e3525 | David Gibson | #define HPTE_R_PP0 0x8000000000000000ULL |
24 | f43e3525 | David Gibson | #define HPTE_R_TS 0x4000000000000000ULL |
25 | f43e3525 | David Gibson | #define HPTE_R_KEY_HI 0x3000000000000000ULL |
26 | f43e3525 | David Gibson | #define HPTE_R_RPN_SHIFT 12 |
27 | f43e3525 | David Gibson | #define HPTE_R_RPN 0x3ffffffffffff000ULL |
28 | f43e3525 | David Gibson | #define HPTE_R_FLAGS 0x00000000000003ffULL |
29 | f43e3525 | David Gibson | #define HPTE_R_PP 0x0000000000000003ULL |
30 | f43e3525 | David Gibson | #define HPTE_R_N 0x0000000000000004ULL |
31 | f43e3525 | David Gibson | #define HPTE_R_G 0x0000000000000008ULL |
32 | f43e3525 | David Gibson | #define HPTE_R_M 0x0000000000000010ULL |
33 | f43e3525 | David Gibson | #define HPTE_R_I 0x0000000000000020ULL |
34 | f43e3525 | David Gibson | #define HPTE_R_W 0x0000000000000040ULL |
35 | f43e3525 | David Gibson | #define HPTE_R_WIMG 0x0000000000000078ULL |
36 | f43e3525 | David Gibson | #define HPTE_R_C 0x0000000000000080ULL |
37 | f43e3525 | David Gibson | #define HPTE_R_R 0x0000000000000100ULL |
38 | f43e3525 | David Gibson | #define HPTE_R_KEY_LO 0x0000000000000e00ULL |
39 | f43e3525 | David Gibson | |
40 | f43e3525 | David Gibson | #define HPTE_V_1TB_SEG 0x4000000000000000ULL |
41 | f43e3525 | David Gibson | #define HPTE_V_VRMA_MASK 0x4001ffffff000000ULL |
42 | f43e3525 | David Gibson | |
43 | f43e3525 | David Gibson | #define HPTE_V_HVLOCK 0x40ULL |
44 | f43e3525 | David Gibson | |
45 | f43e3525 | David Gibson | static inline int lock_hpte(void *hpte, target_ulong bits) |
46 | f43e3525 | David Gibson | { |
47 | f43e3525 | David Gibson | uint64_t pteh; |
48 | f43e3525 | David Gibson | |
49 | f43e3525 | David Gibson | pteh = ldq_p(hpte); |
50 | f43e3525 | David Gibson | |
51 | f43e3525 | David Gibson | /* We're protected by qemu's global lock here */
|
52 | f43e3525 | David Gibson | if (pteh & bits) {
|
53 | f43e3525 | David Gibson | return 0; |
54 | f43e3525 | David Gibson | } |
55 | f43e3525 | David Gibson | stq_p(hpte, pteh | HPTE_V_HVLOCK); |
56 | f43e3525 | David Gibson | return 1; |
57 | f43e3525 | David Gibson | } |
58 | f43e3525 | David Gibson | |
59 | f43e3525 | David Gibson | static target_ulong compute_tlbie_rb(target_ulong v, target_ulong r,
|
60 | f43e3525 | David Gibson | target_ulong pte_index) |
61 | f43e3525 | David Gibson | { |
62 | f43e3525 | David Gibson | target_ulong rb, va_low; |
63 | f43e3525 | David Gibson | |
64 | f43e3525 | David Gibson | rb = (v & ~0x7fULL) << 16; /* AVA field */ |
65 | f43e3525 | David Gibson | va_low = pte_index >> 3;
|
66 | f43e3525 | David Gibson | if (v & HPTE_V_SECONDARY) {
|
67 | f43e3525 | David Gibson | va_low = ~va_low; |
68 | f43e3525 | David Gibson | } |
69 | f43e3525 | David Gibson | /* xor vsid from AVA */
|
70 | f43e3525 | David Gibson | if (!(v & HPTE_V_1TB_SEG)) {
|
71 | f43e3525 | David Gibson | va_low ^= v >> 12;
|
72 | f43e3525 | David Gibson | } else {
|
73 | f43e3525 | David Gibson | va_low ^= v >> 24;
|
74 | f43e3525 | David Gibson | } |
75 | f43e3525 | David Gibson | va_low &= 0x7ff;
|
76 | f43e3525 | David Gibson | if (v & HPTE_V_LARGE) {
|
77 | f43e3525 | David Gibson | rb |= 1; /* L field */ |
78 | f43e3525 | David Gibson | #if 0 /* Disable that P7 specific bit for now */
|
79 | f43e3525 | David Gibson | if (r & 0xff000) {
|
80 | f43e3525 | David Gibson | /* non-16MB large page, must be 64k */
|
81 | f43e3525 | David Gibson | /* (masks depend on page size) */
|
82 | f43e3525 | David Gibson | rb |= 0x1000; /* page encoding in LP field */
|
83 | f43e3525 | David Gibson | rb |= (va_low & 0x7f) << 16; /* 7b of VA in AVA/LP field */
|
84 | f43e3525 | David Gibson | rb |= (va_low & 0xfe); /* AVAL field */
|
85 | f43e3525 | David Gibson | }
|
86 | f43e3525 | David Gibson | #endif
|
87 | f43e3525 | David Gibson | } else {
|
88 | f43e3525 | David Gibson | /* 4kB page */
|
89 | f43e3525 | David Gibson | rb |= (va_low & 0x7ff) << 12; /* remaining 11b of AVA */ |
90 | f43e3525 | David Gibson | } |
91 | f43e3525 | David Gibson | rb |= (v >> 54) & 0x300; /* B field */ |
92 | f43e3525 | David Gibson | return rb;
|
93 | f43e3525 | David Gibson | } |
94 | f43e3525 | David Gibson | |
95 | f43e3525 | David Gibson | static target_ulong h_enter(CPUState *env, sPAPREnvironment *spapr,
|
96 | f43e3525 | David Gibson | target_ulong opcode, target_ulong *args) |
97 | f43e3525 | David Gibson | { |
98 | f43e3525 | David Gibson | target_ulong flags = args[0];
|
99 | f43e3525 | David Gibson | target_ulong pte_index = args[1];
|
100 | f43e3525 | David Gibson | target_ulong pteh = args[2];
|
101 | f43e3525 | David Gibson | target_ulong ptel = args[3];
|
102 | 1235a9cf | David Gibson | target_ulong i; |
103 | f43e3525 | David Gibson | uint8_t *hpte; |
104 | f43e3525 | David Gibson | |
105 | f43e3525 | David Gibson | /* only handle 4k and 16M pages for now */
|
106 | f43e3525 | David Gibson | if (pteh & HPTE_V_LARGE) {
|
107 | f43e3525 | David Gibson | #if 0 /* We don't support 64k pages yet */
|
108 | f43e3525 | David Gibson | if ((ptel & 0xf000) == 0x1000) {
|
109 | f43e3525 | David Gibson | /* 64k page */
|
110 | f43e3525 | David Gibson | } else
|
111 | f43e3525 | David Gibson | #endif
|
112 | f43e3525 | David Gibson | if ((ptel & 0xff000) == 0) { |
113 | f43e3525 | David Gibson | /* 16M page */
|
114 | f43e3525 | David Gibson | /* lowest AVA bit must be 0 for 16M pages */
|
115 | f43e3525 | David Gibson | if (pteh & 0x80) { |
116 | f43e3525 | David Gibson | return H_PARAMETER;
|
117 | f43e3525 | David Gibson | } |
118 | f43e3525 | David Gibson | } else {
|
119 | f43e3525 | David Gibson | return H_PARAMETER;
|
120 | f43e3525 | David Gibson | } |
121 | f43e3525 | David Gibson | } |
122 | f43e3525 | David Gibson | |
123 | f43e3525 | David Gibson | /* FIXME: bounds check the pa? */
|
124 | f43e3525 | David Gibson | |
125 | f43e3525 | David Gibson | /* Check WIMG */
|
126 | f43e3525 | David Gibson | if ((ptel & HPTE_R_WIMG) != HPTE_R_M) {
|
127 | f43e3525 | David Gibson | return H_PARAMETER;
|
128 | f43e3525 | David Gibson | } |
129 | f43e3525 | David Gibson | pteh &= ~0x60ULL;
|
130 | f43e3525 | David Gibson | |
131 | f43e3525 | David Gibson | if ((pte_index * HASH_PTE_SIZE_64) & ~env->htab_mask) {
|
132 | f43e3525 | David Gibson | return H_PARAMETER;
|
133 | f43e3525 | David Gibson | } |
134 | f43e3525 | David Gibson | if (likely((flags & H_EXACT) == 0)) { |
135 | f43e3525 | David Gibson | pte_index &= ~7ULL;
|
136 | f43e3525 | David Gibson | hpte = env->external_htab + (pte_index * HASH_PTE_SIZE_64); |
137 | f43e3525 | David Gibson | for (i = 0; ; ++i) { |
138 | f43e3525 | David Gibson | if (i == 8) { |
139 | f43e3525 | David Gibson | return H_PTEG_FULL;
|
140 | f43e3525 | David Gibson | } |
141 | f43e3525 | David Gibson | if (((ldq_p(hpte) & HPTE_V_VALID) == 0) && |
142 | f43e3525 | David Gibson | lock_hpte(hpte, HPTE_V_HVLOCK | HPTE_V_VALID)) { |
143 | f43e3525 | David Gibson | break;
|
144 | f43e3525 | David Gibson | } |
145 | f43e3525 | David Gibson | hpte += HASH_PTE_SIZE_64; |
146 | f43e3525 | David Gibson | } |
147 | f43e3525 | David Gibson | } else {
|
148 | f43e3525 | David Gibson | i = 0;
|
149 | f43e3525 | David Gibson | hpte = env->external_htab + (pte_index * HASH_PTE_SIZE_64); |
150 | f43e3525 | David Gibson | if (!lock_hpte(hpte, HPTE_V_HVLOCK | HPTE_V_VALID)) {
|
151 | f43e3525 | David Gibson | return H_PTEG_FULL;
|
152 | f43e3525 | David Gibson | } |
153 | f43e3525 | David Gibson | } |
154 | f43e3525 | David Gibson | stq_p(hpte + (HASH_PTE_SIZE_64/2), ptel);
|
155 | f43e3525 | David Gibson | /* eieio(); FIXME: need some sort of barrier for smp? */
|
156 | f43e3525 | David Gibson | stq_p(hpte, pteh); |
157 | f43e3525 | David Gibson | |
158 | f43e3525 | David Gibson | assert(!(ldq_p(hpte) & HPTE_V_HVLOCK)); |
159 | f43e3525 | David Gibson | args[0] = pte_index + i;
|
160 | f43e3525 | David Gibson | return H_SUCCESS;
|
161 | f43e3525 | David Gibson | } |
162 | f43e3525 | David Gibson | |
163 | f43e3525 | David Gibson | static target_ulong h_remove(CPUState *env, sPAPREnvironment *spapr,
|
164 | f43e3525 | David Gibson | target_ulong opcode, target_ulong *args) |
165 | f43e3525 | David Gibson | { |
166 | f43e3525 | David Gibson | target_ulong flags = args[0];
|
167 | f43e3525 | David Gibson | target_ulong pte_index = args[1];
|
168 | f43e3525 | David Gibson | target_ulong avpn = args[2];
|
169 | f43e3525 | David Gibson | uint8_t *hpte; |
170 | f43e3525 | David Gibson | target_ulong v, r, rb; |
171 | f43e3525 | David Gibson | |
172 | f43e3525 | David Gibson | if ((pte_index * HASH_PTE_SIZE_64) & ~env->htab_mask) {
|
173 | f43e3525 | David Gibson | return H_PARAMETER;
|
174 | f43e3525 | David Gibson | } |
175 | f43e3525 | David Gibson | |
176 | f43e3525 | David Gibson | hpte = env->external_htab + (pte_index * HASH_PTE_SIZE_64); |
177 | f43e3525 | David Gibson | while (!lock_hpte(hpte, HPTE_V_HVLOCK)) {
|
178 | f43e3525 | David Gibson | /* We have no real concurrency in qemu soft-emulation, so we
|
179 | f43e3525 | David Gibson | * will never actually have a contested lock */
|
180 | f43e3525 | David Gibson | assert(0);
|
181 | f43e3525 | David Gibson | } |
182 | f43e3525 | David Gibson | |
183 | f43e3525 | David Gibson | v = ldq_p(hpte); |
184 | f43e3525 | David Gibson | r = ldq_p(hpte + (HASH_PTE_SIZE_64/2));
|
185 | f43e3525 | David Gibson | |
186 | f43e3525 | David Gibson | if ((v & HPTE_V_VALID) == 0 || |
187 | f43e3525 | David Gibson | ((flags & H_AVPN) && (v & ~0x7fULL) != avpn) ||
|
188 | f43e3525 | David Gibson | ((flags & H_ANDCOND) && (v & avpn) != 0)) {
|
189 | f43e3525 | David Gibson | stq_p(hpte, v & ~HPTE_V_HVLOCK); |
190 | f43e3525 | David Gibson | assert(!(ldq_p(hpte) & HPTE_V_HVLOCK)); |
191 | f43e3525 | David Gibson | return H_NOT_FOUND;
|
192 | f43e3525 | David Gibson | } |
193 | f43e3525 | David Gibson | args[0] = v & ~HPTE_V_HVLOCK;
|
194 | f43e3525 | David Gibson | args[1] = r;
|
195 | f43e3525 | David Gibson | stq_p(hpte, 0);
|
196 | f43e3525 | David Gibson | rb = compute_tlbie_rb(v, r, pte_index); |
197 | f43e3525 | David Gibson | ppc_tlb_invalidate_one(env, rb); |
198 | f43e3525 | David Gibson | assert(!(ldq_p(hpte) & HPTE_V_HVLOCK)); |
199 | f43e3525 | David Gibson | return H_SUCCESS;
|
200 | f43e3525 | David Gibson | } |
201 | f43e3525 | David Gibson | |
202 | f43e3525 | David Gibson | static target_ulong h_protect(CPUState *env, sPAPREnvironment *spapr,
|
203 | f43e3525 | David Gibson | target_ulong opcode, target_ulong *args) |
204 | f43e3525 | David Gibson | { |
205 | f43e3525 | David Gibson | target_ulong flags = args[0];
|
206 | f43e3525 | David Gibson | target_ulong pte_index = args[1];
|
207 | f43e3525 | David Gibson | target_ulong avpn = args[2];
|
208 | f43e3525 | David Gibson | uint8_t *hpte; |
209 | f43e3525 | David Gibson | target_ulong v, r, rb; |
210 | f43e3525 | David Gibson | |
211 | f43e3525 | David Gibson | if ((pte_index * HASH_PTE_SIZE_64) & ~env->htab_mask) {
|
212 | f43e3525 | David Gibson | return H_PARAMETER;
|
213 | f43e3525 | David Gibson | } |
214 | f43e3525 | David Gibson | |
215 | f43e3525 | David Gibson | hpte = env->external_htab + (pte_index * HASH_PTE_SIZE_64); |
216 | f43e3525 | David Gibson | while (!lock_hpte(hpte, HPTE_V_HVLOCK)) {
|
217 | f43e3525 | David Gibson | /* We have no real concurrency in qemu soft-emulation, so we
|
218 | f43e3525 | David Gibson | * will never actually have a contested lock */
|
219 | f43e3525 | David Gibson | assert(0);
|
220 | f43e3525 | David Gibson | } |
221 | f43e3525 | David Gibson | |
222 | f43e3525 | David Gibson | v = ldq_p(hpte); |
223 | f43e3525 | David Gibson | r = ldq_p(hpte + (HASH_PTE_SIZE_64/2));
|
224 | f43e3525 | David Gibson | |
225 | f43e3525 | David Gibson | if ((v & HPTE_V_VALID) == 0 || |
226 | f43e3525 | David Gibson | ((flags & H_AVPN) && (v & ~0x7fULL) != avpn)) {
|
227 | f43e3525 | David Gibson | stq_p(hpte, v & ~HPTE_V_HVLOCK); |
228 | f43e3525 | David Gibson | assert(!(ldq_p(hpte) & HPTE_V_HVLOCK)); |
229 | f43e3525 | David Gibson | return H_NOT_FOUND;
|
230 | f43e3525 | David Gibson | } |
231 | f43e3525 | David Gibson | |
232 | f43e3525 | David Gibson | r &= ~(HPTE_R_PP0 | HPTE_R_PP | HPTE_R_N | |
233 | f43e3525 | David Gibson | HPTE_R_KEY_HI | HPTE_R_KEY_LO); |
234 | f43e3525 | David Gibson | r |= (flags << 55) & HPTE_R_PP0;
|
235 | f43e3525 | David Gibson | r |= (flags << 48) & HPTE_R_KEY_HI;
|
236 | f43e3525 | David Gibson | r |= flags & (HPTE_R_PP | HPTE_R_N | HPTE_R_KEY_LO); |
237 | f43e3525 | David Gibson | rb = compute_tlbie_rb(v, r, pte_index); |
238 | f43e3525 | David Gibson | stq_p(hpte, v & ~HPTE_V_VALID); |
239 | f43e3525 | David Gibson | ppc_tlb_invalidate_one(env, rb); |
240 | f43e3525 | David Gibson | stq_p(hpte + (HASH_PTE_SIZE_64/2), r);
|
241 | f43e3525 | David Gibson | /* Don't need a memory barrier, due to qemu's global lock */
|
242 | f43e3525 | David Gibson | stq_p(hpte, v & ~HPTE_V_HVLOCK); |
243 | f43e3525 | David Gibson | assert(!(ldq_p(hpte) & HPTE_V_HVLOCK)); |
244 | f43e3525 | David Gibson | return H_SUCCESS;
|
245 | f43e3525 | David Gibson | } |
246 | f43e3525 | David Gibson | |
247 | 821303f5 | David Gibson | static target_ulong h_set_dabr(CPUState *env, sPAPREnvironment *spapr,
|
248 | 821303f5 | David Gibson | target_ulong opcode, target_ulong *args) |
249 | 821303f5 | David Gibson | { |
250 | 821303f5 | David Gibson | /* FIXME: actually implement this */
|
251 | 821303f5 | David Gibson | return H_HARDWARE;
|
252 | 821303f5 | David Gibson | } |
253 | 821303f5 | David Gibson | |
254 | ed120055 | David Gibson | #define FLAGS_REGISTER_VPA 0x0000200000000000ULL |
255 | ed120055 | David Gibson | #define FLAGS_REGISTER_DTL 0x0000400000000000ULL |
256 | ed120055 | David Gibson | #define FLAGS_REGISTER_SLBSHADOW 0x0000600000000000ULL |
257 | ed120055 | David Gibson | #define FLAGS_DEREGISTER_VPA 0x0000a00000000000ULL |
258 | ed120055 | David Gibson | #define FLAGS_DEREGISTER_DTL 0x0000c00000000000ULL |
259 | ed120055 | David Gibson | #define FLAGS_DEREGISTER_SLBSHADOW 0x0000e00000000000ULL |
260 | ed120055 | David Gibson | |
261 | ed120055 | David Gibson | #define VPA_MIN_SIZE 640 |
262 | ed120055 | David Gibson | #define VPA_SIZE_OFFSET 0x4 |
263 | ed120055 | David Gibson | #define VPA_SHARED_PROC_OFFSET 0x9 |
264 | ed120055 | David Gibson | #define VPA_SHARED_PROC_VAL 0x2 |
265 | ed120055 | David Gibson | |
266 | ed120055 | David Gibson | static target_ulong register_vpa(CPUState *env, target_ulong vpa)
|
267 | ed120055 | David Gibson | { |
268 | ed120055 | David Gibson | uint16_t size; |
269 | ed120055 | David Gibson | uint8_t tmp; |
270 | ed120055 | David Gibson | |
271 | ed120055 | David Gibson | if (vpa == 0) { |
272 | ed120055 | David Gibson | hcall_dprintf("Can't cope with registering a VPA at logical 0\n");
|
273 | ed120055 | David Gibson | return H_HARDWARE;
|
274 | ed120055 | David Gibson | } |
275 | ed120055 | David Gibson | |
276 | ed120055 | David Gibson | if (vpa % env->dcache_line_size) {
|
277 | ed120055 | David Gibson | return H_PARAMETER;
|
278 | ed120055 | David Gibson | } |
279 | ed120055 | David Gibson | /* FIXME: bounds check the address */
|
280 | ed120055 | David Gibson | |
281 | ed120055 | David Gibson | size = lduw_phys(vpa + 0x4);
|
282 | ed120055 | David Gibson | |
283 | ed120055 | David Gibson | if (size < VPA_MIN_SIZE) {
|
284 | ed120055 | David Gibson | return H_PARAMETER;
|
285 | ed120055 | David Gibson | } |
286 | ed120055 | David Gibson | |
287 | ed120055 | David Gibson | /* VPA is not allowed to cross a page boundary */
|
288 | ed120055 | David Gibson | if ((vpa / 4096) != ((vpa + size - 1) / 4096)) { |
289 | ed120055 | David Gibson | return H_PARAMETER;
|
290 | ed120055 | David Gibson | } |
291 | ed120055 | David Gibson | |
292 | ed120055 | David Gibson | env->vpa = vpa; |
293 | ed120055 | David Gibson | |
294 | ed120055 | David Gibson | tmp = ldub_phys(env->vpa + VPA_SHARED_PROC_OFFSET); |
295 | ed120055 | David Gibson | tmp |= VPA_SHARED_PROC_VAL; |
296 | ed120055 | David Gibson | stb_phys(env->vpa + VPA_SHARED_PROC_OFFSET, tmp); |
297 | ed120055 | David Gibson | |
298 | ed120055 | David Gibson | return H_SUCCESS;
|
299 | ed120055 | David Gibson | } |
300 | ed120055 | David Gibson | |
301 | ed120055 | David Gibson | static target_ulong deregister_vpa(CPUState *env, target_ulong vpa)
|
302 | ed120055 | David Gibson | { |
303 | ed120055 | David Gibson | if (env->slb_shadow) {
|
304 | ed120055 | David Gibson | return H_RESOURCE;
|
305 | ed120055 | David Gibson | } |
306 | ed120055 | David Gibson | |
307 | ed120055 | David Gibson | if (env->dispatch_trace_log) {
|
308 | ed120055 | David Gibson | return H_RESOURCE;
|
309 | ed120055 | David Gibson | } |
310 | ed120055 | David Gibson | |
311 | ed120055 | David Gibson | env->vpa = 0;
|
312 | ed120055 | David Gibson | return H_SUCCESS;
|
313 | ed120055 | David Gibson | } |
314 | ed120055 | David Gibson | |
315 | ed120055 | David Gibson | static target_ulong register_slb_shadow(CPUState *env, target_ulong addr)
|
316 | ed120055 | David Gibson | { |
317 | ed120055 | David Gibson | uint32_t size; |
318 | ed120055 | David Gibson | |
319 | ed120055 | David Gibson | if (addr == 0) { |
320 | ed120055 | David Gibson | hcall_dprintf("Can't cope with SLB shadow at logical 0\n");
|
321 | ed120055 | David Gibson | return H_HARDWARE;
|
322 | ed120055 | David Gibson | } |
323 | ed120055 | David Gibson | |
324 | ed120055 | David Gibson | size = ldl_phys(addr + 0x4);
|
325 | ed120055 | David Gibson | if (size < 0x8) { |
326 | ed120055 | David Gibson | return H_PARAMETER;
|
327 | ed120055 | David Gibson | } |
328 | ed120055 | David Gibson | |
329 | ed120055 | David Gibson | if ((addr / 4096) != ((addr + size - 1) / 4096)) { |
330 | ed120055 | David Gibson | return H_PARAMETER;
|
331 | ed120055 | David Gibson | } |
332 | ed120055 | David Gibson | |
333 | ed120055 | David Gibson | if (!env->vpa) {
|
334 | ed120055 | David Gibson | return H_RESOURCE;
|
335 | ed120055 | David Gibson | } |
336 | ed120055 | David Gibson | |
337 | ed120055 | David Gibson | env->slb_shadow = addr; |
338 | ed120055 | David Gibson | |
339 | ed120055 | David Gibson | return H_SUCCESS;
|
340 | ed120055 | David Gibson | } |
341 | ed120055 | David Gibson | |
342 | ed120055 | David Gibson | static target_ulong deregister_slb_shadow(CPUState *env, target_ulong addr)
|
343 | ed120055 | David Gibson | { |
344 | ed120055 | David Gibson | env->slb_shadow = 0;
|
345 | ed120055 | David Gibson | return H_SUCCESS;
|
346 | ed120055 | David Gibson | } |
347 | ed120055 | David Gibson | |
348 | ed120055 | David Gibson | static target_ulong register_dtl(CPUState *env, target_ulong addr)
|
349 | ed120055 | David Gibson | { |
350 | ed120055 | David Gibson | uint32_t size; |
351 | ed120055 | David Gibson | |
352 | ed120055 | David Gibson | if (addr == 0) { |
353 | ed120055 | David Gibson | hcall_dprintf("Can't cope with DTL at logical 0\n");
|
354 | ed120055 | David Gibson | return H_HARDWARE;
|
355 | ed120055 | David Gibson | } |
356 | ed120055 | David Gibson | |
357 | ed120055 | David Gibson | size = ldl_phys(addr + 0x4);
|
358 | ed120055 | David Gibson | |
359 | ed120055 | David Gibson | if (size < 48) { |
360 | ed120055 | David Gibson | return H_PARAMETER;
|
361 | ed120055 | David Gibson | } |
362 | ed120055 | David Gibson | |
363 | ed120055 | David Gibson | if (!env->vpa) {
|
364 | ed120055 | David Gibson | return H_RESOURCE;
|
365 | ed120055 | David Gibson | } |
366 | ed120055 | David Gibson | |
367 | ed120055 | David Gibson | env->dispatch_trace_log = addr; |
368 | ed120055 | David Gibson | env->dtl_size = size; |
369 | ed120055 | David Gibson | |
370 | ed120055 | David Gibson | return H_SUCCESS;
|
371 | ed120055 | David Gibson | } |
372 | ed120055 | David Gibson | |
373 | ed120055 | David Gibson | static target_ulong deregister_dtl(CPUState *emv, target_ulong addr)
|
374 | ed120055 | David Gibson | { |
375 | ed120055 | David Gibson | env->dispatch_trace_log = 0;
|
376 | ed120055 | David Gibson | env->dtl_size = 0;
|
377 | ed120055 | David Gibson | |
378 | ed120055 | David Gibson | return H_SUCCESS;
|
379 | ed120055 | David Gibson | } |
380 | ed120055 | David Gibson | |
381 | ed120055 | David Gibson | static target_ulong h_register_vpa(CPUState *env, sPAPREnvironment *spapr,
|
382 | ed120055 | David Gibson | target_ulong opcode, target_ulong *args) |
383 | ed120055 | David Gibson | { |
384 | ed120055 | David Gibson | target_ulong flags = args[0];
|
385 | ed120055 | David Gibson | target_ulong procno = args[1];
|
386 | ed120055 | David Gibson | target_ulong vpa = args[2];
|
387 | ed120055 | David Gibson | target_ulong ret = H_PARAMETER; |
388 | ed120055 | David Gibson | CPUState *tenv; |
389 | ed120055 | David Gibson | |
390 | ed120055 | David Gibson | for (tenv = first_cpu; tenv; tenv = tenv->next_cpu) {
|
391 | ed120055 | David Gibson | if (tenv->cpu_index == procno) {
|
392 | ed120055 | David Gibson | break;
|
393 | ed120055 | David Gibson | } |
394 | ed120055 | David Gibson | } |
395 | ed120055 | David Gibson | |
396 | ed120055 | David Gibson | if (!tenv) {
|
397 | ed120055 | David Gibson | return H_PARAMETER;
|
398 | ed120055 | David Gibson | } |
399 | ed120055 | David Gibson | |
400 | ed120055 | David Gibson | switch (flags) {
|
401 | ed120055 | David Gibson | case FLAGS_REGISTER_VPA:
|
402 | ed120055 | David Gibson | ret = register_vpa(tenv, vpa); |
403 | ed120055 | David Gibson | break;
|
404 | ed120055 | David Gibson | |
405 | ed120055 | David Gibson | case FLAGS_DEREGISTER_VPA:
|
406 | ed120055 | David Gibson | ret = deregister_vpa(tenv, vpa); |
407 | ed120055 | David Gibson | break;
|
408 | ed120055 | David Gibson | |
409 | ed120055 | David Gibson | case FLAGS_REGISTER_SLBSHADOW:
|
410 | ed120055 | David Gibson | ret = register_slb_shadow(tenv, vpa); |
411 | ed120055 | David Gibson | break;
|
412 | ed120055 | David Gibson | |
413 | ed120055 | David Gibson | case FLAGS_DEREGISTER_SLBSHADOW:
|
414 | ed120055 | David Gibson | ret = deregister_slb_shadow(tenv, vpa); |
415 | ed120055 | David Gibson | break;
|
416 | ed120055 | David Gibson | |
417 | ed120055 | David Gibson | case FLAGS_REGISTER_DTL:
|
418 | ed120055 | David Gibson | ret = register_dtl(tenv, vpa); |
419 | ed120055 | David Gibson | break;
|
420 | ed120055 | David Gibson | |
421 | ed120055 | David Gibson | case FLAGS_DEREGISTER_DTL:
|
422 | ed120055 | David Gibson | ret = deregister_dtl(tenv, vpa); |
423 | ed120055 | David Gibson | break;
|
424 | ed120055 | David Gibson | } |
425 | ed120055 | David Gibson | |
426 | ed120055 | David Gibson | return ret;
|
427 | ed120055 | David Gibson | } |
428 | ed120055 | David Gibson | |
429 | ed120055 | David Gibson | static target_ulong h_cede(CPUState *env, sPAPREnvironment *spapr,
|
430 | ed120055 | David Gibson | target_ulong opcode, target_ulong *args) |
431 | ed120055 | David Gibson | { |
432 | ed120055 | David Gibson | env->msr |= (1ULL << MSR_EE);
|
433 | ed120055 | David Gibson | hreg_compute_hflags(env); |
434 | ed120055 | David Gibson | if (!cpu_has_work(env)) {
|
435 | ed120055 | David Gibson | env->halted = 1;
|
436 | ed120055 | David Gibson | } |
437 | ed120055 | David Gibson | return H_SUCCESS;
|
438 | ed120055 | David Gibson | } |
439 | ed120055 | David Gibson | |
440 | 39ac8455 | David Gibson | static target_ulong h_rtas(CPUState *env, sPAPREnvironment *spapr,
|
441 | 39ac8455 | David Gibson | target_ulong opcode, target_ulong *args) |
442 | 39ac8455 | David Gibson | { |
443 | 39ac8455 | David Gibson | target_ulong rtas_r3 = args[0];
|
444 | 39ac8455 | David Gibson | uint32_t token = ldl_phys(rtas_r3); |
445 | 39ac8455 | David Gibson | uint32_t nargs = ldl_phys(rtas_r3 + 4);
|
446 | 39ac8455 | David Gibson | uint32_t nret = ldl_phys(rtas_r3 + 8);
|
447 | 39ac8455 | David Gibson | |
448 | 39ac8455 | David Gibson | return spapr_rtas_call(spapr, token, nargs, rtas_r3 + 12, |
449 | 39ac8455 | David Gibson | nret, rtas_r3 + 12 + 4*nargs); |
450 | 39ac8455 | David Gibson | } |
451 | 39ac8455 | David Gibson | |
452 | 7d7ba3fe | David Gibson | static spapr_hcall_fn papr_hypercall_table[(MAX_HCALL_OPCODE / 4) + 1]; |
453 | 7d7ba3fe | David Gibson | static spapr_hcall_fn kvmppc_hypercall_table[KVMPPC_HCALL_MAX - KVMPPC_HCALL_BASE + 1]; |
454 | 9fdf0c29 | David Gibson | |
455 | 9fdf0c29 | David Gibson | void spapr_register_hypercall(target_ulong opcode, spapr_hcall_fn fn)
|
456 | 9fdf0c29 | David Gibson | { |
457 | 39ac8455 | David Gibson | spapr_hcall_fn *slot; |
458 | 39ac8455 | David Gibson | |
459 | 39ac8455 | David Gibson | if (opcode <= MAX_HCALL_OPCODE) {
|
460 | 39ac8455 | David Gibson | assert((opcode & 0x3) == 0); |
461 | 9fdf0c29 | David Gibson | |
462 | 39ac8455 | David Gibson | slot = &papr_hypercall_table[opcode / 4];
|
463 | 39ac8455 | David Gibson | } else {
|
464 | 39ac8455 | David Gibson | assert((opcode >= KVMPPC_HCALL_BASE) && (opcode <= KVMPPC_HCALL_MAX)); |
465 | 9fdf0c29 | David Gibson | |
466 | 9fdf0c29 | David Gibson | |
467 | 39ac8455 | David Gibson | slot = &kvmppc_hypercall_table[opcode - KVMPPC_HCALL_BASE]; |
468 | 39ac8455 | David Gibson | } |
469 | 9fdf0c29 | David Gibson | |
470 | 39ac8455 | David Gibson | assert(!(*slot) || (fn == *slot)); |
471 | 39ac8455 | David Gibson | *slot = fn; |
472 | 9fdf0c29 | David Gibson | } |
473 | 9fdf0c29 | David Gibson | |
474 | 9fdf0c29 | David Gibson | target_ulong spapr_hypercall(CPUState *env, target_ulong opcode, |
475 | 9fdf0c29 | David Gibson | target_ulong *args) |
476 | 9fdf0c29 | David Gibson | { |
477 | 9fdf0c29 | David Gibson | if (msr_pr) {
|
478 | 9fdf0c29 | David Gibson | hcall_dprintf("Hypercall made with MSR[PR]=1\n");
|
479 | 9fdf0c29 | David Gibson | return H_PRIVILEGE;
|
480 | 9fdf0c29 | David Gibson | } |
481 | 9fdf0c29 | David Gibson | |
482 | 9fdf0c29 | David Gibson | if ((opcode <= MAX_HCALL_OPCODE)
|
483 | 9fdf0c29 | David Gibson | && ((opcode & 0x3) == 0)) { |
484 | 39ac8455 | David Gibson | spapr_hcall_fn fn = papr_hypercall_table[opcode / 4];
|
485 | 39ac8455 | David Gibson | |
486 | 39ac8455 | David Gibson | if (fn) {
|
487 | 39ac8455 | David Gibson | return fn(env, spapr, opcode, args);
|
488 | 39ac8455 | David Gibson | } |
489 | 39ac8455 | David Gibson | } else if ((opcode >= KVMPPC_HCALL_BASE) && |
490 | 39ac8455 | David Gibson | (opcode <= KVMPPC_HCALL_MAX)) { |
491 | 39ac8455 | David Gibson | spapr_hcall_fn fn = kvmppc_hypercall_table[opcode - KVMPPC_HCALL_BASE]; |
492 | 9fdf0c29 | David Gibson | |
493 | 9fdf0c29 | David Gibson | if (fn) {
|
494 | 9fdf0c29 | David Gibson | return fn(env, spapr, opcode, args);
|
495 | 9fdf0c29 | David Gibson | } |
496 | 9fdf0c29 | David Gibson | } |
497 | 9fdf0c29 | David Gibson | |
498 | 9fdf0c29 | David Gibson | hcall_dprintf("Unimplemented hcall 0x" TARGET_FMT_lx "\n", opcode); |
499 | 9fdf0c29 | David Gibson | return H_FUNCTION;
|
500 | 9fdf0c29 | David Gibson | } |
501 | f43e3525 | David Gibson | |
502 | f43e3525 | David Gibson | static void hypercall_init(void) |
503 | f43e3525 | David Gibson | { |
504 | f43e3525 | David Gibson | /* hcall-pft */
|
505 | f43e3525 | David Gibson | spapr_register_hypercall(H_ENTER, h_enter); |
506 | f43e3525 | David Gibson | spapr_register_hypercall(H_REMOVE, h_remove); |
507 | f43e3525 | David Gibson | spapr_register_hypercall(H_PROTECT, h_protect); |
508 | 39ac8455 | David Gibson | |
509 | 821303f5 | David Gibson | /* hcall-dabr */
|
510 | 821303f5 | David Gibson | spapr_register_hypercall(H_SET_DABR, h_set_dabr); |
511 | 821303f5 | David Gibson | |
512 | ed120055 | David Gibson | /* hcall-splpar */
|
513 | ed120055 | David Gibson | spapr_register_hypercall(H_REGISTER_VPA, h_register_vpa); |
514 | ed120055 | David Gibson | spapr_register_hypercall(H_CEDE, h_cede); |
515 | ed120055 | David Gibson | |
516 | 39ac8455 | David Gibson | /* qemu/KVM-PPC specific hcalls */
|
517 | 39ac8455 | David Gibson | spapr_register_hypercall(KVMPPC_H_RTAS, h_rtas); |
518 | f43e3525 | David Gibson | } |
519 | f43e3525 | David Gibson | device_init(hypercall_init); |