root / target-s390x / kvm.c @ d7582078
History | View | Annotate | Download (11.7 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 | a4e3ad19 | Andreas Färber | int kvm_arch_insert_sw_breakpoint(CPUS390XState *env, struct kvm_sw_breakpoint *bp) |
139 | 0e60a699 | Alexander Graf | { |
140 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
141 | 0e60a699 | Alexander Graf | |
142 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 4, 0) || |
143 | 0e60a699 | Alexander Graf | cpu_memory_rw_debug(env, bp->pc, (uint8_t *)diag_501, 4, 1)) { |
144 | 0e60a699 | Alexander Graf | return -EINVAL;
|
145 | 0e60a699 | Alexander Graf | } |
146 | 0e60a699 | Alexander Graf | return 0; |
147 | 0e60a699 | Alexander Graf | } |
148 | 0e60a699 | Alexander Graf | |
149 | a4e3ad19 | Andreas Färber | int kvm_arch_remove_sw_breakpoint(CPUS390XState *env, struct kvm_sw_breakpoint *bp) |
150 | 0e60a699 | Alexander Graf | { |
151 | 0e60a699 | Alexander Graf | uint8_t t[4];
|
152 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
153 | 0e60a699 | Alexander Graf | |
154 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, t, 4, 0)) { |
155 | 0e60a699 | Alexander Graf | return -EINVAL;
|
156 | 0e60a699 | Alexander Graf | } else if (memcmp(t, diag_501, 4)) { |
157 | 0e60a699 | Alexander Graf | return -EINVAL;
|
158 | 0e60a699 | Alexander Graf | } else if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 1, 1)) { |
159 | 0e60a699 | Alexander Graf | return -EINVAL;
|
160 | 0e60a699 | Alexander Graf | } |
161 | 0e60a699 | Alexander Graf | |
162 | 0e60a699 | Alexander Graf | return 0; |
163 | 0e60a699 | Alexander Graf | } |
164 | 0e60a699 | Alexander Graf | |
165 | a4e3ad19 | Andreas Färber | void kvm_arch_pre_run(CPUS390XState *env, struct kvm_run *run) |
166 | 0e60a699 | Alexander Graf | { |
167 | 0e60a699 | Alexander Graf | } |
168 | 0e60a699 | Alexander Graf | |
169 | a4e3ad19 | Andreas Färber | void kvm_arch_post_run(CPUS390XState *env, struct kvm_run *run) |
170 | 0e60a699 | Alexander Graf | { |
171 | 0e60a699 | Alexander Graf | } |
172 | 0e60a699 | Alexander Graf | |
173 | a4e3ad19 | Andreas Färber | int kvm_arch_process_async_events(CPUS390XState *env)
|
174 | 0af691d7 | Marcelo Tosatti | { |
175 | 71b12d31 | Christian Borntraeger | return env->halted;
|
176 | 0af691d7 | Marcelo Tosatti | } |
177 | 0af691d7 | Marcelo Tosatti | |
178 | a4e3ad19 | Andreas Färber | void kvm_s390_interrupt_internal(CPUS390XState *env, int type, uint32_t parm, |
179 | bcec36ea | Alexander Graf | uint64_t parm64, int vm)
|
180 | 0e60a699 | Alexander Graf | { |
181 | 0e60a699 | Alexander Graf | struct kvm_s390_interrupt kvmint;
|
182 | 0e60a699 | Alexander Graf | int r;
|
183 | 0e60a699 | Alexander Graf | |
184 | 0e60a699 | Alexander Graf | if (!env->kvm_state) {
|
185 | 0e60a699 | Alexander Graf | return;
|
186 | 0e60a699 | Alexander Graf | } |
187 | 0e60a699 | Alexander Graf | |
188 | 0e60a699 | Alexander Graf | kvmint.type = type; |
189 | 0e60a699 | Alexander Graf | kvmint.parm = parm; |
190 | 0e60a699 | Alexander Graf | kvmint.parm64 = parm64; |
191 | 0e60a699 | Alexander Graf | |
192 | 0e60a699 | Alexander Graf | if (vm) {
|
193 | 0e60a699 | Alexander Graf | r = kvm_vm_ioctl(env->kvm_state, KVM_S390_INTERRUPT, &kvmint); |
194 | 0e60a699 | Alexander Graf | } else {
|
195 | 0e60a699 | Alexander Graf | r = kvm_vcpu_ioctl(env, KVM_S390_INTERRUPT, &kvmint); |
196 | 0e60a699 | Alexander Graf | } |
197 | 0e60a699 | Alexander Graf | |
198 | 0e60a699 | Alexander Graf | if (r < 0) { |
199 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM failed to inject interrupt\n");
|
200 | 0e60a699 | Alexander Graf | exit(1);
|
201 | 0e60a699 | Alexander Graf | } |
202 | 0e60a699 | Alexander Graf | } |
203 | 0e60a699 | Alexander Graf | |
204 | a4e3ad19 | Andreas Färber | void kvm_s390_virtio_irq(CPUS390XState *env, int config_change, uint64_t token) |
205 | 0e60a699 | Alexander Graf | { |
206 | 0e60a699 | Alexander Graf | kvm_s390_interrupt_internal(env, KVM_S390_INT_VIRTIO, config_change, |
207 | 0e60a699 | Alexander Graf | token, 1);
|
208 | 0e60a699 | Alexander Graf | } |
209 | 0e60a699 | Alexander Graf | |
210 | a4e3ad19 | Andreas Färber | void kvm_s390_interrupt(CPUS390XState *env, int type, uint32_t code) |
211 | 0e60a699 | Alexander Graf | { |
212 | 0e60a699 | Alexander Graf | kvm_s390_interrupt_internal(env, type, code, 0, 0); |
213 | 0e60a699 | Alexander Graf | } |
214 | 0e60a699 | Alexander Graf | |
215 | a4e3ad19 | Andreas Färber | static void enter_pgmcheck(CPUS390XState *env, uint16_t code) |
216 | 0e60a699 | Alexander Graf | { |
217 | 0e60a699 | Alexander Graf | kvm_s390_interrupt(env, KVM_S390_PROGRAM_INT, code); |
218 | 0e60a699 | Alexander Graf | } |
219 | 0e60a699 | Alexander Graf | |
220 | a4e3ad19 | Andreas Färber | static inline void setcc(CPUS390XState *env, uint64_t cc) |
221 | 0e60a699 | Alexander Graf | { |
222 | 81f7c56c | Alexander Graf | env->kvm_run->psw_mask &= ~(3ull << 44); |
223 | 0e60a699 | Alexander Graf | env->kvm_run->psw_mask |= (cc & 3) << 44; |
224 | 0e60a699 | Alexander Graf | |
225 | 0e60a699 | Alexander Graf | env->psw.mask &= ~(3ul << 44); |
226 | 0e60a699 | Alexander Graf | env->psw.mask |= (cc & 3) << 44; |
227 | 0e60a699 | Alexander Graf | } |
228 | 0e60a699 | Alexander Graf | |
229 | a4e3ad19 | Andreas Färber | static int kvm_sclp_service_call(CPUS390XState *env, struct kvm_run *run, |
230 | bcec36ea | Alexander Graf | uint16_t ipbh0) |
231 | 0e60a699 | Alexander Graf | { |
232 | 0e60a699 | Alexander Graf | uint32_t sccb; |
233 | 0e60a699 | Alexander Graf | uint64_t code; |
234 | 0e60a699 | Alexander Graf | int r = 0; |
235 | 0e60a699 | Alexander Graf | |
236 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
237 | 0e60a699 | Alexander Graf | sccb = env->regs[ipbh0 & 0xf];
|
238 | 0e60a699 | Alexander Graf | code = env->regs[(ipbh0 & 0xf0) >> 4]; |
239 | 0e60a699 | Alexander Graf | |
240 | 81f7c56c | Alexander Graf | r = sclp_service_call(env, sccb, code); |
241 | 81f7c56c | Alexander Graf | if (r) {
|
242 | 0e60a699 | Alexander Graf | setcc(env, 3);
|
243 | 0e60a699 | Alexander Graf | } |
244 | 81f7c56c | Alexander Graf | |
245 | 0e60a699 | Alexander Graf | return 0; |
246 | 0e60a699 | Alexander Graf | } |
247 | 0e60a699 | Alexander Graf | |
248 | a4e3ad19 | Andreas Färber | static int handle_priv(CPUS390XState *env, struct kvm_run *run, uint8_t ipa1) |
249 | 0e60a699 | Alexander Graf | { |
250 | 0e60a699 | Alexander Graf | int r = 0; |
251 | 0e60a699 | Alexander Graf | uint16_t ipbh0 = (run->s390_sieic.ipb & 0xffff0000) >> 16; |
252 | 0e60a699 | Alexander Graf | |
253 | 0e60a699 | Alexander Graf | dprintf("KVM: PRIV: %d\n", ipa1);
|
254 | 0e60a699 | Alexander Graf | switch (ipa1) {
|
255 | 0e60a699 | Alexander Graf | case PRIV_SCLP_CALL:
|
256 | bcec36ea | Alexander Graf | r = kvm_sclp_service_call(env, run, ipbh0); |
257 | 0e60a699 | Alexander Graf | break;
|
258 | 0e60a699 | Alexander Graf | default:
|
259 | 0e60a699 | Alexander Graf | dprintf("KVM: unknown PRIV: 0x%x\n", ipa1);
|
260 | 0e60a699 | Alexander Graf | r = -1;
|
261 | 0e60a699 | Alexander Graf | break;
|
262 | 0e60a699 | Alexander Graf | } |
263 | 0e60a699 | Alexander Graf | |
264 | 0e60a699 | Alexander Graf | return r;
|
265 | 0e60a699 | Alexander Graf | } |
266 | 0e60a699 | Alexander Graf | |
267 | a4e3ad19 | Andreas Färber | static int handle_hypercall(CPUS390XState *env, struct kvm_run *run) |
268 | 0e60a699 | Alexander Graf | { |
269 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
270 | bcec36ea | Alexander Graf | env->regs[2] = s390_virtio_hypercall(env, env->regs[2], env->regs[1]); |
271 | 0e60a699 | Alexander Graf | |
272 | bcec36ea | Alexander Graf | return 0; |
273 | 0e60a699 | Alexander Graf | } |
274 | 0e60a699 | Alexander Graf | |
275 | a4e3ad19 | Andreas Färber | static int handle_diag(CPUS390XState *env, struct kvm_run *run, int ipb_code) |
276 | 0e60a699 | Alexander Graf | { |
277 | 0e60a699 | Alexander Graf | int r = 0; |
278 | 0e60a699 | Alexander Graf | |
279 | 0e60a699 | Alexander Graf | switch (ipb_code) {
|
280 | 0e60a699 | Alexander Graf | case DIAG_KVM_HYPERCALL:
|
281 | 0e60a699 | Alexander Graf | r = handle_hypercall(env, run); |
282 | 0e60a699 | Alexander Graf | break;
|
283 | 0e60a699 | Alexander Graf | case DIAG_KVM_BREAKPOINT:
|
284 | 0e60a699 | Alexander Graf | sleep(10);
|
285 | 0e60a699 | Alexander Graf | break;
|
286 | 0e60a699 | Alexander Graf | default:
|
287 | 0e60a699 | Alexander Graf | dprintf("KVM: unknown DIAG: 0x%x\n", ipb_code);
|
288 | 0e60a699 | Alexander Graf | r = -1;
|
289 | 0e60a699 | Alexander Graf | break;
|
290 | 0e60a699 | Alexander Graf | } |
291 | 0e60a699 | Alexander Graf | |
292 | 0e60a699 | Alexander Graf | return r;
|
293 | 0e60a699 | Alexander Graf | } |
294 | 0e60a699 | Alexander Graf | |
295 | 3edb8f92 | Andreas Färber | static int s390_cpu_restart(S390CPU *cpu) |
296 | 0e60a699 | Alexander Graf | { |
297 | 3edb8f92 | Andreas Färber | CPUS390XState *env = &cpu->env; |
298 | 3edb8f92 | Andreas Färber | |
299 | 0e60a699 | Alexander Graf | kvm_s390_interrupt(env, KVM_S390_RESTART, 0);
|
300 | 854e42f3 | Christian Borntraeger | s390_add_running_cpu(env); |
301 | 0e60a699 | Alexander Graf | qemu_cpu_kick(env); |
302 | 0e60a699 | Alexander Graf | dprintf("DONE: SIGP cpu restart: %p\n", env);
|
303 | 0e60a699 | Alexander Graf | return 0; |
304 | 0e60a699 | Alexander Graf | } |
305 | 0e60a699 | Alexander Graf | |
306 | a4e3ad19 | Andreas Färber | static int s390_store_status(CPUS390XState *env, uint32_t parameter) |
307 | 0e60a699 | Alexander Graf | { |
308 | 0e60a699 | Alexander Graf | /* XXX */
|
309 | 0e60a699 | Alexander Graf | fprintf(stderr, "XXX SIGP store status\n");
|
310 | 0e60a699 | Alexander Graf | return -1; |
311 | 0e60a699 | Alexander Graf | } |
312 | 0e60a699 | Alexander Graf | |
313 | a4e3ad19 | Andreas Färber | static int s390_cpu_initial_reset(CPUS390XState *env) |
314 | 0e60a699 | Alexander Graf | { |
315 | d5900813 | Alexander Graf | int i;
|
316 | d5900813 | Alexander Graf | |
317 | 2fb70f6f | Christian Borntraeger | s390_del_running_cpu(env); |
318 | d5900813 | Alexander Graf | if (kvm_vcpu_ioctl(env, KVM_S390_INITIAL_RESET, NULL) < 0) { |
319 | d5900813 | Alexander Graf | perror("cannot init reset vcpu");
|
320 | d5900813 | Alexander Graf | } |
321 | d5900813 | Alexander Graf | |
322 | d5900813 | Alexander Graf | /* Manually zero out all registers */
|
323 | d5900813 | Alexander Graf | cpu_synchronize_state(env); |
324 | d5900813 | Alexander Graf | for (i = 0; i < 16; i++) { |
325 | d5900813 | Alexander Graf | env->regs[i] = 0;
|
326 | d5900813 | Alexander Graf | } |
327 | d5900813 | Alexander Graf | |
328 | d5900813 | Alexander Graf | dprintf("DONE: SIGP initial reset: %p\n", env);
|
329 | d5900813 | Alexander Graf | return 0; |
330 | 0e60a699 | Alexander Graf | } |
331 | 0e60a699 | Alexander Graf | |
332 | a4e3ad19 | Andreas Färber | static int handle_sigp(CPUS390XState *env, struct kvm_run *run, uint8_t ipa1) |
333 | 0e60a699 | Alexander Graf | { |
334 | 0e60a699 | Alexander Graf | uint8_t order_code; |
335 | 0e60a699 | Alexander Graf | uint32_t parameter; |
336 | 0e60a699 | Alexander Graf | uint16_t cpu_addr; |
337 | 0e60a699 | Alexander Graf | uint8_t t; |
338 | 0e60a699 | Alexander Graf | int r = -1; |
339 | 45fa769b | Andreas Färber | S390CPU *target_cpu; |
340 | a4e3ad19 | Andreas Färber | CPUS390XState *target_env; |
341 | 0e60a699 | Alexander Graf | |
342 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
343 | 0e60a699 | Alexander Graf | |
344 | 0e60a699 | Alexander Graf | /* get order code */
|
345 | 0e60a699 | Alexander Graf | order_code = run->s390_sieic.ipb >> 28;
|
346 | 0e60a699 | Alexander Graf | if (order_code > 0) { |
347 | 0e60a699 | Alexander Graf | order_code = env->regs[order_code]; |
348 | 0e60a699 | Alexander Graf | } |
349 | 0e60a699 | Alexander Graf | order_code += (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
350 | 0e60a699 | Alexander Graf | |
351 | 0e60a699 | Alexander Graf | /* get parameters */
|
352 | 0e60a699 | Alexander Graf | t = (ipa1 & 0xf0) >> 4; |
353 | 0e60a699 | Alexander Graf | if (!(t % 2)) { |
354 | 0e60a699 | Alexander Graf | t++; |
355 | 0e60a699 | Alexander Graf | } |
356 | 0e60a699 | Alexander Graf | |
357 | 0e60a699 | Alexander Graf | parameter = env->regs[t] & 0x7ffffe00;
|
358 | 0e60a699 | Alexander Graf | cpu_addr = env->regs[ipa1 & 0x0f];
|
359 | 0e60a699 | Alexander Graf | |
360 | 45fa769b | Andreas Färber | target_cpu = s390_cpu_addr2state(cpu_addr); |
361 | 45fa769b | Andreas Färber | if (target_cpu == NULL) { |
362 | 0e60a699 | Alexander Graf | goto out;
|
363 | 0e60a699 | Alexander Graf | } |
364 | 45fa769b | Andreas Färber | target_env = &target_cpu->env; |
365 | 0e60a699 | Alexander Graf | |
366 | 0e60a699 | Alexander Graf | switch (order_code) {
|
367 | 0e60a699 | Alexander Graf | case SIGP_RESTART:
|
368 | 3edb8f92 | Andreas Färber | r = s390_cpu_restart(target_cpu); |
369 | 0e60a699 | Alexander Graf | break;
|
370 | 0e60a699 | Alexander Graf | case SIGP_STORE_STATUS_ADDR:
|
371 | 0e60a699 | Alexander Graf | r = s390_store_status(target_env, parameter); |
372 | 0e60a699 | Alexander Graf | break;
|
373 | 0e60a699 | Alexander Graf | case SIGP_SET_ARCH:
|
374 | 0e60a699 | Alexander Graf | /* make the caller panic */
|
375 | 0e60a699 | Alexander Graf | return -1; |
376 | 0e60a699 | Alexander Graf | case SIGP_INITIAL_CPU_RESET:
|
377 | 0e60a699 | Alexander Graf | r = s390_cpu_initial_reset(target_env); |
378 | 0e60a699 | Alexander Graf | break;
|
379 | 0e60a699 | Alexander Graf | default:
|
380 | a74cdab4 | Christian Borntraeger | fprintf(stderr, "KVM: unknown SIGP: 0x%x\n", order_code);
|
381 | 0e60a699 | Alexander Graf | break;
|
382 | 0e60a699 | Alexander Graf | } |
383 | 0e60a699 | Alexander Graf | |
384 | 0e60a699 | Alexander Graf | out:
|
385 | 0e60a699 | Alexander Graf | setcc(env, r ? 3 : 0); |
386 | 0e60a699 | Alexander Graf | return 0; |
387 | 0e60a699 | Alexander Graf | } |
388 | 0e60a699 | Alexander Graf | |
389 | a4e3ad19 | Andreas Färber | static int handle_instruction(CPUS390XState *env, struct kvm_run *run) |
390 | 0e60a699 | Alexander Graf | { |
391 | 0e60a699 | Alexander Graf | unsigned int ipa0 = (run->s390_sieic.ipa & 0xff00); |
392 | 0e60a699 | Alexander Graf | uint8_t ipa1 = run->s390_sieic.ipa & 0x00ff;
|
393 | 0e60a699 | Alexander Graf | int ipb_code = (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
394 | d7963c43 | Alexander Graf | int r = -1; |
395 | 0e60a699 | Alexander Graf | |
396 | 0e60a699 | Alexander Graf | dprintf("handle_instruction 0x%x 0x%x\n", run->s390_sieic.ipa, run->s390_sieic.ipb);
|
397 | 0e60a699 | Alexander Graf | switch (ipa0) {
|
398 | 0e60a699 | Alexander Graf | case IPA0_PRIV:
|
399 | 0e60a699 | Alexander Graf | r = handle_priv(env, run, ipa1); |
400 | 0e60a699 | Alexander Graf | break;
|
401 | 0e60a699 | Alexander Graf | case IPA0_DIAG:
|
402 | 0e60a699 | Alexander Graf | r = handle_diag(env, run, ipb_code); |
403 | 0e60a699 | Alexander Graf | break;
|
404 | 0e60a699 | Alexander Graf | case IPA0_SIGP:
|
405 | 0e60a699 | Alexander Graf | r = handle_sigp(env, run, ipa1); |
406 | 0e60a699 | Alexander Graf | break;
|
407 | 0e60a699 | Alexander Graf | } |
408 | 0e60a699 | Alexander Graf | |
409 | 0e60a699 | Alexander Graf | if (r < 0) { |
410 | 0e60a699 | Alexander Graf | enter_pgmcheck(env, 0x0001);
|
411 | 0e60a699 | Alexander Graf | } |
412 | 359507ee | Alexander Graf | return 0; |
413 | 0e60a699 | Alexander Graf | } |
414 | 0e60a699 | Alexander Graf | |
415 | eca3ed03 | Christian Borntraeger | static bool is_special_wait_psw(CPUS390XState *env) |
416 | eca3ed03 | Christian Borntraeger | { |
417 | eca3ed03 | Christian Borntraeger | /* signal quiesce */
|
418 | eca3ed03 | Christian Borntraeger | return env->kvm_run->psw_addr == 0xfffUL; |
419 | eca3ed03 | Christian Borntraeger | } |
420 | eca3ed03 | Christian Borntraeger | |
421 | a4e3ad19 | Andreas Färber | static int handle_intercept(CPUS390XState *env) |
422 | 0e60a699 | Alexander Graf | { |
423 | 0e60a699 | Alexander Graf | struct kvm_run *run = env->kvm_run;
|
424 | 0e60a699 | Alexander Graf | int icpt_code = run->s390_sieic.icptcode;
|
425 | 0e60a699 | Alexander Graf | int r = 0; |
426 | 0e60a699 | Alexander Graf | |
427 | 81f7c56c | Alexander Graf | dprintf("intercept: 0x%x (at 0x%lx)\n", icpt_code,
|
428 | 81f7c56c | Alexander Graf | (long)env->kvm_run->psw_addr);
|
429 | 0e60a699 | Alexander Graf | switch (icpt_code) {
|
430 | 0e60a699 | Alexander Graf | case ICPT_INSTRUCTION:
|
431 | 0e60a699 | Alexander Graf | r = handle_instruction(env, run); |
432 | 0e60a699 | Alexander Graf | break;
|
433 | 0e60a699 | Alexander Graf | case ICPT_WAITPSW:
|
434 | eca3ed03 | Christian Borntraeger | if (s390_del_running_cpu(env) == 0 && |
435 | eca3ed03 | Christian Borntraeger | is_special_wait_psw(env)) { |
436 | eca3ed03 | Christian Borntraeger | qemu_system_shutdown_request(); |
437 | eca3ed03 | Christian Borntraeger | } |
438 | eca3ed03 | Christian Borntraeger | r = EXCP_HALTED; |
439 | eca3ed03 | Christian Borntraeger | break;
|
440 | 854e42f3 | Christian Borntraeger | case ICPT_CPU_STOP:
|
441 | 854e42f3 | Christian Borntraeger | if (s390_del_running_cpu(env) == 0) { |
442 | 854e42f3 | Christian Borntraeger | qemu_system_shutdown_request(); |
443 | 854e42f3 | Christian Borntraeger | } |
444 | 854e42f3 | Christian Borntraeger | r = EXCP_HALTED; |
445 | 0e60a699 | Alexander Graf | break;
|
446 | 0e60a699 | Alexander Graf | case ICPT_SOFT_INTERCEPT:
|
447 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt SOFT\n");
|
448 | 0e60a699 | Alexander Graf | exit(1);
|
449 | 0e60a699 | Alexander Graf | break;
|
450 | 0e60a699 | Alexander Graf | case ICPT_IO:
|
451 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt IO\n");
|
452 | 0e60a699 | Alexander Graf | exit(1);
|
453 | 0e60a699 | Alexander Graf | break;
|
454 | 0e60a699 | Alexander Graf | default:
|
455 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown intercept code: %d\n", icpt_code);
|
456 | 0e60a699 | Alexander Graf | exit(1);
|
457 | 0e60a699 | Alexander Graf | break;
|
458 | 0e60a699 | Alexander Graf | } |
459 | 0e60a699 | Alexander Graf | |
460 | 0e60a699 | Alexander Graf | return r;
|
461 | 0e60a699 | Alexander Graf | } |
462 | 0e60a699 | Alexander Graf | |
463 | a4e3ad19 | Andreas Färber | int kvm_arch_handle_exit(CPUS390XState *env, struct kvm_run *run) |
464 | 0e60a699 | Alexander Graf | { |
465 | 0e60a699 | Alexander Graf | int ret = 0; |
466 | 0e60a699 | Alexander Graf | |
467 | 0e60a699 | Alexander Graf | switch (run->exit_reason) {
|
468 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_SIEIC:
|
469 | 0e60a699 | Alexander Graf | ret = handle_intercept(env); |
470 | 0e60a699 | Alexander Graf | break;
|
471 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_RESET:
|
472 | add142e0 | Jens Freimann | qemu_system_reset_request(); |
473 | 0e60a699 | Alexander Graf | break;
|
474 | 0e60a699 | Alexander Graf | default:
|
475 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown KVM exit: %d\n", run->exit_reason);
|
476 | 0e60a699 | Alexander Graf | break;
|
477 | 0e60a699 | Alexander Graf | } |
478 | 0e60a699 | Alexander Graf | |
479 | bb4ea393 | Jan Kiszka | if (ret == 0) { |
480 | bb4ea393 | Jan Kiszka | ret = EXCP_INTERRUPT; |
481 | bb4ea393 | Jan Kiszka | } |
482 | 0e60a699 | Alexander Graf | return ret;
|
483 | 0e60a699 | Alexander Graf | } |
484 | 4513d923 | Gleb Natapov | |
485 | a4e3ad19 | Andreas Färber | bool kvm_arch_stop_on_emulation_error(CPUS390XState *env)
|
486 | 4513d923 | Gleb Natapov | { |
487 | 4513d923 | Gleb Natapov | return true; |
488 | 4513d923 | Gleb Natapov | } |
489 | a1b87fe0 | Jan Kiszka | |
490 | a4e3ad19 | Andreas Färber | int kvm_arch_on_sigbus_vcpu(CPUS390XState *env, int code, void *addr) |
491 | a1b87fe0 | Jan Kiszka | { |
492 | a1b87fe0 | Jan Kiszka | return 1; |
493 | a1b87fe0 | Jan Kiszka | } |
494 | a1b87fe0 | Jan Kiszka | |
495 | a1b87fe0 | Jan Kiszka | int kvm_arch_on_sigbus(int code, void *addr) |
496 | a1b87fe0 | Jan Kiszka | { |
497 | a1b87fe0 | Jan Kiszka | return 1; |
498 | a1b87fe0 | Jan Kiszka | } |