]>
Commit | Line | Data |
---|---|---|
10ec5117 AG |
1 | /* |
2 | * S/390 helpers | |
3 | * | |
4 | * Copyright (c) 2009 Ulrich Hecht | |
d5a43964 | 5 | * Copyright (c) 2011 Alexander Graf |
10ec5117 AG |
6 | * |
7 | * This library is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU Lesser General Public | |
9 | * License as published by the Free Software Foundation; either | |
10 | * version 2 of the License, or (at your option) any later version. | |
11 | * | |
12 | * This library is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * Lesser General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU Lesser General Public | |
70539e18 | 18 | * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
10ec5117 AG |
19 | */ |
20 | ||
21 | #include <stdio.h> | |
22 | #include <stdlib.h> | |
23 | #include <string.h> | |
24 | ||
25 | #include "cpu.h" | |
10ec5117 AG |
26 | #include "gdbstub.h" |
27 | #include "qemu-common.h" | |
d5a43964 | 28 | #include "qemu-timer.h" |
ef81522b AG |
29 | #ifndef CONFIG_USER_ONLY |
30 | #include "sysemu.h" | |
31 | #endif | |
10ec5117 | 32 | |
d5a43964 AG |
33 | //#define DEBUG_S390 |
34 | //#define DEBUG_S390_PTE | |
35 | //#define DEBUG_S390_STDOUT | |
36 | ||
37 | #ifdef DEBUG_S390 | |
38 | #ifdef DEBUG_S390_STDOUT | |
39 | #define DPRINTF(fmt, ...) \ | |
40 | do { fprintf(stderr, fmt, ## __VA_ARGS__); \ | |
41 | qemu_log(fmt, ##__VA_ARGS__); } while (0) | |
42 | #else | |
43 | #define DPRINTF(fmt, ...) \ | |
44 | do { qemu_log(fmt, ## __VA_ARGS__); } while (0) | |
45 | #endif | |
46 | #else | |
47 | #define DPRINTF(fmt, ...) \ | |
48 | do { } while (0) | |
49 | #endif | |
50 | ||
51 | #ifdef DEBUG_S390_PTE | |
52 | #define PTE_DPRINTF DPRINTF | |
53 | #else | |
54 | #define PTE_DPRINTF(fmt, ...) \ | |
55 | do { } while (0) | |
56 | #endif | |
57 | ||
58 | #ifndef CONFIG_USER_ONLY | |
59 | static void s390x_tod_timer(void *opaque) | |
60 | { | |
61 | CPUState *env = opaque; | |
62 | ||
63 | env->pending_int |= INTERRUPT_TOD; | |
64 | cpu_interrupt(env, CPU_INTERRUPT_HARD); | |
65 | } | |
66 | ||
67 | static void s390x_cpu_timer(void *opaque) | |
68 | { | |
69 | CPUState *env = opaque; | |
70 | ||
71 | env->pending_int |= INTERRUPT_CPUTIMER; | |
72 | cpu_interrupt(env, CPU_INTERRUPT_HARD); | |
73 | } | |
74 | #endif | |
10c339a0 | 75 | |
10ec5117 AG |
76 | CPUS390XState *cpu_s390x_init(const char *cpu_model) |
77 | { | |
78 | CPUS390XState *env; | |
d5a43964 AG |
79 | #if !defined (CONFIG_USER_ONLY) |
80 | struct tm tm; | |
81 | #endif | |
10ec5117 | 82 | static int inited = 0; |
d5a43964 | 83 | static int cpu_num = 0; |
10ec5117 | 84 | |
7267c094 | 85 | env = g_malloc0(sizeof(CPUS390XState)); |
10ec5117 | 86 | cpu_exec_init(env); |
d5ab9713 | 87 | if (tcg_enabled() && !inited) { |
10ec5117 | 88 | inited = 1; |
d5a43964 | 89 | s390x_translate_init(); |
10ec5117 AG |
90 | } |
91 | ||
d5a43964 AG |
92 | #if !defined(CONFIG_USER_ONLY) |
93 | qemu_get_timedate(&tm, 0); | |
94 | env->tod_offset = TOD_UNIX_EPOCH + | |
95 | (time2tod(mktimegm(&tm)) * 1000000000ULL); | |
96 | env->tod_basetime = 0; | |
97 | env->tod_timer = qemu_new_timer_ns(vm_clock, s390x_tod_timer, env); | |
98 | env->cpu_timer = qemu_new_timer_ns(vm_clock, s390x_cpu_timer, env); | |
99 | #endif | |
10ec5117 | 100 | env->cpu_model_str = cpu_model; |
d5a43964 AG |
101 | env->cpu_num = cpu_num++; |
102 | env->ext_index = -1; | |
10ec5117 AG |
103 | cpu_reset(env); |
104 | qemu_init_vcpu(env); | |
105 | return env; | |
106 | } | |
107 | ||
d5a43964 AG |
108 | #if defined(CONFIG_USER_ONLY) |
109 | ||
110 | void do_interrupt (CPUState *env) | |
111 | { | |
112 | env->exception_index = -1; | |
113 | } | |
114 | ||
115 | int cpu_s390x_handle_mmu_fault (CPUState *env, target_ulong address, int rw, | |
97b348e7 | 116 | int mmu_idx) |
d5a43964 | 117 | { |
97b348e7 BS |
118 | /* fprintf(stderr,"%s: address 0x%lx rw %d mmu_idx %d\n", |
119 | __FUNCTION__, address, rw, mmu_idx); */ | |
d5a43964 AG |
120 | env->exception_index = EXCP_ADDR; |
121 | env->__excp_addr = address; /* FIXME: find out how this works on a real machine */ | |
122 | return 1; | |
123 | } | |
124 | ||
125 | #endif /* CONFIG_USER_ONLY */ | |
126 | ||
10ec5117 AG |
127 | void cpu_reset(CPUS390XState *env) |
128 | { | |
129 | if (qemu_loglevel_mask(CPU_LOG_RESET)) { | |
130 | qemu_log("CPU Reset (CPU %d)\n", env->cpu_index); | |
131 | log_cpu_state(env, 0); | |
132 | } | |
133 | ||
134 | memset(env, 0, offsetof(CPUS390XState, breakpoints)); | |
135 | /* FIXME: reset vector? */ | |
136 | tlb_flush(env, 1); | |
ef81522b | 137 | s390_add_running_cpu(env); |
10ec5117 | 138 | } |
10c339a0 | 139 | |
d5a43964 AG |
140 | #ifndef CONFIG_USER_ONLY |
141 | ||
142 | /* Ensure to exit the TB after this call! */ | |
143 | static void trigger_pgm_exception(CPUState *env, uint32_t code, uint32_t ilc) | |
144 | { | |
145 | env->exception_index = EXCP_PGM; | |
146 | env->int_pgm_code = code; | |
147 | env->int_pgm_ilc = ilc; | |
148 | } | |
149 | ||
150 | static int trans_bits(CPUState *env, uint64_t mode) | |
151 | { | |
152 | int bits = 0; | |
153 | ||
154 | switch (mode) { | |
155 | case PSW_ASC_PRIMARY: | |
156 | bits = 1; | |
157 | break; | |
158 | case PSW_ASC_SECONDARY: | |
159 | bits = 2; | |
160 | break; | |
161 | case PSW_ASC_HOME: | |
162 | bits = 3; | |
163 | break; | |
164 | default: | |
165 | cpu_abort(env, "unknown asc mode\n"); | |
166 | break; | |
167 | } | |
168 | ||
169 | return bits; | |
170 | } | |
171 | ||
172 | static void trigger_prot_fault(CPUState *env, target_ulong vaddr, uint64_t mode) | |
173 | { | |
174 | int ilc = ILC_LATER_INC_2; | |
175 | int bits = trans_bits(env, mode) | 4; | |
176 | ||
177 | DPRINTF("%s: vaddr=%016" PRIx64 " bits=%d\n", __FUNCTION__, vaddr, bits); | |
178 | ||
179 | stq_phys(env->psa + offsetof(LowCore, trans_exc_code), vaddr | bits); | |
180 | trigger_pgm_exception(env, PGM_PROTECTION, ilc); | |
181 | } | |
182 | ||
183 | static void trigger_page_fault(CPUState *env, target_ulong vaddr, uint32_t type, | |
184 | uint64_t asc, int rw) | |
185 | { | |
186 | int ilc = ILC_LATER; | |
187 | int bits = trans_bits(env, asc); | |
188 | ||
189 | if (rw == 2) { | |
190 | /* code has is undefined ilc */ | |
191 | ilc = 2; | |
192 | } | |
193 | ||
194 | DPRINTF("%s: vaddr=%016" PRIx64 " bits=%d\n", __FUNCTION__, vaddr, bits); | |
195 | ||
196 | stq_phys(env->psa + offsetof(LowCore, trans_exc_code), vaddr | bits); | |
197 | trigger_pgm_exception(env, type, ilc); | |
198 | } | |
199 | ||
200 | static int mmu_translate_asce(CPUState *env, target_ulong vaddr, uint64_t asc, | |
201 | uint64_t asce, int level, target_ulong *raddr, | |
202 | int *flags, int rw) | |
c92114b1 | 203 | { |
d5a43964 AG |
204 | uint64_t offs = 0; |
205 | uint64_t origin; | |
206 | uint64_t new_asce; | |
207 | ||
208 | PTE_DPRINTF("%s: 0x%" PRIx64 "\n", __FUNCTION__, asce); | |
209 | ||
210 | if (((level != _ASCE_TYPE_SEGMENT) && (asce & _REGION_ENTRY_INV)) || | |
211 | ((level == _ASCE_TYPE_SEGMENT) && (asce & _SEGMENT_ENTRY_INV))) { | |
212 | /* XXX different regions have different faults */ | |
213 | DPRINTF("%s: invalid region\n", __FUNCTION__); | |
214 | trigger_page_fault(env, vaddr, PGM_SEGMENT_TRANS, asc, rw); | |
215 | return -1; | |
216 | } | |
217 | ||
218 | if ((level <= _ASCE_TYPE_MASK) && ((asce & _ASCE_TYPE_MASK) != level)) { | |
219 | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); | |
220 | return -1; | |
221 | } | |
222 | ||
223 | if (asce & _ASCE_REAL_SPACE) { | |
224 | /* direct mapping */ | |
225 | ||
226 | *raddr = vaddr; | |
227 | return 0; | |
228 | } | |
229 | ||
230 | origin = asce & _ASCE_ORIGIN; | |
231 | ||
232 | switch (level) { | |
233 | case _ASCE_TYPE_REGION1 + 4: | |
234 | offs = (vaddr >> 50) & 0x3ff8; | |
235 | break; | |
236 | case _ASCE_TYPE_REGION1: | |
237 | offs = (vaddr >> 39) & 0x3ff8; | |
238 | break; | |
239 | case _ASCE_TYPE_REGION2: | |
240 | offs = (vaddr >> 28) & 0x3ff8; | |
241 | break; | |
242 | case _ASCE_TYPE_REGION3: | |
243 | offs = (vaddr >> 17) & 0x3ff8; | |
244 | break; | |
245 | case _ASCE_TYPE_SEGMENT: | |
246 | offs = (vaddr >> 9) & 0x07f8; | |
247 | origin = asce & _SEGMENT_ENTRY_ORIGIN; | |
248 | break; | |
249 | } | |
250 | ||
251 | /* XXX region protection flags */ | |
252 | /* *flags &= ~PAGE_WRITE */ | |
253 | ||
254 | new_asce = ldq_phys(origin + offs); | |
255 | PTE_DPRINTF("%s: 0x%" PRIx64 " + 0x%" PRIx64 " => 0x%016" PRIx64 "\n", | |
256 | __FUNCTION__, origin, offs, new_asce); | |
257 | ||
258 | if (level != _ASCE_TYPE_SEGMENT) { | |
259 | /* yet another region */ | |
260 | return mmu_translate_asce(env, vaddr, asc, new_asce, level - 4, raddr, | |
261 | flags, rw); | |
262 | } | |
263 | ||
264 | /* PTE */ | |
265 | if (new_asce & _PAGE_INVALID) { | |
266 | DPRINTF("%s: PTE=0x%" PRIx64 " invalid\n", __FUNCTION__, new_asce); | |
267 | trigger_page_fault(env, vaddr, PGM_PAGE_TRANS, asc, rw); | |
268 | return -1; | |
269 | } | |
270 | ||
271 | if (new_asce & _PAGE_RO) { | |
272 | *flags &= ~PAGE_WRITE; | |
273 | } | |
274 | ||
275 | *raddr = new_asce & _ASCE_ORIGIN; | |
276 | ||
277 | PTE_DPRINTF("%s: PTE=0x%" PRIx64 "\n", __FUNCTION__, new_asce); | |
278 | ||
c92114b1 AG |
279 | return 0; |
280 | } | |
281 | ||
d5a43964 AG |
282 | static int mmu_translate_asc(CPUState *env, target_ulong vaddr, uint64_t asc, |
283 | target_ulong *raddr, int *flags, int rw) | |
284 | { | |
285 | uint64_t asce = 0; | |
286 | int level, new_level; | |
287 | int r; | |
10c339a0 | 288 | |
d5a43964 AG |
289 | switch (asc) { |
290 | case PSW_ASC_PRIMARY: | |
291 | PTE_DPRINTF("%s: asc=primary\n", __FUNCTION__); | |
292 | asce = env->cregs[1]; | |
293 | break; | |
294 | case PSW_ASC_SECONDARY: | |
295 | PTE_DPRINTF("%s: asc=secondary\n", __FUNCTION__); | |
296 | asce = env->cregs[7]; | |
297 | break; | |
298 | case PSW_ASC_HOME: | |
299 | PTE_DPRINTF("%s: asc=home\n", __FUNCTION__); | |
300 | asce = env->cregs[13]; | |
301 | break; | |
302 | } | |
303 | ||
304 | switch (asce & _ASCE_TYPE_MASK) { | |
305 | case _ASCE_TYPE_REGION1: | |
306 | break; | |
307 | case _ASCE_TYPE_REGION2: | |
308 | if (vaddr & 0xffe0000000000000ULL) { | |
309 | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64 | |
310 | " 0xffe0000000000000ULL\n", __FUNCTION__, | |
311 | vaddr); | |
312 | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); | |
313 | return -1; | |
314 | } | |
315 | break; | |
316 | case _ASCE_TYPE_REGION3: | |
317 | if (vaddr & 0xfffffc0000000000ULL) { | |
318 | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64 | |
319 | " 0xfffffc0000000000ULL\n", __FUNCTION__, | |
320 | vaddr); | |
321 | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); | |
322 | return -1; | |
323 | } | |
324 | break; | |
325 | case _ASCE_TYPE_SEGMENT: | |
326 | if (vaddr & 0xffffffff80000000ULL) { | |
327 | DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64 | |
328 | " 0xffffffff80000000ULL\n", __FUNCTION__, | |
329 | vaddr); | |
330 | trigger_page_fault(env, vaddr, PGM_TRANS_SPEC, asc, rw); | |
331 | return -1; | |
332 | } | |
333 | break; | |
334 | } | |
335 | ||
336 | /* fake level above current */ | |
337 | level = asce & _ASCE_TYPE_MASK; | |
338 | new_level = level + 4; | |
339 | asce = (asce & ~_ASCE_TYPE_MASK) | (new_level & _ASCE_TYPE_MASK); | |
340 | ||
341 | r = mmu_translate_asce(env, vaddr, asc, asce, new_level, raddr, flags, rw); | |
342 | ||
343 | if ((rw == 1) && !(*flags & PAGE_WRITE)) { | |
344 | trigger_prot_fault(env, vaddr, asc); | |
345 | return -1; | |
346 | } | |
347 | ||
348 | return r; | |
349 | } | |
350 | ||
351 | int mmu_translate(CPUState *env, target_ulong vaddr, int rw, uint64_t asc, | |
352 | target_ulong *raddr, int *flags) | |
353 | { | |
354 | int r = -1; | |
b9959138 | 355 | uint8_t *sk; |
d5a43964 AG |
356 | |
357 | *flags = PAGE_READ | PAGE_WRITE | PAGE_EXEC; | |
358 | vaddr &= TARGET_PAGE_MASK; | |
359 | ||
360 | if (!(env->psw.mask & PSW_MASK_DAT)) { | |
361 | *raddr = vaddr; | |
362 | r = 0; | |
363 | goto out; | |
364 | } | |
365 | ||
366 | switch (asc) { | |
367 | case PSW_ASC_PRIMARY: | |
368 | case PSW_ASC_HOME: | |
369 | r = mmu_translate_asc(env, vaddr, asc, raddr, flags, rw); | |
370 | break; | |
371 | case PSW_ASC_SECONDARY: | |
372 | /* | |
373 | * Instruction: Primary | |
374 | * Data: Secondary | |
375 | */ | |
376 | if (rw == 2) { | |
377 | r = mmu_translate_asc(env, vaddr, PSW_ASC_PRIMARY, raddr, flags, | |
378 | rw); | |
379 | *flags &= ~(PAGE_READ | PAGE_WRITE); | |
380 | } else { | |
381 | r = mmu_translate_asc(env, vaddr, PSW_ASC_SECONDARY, raddr, flags, | |
382 | rw); | |
383 | *flags &= ~(PAGE_EXEC); | |
384 | } | |
385 | break; | |
386 | case PSW_ASC_ACCREG: | |
387 | default: | |
388 | hw_error("guest switched to unknown asc mode\n"); | |
389 | break; | |
390 | } | |
391 | ||
392 | out: | |
393 | /* Convert real address -> absolute address */ | |
394 | if (*raddr < 0x2000) { | |
395 | *raddr = *raddr + env->psa; | |
396 | } | |
397 | ||
b9959138 AG |
398 | if (*raddr <= ram_size) { |
399 | sk = &env->storage_keys[*raddr / TARGET_PAGE_SIZE]; | |
400 | if (*flags & PAGE_READ) { | |
401 | *sk |= SK_R; | |
402 | } | |
403 | ||
404 | if (*flags & PAGE_WRITE) { | |
405 | *sk |= SK_C; | |
406 | } | |
407 | } | |
408 | ||
d5a43964 AG |
409 | return r; |
410 | } | |
411 | ||
412 | int cpu_s390x_handle_mmu_fault (CPUState *env, target_ulong _vaddr, int rw, | |
97b348e7 | 413 | int mmu_idx) |
10c339a0 | 414 | { |
d5a43964 AG |
415 | uint64_t asc = env->psw.mask & PSW_MASK_ASC; |
416 | target_ulong vaddr, raddr; | |
10c339a0 AG |
417 | int prot; |
418 | ||
97b348e7 BS |
419 | DPRINTF("%s: address 0x%" PRIx64 " rw %d mmu_idx %d\n", |
420 | __FUNCTION__, _vaddr, rw, mmu_idx); | |
d5a43964 AG |
421 | |
422 | _vaddr &= TARGET_PAGE_MASK; | |
423 | vaddr = _vaddr; | |
424 | ||
425 | /* 31-Bit mode */ | |
426 | if (!(env->psw.mask & PSW_MASK_64)) { | |
427 | vaddr &= 0x7fffffff; | |
428 | } | |
429 | ||
430 | if (mmu_translate(env, vaddr, rw, asc, &raddr, &prot)) { | |
431 | /* Translation ended in exception */ | |
432 | return 1; | |
433 | } | |
10c339a0 | 434 | |
d5a43964 AG |
435 | /* check out of RAM access */ |
436 | if (raddr > (ram_size + virtio_size)) { | |
437 | DPRINTF("%s: aaddr %" PRIx64 " > ram_size %" PRIx64 "\n", __FUNCTION__, | |
438 | (uint64_t)aaddr, (uint64_t)ram_size); | |
439 | trigger_pgm_exception(env, PGM_ADDRESSING, ILC_LATER); | |
440 | return 1; | |
441 | } | |
10c339a0 | 442 | |
d5a43964 AG |
443 | DPRINTF("%s: set tlb %" PRIx64 " -> %" PRIx64 " (%x)\n", __FUNCTION__, |
444 | (uint64_t)vaddr, (uint64_t)raddr, prot); | |
445 | ||
446 | tlb_set_page(env, _vaddr, raddr, prot, | |
d4c430a8 | 447 | mmu_idx, TARGET_PAGE_SIZE); |
d5a43964 | 448 | |
d4c430a8 | 449 | return 0; |
10c339a0 | 450 | } |
d5a43964 AG |
451 | |
452 | target_phys_addr_t cpu_get_phys_page_debug(CPUState *env, target_ulong vaddr) | |
453 | { | |
454 | target_ulong raddr; | |
455 | int prot = PAGE_READ | PAGE_WRITE | PAGE_EXEC; | |
456 | int old_exc = env->exception_index; | |
457 | uint64_t asc = env->psw.mask & PSW_MASK_ASC; | |
458 | ||
459 | /* 31-Bit mode */ | |
460 | if (!(env->psw.mask & PSW_MASK_64)) { | |
461 | vaddr &= 0x7fffffff; | |
462 | } | |
463 | ||
464 | mmu_translate(env, vaddr, 2, asc, &raddr, &prot); | |
465 | env->exception_index = old_exc; | |
466 | ||
467 | return raddr; | |
468 | } | |
469 | ||
470 | void load_psw(CPUState *env, uint64_t mask, uint64_t addr) | |
471 | { | |
472 | if (mask & PSW_MASK_WAIT) { | |
d5a43964 | 473 | if (!(mask & (PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK))) { |
ef81522b AG |
474 | if (s390_del_running_cpu(env) == 0) { |
475 | #ifndef CONFIG_USER_ONLY | |
476 | qemu_system_shutdown_request(); | |
477 | #endif | |
478 | } | |
d5a43964 | 479 | } |
ef81522b AG |
480 | env->halted = 1; |
481 | env->exception_index = EXCP_HLT; | |
d5a43964 AG |
482 | } |
483 | ||
484 | env->psw.addr = addr; | |
485 | env->psw.mask = mask; | |
486 | env->cc_op = (mask >> 13) & 3; | |
487 | } | |
488 | ||
489 | static uint64_t get_psw_mask(CPUState *env) | |
490 | { | |
491 | uint64_t r = env->psw.mask; | |
492 | ||
493 | env->cc_op = calc_cc(env, env->cc_op, env->cc_src, env->cc_dst, env->cc_vr); | |
494 | ||
495 | r &= ~(3ULL << 13); | |
496 | assert(!(env->cc_op & ~3)); | |
497 | r |= env->cc_op << 13; | |
498 | ||
499 | return r; | |
500 | } | |
501 | ||
502 | static void do_svc_interrupt(CPUState *env) | |
503 | { | |
504 | uint64_t mask, addr; | |
505 | LowCore *lowcore; | |
506 | target_phys_addr_t len = TARGET_PAGE_SIZE; | |
507 | ||
508 | lowcore = cpu_physical_memory_map(env->psa, &len, 1); | |
509 | ||
510 | lowcore->svc_code = cpu_to_be16(env->int_svc_code); | |
511 | lowcore->svc_ilc = cpu_to_be16(env->int_svc_ilc); | |
512 | lowcore->svc_old_psw.mask = cpu_to_be64(get_psw_mask(env)); | |
513 | lowcore->svc_old_psw.addr = cpu_to_be64(env->psw.addr + (env->int_svc_ilc)); | |
514 | mask = be64_to_cpu(lowcore->svc_new_psw.mask); | |
515 | addr = be64_to_cpu(lowcore->svc_new_psw.addr); | |
516 | ||
517 | cpu_physical_memory_unmap(lowcore, len, 1, len); | |
518 | ||
519 | load_psw(env, mask, addr); | |
520 | } | |
521 | ||
522 | static void do_program_interrupt(CPUState *env) | |
523 | { | |
524 | uint64_t mask, addr; | |
525 | LowCore *lowcore; | |
526 | target_phys_addr_t len = TARGET_PAGE_SIZE; | |
527 | int ilc = env->int_pgm_ilc; | |
528 | ||
529 | switch (ilc) { | |
530 | case ILC_LATER: | |
531 | ilc = get_ilc(ldub_code(env->psw.addr)); | |
532 | break; | |
533 | case ILC_LATER_INC: | |
534 | ilc = get_ilc(ldub_code(env->psw.addr)); | |
535 | env->psw.addr += ilc * 2; | |
536 | break; | |
537 | case ILC_LATER_INC_2: | |
538 | ilc = get_ilc(ldub_code(env->psw.addr)) * 2; | |
539 | env->psw.addr += ilc; | |
540 | break; | |
541 | } | |
542 | ||
543 | qemu_log("%s: code=0x%x ilc=%d\n", __FUNCTION__, env->int_pgm_code, ilc); | |
544 | ||
545 | lowcore = cpu_physical_memory_map(env->psa, &len, 1); | |
546 | ||
547 | lowcore->pgm_ilc = cpu_to_be16(ilc); | |
548 | lowcore->pgm_code = cpu_to_be16(env->int_pgm_code); | |
549 | lowcore->program_old_psw.mask = cpu_to_be64(get_psw_mask(env)); | |
550 | lowcore->program_old_psw.addr = cpu_to_be64(env->psw.addr); | |
551 | mask = be64_to_cpu(lowcore->program_new_psw.mask); | |
552 | addr = be64_to_cpu(lowcore->program_new_psw.addr); | |
553 | ||
554 | cpu_physical_memory_unmap(lowcore, len, 1, len); | |
555 | ||
556 | DPRINTF("%s: %x %x %" PRIx64 " %" PRIx64 "\n", __FUNCTION__, | |
557 | env->int_pgm_code, ilc, env->psw.mask, | |
558 | env->psw.addr); | |
559 | ||
560 | load_psw(env, mask, addr); | |
561 | } | |
562 | ||
563 | #define VIRTIO_SUBCODE_64 0x0D00 | |
564 | ||
565 | static void do_ext_interrupt(CPUState *env) | |
566 | { | |
567 | uint64_t mask, addr; | |
568 | LowCore *lowcore; | |
569 | target_phys_addr_t len = TARGET_PAGE_SIZE; | |
570 | ExtQueue *q; | |
571 | ||
572 | if (!(env->psw.mask & PSW_MASK_EXT)) { | |
573 | cpu_abort(env, "Ext int w/o ext mask\n"); | |
574 | } | |
575 | ||
576 | if (env->ext_index < 0 || env->ext_index > MAX_EXT_QUEUE) { | |
577 | cpu_abort(env, "Ext queue overrun: %d\n", env->ext_index); | |
578 | } | |
579 | ||
580 | q = &env->ext_queue[env->ext_index]; | |
581 | lowcore = cpu_physical_memory_map(env->psa, &len, 1); | |
582 | ||
583 | lowcore->ext_int_code = cpu_to_be16(q->code); | |
584 | lowcore->ext_params = cpu_to_be32(q->param); | |
585 | lowcore->ext_params2 = cpu_to_be64(q->param64); | |
586 | lowcore->external_old_psw.mask = cpu_to_be64(get_psw_mask(env)); | |
587 | lowcore->external_old_psw.addr = cpu_to_be64(env->psw.addr); | |
588 | lowcore->cpu_addr = cpu_to_be16(env->cpu_num | VIRTIO_SUBCODE_64); | |
589 | mask = be64_to_cpu(lowcore->external_new_psw.mask); | |
590 | addr = be64_to_cpu(lowcore->external_new_psw.addr); | |
591 | ||
592 | cpu_physical_memory_unmap(lowcore, len, 1, len); | |
593 | ||
594 | env->ext_index--; | |
595 | if (env->ext_index == -1) { | |
596 | env->pending_int &= ~INTERRUPT_EXT; | |
597 | } | |
598 | ||
599 | DPRINTF("%s: %" PRIx64 " %" PRIx64 "\n", __FUNCTION__, | |
600 | env->psw.mask, env->psw.addr); | |
601 | ||
602 | load_psw(env, mask, addr); | |
603 | } | |
3110e292 AG |
604 | |
605 | void do_interrupt (CPUState *env) | |
606 | { | |
d5a43964 AG |
607 | qemu_log("%s: %d at pc=%" PRIx64 "\n", __FUNCTION__, env->exception_index, |
608 | env->psw.addr); | |
609 | ||
ef81522b | 610 | s390_add_running_cpu(env); |
d5a43964 AG |
611 | /* handle external interrupts */ |
612 | if ((env->psw.mask & PSW_MASK_EXT) && | |
613 | env->exception_index == -1) { | |
614 | if (env->pending_int & INTERRUPT_EXT) { | |
615 | /* code is already in env */ | |
616 | env->exception_index = EXCP_EXT; | |
617 | } else if (env->pending_int & INTERRUPT_TOD) { | |
618 | cpu_inject_ext(env, 0x1004, 0, 0); | |
619 | env->exception_index = EXCP_EXT; | |
620 | env->pending_int &= ~INTERRUPT_EXT; | |
621 | env->pending_int &= ~INTERRUPT_TOD; | |
622 | } else if (env->pending_int & INTERRUPT_CPUTIMER) { | |
623 | cpu_inject_ext(env, 0x1005, 0, 0); | |
624 | env->exception_index = EXCP_EXT; | |
625 | env->pending_int &= ~INTERRUPT_EXT; | |
626 | env->pending_int &= ~INTERRUPT_TOD; | |
627 | } | |
628 | } | |
629 | ||
630 | switch (env->exception_index) { | |
631 | case EXCP_PGM: | |
632 | do_program_interrupt(env); | |
633 | break; | |
634 | case EXCP_SVC: | |
635 | do_svc_interrupt(env); | |
636 | break; | |
637 | case EXCP_EXT: | |
638 | do_ext_interrupt(env); | |
639 | break; | |
640 | } | |
641 | env->exception_index = -1; | |
642 | ||
643 | if (!env->pending_int) { | |
644 | env->interrupt_request &= ~CPU_INTERRUPT_HARD; | |
645 | } | |
3110e292 | 646 | } |
d5a43964 AG |
647 | |
648 | #endif /* CONFIG_USER_ONLY */ |