1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include "qemu/osdep.h"
27#include "qapi/error.h"
28#include "cpu.h"
29#include "qemu-common.h"
30#include "qemu/cutils.h"
31#include "qemu/timer.h"
32#include "qemu/error-report.h"
33#include "trace.h"
34#include "qapi/visitor.h"
35#include "migration/vmstate.h"
36#include "exec/exec-all.h"
37#ifndef CONFIG_USER_ONLY
38#include "hw/hw.h"
39#include "sysemu/arch_init.h"
40#include "sysemu/sysemu.h"
41#include "hw/s390x/sclp.h"
42#endif
43
44#define CR0_RESET 0xE0UL
45#define CR14_RESET 0xC2000000UL;
46
47static void s390_cpu_set_pc(CPUState *cs, vaddr value)
48{
49 S390CPU *cpu = S390_CPU(cs);
50
51 cpu->env.psw.addr = value;
52}
53
54static bool s390_cpu_has_work(CPUState *cs)
55{
56 S390CPU *cpu = S390_CPU(cs);
57 CPUS390XState *env = &cpu->env;
58
59 return (cs->interrupt_request & CPU_INTERRUPT_HARD) &&
60 (env->psw.mask & PSW_MASK_EXT);
61}
62
63#if !defined(CONFIG_USER_ONLY)
64
65static void s390_cpu_load_normal(CPUState *s)
66{
67 S390CPU *cpu = S390_CPU(s);
68 cpu->env.psw.addr = ldl_phys(s->as, 4) & PSW_MASK_ESA_ADDR;
69 cpu->env.psw.mask = PSW_MASK_32 | PSW_MASK_64;
70 s390_cpu_set_state(CPU_STATE_OPERATING, cpu);
71}
72#endif
73
74
75static void s390_cpu_reset(CPUState *s)
76{
77 S390CPU *cpu = S390_CPU(s);
78 S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);
79 CPUS390XState *env = &cpu->env;
80
81 env->pfault_token = -1UL;
82 scc->parent_reset(s);
83 cpu->env.sigp_order = 0;
84 s390_cpu_set_state(CPU_STATE_STOPPED, cpu);
85 tlb_flush(s, 1);
86}
87
88
89static void s390_cpu_initial_reset(CPUState *s)
90{
91 S390CPU *cpu = S390_CPU(s);
92 CPUS390XState *env = &cpu->env;
93 int i;
94
95 s390_cpu_reset(s);
96
97 memset(&env->fpc, 0, offsetof(CPUS390XState, cpu_num) -
98 offsetof(CPUS390XState, fpc));
99
100
101 env->cregs[0] = CR0_RESET;
102 env->cregs[14] = CR14_RESET;
103
104
105 env->gbea = 1;
106
107 env->pfault_token = -1UL;
108 env->ext_index = -1;
109 for (i = 0; i < ARRAY_SIZE(env->io_index); i++) {
110 env->io_index[i] = -1;
111 }
112
113
114 set_float_detect_tininess(float_tininess_before_rounding,
115 &env->fpu_status);
116
117
118 if (kvm_enabled()) {
119 kvm_s390_reset_vcpu(cpu);
120 }
121 tlb_flush(s, 1);
122}
123
124
125static void s390_cpu_full_reset(CPUState *s)
126{
127 S390CPU *cpu = S390_CPU(s);
128 S390CPUClass *scc = S390_CPU_GET_CLASS(cpu);
129 CPUS390XState *env = &cpu->env;
130 int i;
131
132 scc->parent_reset(s);
133 cpu->env.sigp_order = 0;
134 s390_cpu_set_state(CPU_STATE_STOPPED, cpu);
135
136 memset(env, 0, offsetof(CPUS390XState, cpu_num));
137
138
139 env->cregs[0] = CR0_RESET;
140 env->cregs[14] = CR14_RESET;
141
142
143 env->gbea = 1;
144
145 env->pfault_token = -1UL;
146 env->ext_index = -1;
147 for (i = 0; i < ARRAY_SIZE(env->io_index); i++) {
148 env->io_index[i] = -1;
149 }
150
151
152 set_float_detect_tininess(float_tininess_before_rounding,
153 &env->fpu_status);
154
155
156 if (kvm_enabled()) {
157 kvm_s390_reset_vcpu(cpu);
158 }
159 tlb_flush(s, 1);
160}
161
162#if !defined(CONFIG_USER_ONLY)
163static void s390_cpu_machine_reset_cb(void *opaque)
164{
165 S390CPU *cpu = opaque;
166
167 run_on_cpu(CPU(cpu), s390_do_cpu_full_reset, RUN_ON_CPU_NULL);
168}
169#endif
170
171static void s390_cpu_disas_set_info(CPUState *cpu, disassemble_info *info)
172{
173 info->mach = bfd_mach_s390_64;
174 info->print_insn = print_insn_s390;
175}
176
177static void s390_cpu_realizefn(DeviceState *dev, Error **errp)
178{
179 CPUState *cs = CPU(dev);
180 S390CPUClass *scc = S390_CPU_GET_CLASS(dev);
181 S390CPU *cpu = S390_CPU(dev);
182 CPUS390XState *env = &cpu->env;
183 Error *err = NULL;
184
185
186 s390_realize_cpu_model(cs, &err);
187 if (err) {
188 goto out;
189 }
190
191#if !defined(CONFIG_USER_ONLY)
192 if (cpu->id >= max_cpus) {
193 error_setg(&err, "Unable to add CPU: %" PRIi64
194 ", max allowed: %d", cpu->id, max_cpus - 1);
195 goto out;
196 }
197#endif
198 if (cpu_exists(cpu->id)) {
199 error_setg(&err, "Unable to add CPU: %" PRIi64
200 ", it already exists", cpu->id);
201 goto out;
202 }
203 if (cpu->id != scc->next_cpu_id) {
204 error_setg(&err, "Unable to add CPU: %" PRIi64
205 ", The next available id is %" PRIi64, cpu->id,
206 scc->next_cpu_id);
207 goto out;
208 }
209
210 cpu_exec_realizefn(cs, &err);
211 if (err != NULL) {
212 goto out;
213 }
214 scc->next_cpu_id++;
215
216#if !defined(CONFIG_USER_ONLY)
217 qemu_register_reset(s390_cpu_machine_reset_cb, cpu);
218#endif
219 env->cpu_num = cpu->id;
220 s390_cpu_gdb_init(cs);
221 qemu_init_vcpu(cs);
222#if !defined(CONFIG_USER_ONLY)
223 run_on_cpu(cs, s390_do_cpu_full_reset, RUN_ON_CPU_NULL);
224#else
225 cpu_reset(cs);
226#endif
227
228 scc->parent_realize(dev, &err);
229
230#if !defined(CONFIG_USER_ONLY)
231 if (dev->hotplugged) {
232 raise_irq_cpu_hotplug();
233 }
234#endif
235
236out:
237 error_propagate(errp, err);
238}
239
240static void s390x_cpu_get_id(Object *obj, Visitor *v, const char *name,
241 void *opaque, Error **errp)
242{
243 S390CPU *cpu = S390_CPU(obj);
244 int64_t value = cpu->id;
245
246 visit_type_int(v, name, &value, errp);
247}
248
249static void s390x_cpu_set_id(Object *obj, Visitor *v, const char *name,
250 void *opaque, Error **errp)
251{
252 S390CPU *cpu = S390_CPU(obj);
253 DeviceState *dev = DEVICE(obj);
254 const int64_t min = 0;
255 const int64_t max = UINT32_MAX;
256 Error *err = NULL;
257 int64_t value;
258
259 if (dev->realized) {
260 error_setg(errp, "Attempt to set property '%s' on '%s' after "
261 "it was realized", name, object_get_typename(obj));
262 return;
263 }
264
265 visit_type_int(v, name, &value, &err);
266 if (err) {
267 error_propagate(errp, err);
268 return;
269 }
270 if (value < min || value > max) {
271 error_setg(errp, "Property %s.%s doesn't take value %" PRId64
272 " (minimum: %" PRId64 ", maximum: %" PRId64 ")" ,
273 object_get_typename(obj), name, value, min, max);
274 return;
275 }
276 cpu->id = value;
277}
278
279static void s390_cpu_initfn(Object *obj)
280{
281 CPUState *cs = CPU(obj);
282 S390CPU *cpu = S390_CPU(obj);
283 CPUS390XState *env = &cpu->env;
284 static bool inited;
285#if !defined(CONFIG_USER_ONLY)
286 struct tm tm;
287#endif
288
289 cs->env_ptr = env;
290 cs->halted = 1;
291 cs->exception_index = EXCP_HLT;
292 object_property_add(OBJECT(cpu), "id", "int64_t", s390x_cpu_get_id,
293 s390x_cpu_set_id, NULL, NULL, NULL);
294 s390_cpu_model_register_props(obj);
295#if !defined(CONFIG_USER_ONLY)
296 qemu_get_timedate(&tm, 0);
297 env->tod_offset = TOD_UNIX_EPOCH +
298 (time2tod(mktimegm(&tm)) * 1000000000ULL);
299 env->tod_basetime = 0;
300 env->tod_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, s390x_tod_timer, cpu);
301 env->cpu_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, s390x_cpu_timer, cpu);
302 s390_cpu_set_state(CPU_STATE_STOPPED, cpu);
303#endif
304
305 if (tcg_enabled() && !inited) {
306 inited = true;
307 s390x_translate_init();
308 }
309}
310
311static void s390_cpu_finalize(Object *obj)
312{
313#if !defined(CONFIG_USER_ONLY)
314 S390CPU *cpu = S390_CPU(obj);
315
316 qemu_unregister_reset(s390_cpu_machine_reset_cb, cpu);
317 g_free(cpu->irqstate);
318#endif
319}
320
321#if !defined(CONFIG_USER_ONLY)
322static bool disabled_wait(CPUState *cpu)
323{
324 return cpu->halted && !(S390_CPU(cpu)->env.psw.mask &
325 (PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK));
326}
327
328static unsigned s390_count_running_cpus(void)
329{
330 CPUState *cpu;
331 int nr_running = 0;
332
333 CPU_FOREACH(cpu) {
334 uint8_t state = S390_CPU(cpu)->env.cpu_state;
335 if (state == CPU_STATE_OPERATING ||
336 state == CPU_STATE_LOAD) {
337 if (!disabled_wait(cpu)) {
338 nr_running++;
339 }
340 }
341 }
342
343 return nr_running;
344}
345
346unsigned int s390_cpu_halt(S390CPU *cpu)
347{
348 CPUState *cs = CPU(cpu);
349 trace_cpu_halt(cs->cpu_index);
350
351 if (!cs->halted) {
352 cs->halted = 1;
353 cs->exception_index = EXCP_HLT;
354 }
355
356 return s390_count_running_cpus();
357}
358
359void s390_cpu_unhalt(S390CPU *cpu)
360{
361 CPUState *cs = CPU(cpu);
362 trace_cpu_unhalt(cs->cpu_index);
363
364 if (cs->halted) {
365 cs->halted = 0;
366 cs->exception_index = -1;
367 }
368}
369
370unsigned int s390_cpu_set_state(uint8_t cpu_state, S390CPU *cpu)
371 {
372 trace_cpu_set_state(CPU(cpu)->cpu_index, cpu_state);
373
374 switch (cpu_state) {
375 case CPU_STATE_STOPPED:
376 case CPU_STATE_CHECK_STOP:
377
378 s390_cpu_halt(cpu);
379 break;
380 case CPU_STATE_OPERATING:
381 case CPU_STATE_LOAD:
382
383 s390_cpu_unhalt(cpu);
384 break;
385 default:
386 error_report("Requested CPU state is not a valid S390 CPU state: %u",
387 cpu_state);
388 exit(1);
389 }
390 if (kvm_enabled() && cpu->env.cpu_state != cpu_state) {
391 kvm_s390_set_cpu_state(cpu, cpu_state);
392 }
393 cpu->env.cpu_state = cpu_state;
394
395 return s390_count_running_cpus();
396}
397#endif
398
399static gchar *s390_gdb_arch_name(CPUState *cs)
400{
401 return g_strdup("s390:64-bit");
402}
403
404static void s390_cpu_class_init(ObjectClass *oc, void *data)
405{
406 S390CPUClass *scc = S390_CPU_CLASS(oc);
407 CPUClass *cc = CPU_CLASS(scc);
408 DeviceClass *dc = DEVICE_CLASS(oc);
409
410 scc->next_cpu_id = 0;
411 scc->parent_realize = dc->realize;
412 dc->realize = s390_cpu_realizefn;
413
414 scc->parent_reset = cc->reset;
415#if !defined(CONFIG_USER_ONLY)
416 scc->load_normal = s390_cpu_load_normal;
417#endif
418 scc->cpu_reset = s390_cpu_reset;
419 scc->initial_cpu_reset = s390_cpu_initial_reset;
420 cc->reset = s390_cpu_full_reset;
421 cc->class_by_name = s390_cpu_class_by_name,
422 cc->has_work = s390_cpu_has_work;
423 cc->do_interrupt = s390_cpu_do_interrupt;
424 cc->dump_state = s390_cpu_dump_state;
425 cc->set_pc = s390_cpu_set_pc;
426 cc->gdb_read_register = s390_cpu_gdb_read_register;
427 cc->gdb_write_register = s390_cpu_gdb_write_register;
428#ifdef CONFIG_USER_ONLY
429 cc->handle_mmu_fault = s390_cpu_handle_mmu_fault;
430#else
431 cc->get_phys_page_debug = s390_cpu_get_phys_page_debug;
432 cc->vmsd = &vmstate_s390_cpu;
433 cc->write_elf64_note = s390_cpu_write_elf64_note;
434 cc->cpu_exec_interrupt = s390_cpu_exec_interrupt;
435 cc->debug_excp_handler = s390x_cpu_debug_excp_handler;
436#endif
437 cc->disas_set_info = s390_cpu_disas_set_info;
438
439 cc->gdb_num_core_regs = S390_NUM_CORE_REGS;
440 cc->gdb_core_xml_file = "s390x-core64.xml";
441 cc->gdb_arch_name = s390_gdb_arch_name;
442
443 s390_cpu_model_class_register_props(oc);
444}
445
446static const TypeInfo s390_cpu_type_info = {
447 .name = TYPE_S390_CPU,
448 .parent = TYPE_CPU,
449 .instance_size = sizeof(S390CPU),
450 .instance_init = s390_cpu_initfn,
451 .instance_finalize = s390_cpu_finalize,
452 .abstract = true,
453 .class_size = sizeof(S390CPUClass),
454 .class_init = s390_cpu_class_init,
455};
456
457static void s390_cpu_register_types(void)
458{
459 type_register_static(&s390_cpu_type_info);
460}
461
462type_init(s390_cpu_register_types)
463
