root / target-s390x / kvm.c @ d1a0cf73
History | View | Annotate | Download (22.4 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 | ccb084d3 | Christian Borntraeger | * Copyright IBM Corp. 2012
|
6 | 0e60a699 | Alexander Graf | *
|
7 | 0e60a699 | Alexander Graf | * This library is free software; you can redistribute it and/or
|
8 | 0e60a699 | Alexander Graf | * modify it under the terms of the GNU Lesser General Public
|
9 | 0e60a699 | Alexander Graf | * License as published by the Free Software Foundation; either
|
10 | 0e60a699 | Alexander Graf | * version 2 of the License, or (at your option) any later version.
|
11 | 0e60a699 | Alexander Graf | *
|
12 | 0e60a699 | Alexander Graf | * This library is distributed in the hope that it will be useful,
|
13 | 0e60a699 | Alexander Graf | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
14 | 0e60a699 | Alexander Graf | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
15 | 0e60a699 | Alexander Graf | * Lesser General Public License for more details.
|
16 | 0e60a699 | Alexander Graf | *
|
17 | ccb084d3 | Christian Borntraeger | * Contributions after 2012-10-29 are licensed under the terms of the
|
18 | ccb084d3 | Christian Borntraeger | * GNU GPL, version 2 or (at your option) any later version.
|
19 | ccb084d3 | Christian Borntraeger | *
|
20 | ccb084d3 | Christian Borntraeger | * You should have received a copy of the GNU (Lesser) General Public
|
21 | 0e60a699 | Alexander Graf | * License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
22 | 0e60a699 | Alexander Graf | */
|
23 | 0e60a699 | Alexander Graf | |
24 | 0e60a699 | Alexander Graf | #include <sys/types.h> |
25 | 0e60a699 | Alexander Graf | #include <sys/ioctl.h> |
26 | 0e60a699 | Alexander Graf | #include <sys/mman.h> |
27 | 0e60a699 | Alexander Graf | |
28 | 0e60a699 | Alexander Graf | #include <linux/kvm.h> |
29 | 0e60a699 | Alexander Graf | #include <asm/ptrace.h> |
30 | 0e60a699 | Alexander Graf | |
31 | 0e60a699 | Alexander Graf | #include "qemu-common.h" |
32 | 1de7afc9 | Paolo Bonzini | #include "qemu/timer.h" |
33 | 9c17d615 | Paolo Bonzini | #include "sysemu/sysemu.h" |
34 | 9c17d615 | Paolo Bonzini | #include "sysemu/kvm.h" |
35 | 0e60a699 | Alexander Graf | #include "cpu.h" |
36 | 9c17d615 | Paolo Bonzini | #include "sysemu/device_tree.h" |
37 | 0e60a699 | Alexander Graf | |
38 | 0e60a699 | Alexander Graf | /* #define DEBUG_KVM */
|
39 | 0e60a699 | Alexander Graf | |
40 | 0e60a699 | Alexander Graf | #ifdef DEBUG_KVM
|
41 | 0e60a699 | Alexander Graf | #define dprintf(fmt, ...) \
|
42 | 0e60a699 | Alexander Graf | do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0) |
43 | 0e60a699 | Alexander Graf | #else
|
44 | 0e60a699 | Alexander Graf | #define dprintf(fmt, ...) \
|
45 | 0e60a699 | Alexander Graf | do { } while (0) |
46 | 0e60a699 | Alexander Graf | #endif
|
47 | 0e60a699 | Alexander Graf | |
48 | 0e60a699 | Alexander Graf | #define IPA0_DIAG 0x8300 |
49 | 0e60a699 | Alexander Graf | #define IPA0_SIGP 0xae00 |
50 | 09b99878 | Cornelia Huck | #define IPA0_B2 0xb200 |
51 | 09b99878 | Cornelia Huck | #define IPA0_B9 0xb900 |
52 | 09b99878 | Cornelia Huck | #define IPA0_EB 0xeb00 |
53 | 0e60a699 | Alexander Graf | |
54 | 0e60a699 | Alexander Graf | #define PRIV_SCLP_CALL 0x20 |
55 | 09b99878 | Cornelia Huck | #define PRIV_CSCH 0x30 |
56 | 09b99878 | Cornelia Huck | #define PRIV_HSCH 0x31 |
57 | 09b99878 | Cornelia Huck | #define PRIV_MSCH 0x32 |
58 | 09b99878 | Cornelia Huck | #define PRIV_SSCH 0x33 |
59 | 09b99878 | Cornelia Huck | #define PRIV_STSCH 0x34 |
60 | 09b99878 | Cornelia Huck | #define PRIV_TSCH 0x35 |
61 | 09b99878 | Cornelia Huck | #define PRIV_TPI 0x36 |
62 | 09b99878 | Cornelia Huck | #define PRIV_SAL 0x37 |
63 | 09b99878 | Cornelia Huck | #define PRIV_RSCH 0x38 |
64 | 09b99878 | Cornelia Huck | #define PRIV_STCRW 0x39 |
65 | 09b99878 | Cornelia Huck | #define PRIV_STCPS 0x3a |
66 | 09b99878 | Cornelia Huck | #define PRIV_RCHP 0x3b |
67 | 09b99878 | Cornelia Huck | #define PRIV_SCHM 0x3c |
68 | 09b99878 | Cornelia Huck | #define PRIV_CHSC 0x5f |
69 | 09b99878 | Cornelia Huck | #define PRIV_SIGA 0x74 |
70 | 09b99878 | Cornelia Huck | #define PRIV_XSCH 0x76 |
71 | 09b99878 | Cornelia Huck | #define PRIV_SQBS 0x8a |
72 | 09b99878 | Cornelia Huck | #define PRIV_EQBS 0x9c |
73 | 0e60a699 | Alexander Graf | #define DIAG_KVM_HYPERCALL 0x500 |
74 | 0e60a699 | Alexander Graf | #define DIAG_KVM_BREAKPOINT 0x501 |
75 | 0e60a699 | Alexander Graf | |
76 | 0e60a699 | Alexander Graf | #define ICPT_INSTRUCTION 0x04 |
77 | 0e60a699 | Alexander Graf | #define ICPT_WAITPSW 0x1c |
78 | 0e60a699 | Alexander Graf | #define ICPT_SOFT_INTERCEPT 0x24 |
79 | 0e60a699 | Alexander Graf | #define ICPT_CPU_STOP 0x28 |
80 | 0e60a699 | Alexander Graf | #define ICPT_IO 0x40 |
81 | 0e60a699 | Alexander Graf | |
82 | 0e60a699 | Alexander Graf | #define SIGP_RESTART 0x06 |
83 | 0e60a699 | Alexander Graf | #define SIGP_INITIAL_CPU_RESET 0x0b |
84 | 0e60a699 | Alexander Graf | #define SIGP_STORE_STATUS_ADDR 0x0e |
85 | 0e60a699 | Alexander Graf | #define SIGP_SET_ARCH 0x12 |
86 | 0e60a699 | Alexander Graf | |
87 | 94a8d39a | Jan Kiszka | const KVMCapabilityInfo kvm_arch_required_capabilities[] = {
|
88 | 94a8d39a | Jan Kiszka | KVM_CAP_LAST_INFO |
89 | 94a8d39a | Jan Kiszka | }; |
90 | 94a8d39a | Jan Kiszka | |
91 | 5b08b344 | Christian Borntraeger | static int cap_sync_regs; |
92 | 5b08b344 | Christian Borntraeger | |
93 | cad1e282 | Jan Kiszka | int kvm_arch_init(KVMState *s)
|
94 | 0e60a699 | Alexander Graf | { |
95 | 5b08b344 | Christian Borntraeger | cap_sync_regs = kvm_check_extension(s, KVM_CAP_SYNC_REGS); |
96 | 0e60a699 | Alexander Graf | return 0; |
97 | 0e60a699 | Alexander Graf | } |
98 | 0e60a699 | Alexander Graf | |
99 | b164e48e | Eduardo Habkost | unsigned long kvm_arch_vcpu_id(CPUState *cpu) |
100 | b164e48e | Eduardo Habkost | { |
101 | b164e48e | Eduardo Habkost | return cpu->cpu_index;
|
102 | b164e48e | Eduardo Habkost | } |
103 | b164e48e | Eduardo Habkost | |
104 | 20d695a9 | Andreas Färber | int kvm_arch_init_vcpu(CPUState *cpu)
|
105 | 0e60a699 | Alexander Graf | { |
106 | 1c9d2a1d | Christian Borntraeger | /* nothing todo yet */
|
107 | 1c9d2a1d | Christian Borntraeger | return 0; |
108 | 0e60a699 | Alexander Graf | } |
109 | 0e60a699 | Alexander Graf | |
110 | 20d695a9 | Andreas Färber | void kvm_arch_reset_vcpu(CPUState *cpu)
|
111 | 0e60a699 | Alexander Graf | { |
112 | 419831d7 | Alexander Graf | /* The initial reset call is needed here to reset in-kernel
|
113 | 419831d7 | Alexander Graf | * vcpu data that we can't access directly from QEMU
|
114 | 419831d7 | Alexander Graf | * (i.e. with older kernels which don't support sync_regs/ONE_REG).
|
115 | 419831d7 | Alexander Graf | * Before this ioctl cpu_synchronize_state() is called in common kvm
|
116 | 419831d7 | Alexander Graf | * code (kvm-all) */
|
117 | 70bada03 | Jens Freimann | if (kvm_vcpu_ioctl(cpu, KVM_S390_INITIAL_RESET, NULL)) { |
118 | 70bada03 | Jens Freimann | perror("Can't reset vcpu\n");
|
119 | 70bada03 | Jens Freimann | } |
120 | 0e60a699 | Alexander Graf | } |
121 | 0e60a699 | Alexander Graf | |
122 | 20d695a9 | Andreas Färber | int kvm_arch_put_registers(CPUState *cs, int level) |
123 | 0e60a699 | Alexander Graf | { |
124 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
125 | 20d695a9 | Andreas Färber | CPUS390XState *env = &cpu->env; |
126 | 5b08b344 | Christian Borntraeger | struct kvm_sregs sregs;
|
127 | 0e60a699 | Alexander Graf | struct kvm_regs regs;
|
128 | 0e60a699 | Alexander Graf | int ret;
|
129 | 0e60a699 | Alexander Graf | int i;
|
130 | 0e60a699 | Alexander Graf | |
131 | 5b08b344 | Christian Borntraeger | /* always save the PSW and the GPRS*/
|
132 | f7575c96 | Andreas Färber | cs->kvm_run->psw_addr = env->psw.addr; |
133 | f7575c96 | Andreas Färber | cs->kvm_run->psw_mask = env->psw.mask; |
134 | 0e60a699 | Alexander Graf | |
135 | f7575c96 | Andreas Färber | if (cap_sync_regs && cs->kvm_run->kvm_valid_regs & KVM_SYNC_GPRS) {
|
136 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
137 | f7575c96 | Andreas Färber | cs->kvm_run->s.regs.gprs[i] = env->regs[i]; |
138 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_GPRS; |
139 | 5b08b344 | Christian Borntraeger | } |
140 | 5b08b344 | Christian Borntraeger | } else {
|
141 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
142 | 5b08b344 | Christian Borntraeger | regs.gprs[i] = env->regs[i]; |
143 | 5b08b344 | Christian Borntraeger | } |
144 | 1bc22652 | Andreas Färber | ret = kvm_vcpu_ioctl(cs, KVM_SET_REGS, ®s); |
145 | 5b08b344 | Christian Borntraeger | if (ret < 0) { |
146 | 5b08b344 | Christian Borntraeger | return ret;
|
147 | 5b08b344 | Christian Borntraeger | } |
148 | 0e60a699 | Alexander Graf | } |
149 | 0e60a699 | Alexander Graf | |
150 | 5b08b344 | Christian Borntraeger | /* Do we need to save more than that? */
|
151 | 5b08b344 | Christian Borntraeger | if (level == KVM_PUT_RUNTIME_STATE) {
|
152 | 5b08b344 | Christian Borntraeger | return 0; |
153 | 0e60a699 | Alexander Graf | } |
154 | 0e60a699 | Alexander Graf | |
155 | 5b08b344 | Christian Borntraeger | if (cap_sync_regs &&
|
156 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_valid_regs & KVM_SYNC_ACRS && |
157 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_valid_regs & KVM_SYNC_CRS) { |
158 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
159 | f7575c96 | Andreas Färber | cs->kvm_run->s.regs.acrs[i] = env->aregs[i]; |
160 | f7575c96 | Andreas Färber | cs->kvm_run->s.regs.crs[i] = env->cregs[i]; |
161 | 5b08b344 | Christian Borntraeger | } |
162 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_ACRS; |
163 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_CRS; |
164 | 5b08b344 | Christian Borntraeger | } else {
|
165 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
166 | 5b08b344 | Christian Borntraeger | sregs.acrs[i] = env->aregs[i]; |
167 | 5b08b344 | Christian Borntraeger | sregs.crs[i] = env->cregs[i]; |
168 | 5b08b344 | Christian Borntraeger | } |
169 | 1bc22652 | Andreas Färber | ret = kvm_vcpu_ioctl(cs, KVM_SET_SREGS, &sregs); |
170 | 5b08b344 | Christian Borntraeger | if (ret < 0) { |
171 | 5b08b344 | Christian Borntraeger | return ret;
|
172 | 5b08b344 | Christian Borntraeger | } |
173 | 5b08b344 | Christian Borntraeger | } |
174 | 0e60a699 | Alexander Graf | |
175 | 5b08b344 | Christian Borntraeger | /* Finally the prefix */
|
176 | f7575c96 | Andreas Färber | if (cap_sync_regs && cs->kvm_run->kvm_valid_regs & KVM_SYNC_PREFIX) {
|
177 | f7575c96 | Andreas Färber | cs->kvm_run->s.regs.prefix = env->psa; |
178 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_dirty_regs |= KVM_SYNC_PREFIX; |
179 | 5b08b344 | Christian Borntraeger | } else {
|
180 | 5b08b344 | Christian Borntraeger | /* prefix is only supported via sync regs */
|
181 | 5b08b344 | Christian Borntraeger | } |
182 | 5b08b344 | Christian Borntraeger | return 0; |
183 | 0e60a699 | Alexander Graf | } |
184 | 0e60a699 | Alexander Graf | |
185 | 20d695a9 | Andreas Färber | int kvm_arch_get_registers(CPUState *cs)
|
186 | 0e60a699 | Alexander Graf | { |
187 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
188 | 20d695a9 | Andreas Färber | CPUS390XState *env = &cpu->env; |
189 | 5b08b344 | Christian Borntraeger | struct kvm_sregs sregs;
|
190 | 0e60a699 | Alexander Graf | struct kvm_regs regs;
|
191 | 5b08b344 | Christian Borntraeger | int ret;
|
192 | 0e60a699 | Alexander Graf | int i;
|
193 | 0e60a699 | Alexander Graf | |
194 | 5b08b344 | Christian Borntraeger | /* get the PSW */
|
195 | f7575c96 | Andreas Färber | env->psw.addr = cs->kvm_run->psw_addr; |
196 | f7575c96 | Andreas Färber | env->psw.mask = cs->kvm_run->psw_mask; |
197 | 5b08b344 | Christian Borntraeger | |
198 | 5b08b344 | Christian Borntraeger | /* the GPRS */
|
199 | f7575c96 | Andreas Färber | if (cap_sync_regs && cs->kvm_run->kvm_valid_regs & KVM_SYNC_GPRS) {
|
200 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
201 | f7575c96 | Andreas Färber | env->regs[i] = cs->kvm_run->s.regs.gprs[i]; |
202 | 5b08b344 | Christian Borntraeger | } |
203 | 5b08b344 | Christian Borntraeger | } else {
|
204 | 1bc22652 | Andreas Färber | ret = kvm_vcpu_ioctl(cs, KVM_GET_REGS, ®s); |
205 | 5b08b344 | Christian Borntraeger | if (ret < 0) { |
206 | 5b08b344 | Christian Borntraeger | return ret;
|
207 | 5b08b344 | Christian Borntraeger | } |
208 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
209 | 5b08b344 | Christian Borntraeger | env->regs[i] = regs.gprs[i]; |
210 | 5b08b344 | Christian Borntraeger | } |
211 | 0e60a699 | Alexander Graf | } |
212 | 0e60a699 | Alexander Graf | |
213 | 5b08b344 | Christian Borntraeger | /* The ACRS and CRS */
|
214 | 5b08b344 | Christian Borntraeger | if (cap_sync_regs &&
|
215 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_valid_regs & KVM_SYNC_ACRS && |
216 | f7575c96 | Andreas Färber | cs->kvm_run->kvm_valid_regs & KVM_SYNC_CRS) { |
217 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
218 | f7575c96 | Andreas Färber | env->aregs[i] = cs->kvm_run->s.regs.acrs[i]; |
219 | f7575c96 | Andreas Färber | env->cregs[i] = cs->kvm_run->s.regs.crs[i]; |
220 | 5b08b344 | Christian Borntraeger | } |
221 | 5b08b344 | Christian Borntraeger | } else {
|
222 | 1bc22652 | Andreas Färber | ret = kvm_vcpu_ioctl(cs, KVM_GET_SREGS, &sregs); |
223 | 5b08b344 | Christian Borntraeger | if (ret < 0) { |
224 | 5b08b344 | Christian Borntraeger | return ret;
|
225 | 5b08b344 | Christian Borntraeger | } |
226 | 5b08b344 | Christian Borntraeger | for (i = 0; i < 16; i++) { |
227 | 5b08b344 | Christian Borntraeger | env->aregs[i] = sregs.acrs[i]; |
228 | 5b08b344 | Christian Borntraeger | env->cregs[i] = sregs.crs[i]; |
229 | 5b08b344 | Christian Borntraeger | } |
230 | 0e60a699 | Alexander Graf | } |
231 | 0e60a699 | Alexander Graf | |
232 | 5b08b344 | Christian Borntraeger | /* Finally the prefix */
|
233 | f7575c96 | Andreas Färber | if (cap_sync_regs && cs->kvm_run->kvm_valid_regs & KVM_SYNC_PREFIX) {
|
234 | f7575c96 | Andreas Färber | env->psa = cs->kvm_run->s.regs.prefix; |
235 | 5b08b344 | Christian Borntraeger | } else {
|
236 | 5b08b344 | Christian Borntraeger | /* no prefix without sync regs */
|
237 | 5b08b344 | Christian Borntraeger | } |
238 | 0e60a699 | Alexander Graf | |
239 | 0e60a699 | Alexander Graf | return 0; |
240 | 0e60a699 | Alexander Graf | } |
241 | 0e60a699 | Alexander Graf | |
242 | fdec9918 | Christian Borntraeger | /*
|
243 | fdec9918 | Christian Borntraeger | * Legacy layout for s390:
|
244 | fdec9918 | Christian Borntraeger | * Older S390 KVM requires the topmost vma of the RAM to be
|
245 | fdec9918 | Christian Borntraeger | * smaller than an system defined value, which is at least 256GB.
|
246 | fdec9918 | Christian Borntraeger | * Larger systems have larger values. We put the guest between
|
247 | fdec9918 | Christian Borntraeger | * the end of data segment (system break) and this value. We
|
248 | fdec9918 | Christian Borntraeger | * use 32GB as a base to have enough room for the system break
|
249 | fdec9918 | Christian Borntraeger | * to grow. We also have to use MAP parameters that avoid
|
250 | fdec9918 | Christian Borntraeger | * read-only mapping of guest pages.
|
251 | fdec9918 | Christian Borntraeger | */
|
252 | fdec9918 | Christian Borntraeger | static void *legacy_s390_alloc(ram_addr_t size) |
253 | fdec9918 | Christian Borntraeger | { |
254 | fdec9918 | Christian Borntraeger | void *mem;
|
255 | fdec9918 | Christian Borntraeger | |
256 | fdec9918 | Christian Borntraeger | mem = mmap((void *) 0x800000000ULL, size, |
257 | fdec9918 | Christian Borntraeger | PROT_EXEC|PROT_READ|PROT_WRITE, |
258 | fdec9918 | Christian Borntraeger | MAP_SHARED | MAP_ANONYMOUS | MAP_FIXED, -1, 0); |
259 | fdec9918 | Christian Borntraeger | if (mem == MAP_FAILED) {
|
260 | fdec9918 | Christian Borntraeger | fprintf(stderr, "Allocating RAM failed\n");
|
261 | fdec9918 | Christian Borntraeger | abort(); |
262 | fdec9918 | Christian Borntraeger | } |
263 | fdec9918 | Christian Borntraeger | return mem;
|
264 | fdec9918 | Christian Borntraeger | } |
265 | fdec9918 | Christian Borntraeger | |
266 | fdec9918 | Christian Borntraeger | void *kvm_arch_vmalloc(ram_addr_t size)
|
267 | fdec9918 | Christian Borntraeger | { |
268 | fdec9918 | Christian Borntraeger | /* Can we use the standard allocation ? */
|
269 | fdec9918 | Christian Borntraeger | if (kvm_check_extension(kvm_state, KVM_CAP_S390_GMAP) &&
|
270 | fdec9918 | Christian Borntraeger | kvm_check_extension(kvm_state, KVM_CAP_S390_COW)) { |
271 | fdec9918 | Christian Borntraeger | return NULL; |
272 | fdec9918 | Christian Borntraeger | } else {
|
273 | fdec9918 | Christian Borntraeger | return legacy_s390_alloc(size);
|
274 | fdec9918 | Christian Borntraeger | } |
275 | fdec9918 | Christian Borntraeger | } |
276 | fdec9918 | Christian Borntraeger | |
277 | 20d695a9 | Andreas Färber | int kvm_arch_insert_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp) |
278 | 0e60a699 | Alexander Graf | { |
279 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
280 | 20d695a9 | Andreas Färber | CPUS390XState *env = &cpu->env; |
281 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
282 | 0e60a699 | Alexander Graf | |
283 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 4, 0) || |
284 | 0e60a699 | Alexander Graf | cpu_memory_rw_debug(env, bp->pc, (uint8_t *)diag_501, 4, 1)) { |
285 | 0e60a699 | Alexander Graf | return -EINVAL;
|
286 | 0e60a699 | Alexander Graf | } |
287 | 0e60a699 | Alexander Graf | return 0; |
288 | 0e60a699 | Alexander Graf | } |
289 | 0e60a699 | Alexander Graf | |
290 | 20d695a9 | Andreas Färber | int kvm_arch_remove_sw_breakpoint(CPUState *cs, struct kvm_sw_breakpoint *bp) |
291 | 0e60a699 | Alexander Graf | { |
292 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
293 | 20d695a9 | Andreas Färber | CPUS390XState *env = &cpu->env; |
294 | 0e60a699 | Alexander Graf | uint8_t t[4];
|
295 | 0e60a699 | Alexander Graf | static const uint8_t diag_501[] = {0x83, 0x24, 0x05, 0x01}; |
296 | 0e60a699 | Alexander Graf | |
297 | 0e60a699 | Alexander Graf | if (cpu_memory_rw_debug(env, bp->pc, t, 4, 0)) { |
298 | 0e60a699 | Alexander Graf | return -EINVAL;
|
299 | 0e60a699 | Alexander Graf | } else if (memcmp(t, diag_501, 4)) { |
300 | 0e60a699 | Alexander Graf | return -EINVAL;
|
301 | 0e60a699 | Alexander Graf | } else if (cpu_memory_rw_debug(env, bp->pc, (uint8_t *)&bp->saved_insn, 1, 1)) { |
302 | 0e60a699 | Alexander Graf | return -EINVAL;
|
303 | 0e60a699 | Alexander Graf | } |
304 | 0e60a699 | Alexander Graf | |
305 | 0e60a699 | Alexander Graf | return 0; |
306 | 0e60a699 | Alexander Graf | } |
307 | 0e60a699 | Alexander Graf | |
308 | 20d695a9 | Andreas Färber | void kvm_arch_pre_run(CPUState *cpu, struct kvm_run *run) |
309 | 0e60a699 | Alexander Graf | { |
310 | 0e60a699 | Alexander Graf | } |
311 | 0e60a699 | Alexander Graf | |
312 | 20d695a9 | Andreas Färber | void kvm_arch_post_run(CPUState *cpu, struct kvm_run *run) |
313 | 0e60a699 | Alexander Graf | { |
314 | 0e60a699 | Alexander Graf | } |
315 | 0e60a699 | Alexander Graf | |
316 | 20d695a9 | Andreas Färber | int kvm_arch_process_async_events(CPUState *cs)
|
317 | 0af691d7 | Marcelo Tosatti | { |
318 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
319 | 20d695a9 | Andreas Färber | return cpu->env.halted;
|
320 | 0af691d7 | Marcelo Tosatti | } |
321 | 0af691d7 | Marcelo Tosatti | |
322 | 1bc22652 | Andreas Färber | void kvm_s390_interrupt_internal(S390CPU *cpu, int type, uint32_t parm, |
323 | bcec36ea | Alexander Graf | uint64_t parm64, int vm)
|
324 | 0e60a699 | Alexander Graf | { |
325 | 1bc22652 | Andreas Färber | CPUState *cs = CPU(cpu); |
326 | 0e60a699 | Alexander Graf | struct kvm_s390_interrupt kvmint;
|
327 | 0e60a699 | Alexander Graf | int r;
|
328 | 0e60a699 | Alexander Graf | |
329 | a60f24b5 | Andreas Färber | if (!cs->kvm_state) {
|
330 | 0e60a699 | Alexander Graf | return;
|
331 | 0e60a699 | Alexander Graf | } |
332 | 0e60a699 | Alexander Graf | |
333 | 0e60a699 | Alexander Graf | kvmint.type = type; |
334 | 0e60a699 | Alexander Graf | kvmint.parm = parm; |
335 | 0e60a699 | Alexander Graf | kvmint.parm64 = parm64; |
336 | 0e60a699 | Alexander Graf | |
337 | 0e60a699 | Alexander Graf | if (vm) {
|
338 | a60f24b5 | Andreas Färber | r = kvm_vm_ioctl(cs->kvm_state, KVM_S390_INTERRUPT, &kvmint); |
339 | 0e60a699 | Alexander Graf | } else {
|
340 | 1bc22652 | Andreas Färber | r = kvm_vcpu_ioctl(cs, KVM_S390_INTERRUPT, &kvmint); |
341 | 0e60a699 | Alexander Graf | } |
342 | 0e60a699 | Alexander Graf | |
343 | 0e60a699 | Alexander Graf | if (r < 0) { |
344 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM failed to inject interrupt\n");
|
345 | 0e60a699 | Alexander Graf | exit(1);
|
346 | 0e60a699 | Alexander Graf | } |
347 | 0e60a699 | Alexander Graf | } |
348 | 0e60a699 | Alexander Graf | |
349 | 1bc22652 | Andreas Färber | void kvm_s390_virtio_irq(S390CPU *cpu, int config_change, uint64_t token) |
350 | 0e60a699 | Alexander Graf | { |
351 | 1bc22652 | Andreas Färber | kvm_s390_interrupt_internal(cpu, KVM_S390_INT_VIRTIO, config_change, |
352 | 0e60a699 | Alexander Graf | token, 1);
|
353 | 0e60a699 | Alexander Graf | } |
354 | 0e60a699 | Alexander Graf | |
355 | 1bc22652 | Andreas Färber | void kvm_s390_interrupt(S390CPU *cpu, int type, uint32_t code) |
356 | 0e60a699 | Alexander Graf | { |
357 | 1bc22652 | Andreas Färber | kvm_s390_interrupt_internal(cpu, type, code, 0, 0); |
358 | 0e60a699 | Alexander Graf | } |
359 | 0e60a699 | Alexander Graf | |
360 | 1bc22652 | Andreas Färber | static void enter_pgmcheck(S390CPU *cpu, uint16_t code) |
361 | 0e60a699 | Alexander Graf | { |
362 | 1bc22652 | Andreas Färber | kvm_s390_interrupt(cpu, KVM_S390_PROGRAM_INT, code); |
363 | 0e60a699 | Alexander Graf | } |
364 | 0e60a699 | Alexander Graf | |
365 | f7575c96 | Andreas Färber | static inline void setcc(S390CPU *cpu, uint64_t cc) |
366 | 0e60a699 | Alexander Graf | { |
367 | f7575c96 | Andreas Färber | CPUS390XState *env = &cpu->env; |
368 | f7575c96 | Andreas Färber | CPUState *cs = CPU(cpu); |
369 | f7575c96 | Andreas Färber | |
370 | f7575c96 | Andreas Färber | cs->kvm_run->psw_mask &= ~(3ull << 44); |
371 | f7575c96 | Andreas Färber | cs->kvm_run->psw_mask |= (cc & 3) << 44; |
372 | 0e60a699 | Alexander Graf | |
373 | 0e60a699 | Alexander Graf | env->psw.mask &= ~(3ul << 44); |
374 | 0e60a699 | Alexander Graf | env->psw.mask |= (cc & 3) << 44; |
375 | 0e60a699 | Alexander Graf | } |
376 | 0e60a699 | Alexander Graf | |
377 | 1bc22652 | Andreas Färber | static int kvm_sclp_service_call(S390CPU *cpu, struct kvm_run *run, |
378 | bcec36ea | Alexander Graf | uint16_t ipbh0) |
379 | 0e60a699 | Alexander Graf | { |
380 | 1bc22652 | Andreas Färber | CPUS390XState *env = &cpu->env; |
381 | 0e60a699 | Alexander Graf | uint32_t sccb; |
382 | 0e60a699 | Alexander Graf | uint64_t code; |
383 | 0e60a699 | Alexander Graf | int r = 0; |
384 | 0e60a699 | Alexander Graf | |
385 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
386 | 0e60a699 | Alexander Graf | sccb = env->regs[ipbh0 & 0xf];
|
387 | 0e60a699 | Alexander Graf | code = env->regs[(ipbh0 & 0xf0) >> 4]; |
388 | 0e60a699 | Alexander Graf | |
389 | f6c98f92 | Heinz Graalfs | r = sclp_service_call(sccb, code); |
390 | 9abf567d | Christian Borntraeger | if (r < 0) { |
391 | 1bc22652 | Andreas Färber | enter_pgmcheck(cpu, -r); |
392 | 0e60a699 | Alexander Graf | } |
393 | f7575c96 | Andreas Färber | setcc(cpu, r); |
394 | 81f7c56c | Alexander Graf | |
395 | 0e60a699 | Alexander Graf | return 0; |
396 | 0e60a699 | Alexander Graf | } |
397 | 0e60a699 | Alexander Graf | |
398 | 09b99878 | Cornelia Huck | static int kvm_handle_css_inst(S390CPU *cpu, struct kvm_run *run, |
399 | 09b99878 | Cornelia Huck | uint8_t ipa0, uint8_t ipa1, uint8_t ipb) |
400 | 09b99878 | Cornelia Huck | { |
401 | 09b99878 | Cornelia Huck | int r = 0; |
402 | 09b99878 | Cornelia Huck | int no_cc = 0; |
403 | 09b99878 | Cornelia Huck | CPUS390XState *env = &cpu->env; |
404 | 09b99878 | Cornelia Huck | |
405 | 09b99878 | Cornelia Huck | if (ipa0 != 0xb2) { |
406 | 09b99878 | Cornelia Huck | /* Not handled for now. */
|
407 | 09b99878 | Cornelia Huck | return -1; |
408 | 09b99878 | Cornelia Huck | } |
409 | 09b99878 | Cornelia Huck | cpu_synchronize_state(env); |
410 | 09b99878 | Cornelia Huck | switch (ipa1) {
|
411 | 09b99878 | Cornelia Huck | case PRIV_XSCH:
|
412 | 09b99878 | Cornelia Huck | r = ioinst_handle_xsch(env, env->regs[1]);
|
413 | 09b99878 | Cornelia Huck | break;
|
414 | 09b99878 | Cornelia Huck | case PRIV_CSCH:
|
415 | 09b99878 | Cornelia Huck | r = ioinst_handle_csch(env, env->regs[1]);
|
416 | 09b99878 | Cornelia Huck | break;
|
417 | 09b99878 | Cornelia Huck | case PRIV_HSCH:
|
418 | 09b99878 | Cornelia Huck | r = ioinst_handle_hsch(env, env->regs[1]);
|
419 | 09b99878 | Cornelia Huck | break;
|
420 | 09b99878 | Cornelia Huck | case PRIV_MSCH:
|
421 | 09b99878 | Cornelia Huck | r = ioinst_handle_msch(env, env->regs[1], run->s390_sieic.ipb);
|
422 | 09b99878 | Cornelia Huck | break;
|
423 | 09b99878 | Cornelia Huck | case PRIV_SSCH:
|
424 | 09b99878 | Cornelia Huck | r = ioinst_handle_ssch(env, env->regs[1], run->s390_sieic.ipb);
|
425 | 09b99878 | Cornelia Huck | break;
|
426 | 09b99878 | Cornelia Huck | case PRIV_STCRW:
|
427 | 09b99878 | Cornelia Huck | r = ioinst_handle_stcrw(env, run->s390_sieic.ipb); |
428 | 09b99878 | Cornelia Huck | break;
|
429 | 09b99878 | Cornelia Huck | case PRIV_STSCH:
|
430 | 09b99878 | Cornelia Huck | r = ioinst_handle_stsch(env, env->regs[1], run->s390_sieic.ipb);
|
431 | 09b99878 | Cornelia Huck | break;
|
432 | 09b99878 | Cornelia Huck | case PRIV_TSCH:
|
433 | 09b99878 | Cornelia Huck | /* We should only get tsch via KVM_EXIT_S390_TSCH. */
|
434 | 09b99878 | Cornelia Huck | fprintf(stderr, "Spurious tsch intercept\n");
|
435 | 09b99878 | Cornelia Huck | break;
|
436 | 09b99878 | Cornelia Huck | case PRIV_CHSC:
|
437 | 09b99878 | Cornelia Huck | r = ioinst_handle_chsc(env, run->s390_sieic.ipb); |
438 | 09b99878 | Cornelia Huck | break;
|
439 | 09b99878 | Cornelia Huck | case PRIV_TPI:
|
440 | 09b99878 | Cornelia Huck | /* This should have been handled by kvm already. */
|
441 | 09b99878 | Cornelia Huck | fprintf(stderr, "Spurious tpi intercept\n");
|
442 | 09b99878 | Cornelia Huck | break;
|
443 | 09b99878 | Cornelia Huck | case PRIV_SCHM:
|
444 | 09b99878 | Cornelia Huck | no_cc = 1;
|
445 | 09b99878 | Cornelia Huck | r = ioinst_handle_schm(env, env->regs[1], env->regs[2], |
446 | 09b99878 | Cornelia Huck | run->s390_sieic.ipb); |
447 | 09b99878 | Cornelia Huck | break;
|
448 | 09b99878 | Cornelia Huck | case PRIV_RSCH:
|
449 | 09b99878 | Cornelia Huck | r = ioinst_handle_rsch(env, env->regs[1]);
|
450 | 09b99878 | Cornelia Huck | break;
|
451 | 09b99878 | Cornelia Huck | case PRIV_RCHP:
|
452 | 09b99878 | Cornelia Huck | r = ioinst_handle_rchp(env, env->regs[1]);
|
453 | 09b99878 | Cornelia Huck | break;
|
454 | 09b99878 | Cornelia Huck | case PRIV_STCPS:
|
455 | 09b99878 | Cornelia Huck | /* We do not provide this instruction, it is suppressed. */
|
456 | 09b99878 | Cornelia Huck | no_cc = 1;
|
457 | 09b99878 | Cornelia Huck | r = 0;
|
458 | 09b99878 | Cornelia Huck | break;
|
459 | 09b99878 | Cornelia Huck | case PRIV_SAL:
|
460 | 09b99878 | Cornelia Huck | no_cc = 1;
|
461 | 09b99878 | Cornelia Huck | r = ioinst_handle_sal(env, env->regs[1]);
|
462 | 09b99878 | Cornelia Huck | break;
|
463 | 09b99878 | Cornelia Huck | default:
|
464 | 09b99878 | Cornelia Huck | r = -1;
|
465 | 09b99878 | Cornelia Huck | break;
|
466 | 09b99878 | Cornelia Huck | } |
467 | 09b99878 | Cornelia Huck | |
468 | 09b99878 | Cornelia Huck | if (r >= 0) { |
469 | 09b99878 | Cornelia Huck | if (!no_cc) {
|
470 | 09b99878 | Cornelia Huck | setcc(cpu, r); |
471 | 09b99878 | Cornelia Huck | } |
472 | 09b99878 | Cornelia Huck | r = 0;
|
473 | 09b99878 | Cornelia Huck | } else if (r < -1) { |
474 | 09b99878 | Cornelia Huck | r = 0;
|
475 | 09b99878 | Cornelia Huck | } |
476 | 09b99878 | Cornelia Huck | return r;
|
477 | 09b99878 | Cornelia Huck | } |
478 | 09b99878 | Cornelia Huck | |
479 | 09b99878 | Cornelia Huck | static int is_ioinst(uint8_t ipa0, uint8_t ipa1, uint8_t ipb) |
480 | 09b99878 | Cornelia Huck | { |
481 | 09b99878 | Cornelia Huck | int ret = 0; |
482 | 09b99878 | Cornelia Huck | uint16_t ipa = (ipa0 << 8) | ipa1;
|
483 | 09b99878 | Cornelia Huck | |
484 | 09b99878 | Cornelia Huck | switch (ipa) {
|
485 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_CSCH:
|
486 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_HSCH:
|
487 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_MSCH:
|
488 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_SSCH:
|
489 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_STSCH:
|
490 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_TPI:
|
491 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_SAL:
|
492 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_RSCH:
|
493 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_STCRW:
|
494 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_STCPS:
|
495 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_RCHP:
|
496 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_SCHM:
|
497 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_CHSC:
|
498 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_SIGA:
|
499 | 09b99878 | Cornelia Huck | case IPA0_B2 | PRIV_XSCH:
|
500 | 09b99878 | Cornelia Huck | case IPA0_B9 | PRIV_EQBS:
|
501 | 09b99878 | Cornelia Huck | case IPA0_EB | PRIV_SQBS:
|
502 | 09b99878 | Cornelia Huck | ret = 1;
|
503 | 09b99878 | Cornelia Huck | break;
|
504 | 09b99878 | Cornelia Huck | } |
505 | 09b99878 | Cornelia Huck | |
506 | 09b99878 | Cornelia Huck | return ret;
|
507 | 09b99878 | Cornelia Huck | } |
508 | 09b99878 | Cornelia Huck | |
509 | 09b99878 | Cornelia Huck | static int handle_priv(S390CPU *cpu, struct kvm_run *run, |
510 | 09b99878 | Cornelia Huck | uint8_t ipa0, uint8_t ipa1) |
511 | 0e60a699 | Alexander Graf | { |
512 | 0e60a699 | Alexander Graf | int r = 0; |
513 | 0e60a699 | Alexander Graf | uint16_t ipbh0 = (run->s390_sieic.ipb & 0xffff0000) >> 16; |
514 | 09b99878 | Cornelia Huck | uint8_t ipb = run->s390_sieic.ipb & 0xff;
|
515 | 0e60a699 | Alexander Graf | |
516 | 0e60a699 | Alexander Graf | dprintf("KVM: PRIV: %d\n", ipa1);
|
517 | 0e60a699 | Alexander Graf | switch (ipa1) {
|
518 | 0e60a699 | Alexander Graf | case PRIV_SCLP_CALL:
|
519 | 1bc22652 | Andreas Färber | r = kvm_sclp_service_call(cpu, run, ipbh0); |
520 | 0e60a699 | Alexander Graf | break;
|
521 | 0e60a699 | Alexander Graf | default:
|
522 | 09b99878 | Cornelia Huck | if (is_ioinst(ipa0, ipa1, ipb)) {
|
523 | 09b99878 | Cornelia Huck | r = kvm_handle_css_inst(cpu, run, ipa0, ipa1, ipb); |
524 | 09b99878 | Cornelia Huck | if (r == -1) { |
525 | 09b99878 | Cornelia Huck | setcc(cpu, 3);
|
526 | 09b99878 | Cornelia Huck | r = 0;
|
527 | 09b99878 | Cornelia Huck | } |
528 | 09b99878 | Cornelia Huck | } else {
|
529 | 09b99878 | Cornelia Huck | dprintf("KVM: unknown PRIV: 0x%x\n", ipa1);
|
530 | 09b99878 | Cornelia Huck | r = -1;
|
531 | 09b99878 | Cornelia Huck | } |
532 | 0e60a699 | Alexander Graf | break;
|
533 | 0e60a699 | Alexander Graf | } |
534 | 0e60a699 | Alexander Graf | |
535 | 0e60a699 | Alexander Graf | return r;
|
536 | 0e60a699 | Alexander Graf | } |
537 | 0e60a699 | Alexander Graf | |
538 | a4e3ad19 | Andreas Färber | static int handle_hypercall(CPUS390XState *env, struct kvm_run *run) |
539 | 0e60a699 | Alexander Graf | { |
540 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
541 | 28e942f8 | Cornelia Huck | env->regs[2] = s390_virtio_hypercall(env);
|
542 | 0e60a699 | Alexander Graf | |
543 | bcec36ea | Alexander Graf | return 0; |
544 | 0e60a699 | Alexander Graf | } |
545 | 0e60a699 | Alexander Graf | |
546 | a4e3ad19 | Andreas Färber | static int handle_diag(CPUS390XState *env, struct kvm_run *run, int ipb_code) |
547 | 0e60a699 | Alexander Graf | { |
548 | 0e60a699 | Alexander Graf | int r = 0; |
549 | 0e60a699 | Alexander Graf | |
550 | 0e60a699 | Alexander Graf | switch (ipb_code) {
|
551 | 0e60a699 | Alexander Graf | case DIAG_KVM_HYPERCALL:
|
552 | 0e60a699 | Alexander Graf | r = handle_hypercall(env, run); |
553 | 0e60a699 | Alexander Graf | break;
|
554 | 0e60a699 | Alexander Graf | case DIAG_KVM_BREAKPOINT:
|
555 | 0e60a699 | Alexander Graf | sleep(10);
|
556 | 0e60a699 | Alexander Graf | break;
|
557 | 0e60a699 | Alexander Graf | default:
|
558 | 0e60a699 | Alexander Graf | dprintf("KVM: unknown DIAG: 0x%x\n", ipb_code);
|
559 | 0e60a699 | Alexander Graf | r = -1;
|
560 | 0e60a699 | Alexander Graf | break;
|
561 | 0e60a699 | Alexander Graf | } |
562 | 0e60a699 | Alexander Graf | |
563 | 0e60a699 | Alexander Graf | return r;
|
564 | 0e60a699 | Alexander Graf | } |
565 | 0e60a699 | Alexander Graf | |
566 | 3edb8f92 | Andreas Färber | static int s390_cpu_restart(S390CPU *cpu) |
567 | 0e60a699 | Alexander Graf | { |
568 | 1bc22652 | Andreas Färber | kvm_s390_interrupt(cpu, KVM_S390_RESTART, 0);
|
569 | 49e15878 | Andreas Färber | s390_add_running_cpu(cpu); |
570 | c08d7424 | Andreas Färber | qemu_cpu_kick(CPU(cpu)); |
571 | 49e15878 | Andreas Färber | dprintf("DONE: SIGP cpu restart: %p\n", &cpu->env);
|
572 | 0e60a699 | Alexander Graf | return 0; |
573 | 0e60a699 | Alexander Graf | } |
574 | 0e60a699 | Alexander Graf | |
575 | a4e3ad19 | Andreas Färber | static int s390_store_status(CPUS390XState *env, uint32_t parameter) |
576 | 0e60a699 | Alexander Graf | { |
577 | 0e60a699 | Alexander Graf | /* XXX */
|
578 | 0e60a699 | Alexander Graf | fprintf(stderr, "XXX SIGP store status\n");
|
579 | 0e60a699 | Alexander Graf | return -1; |
580 | 0e60a699 | Alexander Graf | } |
581 | 0e60a699 | Alexander Graf | |
582 | 1bc22652 | Andreas Färber | static int s390_cpu_initial_reset(S390CPU *cpu) |
583 | 0e60a699 | Alexander Graf | { |
584 | 1bc22652 | Andreas Färber | CPUS390XState *env = &cpu->env; |
585 | d5900813 | Alexander Graf | int i;
|
586 | d5900813 | Alexander Graf | |
587 | 49e15878 | Andreas Färber | s390_del_running_cpu(cpu); |
588 | 1bc22652 | Andreas Färber | if (kvm_vcpu_ioctl(CPU(cpu), KVM_S390_INITIAL_RESET, NULL) < 0) { |
589 | d5900813 | Alexander Graf | perror("cannot init reset vcpu");
|
590 | d5900813 | Alexander Graf | } |
591 | d5900813 | Alexander Graf | |
592 | d5900813 | Alexander Graf | /* Manually zero out all registers */
|
593 | d5900813 | Alexander Graf | cpu_synchronize_state(env); |
594 | d5900813 | Alexander Graf | for (i = 0; i < 16; i++) { |
595 | d5900813 | Alexander Graf | env->regs[i] = 0;
|
596 | d5900813 | Alexander Graf | } |
597 | d5900813 | Alexander Graf | |
598 | d5900813 | Alexander Graf | dprintf("DONE: SIGP initial reset: %p\n", env);
|
599 | d5900813 | Alexander Graf | return 0; |
600 | 0e60a699 | Alexander Graf | } |
601 | 0e60a699 | Alexander Graf | |
602 | f7575c96 | Andreas Färber | static int handle_sigp(S390CPU *cpu, struct kvm_run *run, uint8_t ipa1) |
603 | 0e60a699 | Alexander Graf | { |
604 | f7575c96 | Andreas Färber | CPUS390XState *env = &cpu->env; |
605 | 0e60a699 | Alexander Graf | uint8_t order_code; |
606 | 0e60a699 | Alexander Graf | uint32_t parameter; |
607 | 0e60a699 | Alexander Graf | uint16_t cpu_addr; |
608 | 0e60a699 | Alexander Graf | uint8_t t; |
609 | 0e60a699 | Alexander Graf | int r = -1; |
610 | 45fa769b | Andreas Färber | S390CPU *target_cpu; |
611 | a4e3ad19 | Andreas Färber | CPUS390XState *target_env; |
612 | 0e60a699 | Alexander Graf | |
613 | 0e60a699 | Alexander Graf | cpu_synchronize_state(env); |
614 | 0e60a699 | Alexander Graf | |
615 | 0e60a699 | Alexander Graf | /* get order code */
|
616 | 0e60a699 | Alexander Graf | order_code = run->s390_sieic.ipb >> 28;
|
617 | 0e60a699 | Alexander Graf | if (order_code > 0) { |
618 | 0e60a699 | Alexander Graf | order_code = env->regs[order_code]; |
619 | 0e60a699 | Alexander Graf | } |
620 | 0e60a699 | Alexander Graf | order_code += (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
621 | 0e60a699 | Alexander Graf | |
622 | 0e60a699 | Alexander Graf | /* get parameters */
|
623 | 0e60a699 | Alexander Graf | t = (ipa1 & 0xf0) >> 4; |
624 | 0e60a699 | Alexander Graf | if (!(t % 2)) { |
625 | 0e60a699 | Alexander Graf | t++; |
626 | 0e60a699 | Alexander Graf | } |
627 | 0e60a699 | Alexander Graf | |
628 | 0e60a699 | Alexander Graf | parameter = env->regs[t] & 0x7ffffe00;
|
629 | 0e60a699 | Alexander Graf | cpu_addr = env->regs[ipa1 & 0x0f];
|
630 | 0e60a699 | Alexander Graf | |
631 | 45fa769b | Andreas Färber | target_cpu = s390_cpu_addr2state(cpu_addr); |
632 | 45fa769b | Andreas Färber | if (target_cpu == NULL) { |
633 | 0e60a699 | Alexander Graf | goto out;
|
634 | 0e60a699 | Alexander Graf | } |
635 | 45fa769b | Andreas Färber | target_env = &target_cpu->env; |
636 | 0e60a699 | Alexander Graf | |
637 | 0e60a699 | Alexander Graf | switch (order_code) {
|
638 | 0e60a699 | Alexander Graf | case SIGP_RESTART:
|
639 | 3edb8f92 | Andreas Färber | r = s390_cpu_restart(target_cpu); |
640 | 0e60a699 | Alexander Graf | break;
|
641 | 0e60a699 | Alexander Graf | case SIGP_STORE_STATUS_ADDR:
|
642 | 0e60a699 | Alexander Graf | r = s390_store_status(target_env, parameter); |
643 | 0e60a699 | Alexander Graf | break;
|
644 | 0e60a699 | Alexander Graf | case SIGP_SET_ARCH:
|
645 | 0e60a699 | Alexander Graf | /* make the caller panic */
|
646 | 0e60a699 | Alexander Graf | return -1; |
647 | 0e60a699 | Alexander Graf | case SIGP_INITIAL_CPU_RESET:
|
648 | 1bc22652 | Andreas Färber | r = s390_cpu_initial_reset(target_cpu); |
649 | 0e60a699 | Alexander Graf | break;
|
650 | 0e60a699 | Alexander Graf | default:
|
651 | a74cdab4 | Christian Borntraeger | fprintf(stderr, "KVM: unknown SIGP: 0x%x\n", order_code);
|
652 | 0e60a699 | Alexander Graf | break;
|
653 | 0e60a699 | Alexander Graf | } |
654 | 0e60a699 | Alexander Graf | |
655 | 0e60a699 | Alexander Graf | out:
|
656 | f7575c96 | Andreas Färber | setcc(cpu, r ? 3 : 0); |
657 | 0e60a699 | Alexander Graf | return 0; |
658 | 0e60a699 | Alexander Graf | } |
659 | 0e60a699 | Alexander Graf | |
660 | 1bc22652 | Andreas Färber | static int handle_instruction(S390CPU *cpu, struct kvm_run *run) |
661 | 0e60a699 | Alexander Graf | { |
662 | 1bc22652 | Andreas Färber | CPUS390XState *env = &cpu->env; |
663 | 0e60a699 | Alexander Graf | unsigned int ipa0 = (run->s390_sieic.ipa & 0xff00); |
664 | 0e60a699 | Alexander Graf | uint8_t ipa1 = run->s390_sieic.ipa & 0x00ff;
|
665 | 0e60a699 | Alexander Graf | int ipb_code = (run->s390_sieic.ipb & 0x0fff0000) >> 16; |
666 | d7963c43 | Alexander Graf | int r = -1; |
667 | 0e60a699 | Alexander Graf | |
668 | 0e60a699 | Alexander Graf | dprintf("handle_instruction 0x%x 0x%x\n", run->s390_sieic.ipa, run->s390_sieic.ipb);
|
669 | 0e60a699 | Alexander Graf | switch (ipa0) {
|
670 | 09b99878 | Cornelia Huck | case IPA0_B2:
|
671 | 09b99878 | Cornelia Huck | case IPA0_B9:
|
672 | 09b99878 | Cornelia Huck | case IPA0_EB:
|
673 | 09b99878 | Cornelia Huck | r = handle_priv(cpu, run, ipa0 >> 8, ipa1);
|
674 | 09b99878 | Cornelia Huck | break;
|
675 | 09b99878 | Cornelia Huck | case IPA0_DIAG:
|
676 | 09b99878 | Cornelia Huck | r = handle_diag(env, run, ipb_code); |
677 | 09b99878 | Cornelia Huck | break;
|
678 | 09b99878 | Cornelia Huck | case IPA0_SIGP:
|
679 | 09b99878 | Cornelia Huck | r = handle_sigp(cpu, run, ipa1); |
680 | 09b99878 | Cornelia Huck | break;
|
681 | 0e60a699 | Alexander Graf | } |
682 | 0e60a699 | Alexander Graf | |
683 | 0e60a699 | Alexander Graf | if (r < 0) { |
684 | 1bc22652 | Andreas Färber | enter_pgmcheck(cpu, 0x0001);
|
685 | 0e60a699 | Alexander Graf | } |
686 | 359507ee | Alexander Graf | return 0; |
687 | 0e60a699 | Alexander Graf | } |
688 | 0e60a699 | Alexander Graf | |
689 | f7575c96 | Andreas Färber | static bool is_special_wait_psw(CPUState *cs) |
690 | eca3ed03 | Christian Borntraeger | { |
691 | eca3ed03 | Christian Borntraeger | /* signal quiesce */
|
692 | f7575c96 | Andreas Färber | return cs->kvm_run->psw_addr == 0xfffUL; |
693 | eca3ed03 | Christian Borntraeger | } |
694 | eca3ed03 | Christian Borntraeger | |
695 | 1bc22652 | Andreas Färber | static int handle_intercept(S390CPU *cpu) |
696 | 0e60a699 | Alexander Graf | { |
697 | f7575c96 | Andreas Färber | CPUState *cs = CPU(cpu); |
698 | f7575c96 | Andreas Färber | struct kvm_run *run = cs->kvm_run;
|
699 | 0e60a699 | Alexander Graf | int icpt_code = run->s390_sieic.icptcode;
|
700 | 0e60a699 | Alexander Graf | int r = 0; |
701 | 0e60a699 | Alexander Graf | |
702 | 81f7c56c | Alexander Graf | dprintf("intercept: 0x%x (at 0x%lx)\n", icpt_code,
|
703 | f7575c96 | Andreas Färber | (long)cs->kvm_run->psw_addr);
|
704 | 0e60a699 | Alexander Graf | switch (icpt_code) {
|
705 | 0e60a699 | Alexander Graf | case ICPT_INSTRUCTION:
|
706 | 1bc22652 | Andreas Färber | r = handle_instruction(cpu, run); |
707 | 0e60a699 | Alexander Graf | break;
|
708 | 0e60a699 | Alexander Graf | case ICPT_WAITPSW:
|
709 | 49e15878 | Andreas Färber | if (s390_del_running_cpu(cpu) == 0 && |
710 | f7575c96 | Andreas Färber | is_special_wait_psw(cs)) { |
711 | eca3ed03 | Christian Borntraeger | qemu_system_shutdown_request(); |
712 | eca3ed03 | Christian Borntraeger | } |
713 | eca3ed03 | Christian Borntraeger | r = EXCP_HALTED; |
714 | eca3ed03 | Christian Borntraeger | break;
|
715 | 854e42f3 | Christian Borntraeger | case ICPT_CPU_STOP:
|
716 | 49e15878 | Andreas Färber | if (s390_del_running_cpu(cpu) == 0) { |
717 | 854e42f3 | Christian Borntraeger | qemu_system_shutdown_request(); |
718 | 854e42f3 | Christian Borntraeger | } |
719 | 854e42f3 | Christian Borntraeger | r = EXCP_HALTED; |
720 | 0e60a699 | Alexander Graf | break;
|
721 | 0e60a699 | Alexander Graf | case ICPT_SOFT_INTERCEPT:
|
722 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt SOFT\n");
|
723 | 0e60a699 | Alexander Graf | exit(1);
|
724 | 0e60a699 | Alexander Graf | break;
|
725 | 0e60a699 | Alexander Graf | case ICPT_IO:
|
726 | 0e60a699 | Alexander Graf | fprintf(stderr, "KVM unimplemented icpt IO\n");
|
727 | 0e60a699 | Alexander Graf | exit(1);
|
728 | 0e60a699 | Alexander Graf | break;
|
729 | 0e60a699 | Alexander Graf | default:
|
730 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown intercept code: %d\n", icpt_code);
|
731 | 0e60a699 | Alexander Graf | exit(1);
|
732 | 0e60a699 | Alexander Graf | break;
|
733 | 0e60a699 | Alexander Graf | } |
734 | 0e60a699 | Alexander Graf | |
735 | 0e60a699 | Alexander Graf | return r;
|
736 | 0e60a699 | Alexander Graf | } |
737 | 0e60a699 | Alexander Graf | |
738 | 09b99878 | Cornelia Huck | static int handle_tsch(S390CPU *cpu) |
739 | 09b99878 | Cornelia Huck | { |
740 | 09b99878 | Cornelia Huck | CPUS390XState *env = &cpu->env; |
741 | 09b99878 | Cornelia Huck | CPUState *cs = CPU(cpu); |
742 | 09b99878 | Cornelia Huck | struct kvm_run *run = cs->kvm_run;
|
743 | 09b99878 | Cornelia Huck | int ret;
|
744 | 09b99878 | Cornelia Huck | |
745 | 09b99878 | Cornelia Huck | cpu_synchronize_state(env); |
746 | 09b99878 | Cornelia Huck | ret = ioinst_handle_tsch(env, env->regs[1], run->s390_tsch.ipb);
|
747 | 09b99878 | Cornelia Huck | if (ret >= 0) { |
748 | 09b99878 | Cornelia Huck | /* Success; set condition code. */
|
749 | 09b99878 | Cornelia Huck | setcc(cpu, ret); |
750 | 09b99878 | Cornelia Huck | ret = 0;
|
751 | 09b99878 | Cornelia Huck | } else if (ret < -1) { |
752 | 09b99878 | Cornelia Huck | /*
|
753 | 09b99878 | Cornelia Huck | * Failure.
|
754 | 09b99878 | Cornelia Huck | * If an I/O interrupt had been dequeued, we have to reinject it.
|
755 | 09b99878 | Cornelia Huck | */
|
756 | 09b99878 | Cornelia Huck | if (run->s390_tsch.dequeued) {
|
757 | 09b99878 | Cornelia Huck | uint16_t subchannel_id = run->s390_tsch.subchannel_id; |
758 | 09b99878 | Cornelia Huck | uint16_t subchannel_nr = run->s390_tsch.subchannel_nr; |
759 | 09b99878 | Cornelia Huck | uint32_t io_int_parm = run->s390_tsch.io_int_parm; |
760 | 09b99878 | Cornelia Huck | uint32_t io_int_word = run->s390_tsch.io_int_word; |
761 | 09b99878 | Cornelia Huck | uint32_t type = ((subchannel_id & 0xff00) << 24) | |
762 | 09b99878 | Cornelia Huck | ((subchannel_id & 0x00060) << 22) | (subchannel_nr << 16); |
763 | 09b99878 | Cornelia Huck | |
764 | 09b99878 | Cornelia Huck | kvm_s390_interrupt_internal(cpu, type, |
765 | 09b99878 | Cornelia Huck | ((uint32_t)subchannel_id << 16)
|
766 | 09b99878 | Cornelia Huck | | subchannel_nr, |
767 | 09b99878 | Cornelia Huck | ((uint64_t)io_int_parm << 32)
|
768 | 09b99878 | Cornelia Huck | | io_int_word, 1);
|
769 | 09b99878 | Cornelia Huck | } |
770 | 09b99878 | Cornelia Huck | ret = 0;
|
771 | 09b99878 | Cornelia Huck | } |
772 | 09b99878 | Cornelia Huck | return ret;
|
773 | 09b99878 | Cornelia Huck | } |
774 | 09b99878 | Cornelia Huck | |
775 | 20d695a9 | Andreas Färber | int kvm_arch_handle_exit(CPUState *cs, struct kvm_run *run) |
776 | 0e60a699 | Alexander Graf | { |
777 | 20d695a9 | Andreas Färber | S390CPU *cpu = S390_CPU(cs); |
778 | 0e60a699 | Alexander Graf | int ret = 0; |
779 | 0e60a699 | Alexander Graf | |
780 | 0e60a699 | Alexander Graf | switch (run->exit_reason) {
|
781 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_SIEIC:
|
782 | 1bc22652 | Andreas Färber | ret = handle_intercept(cpu); |
783 | 0e60a699 | Alexander Graf | break;
|
784 | 0e60a699 | Alexander Graf | case KVM_EXIT_S390_RESET:
|
785 | add142e0 | Jens Freimann | qemu_system_reset_request(); |
786 | 0e60a699 | Alexander Graf | break;
|
787 | 09b99878 | Cornelia Huck | case KVM_EXIT_S390_TSCH:
|
788 | 09b99878 | Cornelia Huck | ret = handle_tsch(cpu); |
789 | 09b99878 | Cornelia Huck | break;
|
790 | 0e60a699 | Alexander Graf | default:
|
791 | 0e60a699 | Alexander Graf | fprintf(stderr, "Unknown KVM exit: %d\n", run->exit_reason);
|
792 | 0e60a699 | Alexander Graf | break;
|
793 | 0e60a699 | Alexander Graf | } |
794 | 0e60a699 | Alexander Graf | |
795 | bb4ea393 | Jan Kiszka | if (ret == 0) { |
796 | bb4ea393 | Jan Kiszka | ret = EXCP_INTERRUPT; |
797 | bb4ea393 | Jan Kiszka | } |
798 | 0e60a699 | Alexander Graf | return ret;
|
799 | 0e60a699 | Alexander Graf | } |
800 | 4513d923 | Gleb Natapov | |
801 | 20d695a9 | Andreas Färber | bool kvm_arch_stop_on_emulation_error(CPUState *cpu)
|
802 | 4513d923 | Gleb Natapov | { |
803 | 4513d923 | Gleb Natapov | return true; |
804 | 4513d923 | Gleb Natapov | } |
805 | a1b87fe0 | Jan Kiszka | |
806 | 20d695a9 | Andreas Färber | int kvm_arch_on_sigbus_vcpu(CPUState *cpu, int code, void *addr) |
807 | a1b87fe0 | Jan Kiszka | { |
808 | a1b87fe0 | Jan Kiszka | return 1; |
809 | a1b87fe0 | Jan Kiszka | } |
810 | a1b87fe0 | Jan Kiszka | |
811 | a1b87fe0 | Jan Kiszka | int kvm_arch_on_sigbus(int code, void *addr) |
812 | a1b87fe0 | Jan Kiszka | { |
813 | a1b87fe0 | Jan Kiszka | return 1; |
814 | a1b87fe0 | Jan Kiszka | } |
815 | 09b99878 | Cornelia Huck | |
816 | 09b99878 | Cornelia Huck | void kvm_s390_io_interrupt(S390CPU *cpu, uint16_t subchannel_id,
|
817 | 09b99878 | Cornelia Huck | uint16_t subchannel_nr, uint32_t io_int_parm, |
818 | 09b99878 | Cornelia Huck | uint32_t io_int_word) |
819 | 09b99878 | Cornelia Huck | { |
820 | 09b99878 | Cornelia Huck | uint32_t type; |
821 | 09b99878 | Cornelia Huck | |
822 | 09b99878 | Cornelia Huck | type = ((subchannel_id & 0xff00) << 24) | |
823 | 09b99878 | Cornelia Huck | ((subchannel_id & 0x00060) << 22) | (subchannel_nr << 16); |
824 | 09b99878 | Cornelia Huck | kvm_s390_interrupt_internal(cpu, type, |
825 | 09b99878 | Cornelia Huck | ((uint32_t)subchannel_id << 16) | subchannel_nr,
|
826 | 09b99878 | Cornelia Huck | ((uint64_t)io_int_parm << 32) | io_int_word, 1); |
827 | 09b99878 | Cornelia Huck | } |
828 | 09b99878 | Cornelia Huck | |
829 | 09b99878 | Cornelia Huck | void kvm_s390_crw_mchk(S390CPU *cpu)
|
830 | 09b99878 | Cornelia Huck | { |
831 | 09b99878 | Cornelia Huck | kvm_s390_interrupt_internal(cpu, KVM_S390_MCHK, 1 << 28, |
832 | 09b99878 | Cornelia Huck | 0x00400f1d40330000, 1); |
833 | 09b99878 | Cornelia Huck | } |
834 | 09b99878 | Cornelia Huck | |
835 | 09b99878 | Cornelia Huck | void kvm_s390_enable_css_support(S390CPU *cpu)
|
836 | 09b99878 | Cornelia Huck | { |
837 | 09b99878 | Cornelia Huck | struct kvm_enable_cap cap = {};
|
838 | 09b99878 | Cornelia Huck | int r;
|
839 | 09b99878 | Cornelia Huck | |
840 | 09b99878 | Cornelia Huck | /* Activate host kernel channel subsystem support. */
|
841 | 09b99878 | Cornelia Huck | cap.cap = KVM_CAP_S390_CSS_SUPPORT; |
842 | 09b99878 | Cornelia Huck | r = kvm_vcpu_ioctl(CPU(cpu), KVM_ENABLE_CAP, &cap); |
843 | 09b99878 | Cornelia Huck | assert(r == 0);
|
844 | 09b99878 | Cornelia Huck | } |