root / target-s390x / kvm.c @ 29eee86f
History | View | Annotate | Download (12.8 kB)
1 | 0e60a699 | Alexander Graf | /*
|
---|---|---|---|
2 | 0e60a699 | Alexander Graf | * QEMU S390x KVM implementation
|
3 | 0e60a699 | Alexander Graf | *
|
4 | 0e60a699 | Alexander Graf | * Copyright (c) 2009 Alexander Graf <agraf@suse.de>
|
5 | 0e60a699 | Alexander Graf | *
|
6 | 0e60a699 | Alexander Graf | * This library is free software; you can redistribute it and/or
|
7 | 0e60a699 | Alexander Graf | * modify it under the terms of the GNU Lesser General Public
|
8 | 0e60a699 | Alexander Graf | * License as published by the Free Software Foundation; either
|
9 | 0e60a699 | Alexander Graf | * version 2 of the License, or (at your option) any later version.
|
10 | 0e60a699 | Alexander Graf | *
|
11 | 0e60a699 | Alexander Graf | * This library is distributed in the hope that it will be useful,
|
12 | 0e60a699 | Alexander Graf | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | 0e60a699 | Alexander Graf | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | 0e60a699 | Alexander Graf | * Lesser General Public License for more details.
|
15 | 0e60a699 | Alexander Graf | *
|
16 | 0e60a699 | Alexander Graf | * You should have received a copy of the GNU Lesser General Public
|
17 | 0e60a699 | Alexander Graf | * License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
18 | 0e60a699 | Alexander Graf | */
|
19 | 0e60a699 | Alexander Graf | |
20 | 0e60a699 | Alexander Graf | #include <sys/types.h> |
21 | 0e60a699 | Alexander Graf | #include <sys/ioctl.h> |
22 | 0e60a699 | Alexander Graf | #include <sys/mman.h> |
23 | 0e60a699 | Alexander Graf | |
24 | 0e60a699 | Alexander Graf | #include <linux/kvm.h> |
25 | 0e60a699 | Alexander Graf | #include <asm/ptrace.h> |
26 | 0e60a699 | Alexander Graf | |
27 | 0e60a699 | Alexander Graf | #include "qemu-common.h" |
28 | 0e60a699 | Alexander Graf | #include "qemu-timer.h" |
29 | 0e60a699 | Alexander Graf | #include "sysemu.h" |
30 | 0e60a699 | Alexander Graf | #include "kvm.h" |
31 | 0e60a699 | Alexander Graf | #include "cpu.h" |
32 | 0e60a699 | Alexander Graf | #include "device_tree.h" |
33 | 0e60a699 | Alexander Graf | |
34 | 0e60a699 | Alexander Graf | /* #define DEBUG_KVM */
|
35 | 0e60a699 | Alexander Graf | |
36 | 0e60a699 | Alexander Graf | #ifdef DEBUG_KVM
|
37 | 0e60a699 | Alexander Graf | #define dprintf(fmt, ...) \
|
38 | 0e60a699 | Alexander Graf | do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0) |
39 | 0e60a699 | Alexander Graf | #else
|
40 | 0e60a699 | Alexander Graf | #define dprintf(fmt, ...) \
|
41 | 0e60a699 | Alexander Graf | do { } while (0) |
42 | 0e60a699 | Alexander Graf | #endif
|
43 | 0e60a699 | Alexander Graf | |
44 | 0e60a699 | Alexander Graf | #define IPA0_DIAG 0x8300 |
45 | 0e60a699 | Alexander Graf | #define IPA0_SIGP 0xae00 |
46 | 0e60a699 | Alexander Graf | #define IPA0_PRIV 0xb200 |
47 | 0e60a699 | Alexander Graf | |
48 | 0e60a699 | Alexander Graf | #define PRIV_SCLP_CALL 0x20 |
49 | 0e60a699 | Alexander Graf | #define DIAG_KVM_HYPERCALL 0x500 |
50 | 0e60a699 | Alexander Graf | #define DIAG_KVM_BREAKPOINT 0x501 |
51 | 0e60a699 | Alexander Graf | |
52 | 0e60a699 | Alexander Graf | #define ICPT_INSTRUCTION 0x04 |
53 | 0e60a699 | Alexander Graf | #define ICPT_WAITPSW 0x1c |
54 | 0e60a699 | Alexander Graf | #define ICPT_SOFT_INTERCEPT 0x24 |
55 | 0e60a699 | Alexander Graf | #define ICPT_CPU_STOP 0x28 |
56 | 0e60a699 | Alexander Graf | #define ICPT_IO 0x40 |
57 | 0e60a699 | Alexander Graf | |
58 | 0e60a699 | Alexander Graf | #define SIGP_RESTART 0x06 |
59 | 0e60a699 | Alexander Graf | #define SIGP_INITIAL_CPU_RESET 0x0b |
60 | 0e60a699 | Alexander Graf | #define SIGP_STORE_STATUS_ADDR 0x0e |
61 | 0e60a699 | Alexander Graf | #define SIGP_SET_ARCH 0x12 |
62 | 0e60a699 | Alexander Graf | |
63 | 0e60a699 | Alexander Graf | #define SCLP_CMDW_READ_SCP_INFO 0x00020001 |
64 | 0e60a699 | Alexander Graf | #define SCLP_CMDW_READ_SCP_INFO_FORCED 0x00120001 |
65 | 0e60a699 | Alexander Graf | |
66 | 94a8d39a | Jan Kiszka | const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
|
67 | 94a8d39a | Jan Kiszka | KVM_CAP_LAST_INFO |
68 | 94a8d39a | Jan Kiszka | }; |
69 | 94a8d39a | Jan Kiszka | |
70 | cad1e282 | Jan Kiszka | int kvm_arch_init(KVMState *s)
|
71 | 0e60a699 | Alexander Graf | { |
72 | 0e60a699 | Alexander Graf | return 0; |
73 | 0e60a699 | Alexander Graf | } |
74 | 0e60a699 | Alexander Graf | |
75 | a4e3ad19 | Andreas Färber | int kvm_arch_init_vcpu(CPUS390XState *env)
|
76 | 0e60a699 | Alexander Graf | { |
77 | 0e60a699 | Alexander Graf | int ret = 0; |
78 | 0e60a699 | Alexander Graf | |
79 | 0e60a699 | Alexander Graf | if (kvm_vcpu_ioctl(env, KVM_S390_INITIAL_RESET, NULL) < 0) { |
80 | 0e60a699 | Alexander Graf | perror("cannot init reset vcpu");
|
81 | 0e60a699 | Alexander Graf | } |
82 | 0e60a699 | Alexander Graf | |
83 | 0e60a699 | Alexander Graf | return ret;
|
84 | 0e60a699 | Alexander Graf | } |
85 | 0e60a699 | Alexander Graf | |
86 | a4e3ad19 | Andreas Färber | void kvm_arch_reset_vcpu(CPUS390XState *env)
|
87 | 0e60a699 | Alexander Graf | { |
88 | 0e60a699 | Alexander Graf | /* FIXME: add code to reset vcpu. */
|
89 | 0e60a699 | Alexander Graf | } |
90 | 0e60a699 | Alexander Graf | |
91 | a4e3ad19 | Andreas Färber | int kvm_arch_put_registers(CPUS390XState *env, int level) |
92 | 0e60a699 | Alexander Graf | { |
93 | 0e60a699 | Alexander Graf | struct kvm_regs regs;
|
94 | 0e60a699 | Alexander Graf | int ret;
|
95 | 0e60a699 | Alexander Graf | int i;
|
96 | 0e60a699 | Alexander Graf | |
97 | 0e60a699 | Alexander Graf | ret = kvm_vcpu_ioctl(env, KVM_GET_REGS, ®s); |
98 | 0e60a699 | Alexander Graf | if (ret < 0) { |
99 | 0e60a699 | Alexander Graf | return ret;
|
100 | 0e60a699 | Alexander Graf | } |
101 | 0e60a699 | Alexander Graf | |
102 | 0e60a699 | Alexander Graf | for (i = 0; i < 16; i++) { |
103 | 0e60a699 | Alexander Graf | regs.gprs[i] = env->regs[i]; |
104 | 0e60a699 | Alexander Graf | } |
105 | 0e60a699 | Alexander Graf | |
106 | 0e60a699 | Alexander Graf | ret = kvm_vcpu_ioctl(env, KVM_SET_REGS, ®s); |
107 | 0e60a699 | Alexander Graf | if (ret < 0) { |
108 | 0e60a699 | Alexander Graf | return ret;
|
109 | 0e60a699 | Alexander Graf | } |
110 | 0e60a699 | Alexander Graf | |
111 | 0e60a699 | Alexander Graf | env->kvm_run->psw_addr = env->psw.addr; |
112 | 0e60a699 | Alexander Graf | env->kvm_run->psw_mask = env->psw.mask; |
113 | 0e60a699 | Alexander Graf | |
114 | 0e60a699 | Alexander Graf | return ret;
|
115 | 0e60a699 | Alexander Graf | } |
116 | 0e60a699 | Alexander Graf | |
117 | a4e3ad19 | Andreas Färber | int kvm_arch_get_registers(CPUS390XState *env)
|
118 | 0e60a699 | Alexander Graf | { |
119 | 6c33286a | Alexander Graf | int ret;
|
120 | 0e60a699 | Alexander Graf | struct kvm_regs regs;
|
121 | 0e60a699 | Alexander Graf | int i;
|
122 | 0e60a699 | Alexander Graf | |
123 | 0e60a699 | Alexander Graf | ret = kvm_vcpu_ioctl(env, KVM_GET_REGS, ®s); |
124 | 0e60a699 | Alexander Graf | if (ret < 0) { |
125 | 0e60a699 | Alexander Graf | return ret;
|
126 | 0e60a699 | Alexander Graf | } |
127 | 0e60a699 | Alexander Graf | |
128 | 0e60a699 | Alexander Graf | for (i = 0; i < 16; i++) { |
129 | 0e60a699 | Alexander Graf | env->regs[i] = regs.gprs[i]; |
130 | 0e60a699 | Alexander Graf | } |
131 | 0e60a699 | Alexander Graf | |
132 | 0e60a699 | Alexander Graf | env->psw.addr = env->kvm_run->psw_addr; |
133 | 0e60a699 | Alexander Graf | env->psw.mask = env->kvm_run->psw_mask; |
134 | 0e60a699 | Alexander Graf | |
135 | 0e60a699 | Alexander Graf | return 0; |
136 | 0e60a699 | Alexander Graf | } |
137 | 0e60a699 | Alexander Graf | |
138 | fdec9918 | Christian Borntraeger | /*
|
139 | fdec9918 | Christian Borntraeger | * Legacy layout for s390:
|
140 | fdec9918 | Christian Borntraeger | * Older S390 KVM requires the topmost vma of the RAM to be
|
141 | fdec9918 | Christian Borntraeger | * smaller than an system defined value, which is at least 256GB.
|
142 | fdec9918 | Christian Borntraeger | * Larger systems have larger values. We put the guest between
|
143 | fdec9918 | Christian Borntraeger | * the end of data segment (system break) and this value. We
|
144 | fdec9918 | Christian Borntraeger | * use 32GB as a base to have enough room for the system break
|
145 | fdec9918 | Christian Borntraeger | * to grow. We also have to use MAP parameters that avoid
|
146 | fdec9918 | Christian Borntraeger | * read-only mapping of guest pages.
|
147 | fdec9918 | Christian Borntraeger | */
|
148 | fdec9918 | Christian Borntraeger | static void *legacy_s390_alloc(ram_addr_t size) |
149 | fdec9918 | Christian Borntraeger | { |
150 | fdec9918 | Christian Borntraeger | void *mem;
|
151 | fdec9918 | Christian Borntraeger | |
152 | fdec9918 | Christian Borntraeger | mem = mmap((void *) 0x800000000ULL, size, |
153 | fdec9918 | Christian Borntraeger | PROT_EXEC|PROT_READ|PROT_WRITE, |
154 | fdec9918 | Christian Borntraeger | MAP_SHARED | MAP_ANONYMOUS | MAP_FIXED, -1, 0); |
155 | fdec9918 | Christian Borntraeger | if (mem == MAP_FAILED) {
|
156 | fdec9918 | Christian Borntraeger | fprintf(stderr, "Allocating RAM failed\n");
|
157 | fdec9918 | Christian Borntraeger | abort(); |
158 | fdec9918 | Christian Borntraeger | } |
159 | fdec9918 | Christian Borntraeger | return mem;
|
160 | fdec9918 | Christian Borntraeger | } |
161 | fdec9918 | Christian Borntraeger | |
162 | fdec9918 | Christian Borntraeger | void *kvm_arch_vmalloc(ram_addr_t size)
|
163 | fdec9918 | Christian Borntraeger | { |
164 | fdec9918 | Christian Borntraeger | /* Can we use the standard allocation ? */
|
165 | fdec9918 | Christian Borntraeger | if (kvm_check_extension(kvm_state, KVM_CAP_S390_GMAP) &&
|
166 | fdec9918 | Christian Borntraeger | kvm_check_extension(kvm_state, KVM_CAP_S390_COW)) { |
167 | fdec9918 | Christian Borntraeger | return NULL; |
168 | fdec9918 | Christian Borntraeger | } else {
|
169 | fdec9918 | Christian Borntraeger | return legacy_s390_alloc(size);
|
170 | fdec9918 | Christian Borntraeger | } |
171 | fdec9918 | Christian Borntraeger | } |
172 | fdec9918 | Christian Borntraeger | |
173 | a4e3ad19 | Andreas Färber | int kvm_arch_insert_sw_breakpoint(CPUS390XState *env, struct kvm_sw_breakpoint *bp) |
174 | 0e60a699 | Alexander Graf | { |
175 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
176 | 0e60a699 | Alexander Graf | |
177 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 4, 0) || |
178 | 0e60a699 | Alexander Graf | cpu_memory_rw_debug(env, bp->pc, (uint8_t *)diag_501, 4, 1)) { |
179 | 0e60a699 | Alexander Graf | return -EINVAL;
|
180 | 0e60a699 | Alexander Graf | } |
181 | 0e60a699 | Alexander Graf | return 0; |
182 | 0e60a699 | Alexander Graf | } |
183 | 0e60a699 | Alexander Graf | |
184 | a4e3ad19 | Andreas Färber | int kvm_arch_remove_sw_breakpoint(CPUS390XState *env, struct kvm_sw_breakpoint *bp) |
185 | 0e60a699 | Alexander Graf | { |
186 | 0e60a699 | Alexander Graf | uint8_t t[4];
|
187 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
188 | 0e60a699 | Alexander Graf | |
189 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, t, 4, 0)) { |
190 | 0e60a699 | Alexander Graf | return -EINVAL;
|
191 | 0e60a699 | Alexander Graf | } else if (memcmp(t, diag_501, 4)) { |
192 | 0e60a699 | Alexander Graf | return -EINVAL;
|
193 | 0e60a699 | Alexander Graf | } else if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 1, 1)) { |
194 | 0e60a699 | Alexander Graf | return -EINVAL;
|
195 | 0e60a699 | Alexander Graf | } |
196 | 0e60a699 | Alexander Graf | |
197 | 0e60a699 | Alexander Graf | return 0; |
198 | 0e60a699 | Alexander Graf | } |
199 | 0e60a699 | Alexander Graf | |
200 | a4e3ad19 | Andreas Färber | void kvm_arch_pre_run(CPUS390XState *env, struct kvm_run *run) |
201 | 0e60a699 | Alexander Graf | { |
202 | 0e60a699 | Alexander Graf | } |
203 | 0e60a699 | Alexander Graf | |
204 | a4e3ad19 | Andreas Färber | void kvm_arch_post_run(CPUS390XState *env, struct kvm_run *run) |
205 | 0e60a699 | Alexander Graf | { |
206 | 0e60a699 | Alexander Graf | } |
207 | 0e60a699 | Alexander Graf | |
208 | a4e3ad19 | Andreas Färber | int kvm_arch_process_async_events(CPUS390XState *env)
|
209 | 0af691d7 | Marcelo Tosatti | { |
210 | 71b12d31 | Christian Borntraeger | return env->halted;
|
211 | 0af691d7 | Marcelo Tosatti | } |
212 | 0af691d7 | Marcelo Tosatti | |
213 | a4e3ad19 | Andreas Färber | void kvm_s390_interrupt_internal(CPUS390XState *env, int type, uint32_t parm, |
214 | bcec36ea | Alexander Graf | uint64_t parm64, int vm)
|
215 | 0e60a699 | Alexander Graf | { |
216 | 0e60a699 | Alexander Graf | struct kvm_s390_interrupt kvmint;
|
217 | 0e60a699 | Alexander Graf | int r;
|
218 | 0e60a699 | Alexander Graf | |
219 | 0e60a699 | Alexander Graf | if (!env->kvm_state) {
|
220 | 0e60a699 | Alexander Graf | return;
|
221 | 0e60a699 | Alexander Graf | } |
222 | 0e60a699 | Alexander Graf | |
223 | 0e60a699 | Alexander Graf | kvmint.type = type; |
224 | 0e60a699 | Alexander Graf | kvmint.parm = parm; |
225 | 0e60a699 | Alexander Graf | kvmint.parm64 = parm64; |
226 | 0e60a699 | Alexander Graf | |
227 | 0e60a699 | Alexander Graf | if (vm) {
|
228 | 0e60a699 | Alexander Graf | r = kvm_vm_ioctl(env->kvm_state, KVM_S390_INTERRUPT, &kvmint); |
229 | 0e60a699 | Alexander Graf | } else {
|
230 | 0e60a699 | Alexander Graf | r = kvm_vcpu_ioctl(env, KVM_S390_INTERRUPT, &kvmint); |
231 | 0e60a699 | Alexander Graf | } |
232 | 0e60a699 | Alexander Graf | |
233 | 0e60a699 | Alexander Graf | if (r < 0) { |
234 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM failed to inject interrupt\n");
|
235 | 0e60a699 | Alexander Graf | exit(1);
|
236 | 0e60a699 | Alexander Graf | } |
237 | 0e60a699 | Alexander Graf | } |
238 | 0e60a699 | Alexander Graf | |
239 | a4e3ad19 | Andreas Färber | void kvm_s390_virtio_irq(CPUS390XState *env, int config_change, uint64_t token) |
240 | 0e60a699 | Alexander Graf | { |
241 | 0e60a699 | Alexander Graf | kvm_s390_interrupt_internal(env, KVM_S390_INT_VIRTIO, config_change, |
242 | 0e60a699 | Alexander Graf | token, 1);
|
243 | 0e60a699 | Alexander Graf | } |
244 | 0e60a699 | Alexander Graf | |
245 | a4e3ad19 | Andreas Färber | void kvm_s390_interrupt(CPUS390XState *env, int type, uint32_t code) |
246 | 0e60a699 | Alexander Graf | { |
247 | 0e60a699 | Alexander Graf | kvm_s390_interrupt_internal(env, type, code, 0, 0); |
248 | 0e60a699 | Alexander Graf | } |
249 | 0e60a699 | Alexander Graf | |
250 | a4e3ad19 | Andreas Färber | static void enter_pgmcheck(CPUS390XState *env, uint16_t code) |
251 | 0e60a699 | Alexander Graf | { |
252 | 0e60a699 | Alexander Graf | kvm_s390_interrupt(env, KVM_S390_PROGRAM_INT, code); |
253 | 0e60a699 | Alexander Graf | } |
254 | 0e60a699 | Alexander Graf | |
255 | a4e3ad19 | Andreas Färber | static inline void setcc(CPUS390XState *env, uint64_t cc) |
256 | 0e60a699 | Alexander Graf | { |
257 | 81f7c56c | Alexander Graf | env->kvm_run->psw_mask &= ~(3ull << 44); |
258 | 0e60a699 | Alexander Graf | env->kvm_run->psw_mask |= (cc & 3) << 44; |
259 | 0e60a699 | Alexander Graf | |
260 | 0e60a699 | Alexander Graf | env->psw.mask &= ~(3ul << 44); |
261 | 0e60a699 | Alexander Graf | env->psw.mask |= (cc & 3) << 44; |
262 | 0e60a699 | Alexander Graf | } |
263 | 0e60a699 | Alexander Graf | |
264 | a4e3ad19 | Andreas Färber | static int kvm_sclp_service_call(CPUS390XState *env, struct kvm_run *run, |
265 | bcec36ea | Alexander Graf | uint16_t ipbh0) |
266 | 0e60a699 | Alexander Graf | { |
267 | 0e60a699 | Alexander Graf | uint32_t sccb; |
268 | 0e60a699 | Alexander Graf | uint64_t code; |
269 | 0e60a699 | Alexander Graf | int r = 0; |
270 | 0e60a699 | Alexander Graf | |
271 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
272 | 0e60a699 | Alexander Graf | sccb = env->regs[ipbh0 & 0xf];
|
273 | 0e60a699 | Alexander Graf | code = env->regs[(ipbh0 & 0xf0) >> 4]; |
274 | 0e60a699 | Alexander Graf | |
275 | 81f7c56c | Alexander Graf | r = sclp_service_call(env, sccb, code); |
276 | 9abf567d | Christian Borntraeger | if (r < 0) { |
277 | 9abf567d | Christian Borntraeger | enter_pgmcheck(env, -r); |
278 | 0e60a699 | Alexander Graf | } |
279 | 9abf567d | Christian Borntraeger | setcc(env, r); |
280 | 81f7c56c | Alexander Graf | |
281 | 0e60a699 | Alexander Graf | return 0; |
282 | 0e60a699 | Alexander Graf | } |
283 | 0e60a699 | Alexander Graf | |
284 | a4e3ad19 | Andreas Färber | static int handle_priv(CPUS390XState *env, struct kvm_run *run, uint8_t ipa1) |
285 | 0e60a699 | Alexander Graf | { |
286 | 0e60a699 | Alexander Graf | int r = 0; |
287 | 0e60a699 | Alexander Graf | uint16_t ipbh0 = (run->s390_sieic.ipb & 0xffff0000) >> 16; |
288 | 0e60a699 | Alexander Graf | |
289 | 0e60a699 | Alexander Graf | dprintf("KVM: PRIV: %d\n", ipa1);
|
290 | 0e60a699 | Alexander Graf | switch (ipa1) {
|
291 | 0e60a699 | Alexander Graf | case PRIV_SCLP_CALL:
|
292 | bcec36ea | Alexander Graf | r = kvm_sclp_service_call(env, run, ipbh0); |
293 | 0e60a699 | Alexander Graf | break;
|
294 | 0e60a699 | Alexander Graf | default:
|
295 | 0e60a699 | Alexander Graf | dprintf("KVM: unknown PRIV: 0x%x\n", ipa1);
|
296 | 0e60a699 | Alexander Graf | r = -1;
|
297 | 0e60a699 | Alexander Graf | break;
|
298 | 0e60a699 | Alexander Graf | } |
299 | 0e60a699 | Alexander Graf | |
300 | 0e60a699 | Alexander Graf | return r;
|
301 | 0e60a699 | Alexander Graf | } |
302 | 0e60a699 | Alexander Graf | |
303 | a4e3ad19 | Andreas Färber | static int handle_hypercall(CPUS390XState *env, struct kvm_run *run) |
304 | 0e60a699 | Alexander Graf | { |
305 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
306 | bcec36ea | Alexander Graf | env->regs[2] = s390_virtio_hypercall(env, env->regs[2], env->regs[1]); |
307 | 0e60a699 | Alexander Graf | |
308 | bcec36ea | Alexander Graf | return 0; |
309 | 0e60a699 | Alexander Graf | } |
310 | 0e60a699 | Alexander Graf | |
311 | a4e3ad19 | Andreas Färber | static int handle_diag(CPUS390XState *env, struct kvm_run *run, int ipb_code) |
312 | 0e60a699 | Alexander Graf | { |
313 | 0e60a699 | Alexander Graf | int r = 0; |
314 | 0e60a699 | Alexander Graf | |
315 | 0e60a699 | Alexander Graf | switch (ipb_code) {
|
316 | 0e60a699 | Alexander Graf | case DIAG_KVM_HYPERCALL:
|
317 | 0e60a699 | Alexander Graf | r = handle_hypercall(env, run); |
318 | 0e60a699 | Alexander Graf | break;
|
319 | 0e60a699 | Alexander Graf | case DIAG_KVM_BREAKPOINT:
|
320 | 0e60a699 | Alexander Graf | sleep(10);
|
321 | 0e60a699 | Alexander Graf | break;
|
322 | 0e60a699 | Alexander Graf | default:
|
323 | 0e60a699 | Alexander Graf | dprintf("KVM: unknown DIAG: 0x%x\n", ipb_code);
|
324 | 0e60a699 | Alexander Graf | r = -1;
|
325 | 0e60a699 | Alexander Graf | break;
|
326 | 0e60a699 | Alexander Graf | } |
327 | 0e60a699 | Alexander Graf | |
328 | 0e60a699 | Alexander Graf | return r;
|
329 | 0e60a699 | Alexander Graf | } |
330 | 0e60a699 | Alexander Graf | |
331 | 3edb8f92 | Andreas Färber | static int s390_cpu_restart(S390CPU *cpu) |
332 | 0e60a699 | Alexander Graf | { |
333 | 3edb8f92 | Andreas Färber | CPUS390XState *env = &cpu->env; |
334 | 3edb8f92 | Andreas Färber | |
335 | 0e60a699 | Alexander Graf | kvm_s390_interrupt(env, KVM_S390_RESTART, 0);
|
336 | 854e42f3 | Christian Borntraeger | s390_add_running_cpu(env); |
337 | 0e60a699 | Alexander Graf | qemu_cpu_kick(env); |
338 | 0e60a699 | Alexander Graf | dprintf("DONE: SIGP cpu restart: %p\n", env);
|
339 | 0e60a699 | Alexander Graf | return 0; |
340 | 0e60a699 | Alexander Graf | } |
341 | 0e60a699 | Alexander Graf | |
342 | a4e3ad19 | Andreas Färber | static int s390_store_status(CPUS390XState *env, uint32_t parameter) |
343 | 0e60a699 | Alexander Graf | { |
344 | 0e60a699 | Alexander Graf | /* XXX */
|
345 | 0e60a699 | Alexander Graf | fprintf(stderr, "XXX SIGP store status\n");
|
346 | 0e60a699 | Alexander Graf | return -1; |
347 | 0e60a699 | Alexander Graf | } |
348 | 0e60a699 | Alexander Graf | |
349 | a4e3ad19 | Andreas Färber | static int s390_cpu_initial_reset(CPUS390XState *env) |
350 | 0e60a699 | Alexander Graf | { |
351 | d5900813 | Alexander Graf | int i;
|
352 | d5900813 | Alexander Graf | |
353 | 2fb70f6f | Christian Borntraeger | s390_del_running_cpu(env); |
354 | d5900813 | Alexander Graf | if (kvm_vcpu_ioctl(env, KVM_S390_INITIAL_RESET, NULL) < 0) { |
355 | d5900813 | Alexander Graf | perror("cannot init reset vcpu");
|
356 | d5900813 | Alexander Graf | } |
357 | d5900813 | Alexander Graf | |
358 | d5900813 | Alexander Graf | /* Manually zero out all registers */
|
359 | d5900813 | Alexander Graf | cpu_synchronize_state(env); |
360 | d5900813 | Alexander Graf | for (i = 0; i < 16; i++) { |
361 | d5900813 | Alexander Graf | env->regs[i] = 0;
|
362 | d5900813 | Alexander Graf | } |
363 | d5900813 | Alexander Graf | |
364 | d5900813 | Alexander Graf | dprintf("DONE: SIGP initial reset: %p\n", env);
|
365 | d5900813 | Alexander Graf | return 0; |
366 | 0e60a699 | Alexander Graf | } |
367 | 0e60a699 | Alexander Graf | |
368 | a4e3ad19 | Andreas Färber | static int handle_sigp(CPUS390XState *env, struct kvm_run *run, uint8_t ipa1) |
369 | 0e60a699 | Alexander Graf | { |
370 | 0e60a699 | Alexander Graf | uint8_t order_code; |
371 | 0e60a699 | Alexander Graf | uint32_t parameter; |
372 | 0e60a699 | Alexander Graf | uint16_t cpu_addr; |
373 | 0e60a699 | Alexander Graf | uint8_t t; |
374 | 0e60a699 | Alexander Graf | int r = -1; |
375 | 45fa769b | Andreas Färber | S390CPU *target_cpu; |
376 | a4e3ad19 | Andreas Färber | CPUS390XState *target_env; |
377 | 0e60a699 | Alexander Graf | |
378 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
379 | 0e60a699 | Alexander Graf | |
380 | 0e60a699 | Alexander Graf | /* get order code */
|
381 | 0e60a699 | Alexander Graf | order_code = run->s390_sieic.ipb >> 28;
|
382 | 0e60a699 | Alexander Graf | if (order_code > 0) { |
383 | 0e60a699 | Alexander Graf | order_code = env->regs[order_code]; |
384 | 0e60a699 | Alexander Graf | } |
385 | 0e60a699 | Alexander Graf | order_code += (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
386 | 0e60a699 | Alexander Graf | |
387 | 0e60a699 | Alexander Graf | /* get parameters */
|
388 | 0e60a699 | Alexander Graf | t = (ipa1 & 0xf0) >> 4; |
389 | 0e60a699 | Alexander Graf | if (!(t % 2)) { |
390 | 0e60a699 | Alexander Graf | t++; |
391 | 0e60a699 | Alexander Graf | } |
392 | 0e60a699 | Alexander Graf | |
393 | 0e60a699 | Alexander Graf | parameter = env->regs[t] & 0x7ffffe00;
|
394 | 0e60a699 | Alexander Graf | cpu_addr = env->regs[ipa1 & 0x0f];
|
395 | 0e60a699 | Alexander Graf | |
396 | 45fa769b | Andreas Färber | target_cpu = s390_cpu_addr2state(cpu_addr); |
397 | 45fa769b | Andreas Färber | if (target_cpu == NULL) { |
398 | 0e60a699 | Alexander Graf | goto out;
|
399 | 0e60a699 | Alexander Graf | } |
400 | 45fa769b | Andreas Färber | target_env = &target_cpu->env; |
401 | 0e60a699 | Alexander Graf | |
402 | 0e60a699 | Alexander Graf | switch (order_code) {
|
403 | 0e60a699 | Alexander Graf | case SIGP_RESTART:
|
404 | 3edb8f92 | Andreas Färber | r = s390_cpu_restart(target_cpu); |
405 | 0e60a699 | Alexander Graf | break;
|
406 | 0e60a699 | Alexander Graf | case SIGP_STORE_STATUS_ADDR:
|
407 | 0e60a699 | Alexander Graf | r = s390_store_status(target_env, parameter); |
408 | 0e60a699 | Alexander Graf | break;
|
409 | 0e60a699 | Alexander Graf | case SIGP_SET_ARCH:
|
410 | 0e60a699 | Alexander Graf | /* make the caller panic */
|
411 | 0e60a699 | Alexander Graf | return -1; |
412 | 0e60a699 | Alexander Graf | case SIGP_INITIAL_CPU_RESET:
|
413 | 0e60a699 | Alexander Graf | r = s390_cpu_initial_reset(target_env); |
414 | 0e60a699 | Alexander Graf | break;
|
415 | 0e60a699 | Alexander Graf | default:
|
416 | a74cdab4 | Christian Borntraeger | fprintf(stderr, "KVM: unknown SIGP: 0x%x\n", order_code);
|
417 | 0e60a699 | Alexander Graf | break;
|
418 | 0e60a699 | Alexander Graf | } |
419 | 0e60a699 | Alexander Graf | |
420 | 0e60a699 | Alexander Graf | out:
|
421 | 0e60a699 | Alexander Graf | setcc(env, r ? 3 : 0); |
422 | 0e60a699 | Alexander Graf | return 0; |
423 | 0e60a699 | Alexander Graf | } |
424 | 0e60a699 | Alexander Graf | |
425 | a4e3ad19 | Andreas Färber | static int handle_instruction(CPUS390XState *env, struct kvm_run *run) |
426 | 0e60a699 | Alexander Graf | { |
427 | 0e60a699 | Alexander Graf | unsigned int ipa0 = (run->s390_sieic.ipa & 0xff00); |
428 | 0e60a699 | Alexander Graf | uint8_t ipa1 = run->s390_sieic.ipa & 0x00ff;
|
429 | 0e60a699 | Alexander Graf | int ipb_code = (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
430 | d7963c43 | Alexander Graf | int r = -1; |
431 | 0e60a699 | Alexander Graf | |
432 | 0e60a699 | Alexander Graf | dprintf("handle_instruction 0x%x 0x%x\n", run->s390_sieic.ipa, run->s390_sieic.ipb);
|
433 | 0e60a699 | Alexander Graf | switch (ipa0) {
|
434 | 0e60a699 | Alexander Graf | case IPA0_PRIV:
|
435 | 0e60a699 | Alexander Graf | r = handle_priv(env, run, ipa1); |
436 | 0e60a699 | Alexander Graf | break;
|
437 | 0e60a699 | Alexander Graf | case IPA0_DIAG:
|
438 | 0e60a699 | Alexander Graf | r = handle_diag(env, run, ipb_code); |
439 | 0e60a699 | Alexander Graf | break;
|
440 | 0e60a699 | Alexander Graf | case IPA0_SIGP:
|
441 | 0e60a699 | Alexander Graf | r = handle_sigp(env, run, ipa1); |
442 | 0e60a699 | Alexander Graf | break;
|
443 | 0e60a699 | Alexander Graf | } |
444 | 0e60a699 | Alexander Graf | |
445 | 0e60a699 | Alexander Graf | if (r < 0) { |
446 | 0e60a699 | Alexander Graf | enter_pgmcheck(env, 0x0001);
|
447 | 0e60a699 | Alexander Graf | } |
448 | 359507ee | Alexander Graf | return 0; |
449 | 0e60a699 | Alexander Graf | } |
450 | 0e60a699 | Alexander Graf | |
451 | eca3ed03 | Christian Borntraeger | static bool is_special_wait_psw(CPUS390XState *env) |
452 | eca3ed03 | Christian Borntraeger | { |
453 | eca3ed03 | Christian Borntraeger | /* signal quiesce */
|
454 | eca3ed03 | Christian Borntraeger | return env->kvm_run->psw_addr == 0xfffUL; |
455 | eca3ed03 | Christian Borntraeger | } |
456 | eca3ed03 | Christian Borntraeger | |
457 | a4e3ad19 | Andreas Färber | static int handle_intercept(CPUS390XState *env) |
458 | 0e60a699 | Alexander Graf | { |
459 | 0e60a699 | Alexander Graf | struct kvm_run *run = env->kvm_run;
|
460 | 0e60a699 | Alexander Graf | int icpt_code = run->s390_sieic.icptcode;
|
461 | 0e60a699 | Alexander Graf | int r = 0; |
462 | 0e60a699 | Alexander Graf | |
463 | 81f7c56c | Alexander Graf | dprintf("intercept: 0x%x (at 0x%lx)\n", icpt_code,
|
464 | 81f7c56c | Alexander Graf | (long)env->kvm_run->psw_addr);
|
465 | 0e60a699 | Alexander Graf | switch (icpt_code) {
|
466 | 0e60a699 | Alexander Graf | case ICPT_INSTRUCTION:
|
467 | 0e60a699 | Alexander Graf | r = handle_instruction(env, run); |
468 | 0e60a699 | Alexander Graf | break;
|
469 | 0e60a699 | Alexander Graf | case ICPT_WAITPSW:
|
470 | eca3ed03 | Christian Borntraeger | if (s390_del_running_cpu(env) == 0 && |
471 | eca3ed03 | Christian Borntraeger | is_special_wait_psw(env)) { |
472 | eca3ed03 | Christian Borntraeger | qemu_system_shutdown_request(); |
473 | eca3ed03 | Christian Borntraeger | } |
474 | eca3ed03 | Christian Borntraeger | r = EXCP_HALTED; |
475 | eca3ed03 | Christian Borntraeger | break;
|
476 | 854e42f3 | Christian Borntraeger | case ICPT_CPU_STOP:
|
477 | 854e42f3 | Christian Borntraeger | if (s390_del_running_cpu(env) == 0) { |
478 | 854e42f3 | Christian Borntraeger | qemu_system_shutdown_request(); |
479 | 854e42f3 | Christian Borntraeger | } |
480 | 854e42f3 | Christian Borntraeger | r = EXCP_HALTED; |
481 | 0e60a699 | Alexander Graf | break;
|
482 | 0e60a699 | Alexander Graf | case ICPT_SOFT_INTERCEPT:
|
483 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt SOFT\n");
|
484 | 0e60a699 | Alexander Graf | exit(1);
|
485 | 0e60a699 | Alexander Graf | break;
|
486 | 0e60a699 | Alexander Graf | case ICPT_IO:
|
487 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt IO\n");
|
488 | 0e60a699 | Alexander Graf | exit(1);
|
489 | 0e60a699 | Alexander Graf | break;
|
490 | 0e60a699 | Alexander Graf | default:
|
491 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown intercept code: %d\n", icpt_code);
|
492 | 0e60a699 | Alexander Graf | exit(1);
|
493 | 0e60a699 | Alexander Graf | break;
|
494 | 0e60a699 | Alexander Graf | } |
495 | 0e60a699 | Alexander Graf | |
496 | 0e60a699 | Alexander Graf | return r;
|
497 | 0e60a699 | Alexander Graf | } |
498 | 0e60a699 | Alexander Graf | |
499 | a4e3ad19 | Andreas Färber | int kvm_arch_handle_exit(CPUS390XState *env, struct kvm_run *run) |
500 | 0e60a699 | Alexander Graf | { |
501 | 0e60a699 | Alexander Graf | int ret = 0; |
502 | 0e60a699 | Alexander Graf | |
503 | 0e60a699 | Alexander Graf | switch (run->exit_reason) {
|
504 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_SIEIC:
|
505 | 0e60a699 | Alexander Graf | ret = handle_intercept(env); |
506 | 0e60a699 | Alexander Graf | break;
|
507 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_RESET:
|
508 | add142e0 | Jens Freimann | qemu_system_reset_request(); |
509 | 0e60a699 | Alexander Graf | break;
|
510 | 0e60a699 | Alexander Graf | default:
|
511 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown KVM exit: %d\n", run->exit_reason);
|
512 | 0e60a699 | Alexander Graf | break;
|
513 | 0e60a699 | Alexander Graf | } |
514 | 0e60a699 | Alexander Graf | |
515 | bb4ea393 | Jan Kiszka | if (ret == 0) { |
516 | bb4ea393 | Jan Kiszka | ret = EXCP_INTERRUPT; |
517 | bb4ea393 | Jan Kiszka | } |
518 | 0e60a699 | Alexander Graf | return ret;
|
519 | 0e60a699 | Alexander Graf | } |
520 | 4513d923 | Gleb Natapov | |
521 | a4e3ad19 | Andreas Färber | bool kvm_arch_stop_on_emulation_error(CPUS390XState *env)
|
522 | 4513d923 | Gleb Natapov | { |
523 | 4513d923 | Gleb Natapov | return true; |
524 | 4513d923 | Gleb Natapov | } |
525 | a1b87fe0 | Jan Kiszka | |
526 | a4e3ad19 | Andreas Färber | int kvm_arch_on_sigbus_vcpu(CPUS390XState *env, int code, void *addr) |
527 | a1b87fe0 | Jan Kiszka | { |
528 | a1b87fe0 | Jan Kiszka | return 1; |
529 | a1b87fe0 | Jan Kiszka | } |
530 | a1b87fe0 | Jan Kiszka | |
531 | a1b87fe0 | Jan Kiszka | int kvm_arch_on_sigbus(int code, void *addr) |
532 | a1b87fe0 | Jan Kiszka | { |
533 | a1b87fe0 | Jan Kiszka | return 1; |
534 | a1b87fe0 | Jan Kiszka | } |