4 * Copyright (c) 2009 Ulrich Hecht
5 * Copyright (c) 2011 Alexander Graf
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.
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.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
27 #include "qemu-common.h"
28 #include "qemu-timer.h"
29 #ifndef CONFIG_USER_ONLY
34 //#define DEBUG_S390_PTE
35 //#define DEBUG_S390_STDOUT
38 #ifdef DEBUG_S390_STDOUT
39 #define DPRINTF(fmt, ...) \
40 do { fprintf(stderr, fmt, ## __VA_ARGS__); \
41 qemu_log(fmt, ##__VA_ARGS__); } while (0)
43 #define DPRINTF(fmt, ...) \
44 do { qemu_log(fmt, ## __VA_ARGS__); } while (0)
47 #define DPRINTF(fmt, ...) \
52 #define PTE_DPRINTF DPRINTF
54 #define PTE_DPRINTF(fmt, ...) \
58 #ifndef CONFIG_USER_ONLY
59 static void s390x_tod_timer(void *opaque
)
61 CPUState
*env
= opaque
;
63 env
->pending_int
|= INTERRUPT_TOD
;
64 cpu_interrupt(env
, CPU_INTERRUPT_HARD
);
67 static void s390x_cpu_timer(void *opaque
)
69 CPUState
*env
= opaque
;
71 env
->pending_int
|= INTERRUPT_CPUTIMER
;
72 cpu_interrupt(env
, CPU_INTERRUPT_HARD
);
76 CPUS390XState
*cpu_s390x_init(const char *cpu_model
)
79 #if !defined (CONFIG_USER_ONLY)
82 static int inited
= 0;
83 static int cpu_num
= 0;
85 env
= g_malloc0(sizeof(CPUS390XState
));
87 if (tcg_enabled() && !inited
) {
89 s390x_translate_init();
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
);
100 env
->cpu_model_str
= cpu_model
;
101 env
->cpu_num
= cpu_num
++;
108 #if defined(CONFIG_USER_ONLY)
110 void do_interrupt (CPUState
*env
)
112 env
->exception_index
= -1;
115 int cpu_s390x_handle_mmu_fault (CPUState
*env
, target_ulong address
, int rw
,
118 /* fprintf(stderr,"%s: address 0x%lx rw %d mmu_idx %d\n",
119 __FUNCTION__, address, rw, mmu_idx); */
120 env
->exception_index
= EXCP_ADDR
;
121 env
->__excp_addr
= address
; /* FIXME: find out how this works on a real machine */
125 #endif /* CONFIG_USER_ONLY */
127 void cpu_reset(CPUS390XState
*env
)
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);
134 memset(env
, 0, offsetof(CPUS390XState
, breakpoints
));
135 /* FIXME: reset vector? */
137 s390_add_running_cpu(env
);
140 #ifndef CONFIG_USER_ONLY
142 /* Ensure to exit the TB after this call! */
143 static void trigger_pgm_exception(CPUState
*env
, uint32_t code
, uint32_t ilc
)
145 env
->exception_index
= EXCP_PGM
;
146 env
->int_pgm_code
= code
;
147 env
->int_pgm_ilc
= ilc
;
150 static int trans_bits(CPUState
*env
, uint64_t mode
)
155 case PSW_ASC_PRIMARY
:
158 case PSW_ASC_SECONDARY
:
165 cpu_abort(env
, "unknown asc mode\n");
172 static void trigger_prot_fault(CPUState
*env
, target_ulong vaddr
, uint64_t mode
)
174 int ilc
= ILC_LATER_INC_2
;
175 int bits
= trans_bits(env
, mode
) | 4;
177 DPRINTF("%s: vaddr=%016" PRIx64
" bits=%d\n", __FUNCTION__
, vaddr
, bits
);
179 stq_phys(env
->psa
+ offsetof(LowCore
, trans_exc_code
), vaddr
| bits
);
180 trigger_pgm_exception(env
, PGM_PROTECTION
, ilc
);
183 static void trigger_page_fault(CPUState
*env
, target_ulong vaddr
, uint32_t type
,
184 uint64_t asc
, int rw
)
187 int bits
= trans_bits(env
, asc
);
190 /* code has is undefined ilc */
194 DPRINTF("%s: vaddr=%016" PRIx64
" bits=%d\n", __FUNCTION__
, vaddr
, bits
);
196 stq_phys(env
->psa
+ offsetof(LowCore
, trans_exc_code
), vaddr
| bits
);
197 trigger_pgm_exception(env
, type
, ilc
);
200 static int mmu_translate_asce(CPUState
*env
, target_ulong vaddr
, uint64_t asc
,
201 uint64_t asce
, int level
, target_ulong
*raddr
,
208 PTE_DPRINTF("%s: 0x%" PRIx64
"\n", __FUNCTION__
, asce
);
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
);
218 if ((level
<= _ASCE_TYPE_MASK
) && ((asce
& _ASCE_TYPE_MASK
) != level
)) {
219 trigger_page_fault(env
, vaddr
, PGM_TRANS_SPEC
, asc
, rw
);
223 if (asce
& _ASCE_REAL_SPACE
) {
230 origin
= asce
& _ASCE_ORIGIN
;
233 case _ASCE_TYPE_REGION1
+ 4:
234 offs
= (vaddr
>> 50) & 0x3ff8;
236 case _ASCE_TYPE_REGION1
:
237 offs
= (vaddr
>> 39) & 0x3ff8;
239 case _ASCE_TYPE_REGION2
:
240 offs
= (vaddr
>> 28) & 0x3ff8;
242 case _ASCE_TYPE_REGION3
:
243 offs
= (vaddr
>> 17) & 0x3ff8;
245 case _ASCE_TYPE_SEGMENT
:
246 offs
= (vaddr
>> 9) & 0x07f8;
247 origin
= asce
& _SEGMENT_ENTRY_ORIGIN
;
251 /* XXX region protection flags */
252 /* *flags &= ~PAGE_WRITE */
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
);
258 if (level
!= _ASCE_TYPE_SEGMENT
) {
259 /* yet another region */
260 return mmu_translate_asce(env
, vaddr
, asc
, new_asce
, level
- 4, raddr
,
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
);
271 if (new_asce
& _PAGE_RO
) {
272 *flags
&= ~PAGE_WRITE
;
275 *raddr
= new_asce
& _ASCE_ORIGIN
;
277 PTE_DPRINTF("%s: PTE=0x%" PRIx64
"\n", __FUNCTION__
, new_asce
);
282 static int mmu_translate_asc(CPUState
*env
, target_ulong vaddr
, uint64_t asc
,
283 target_ulong
*raddr
, int *flags
, int rw
)
286 int level
, new_level
;
290 case PSW_ASC_PRIMARY
:
291 PTE_DPRINTF("%s: asc=primary\n", __FUNCTION__
);
292 asce
= env
->cregs
[1];
294 case PSW_ASC_SECONDARY
:
295 PTE_DPRINTF("%s: asc=secondary\n", __FUNCTION__
);
296 asce
= env
->cregs
[7];
299 PTE_DPRINTF("%s: asc=home\n", __FUNCTION__
);
300 asce
= env
->cregs
[13];
304 switch (asce
& _ASCE_TYPE_MASK
) {
305 case _ASCE_TYPE_REGION1
:
307 case _ASCE_TYPE_REGION2
:
308 if (vaddr
& 0xffe0000000000000ULL
) {
309 DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
310 " 0xffe0000000000000ULL\n", __FUNCTION__
,
312 trigger_page_fault(env
, vaddr
, PGM_TRANS_SPEC
, asc
, rw
);
316 case _ASCE_TYPE_REGION3
:
317 if (vaddr
& 0xfffffc0000000000ULL
) {
318 DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
319 " 0xfffffc0000000000ULL\n", __FUNCTION__
,
321 trigger_page_fault(env
, vaddr
, PGM_TRANS_SPEC
, asc
, rw
);
325 case _ASCE_TYPE_SEGMENT
:
326 if (vaddr
& 0xffffffff80000000ULL
) {
327 DPRINTF("%s: vaddr doesn't fit 0x%16" PRIx64
328 " 0xffffffff80000000ULL\n", __FUNCTION__
,
330 trigger_page_fault(env
, vaddr
, PGM_TRANS_SPEC
, asc
, rw
);
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
);
341 r
= mmu_translate_asce(env
, vaddr
, asc
, asce
, new_level
, raddr
, flags
, rw
);
343 if ((rw
== 1) && !(*flags
& PAGE_WRITE
)) {
344 trigger_prot_fault(env
, vaddr
, asc
);
351 int mmu_translate(CPUState
*env
, target_ulong vaddr
, int rw
, uint64_t asc
,
352 target_ulong
*raddr
, int *flags
)
357 *flags
= PAGE_READ
| PAGE_WRITE
| PAGE_EXEC
;
358 vaddr
&= TARGET_PAGE_MASK
;
360 if (!(env
->psw
.mask
& PSW_MASK_DAT
)) {
367 case PSW_ASC_PRIMARY
:
369 r
= mmu_translate_asc(env
, vaddr
, asc
, raddr
, flags
, rw
);
371 case PSW_ASC_SECONDARY
:
373 * Instruction: Primary
377 r
= mmu_translate_asc(env
, vaddr
, PSW_ASC_PRIMARY
, raddr
, flags
,
379 *flags
&= ~(PAGE_READ
| PAGE_WRITE
);
381 r
= mmu_translate_asc(env
, vaddr
, PSW_ASC_SECONDARY
, raddr
, flags
,
383 *flags
&= ~(PAGE_EXEC
);
388 hw_error("guest switched to unknown asc mode\n");
393 /* Convert real address -> absolute address */
394 if (*raddr
< 0x2000) {
395 *raddr
= *raddr
+ env
->psa
;
398 if (*raddr
<= ram_size
) {
399 sk
= &env
->storage_keys
[*raddr
/ TARGET_PAGE_SIZE
];
400 if (*flags
& PAGE_READ
) {
404 if (*flags
& PAGE_WRITE
) {
412 int cpu_s390x_handle_mmu_fault (CPUState
*env
, target_ulong _vaddr
, int rw
,
415 uint64_t asc
= env
->psw
.mask
& PSW_MASK_ASC
;
416 target_ulong vaddr
, raddr
;
419 DPRINTF("%s: address 0x%" PRIx64
" rw %d mmu_idx %d\n",
420 __FUNCTION__
, _vaddr
, rw
, mmu_idx
);
422 _vaddr
&= TARGET_PAGE_MASK
;
426 if (!(env
->psw
.mask
& PSW_MASK_64
)) {
430 if (mmu_translate(env
, vaddr
, rw
, asc
, &raddr
, &prot
)) {
431 /* Translation ended in exception */
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
);
443 DPRINTF("%s: set tlb %" PRIx64
" -> %" PRIx64
" (%x)\n", __FUNCTION__
,
444 (uint64_t)vaddr
, (uint64_t)raddr
, prot
);
446 tlb_set_page(env
, _vaddr
, raddr
, prot
,
447 mmu_idx
, TARGET_PAGE_SIZE
);
452 target_phys_addr_t
cpu_get_phys_page_debug(CPUState
*env
, target_ulong vaddr
)
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
;
460 if (!(env
->psw
.mask
& PSW_MASK_64
)) {
464 mmu_translate(env
, vaddr
, 2, asc
, &raddr
, &prot
);
465 env
->exception_index
= old_exc
;
470 void load_psw(CPUState
*env
, uint64_t mask
, uint64_t addr
)
472 if (mask
& PSW_MASK_WAIT
) {
473 if (!(mask
& (PSW_MASK_IO
| PSW_MASK_EXT
| PSW_MASK_MCHECK
))) {
474 if (s390_del_running_cpu(env
) == 0) {
475 #ifndef CONFIG_USER_ONLY
476 qemu_system_shutdown_request();
481 env
->exception_index
= EXCP_HLT
;
484 env
->psw
.addr
= addr
;
485 env
->psw
.mask
= mask
;
486 env
->cc_op
= (mask
>> 13) & 3;
489 static uint64_t get_psw_mask(CPUState
*env
)
491 uint64_t r
= env
->psw
.mask
;
493 env
->cc_op
= calc_cc(env
, env
->cc_op
, env
->cc_src
, env
->cc_dst
, env
->cc_vr
);
496 assert(!(env
->cc_op
& ~3));
497 r
|= env
->cc_op
<< 13;
502 static void do_svc_interrupt(CPUState
*env
)
506 target_phys_addr_t len
= TARGET_PAGE_SIZE
;
508 lowcore
= cpu_physical_memory_map(env
->psa
, &len
, 1);
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
);
517 cpu_physical_memory_unmap(lowcore
, len
, 1, len
);
519 load_psw(env
, mask
, addr
);
522 static void do_program_interrupt(CPUState
*env
)
526 target_phys_addr_t len
= TARGET_PAGE_SIZE
;
527 int ilc
= env
->int_pgm_ilc
;
531 ilc
= get_ilc(ldub_code(env
->psw
.addr
));
534 ilc
= get_ilc(ldub_code(env
->psw
.addr
));
535 env
->psw
.addr
+= ilc
* 2;
537 case ILC_LATER_INC_2
:
538 ilc
= get_ilc(ldub_code(env
->psw
.addr
)) * 2;
539 env
->psw
.addr
+= ilc
;
543 qemu_log("%s: code=0x%x ilc=%d\n", __FUNCTION__
, env
->int_pgm_code
, ilc
);
545 lowcore
= cpu_physical_memory_map(env
->psa
, &len
, 1);
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
);
554 cpu_physical_memory_unmap(lowcore
, len
, 1, len
);
556 DPRINTF("%s: %x %x %" PRIx64
" %" PRIx64
"\n", __FUNCTION__
,
557 env
->int_pgm_code
, ilc
, env
->psw
.mask
,
560 load_psw(env
, mask
, addr
);
563 #define VIRTIO_SUBCODE_64 0x0D00
565 static void do_ext_interrupt(CPUState
*env
)
569 target_phys_addr_t len
= TARGET_PAGE_SIZE
;
572 if (!(env
->psw
.mask
& PSW_MASK_EXT
)) {
573 cpu_abort(env
, "Ext int w/o ext mask\n");
576 if (env
->ext_index
< 0 || env
->ext_index
> MAX_EXT_QUEUE
) {
577 cpu_abort(env
, "Ext queue overrun: %d\n", env
->ext_index
);
580 q
= &env
->ext_queue
[env
->ext_index
];
581 lowcore
= cpu_physical_memory_map(env
->psa
, &len
, 1);
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
);
592 cpu_physical_memory_unmap(lowcore
, len
, 1, len
);
595 if (env
->ext_index
== -1) {
596 env
->pending_int
&= ~INTERRUPT_EXT
;
599 DPRINTF("%s: %" PRIx64
" %" PRIx64
"\n", __FUNCTION__
,
600 env
->psw
.mask
, env
->psw
.addr
);
602 load_psw(env
, mask
, addr
);
605 void do_interrupt (CPUState
*env
)
607 qemu_log("%s: %d at pc=%" PRIx64
"\n", __FUNCTION__
, env
->exception_index
,
610 s390_add_running_cpu(env
);
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
;
630 switch (env
->exception_index
) {
632 do_program_interrupt(env
);
635 do_svc_interrupt(env
);
638 do_ext_interrupt(env
);
641 env
->exception_index
= -1;
643 if (!env
->pending_int
) {
644 env
->interrupt_request
&= ~CPU_INTERRUPT_HARD
;
648 #endif /* CONFIG_USER_ONLY */