]>
Commit | Line | Data |
---|---|---|
10ec5117 | 1 | /* |
aea1e885 | 2 | * S/390 misc helper routines |
10ec5117 | 3 | * |
defb0e31 | 4 | * Copyright (c) 2009 Ulrich Hecht |
10ec5117 AG |
5 | * Copyright (c) 2009 Alexander Graf |
6 | * | |
7 | * This library is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU Lesser General Public | |
9 | * License as published by the Free Software Foundation; either | |
10 | * version 2 of the License, or (at your option) any later version. | |
11 | * | |
12 | * This library is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * Lesser General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU Lesser General Public | |
70539e18 | 18 | * License along with this library; if not, see <http://www.gnu.org/licenses/>. |
10ec5117 AG |
19 | */ |
20 | ||
3e457172 | 21 | #include "cpu.h" |
022c62cb | 22 | #include "exec/memory.h" |
1de7afc9 | 23 | #include "qemu/host-utils.h" |
3208afbe | 24 | #include "helper.h" |
defb0e31 | 25 | #include <string.h> |
9c17d615 | 26 | #include "sysemu/kvm.h" |
1de7afc9 | 27 | #include "qemu/timer.h" |
af2be207 JK |
28 | #ifdef CONFIG_KVM |
29 | #include <linux/kvm.h> | |
30 | #endif | |
10ec5117 | 31 | |
71e47088 | 32 | #if !defined(CONFIG_USER_ONLY) |
022c62cb | 33 | #include "exec/softmmu_exec.h" |
9c17d615 | 34 | #include "sysemu/sysemu.h" |
10ec5117 | 35 | #endif |
d5a43964 | 36 | |
defb0e31 AG |
37 | /* #define DEBUG_HELPER */ |
38 | #ifdef DEBUG_HELPER | |
39 | #define HELPER_LOG(x...) qemu_log(x) | |
40 | #else | |
41 | #define HELPER_LOG(x...) | |
42 | #endif | |
43 | ||
b4e2bd35 RH |
44 | /* Raise an exception dynamically from a helper function. */ |
45 | void QEMU_NORETURN runtime_exception(CPUS390XState *env, int excp, | |
46 | uintptr_t retaddr) | |
47 | { | |
48 | int t; | |
49 | ||
50 | env->exception_index = EXCP_PGM; | |
51 | env->int_pgm_code = excp; | |
52 | ||
53 | /* Use the (ultimate) callers address to find the insn that trapped. */ | |
54 | cpu_restore_state(env, retaddr); | |
55 | ||
56 | /* Advance past the insn. */ | |
57 | t = cpu_ldub_code(env, env->psw.addr); | |
58 | env->int_pgm_ilen = t = get_ilen(t); | |
59 | env->psw.addr += 2 * t; | |
60 | ||
61 | cpu_loop_exit(env); | |
62 | } | |
63 | ||
d5a103cd | 64 | /* Raise an exception statically from a TB. */ |
089f5c06 | 65 | void HELPER(exception)(CPUS390XState *env, uint32_t excp) |
defb0e31 | 66 | { |
71e47088 | 67 | HELPER_LOG("%s: exception %d\n", __func__, excp); |
defb0e31 | 68 | env->exception_index = excp; |
1162c041 | 69 | cpu_loop_exit(env); |
defb0e31 AG |
70 | } |
71 | ||
defb0e31 | 72 | #ifndef CONFIG_USER_ONLY |
d5a103cd | 73 | void program_interrupt(CPUS390XState *env, uint32_t code, int ilen) |
defb0e31 | 74 | { |
0d404541 RH |
75 | qemu_log_mask(CPU_LOG_INT, "program interrupt at %#" PRIx64 "\n", |
76 | env->psw.addr); | |
defb0e31 AG |
77 | |
78 | if (kvm_enabled()) { | |
af2be207 | 79 | #ifdef CONFIG_KVM |
1bc22652 | 80 | kvm_s390_interrupt(s390_env_get_cpu(env), KVM_S390_PROGRAM_INT, code); |
af2be207 | 81 | #endif |
defb0e31 AG |
82 | } else { |
83 | env->int_pgm_code = code; | |
d5a103cd | 84 | env->int_pgm_ilen = ilen; |
defb0e31 | 85 | env->exception_index = EXCP_PGM; |
1162c041 | 86 | cpu_loop_exit(env); |
defb0e31 AG |
87 | } |
88 | } | |
89 | ||
defb0e31 | 90 | /* SCLP service call */ |
089f5c06 | 91 | uint32_t HELPER(servc)(CPUS390XState *env, uint32_t r1, uint64_t r2) |
defb0e31 | 92 | { |
9abf567d | 93 | int r; |
defb0e31 | 94 | |
f6c98f92 | 95 | r = sclp_service_call(r1, r2); |
9abf567d CB |
96 | if (r < 0) { |
97 | program_interrupt(env, -r, 4); | |
98 | return 0; | |
99 | } | |
100 | return r; | |
defb0e31 AG |
101 | } |
102 | ||
103 | /* DIAG */ | |
089f5c06 BS |
104 | uint64_t HELPER(diag)(CPUS390XState *env, uint32_t num, uint64_t mem, |
105 | uint64_t code) | |
defb0e31 AG |
106 | { |
107 | uint64_t r; | |
108 | ||
109 | switch (num) { | |
110 | case 0x500: | |
111 | /* KVM hypercall */ | |
112 | r = s390_virtio_hypercall(env, mem, code); | |
113 | break; | |
114 | case 0x44: | |
115 | /* yield */ | |
116 | r = 0; | |
117 | break; | |
118 | case 0x308: | |
119 | /* ipl */ | |
120 | r = 0; | |
121 | break; | |
122 | default: | |
123 | r = -1; | |
124 | break; | |
125 | } | |
126 | ||
127 | if (r) { | |
d5a103cd | 128 | program_interrupt(env, PGM_OPERATION, ILEN_LATER_INC); |
defb0e31 AG |
129 | } |
130 | ||
131 | return r; | |
132 | } | |
133 | ||
defb0e31 | 134 | /* Set Prefix */ |
089f5c06 | 135 | void HELPER(spx)(CPUS390XState *env, uint64_t a1) |
defb0e31 AG |
136 | { |
137 | uint32_t prefix; | |
138 | ||
089f5c06 | 139 | prefix = cpu_ldl_data(env, a1); |
defb0e31 AG |
140 | env->psa = prefix & 0xfffff000; |
141 | qemu_log("prefix: %#x\n", prefix); | |
142 | tlb_flush_page(env, 0); | |
143 | tlb_flush_page(env, TARGET_PAGE_SIZE); | |
144 | } | |
145 | ||
a4e3ad19 | 146 | static inline uint64_t clock_value(CPUS390XState *env) |
defb0e31 AG |
147 | { |
148 | uint64_t time; | |
149 | ||
150 | time = env->tod_offset + | |
71e47088 | 151 | time2tod(qemu_get_clock_ns(vm_clock) - env->tod_basetime); |
defb0e31 AG |
152 | |
153 | return time; | |
154 | } | |
155 | ||
156 | /* Store Clock */ | |
434c91a5 | 157 | uint64_t HELPER(stck)(CPUS390XState *env) |
defb0e31 | 158 | { |
434c91a5 | 159 | return clock_value(env); |
defb0e31 AG |
160 | } |
161 | ||
162 | /* Store Clock Extended */ | |
089f5c06 | 163 | uint32_t HELPER(stcke)(CPUS390XState *env, uint64_t a1) |
defb0e31 | 164 | { |
089f5c06 | 165 | cpu_stb_data(env, a1, 0); |
defb0e31 | 166 | /* basically the same value as stck */ |
089f5c06 | 167 | cpu_stq_data(env, a1 + 1, clock_value(env) | env->cpu_num); |
defb0e31 | 168 | /* more fine grained than stck */ |
089f5c06 | 169 | cpu_stq_data(env, a1 + 9, 0); |
defb0e31 | 170 | /* XXX programmable fields */ |
089f5c06 | 171 | cpu_stw_data(env, a1 + 17, 0); |
defb0e31 | 172 | |
defb0e31 AG |
173 | return 0; |
174 | } | |
175 | ||
176 | /* Set Clock Comparator */ | |
dd3eb7b5 | 177 | void HELPER(sckc)(CPUS390XState *env, uint64_t time) |
defb0e31 | 178 | { |
defb0e31 AG |
179 | if (time == -1ULL) { |
180 | return; | |
181 | } | |
182 | ||
183 | /* difference between now and then */ | |
184 | time -= clock_value(env); | |
185 | /* nanoseconds */ | |
186 | time = (time * 125) >> 9; | |
187 | ||
188 | qemu_mod_timer(env->tod_timer, qemu_get_clock_ns(vm_clock) + time); | |
189 | } | |
190 | ||
191 | /* Store Clock Comparator */ | |
dd3eb7b5 | 192 | uint64_t HELPER(stckc)(CPUS390XState *env) |
defb0e31 AG |
193 | { |
194 | /* XXX implement */ | |
dd3eb7b5 | 195 | return 0; |
defb0e31 AG |
196 | } |
197 | ||
198 | /* Set CPU Timer */ | |
089f5c06 | 199 | void HELPER(spt)(CPUS390XState *env, uint64_t a1) |
defb0e31 | 200 | { |
089f5c06 | 201 | uint64_t time = cpu_ldq_data(env, a1); |
defb0e31 AG |
202 | |
203 | if (time == -1ULL) { | |
204 | return; | |
205 | } | |
206 | ||
207 | /* nanoseconds */ | |
208 | time = (time * 125) >> 9; | |
209 | ||
210 | qemu_mod_timer(env->cpu_timer, qemu_get_clock_ns(vm_clock) + time); | |
211 | } | |
212 | ||
213 | /* Store CPU Timer */ | |
089f5c06 | 214 | void HELPER(stpt)(CPUS390XState *env, uint64_t a1) |
defb0e31 AG |
215 | { |
216 | /* XXX implement */ | |
089f5c06 | 217 | cpu_stq_data(env, a1, 0); |
defb0e31 AG |
218 | } |
219 | ||
220 | /* Store System Information */ | |
089f5c06 BS |
221 | uint32_t HELPER(stsi)(CPUS390XState *env, uint64_t a0, uint32_t r0, |
222 | uint32_t r1) | |
defb0e31 AG |
223 | { |
224 | int cc = 0; | |
225 | int sel1, sel2; | |
226 | ||
227 | if ((r0 & STSI_LEVEL_MASK) <= STSI_LEVEL_3 && | |
228 | ((r0 & STSI_R0_RESERVED_MASK) || (r1 & STSI_R1_RESERVED_MASK))) { | |
229 | /* valid function code, invalid reserved bits */ | |
230 | program_interrupt(env, PGM_SPECIFICATION, 2); | |
231 | } | |
232 | ||
233 | sel1 = r0 & STSI_R0_SEL1_MASK; | |
234 | sel2 = r1 & STSI_R1_SEL2_MASK; | |
235 | ||
236 | /* XXX: spec exception if sysib is not 4k-aligned */ | |
237 | ||
238 | switch (r0 & STSI_LEVEL_MASK) { | |
239 | case STSI_LEVEL_1: | |
240 | if ((sel1 == 1) && (sel2 == 1)) { | |
241 | /* Basic Machine Configuration */ | |
242 | struct sysib_111 sysib; | |
243 | ||
244 | memset(&sysib, 0, sizeof(sysib)); | |
245 | ebcdic_put(sysib.manuf, "QEMU ", 16); | |
246 | /* same as machine type number in STORE CPU ID */ | |
247 | ebcdic_put(sysib.type, "QEMU", 4); | |
248 | /* same as model number in STORE CPU ID */ | |
249 | ebcdic_put(sysib.model, "QEMU ", 16); | |
250 | ebcdic_put(sysib.sequence, "QEMU ", 16); | |
251 | ebcdic_put(sysib.plant, "QEMU", 4); | |
71e47088 | 252 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); |
defb0e31 AG |
253 | } else if ((sel1 == 2) && (sel2 == 1)) { |
254 | /* Basic Machine CPU */ | |
255 | struct sysib_121 sysib; | |
256 | ||
257 | memset(&sysib, 0, sizeof(sysib)); | |
258 | /* XXX make different for different CPUs? */ | |
259 | ebcdic_put(sysib.sequence, "QEMUQEMUQEMUQEMU", 16); | |
260 | ebcdic_put(sysib.plant, "QEMU", 4); | |
261 | stw_p(&sysib.cpu_addr, env->cpu_num); | |
71e47088 | 262 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); |
defb0e31 AG |
263 | } else if ((sel1 == 2) && (sel2 == 2)) { |
264 | /* Basic Machine CPUs */ | |
265 | struct sysib_122 sysib; | |
266 | ||
267 | memset(&sysib, 0, sizeof(sysib)); | |
268 | stl_p(&sysib.capability, 0x443afc29); | |
269 | /* XXX change when SMP comes */ | |
270 | stw_p(&sysib.total_cpus, 1); | |
271 | stw_p(&sysib.active_cpus, 1); | |
272 | stw_p(&sysib.standby_cpus, 0); | |
273 | stw_p(&sysib.reserved_cpus, 0); | |
71e47088 | 274 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); |
defb0e31 AG |
275 | } else { |
276 | cc = 3; | |
277 | } | |
278 | break; | |
279 | case STSI_LEVEL_2: | |
71e47088 BS |
280 | { |
281 | if ((sel1 == 2) && (sel2 == 1)) { | |
282 | /* LPAR CPU */ | |
283 | struct sysib_221 sysib; | |
284 | ||
285 | memset(&sysib, 0, sizeof(sysib)); | |
286 | /* XXX make different for different CPUs? */ | |
287 | ebcdic_put(sysib.sequence, "QEMUQEMUQEMUQEMU", 16); | |
288 | ebcdic_put(sysib.plant, "QEMU", 4); | |
289 | stw_p(&sysib.cpu_addr, env->cpu_num); | |
290 | stw_p(&sysib.cpu_id, 0); | |
291 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); | |
292 | } else if ((sel1 == 2) && (sel2 == 2)) { | |
293 | /* LPAR CPUs */ | |
294 | struct sysib_222 sysib; | |
295 | ||
296 | memset(&sysib, 0, sizeof(sysib)); | |
297 | stw_p(&sysib.lpar_num, 0); | |
298 | sysib.lcpuc = 0; | |
299 | /* XXX change when SMP comes */ | |
300 | stw_p(&sysib.total_cpus, 1); | |
301 | stw_p(&sysib.conf_cpus, 1); | |
302 | stw_p(&sysib.standby_cpus, 0); | |
303 | stw_p(&sysib.reserved_cpus, 0); | |
304 | ebcdic_put(sysib.name, "QEMU ", 8); | |
305 | stl_p(&sysib.caf, 1000); | |
306 | stw_p(&sysib.dedicated_cpus, 0); | |
307 | stw_p(&sysib.shared_cpus, 0); | |
308 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); | |
309 | } else { | |
310 | cc = 3; | |
311 | } | |
312 | break; | |
defb0e31 | 313 | } |
defb0e31 | 314 | case STSI_LEVEL_3: |
71e47088 BS |
315 | { |
316 | if ((sel1 == 2) && (sel2 == 2)) { | |
317 | /* VM CPUs */ | |
318 | struct sysib_322 sysib; | |
319 | ||
320 | memset(&sysib, 0, sizeof(sysib)); | |
321 | sysib.count = 1; | |
322 | /* XXX change when SMP comes */ | |
323 | stw_p(&sysib.vm[0].total_cpus, 1); | |
324 | stw_p(&sysib.vm[0].conf_cpus, 1); | |
325 | stw_p(&sysib.vm[0].standby_cpus, 0); | |
326 | stw_p(&sysib.vm[0].reserved_cpus, 0); | |
327 | ebcdic_put(sysib.vm[0].name, "KVMguest", 8); | |
328 | stl_p(&sysib.vm[0].caf, 1000); | |
329 | ebcdic_put(sysib.vm[0].cpi, "KVM/Linux ", 16); | |
330 | cpu_physical_memory_rw(a0, (uint8_t *)&sysib, sizeof(sysib), 1); | |
331 | } else { | |
332 | cc = 3; | |
333 | } | |
334 | break; | |
defb0e31 | 335 | } |
defb0e31 AG |
336 | case STSI_LEVEL_CURRENT: |
337 | env->regs[0] = STSI_LEVEL_3; | |
338 | break; | |
339 | default: | |
340 | cc = 3; | |
341 | break; | |
342 | } | |
343 | ||
344 | return cc; | |
345 | } | |
346 | ||
089f5c06 BS |
347 | uint32_t HELPER(sigp)(CPUS390XState *env, uint64_t order_code, uint32_t r1, |
348 | uint64_t cpu_addr) | |
defb0e31 AG |
349 | { |
350 | int cc = 0; | |
351 | ||
352 | HELPER_LOG("%s: %016" PRIx64 " %08x %016" PRIx64 "\n", | |
71e47088 | 353 | __func__, order_code, r1, cpu_addr); |
defb0e31 | 354 | |
71e47088 | 355 | /* Remember: Use "R1 or R1 + 1, whichever is the odd-numbered register" |
defb0e31 AG |
356 | as parameter (input). Status (output) is always R1. */ |
357 | ||
358 | switch (order_code) { | |
359 | case SIGP_SET_ARCH: | |
360 | /* switch arch */ | |
361 | break; | |
362 | case SIGP_SENSE: | |
363 | /* enumerate CPU status */ | |
364 | if (cpu_addr) { | |
365 | /* XXX implement when SMP comes */ | |
366 | return 3; | |
367 | } | |
368 | env->regs[r1] &= 0xffffffff00000000ULL; | |
369 | cc = 1; | |
370 | break; | |
71e47088 | 371 | #if !defined(CONFIG_USER_ONLY) |
1864b94a AG |
372 | case SIGP_RESTART: |
373 | qemu_system_reset_request(); | |
374 | cpu_loop_exit(env); | |
375 | break; | |
376 | case SIGP_STOP: | |
377 | qemu_system_shutdown_request(); | |
378 | cpu_loop_exit(env); | |
379 | break; | |
380 | #endif | |
defb0e31 AG |
381 | default: |
382 | /* unknown sigp */ | |
383 | fprintf(stderr, "XXX unknown sigp: 0x%" PRIx64 "\n", order_code); | |
384 | cc = 3; | |
385 | } | |
386 | ||
387 | return cc; | |
388 | } | |
defb0e31 | 389 | #endif |