1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include "qemu/osdep.h"
16#include "qemu/units.h"
17#include "qapi/error.h"
18#include "cpu.h"
19#include "sysemu/sysemu.h"
20#include "hw/boards.h"
21#include "hw/s390x/sclp.h"
22#include "hw/s390x/event-facility.h"
23#include "hw/s390x/s390-pci-bus.h"
24#include "hw/s390x/ipl.h"
25
26static inline SCLPDevice *get_sclp_device(void)
27{
28 static SCLPDevice *sclp;
29
30 if (!sclp) {
31 sclp = SCLP(object_resolve_path_type("", TYPE_SCLP, NULL));
32 }
33 return sclp;
34}
35
36static inline bool sclp_command_code_valid(uint32_t code)
37{
38 switch (code & SCLP_CMD_CODE_MASK) {
39 case SCLP_CMDW_READ_SCP_INFO:
40 case SCLP_CMDW_READ_SCP_INFO_FORCED:
41 case SCLP_CMDW_READ_CPU_INFO:
42 case SCLP_CMDW_CONFIGURE_IOA:
43 case SCLP_CMDW_DECONFIGURE_IOA:
44 case SCLP_CMD_READ_EVENT_DATA:
45 case SCLP_CMD_WRITE_EVENT_DATA:
46 case SCLP_CMD_WRITE_EVENT_MASK:
47 return true;
48 }
49 return false;
50}
51
52static bool sccb_verify_boundary(uint64_t sccb_addr, uint16_t sccb_len,
53 uint32_t code)
54{
55 uint64_t sccb_max_addr = sccb_addr + sccb_len - 1;
56 uint64_t sccb_boundary = (sccb_addr & PAGE_MASK) + PAGE_SIZE;
57
58 switch (code & SCLP_CMD_CODE_MASK) {
59 case SCLP_CMDW_READ_SCP_INFO:
60 case SCLP_CMDW_READ_SCP_INFO_FORCED:
61 case SCLP_CMDW_READ_CPU_INFO:
62
63
64
65
66
67
68 if (s390_has_feat(S390_FEAT_EXTENDED_LENGTH_SCCB)) {
69 return true;
70 }
71
72 default:
73 if (sccb_max_addr < sccb_boundary) {
74 return true;
75 }
76 }
77
78 return false;
79}
80
81static void prepare_cpu_entries(MachineState *ms, CPUEntry *entry, int *count)
82{
83 uint8_t features[SCCB_CPU_FEATURE_LEN] = { 0 };
84 int i;
85
86 s390_get_feat_block(S390_FEAT_TYPE_SCLP_CPU, features);
87 for (i = 0, *count = 0; i < ms->possible_cpus->len; i++) {
88 if (!ms->possible_cpus->cpus[i].cpu) {
89 continue;
90 }
91 entry[*count].address = ms->possible_cpus->cpus[i].arch_id;
92 entry[*count].type = 0;
93 memcpy(entry[*count].features, features, sizeof(features));
94 (*count)++;
95 }
96}
97
98#define SCCB_REQ_LEN(s, max_cpus) (sizeof(s) + max_cpus * sizeof(CPUEntry))
99
100static inline bool ext_len_sccb_supported(SCCBHeader header)
101{
102 return s390_has_feat(S390_FEAT_EXTENDED_LENGTH_SCCB) &&
103 header.control_mask[2] & SCLP_VARIABLE_LENGTH_RESPONSE;
104}
105
106
107static void read_SCP_info(SCLPDevice *sclp, SCCB *sccb)
108{
109 ReadInfo *read_info = (ReadInfo *) sccb;
110 MachineState *machine = MACHINE(qdev_get_machine());
111 int cpu_count;
112 int rnsize, rnmax;
113 IplParameterBlock *ipib = s390_ipl_get_iplb();
114 int required_len = SCCB_REQ_LEN(ReadInfo, machine->possible_cpus->len);
115 int offset_cpu = s390_has_feat(S390_FEAT_EXTENDED_LENGTH_SCCB) ?
116 offsetof(ReadInfo, entries) :
117 SCLP_READ_SCP_INFO_FIXED_CPU_OFFSET;
118 CPUEntry *entries_start = (void *)sccb + offset_cpu;
119
120 if (be16_to_cpu(sccb->h.length) < required_len) {
121 if (ext_len_sccb_supported(sccb->h)) {
122 sccb->h.length = cpu_to_be16(required_len);
123 }
124 sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
125 return;
126 }
127
128
129 prepare_cpu_entries(machine, entries_start, &cpu_count);
130 read_info->entries_cpu = cpu_to_be16(cpu_count);
131 read_info->offset_cpu = cpu_to_be16(offset_cpu);
132 read_info->highest_cpu = cpu_to_be16(machine->smp.max_cpus - 1);
133
134 read_info->ibc_val = cpu_to_be32(s390_get_ibc_val());
135
136
137 s390_get_feat_block(S390_FEAT_TYPE_SCLP_CONF_CHAR,
138 read_info->conf_char);
139 s390_get_feat_block(S390_FEAT_TYPE_SCLP_CONF_CHAR_EXT,
140 read_info->conf_char_ext);
141
142 if (s390_has_feat(S390_FEAT_EXTENDED_LENGTH_SCCB)) {
143 s390_get_feat_block(S390_FEAT_TYPE_SCLP_FAC134,
144 &read_info->fac134);
145 }
146
147 read_info->facilities = cpu_to_be64(SCLP_HAS_CPU_INFO |
148 SCLP_HAS_IOA_RECONFIG);
149
150 read_info->mha_pow = s390_get_mha_pow();
151 read_info->hmfai = cpu_to_be32(s390_get_hmfai());
152
153 rnsize = 1 << (sclp->increment_size - 20);
154 if (rnsize <= 128) {
155 read_info->rnsize = rnsize;
156 } else {
157 read_info->rnsize = 0;
158 read_info->rnsize2 = cpu_to_be32(rnsize);
159 }
160
161
162 rnmax = machine->ram_size >> sclp->increment_size;
163 if (rnmax < 0x10000) {
164 read_info->rnmax = cpu_to_be16(rnmax);
165 } else {
166 read_info->rnmax = cpu_to_be16(0);
167 read_info->rnmax2 = cpu_to_be64(rnmax);
168 }
169
170 if (ipib && ipib->flags & DIAG308_FLAGS_LP_VALID) {
171 memcpy(&read_info->loadparm, &ipib->loadparm,
172 sizeof(read_info->loadparm));
173 } else {
174 s390_ipl_set_loadparm(read_info->loadparm);
175 }
176
177 sccb->h.response_code = cpu_to_be16(SCLP_RC_NORMAL_READ_COMPLETION);
178}
179
180
181static void sclp_read_cpu_info(SCLPDevice *sclp, SCCB *sccb)
182{
183 MachineState *machine = MACHINE(qdev_get_machine());
184 ReadCpuInfo *cpu_info = (ReadCpuInfo *) sccb;
185 int cpu_count;
186 int required_len = SCCB_REQ_LEN(ReadCpuInfo, machine->possible_cpus->len);
187
188 if (be16_to_cpu(sccb->h.length) < required_len) {
189 if (ext_len_sccb_supported(sccb->h)) {
190 sccb->h.length = cpu_to_be16(required_len);
191 }
192 sccb->h.response_code = cpu_to_be16(SCLP_RC_INSUFFICIENT_SCCB_LENGTH);
193 return;
194 }
195
196 prepare_cpu_entries(machine, cpu_info->entries, &cpu_count);
197 cpu_info->nr_configured = cpu_to_be16(cpu_count);
198 cpu_info->offset_configured = cpu_to_be16(offsetof(ReadCpuInfo, entries));
199 cpu_info->nr_standby = cpu_to_be16(0);
200
201
202 cpu_info->offset_standby = cpu_to_be16(cpu_info->offset_configured
203 + cpu_info->nr_configured*sizeof(CPUEntry));
204
205
206 sccb->h.response_code = cpu_to_be16(SCLP_RC_NORMAL_READ_COMPLETION);
207}
208
209static void sclp_configure_io_adapter(SCLPDevice *sclp, SCCB *sccb,
210 bool configure)
211{
212 int rc;
213
214 if (be16_to_cpu(sccb->h.length) < 16) {
215 rc = SCLP_RC_INSUFFICIENT_SCCB_LENGTH;
216 goto out_err;
217 }
218
219 switch (((IoaCfgSccb *)sccb)->atype) {
220 case SCLP_RECONFIG_PCI_ATYPE:
221 if (s390_has_feat(S390_FEAT_ZPCI)) {
222 if (configure) {
223 s390_pci_sclp_configure(sccb);
224 } else {
225 s390_pci_sclp_deconfigure(sccb);
226 }
227 return;
228 }
229
230 default:
231 rc = SCLP_RC_ADAPTER_TYPE_NOT_RECOGNIZED;
232 }
233
234 out_err:
235 sccb->h.response_code = cpu_to_be16(rc);
236}
237
238static void sclp_execute(SCLPDevice *sclp, SCCB *sccb, uint32_t code)
239{
240 SCLPDeviceClass *sclp_c = SCLP_GET_CLASS(sclp);
241 SCLPEventFacility *ef = sclp->event_facility;
242 SCLPEventFacilityClass *efc = EVENT_FACILITY_GET_CLASS(ef);
243
244 switch (code & SCLP_CMD_CODE_MASK) {
245 case SCLP_CMDW_READ_SCP_INFO:
246 case SCLP_CMDW_READ_SCP_INFO_FORCED:
247 sclp_c->read_SCP_info(sclp, sccb);
248 break;
249 case SCLP_CMDW_READ_CPU_INFO:
250 sclp_c->read_cpu_info(sclp, sccb);
251 break;
252 case SCLP_CMDW_CONFIGURE_IOA:
253 sclp_configure_io_adapter(sclp, sccb, true);
254 break;
255 case SCLP_CMDW_DECONFIGURE_IOA:
256 sclp_configure_io_adapter(sclp, sccb, false);
257 break;
258 default:
259 efc->command_handler(ef, sccb, code);
260 break;
261 }
262}
263
264
265
266
267
268#define SCLP_PV_DUMMY_ADDR 0x4000
269int sclp_service_call_protected(CPUS390XState *env, uint64_t sccb,
270 uint32_t code)
271{
272 SCLPDevice *sclp = get_sclp_device();
273 SCLPDeviceClass *sclp_c = SCLP_GET_CLASS(sclp);
274 SCCBHeader header;
275 g_autofree SCCB *work_sccb = NULL;
276
277 s390_cpu_pv_mem_read(env_archcpu(env), 0, &header, sizeof(SCCBHeader));
278
279 work_sccb = g_malloc0(be16_to_cpu(header.length));
280 s390_cpu_pv_mem_read(env_archcpu(env), 0, work_sccb,
281 be16_to_cpu(header.length));
282
283 if (!sclp_command_code_valid(code)) {
284 work_sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_SCLP_COMMAND);
285 goto out_write;
286 }
287
288 sclp_c->execute(sclp, work_sccb, code);
289out_write:
290 s390_cpu_pv_mem_write(env_archcpu(env), 0, work_sccb,
291 be16_to_cpu(work_sccb->h.length));
292 sclp_c->service_interrupt(sclp, SCLP_PV_DUMMY_ADDR);
293 return 0;
294}
295
296int sclp_service_call(CPUS390XState *env, uint64_t sccb, uint32_t code)
297{
298 SCLPDevice *sclp = get_sclp_device();
299 SCLPDeviceClass *sclp_c = SCLP_GET_CLASS(sclp);
300 SCCBHeader header;
301 g_autofree SCCB *work_sccb = NULL;
302
303
304 if (env->psw.mask & PSW_MASK_PSTATE) {
305 return -PGM_PRIVILEGED;
306 }
307 if (cpu_physical_memory_is_io(sccb)) {
308 return -PGM_ADDRESSING;
309 }
310 if ((sccb & ~0x1fffUL) == 0 || (sccb & ~0x1fffUL) == env->psa
311 || (sccb & ~0x7ffffff8UL) != 0) {
312 return -PGM_SPECIFICATION;
313 }
314
315
316 cpu_physical_memory_read(sccb, &header, sizeof(SCCBHeader));
317
318
319 if (be16_to_cpu(header.length) < sizeof(SCCBHeader)) {
320 return -PGM_SPECIFICATION;
321 }
322
323
324
325
326
327
328 work_sccb = g_malloc0(be16_to_cpu(header.length));
329 cpu_physical_memory_read(sccb, work_sccb, be16_to_cpu(header.length));
330
331 if (!sclp_command_code_valid(code)) {
332 work_sccb->h.response_code = cpu_to_be16(SCLP_RC_INVALID_SCLP_COMMAND);
333 goto out_write;
334 }
335
336 if (!sccb_verify_boundary(sccb, be16_to_cpu(work_sccb->h.length), code)) {
337 work_sccb->h.response_code = cpu_to_be16(SCLP_RC_SCCB_BOUNDARY_VIOLATION);
338 goto out_write;
339 }
340
341 sclp_c->execute(sclp, work_sccb, code);
342out_write:
343 cpu_physical_memory_write(sccb, work_sccb,
344 be16_to_cpu(work_sccb->h.length));
345
346 sclp_c->service_interrupt(sclp, sccb);
347
348 return 0;
349}
350
351static void service_interrupt(SCLPDevice *sclp, uint32_t sccb)
352{
353 SCLPEventFacility *ef = sclp->event_facility;
354 SCLPEventFacilityClass *efc = EVENT_FACILITY_GET_CLASS(ef);
355
356 uint32_t param = sccb & ~3;
357
358
359 param |= efc->event_pending(ef) ? 1 : 0;
360
361 if (!param) {
362
363 return;
364 }
365 s390_sclp_extint(param);
366}
367
368void sclp_service_interrupt(uint32_t sccb)
369{
370 SCLPDevice *sclp = get_sclp_device();
371 SCLPDeviceClass *sclp_c = SCLP_GET_CLASS(sclp);
372
373 sclp_c->service_interrupt(sclp, sccb);
374}
375
376
377
378void s390_sclp_init(void)
379{
380 Object *new = object_new(TYPE_SCLP);
381
382 object_property_add_child(qdev_get_machine(), TYPE_SCLP, new);
383 object_unref(new);
384 qdev_realize(DEVICE(new), NULL, &error_fatal);
385}
386
387static void sclp_realize(DeviceState *dev, Error **errp)
388{
389 MachineState *machine = MACHINE(qdev_get_machine());
390 SCLPDevice *sclp = SCLP(dev);
391 uint64_t hw_limit;
392 int ret;
393
394
395
396
397
398
399 if (!sysbus_realize(SYS_BUS_DEVICE(sclp->event_facility), errp)) {
400 return;
401 }
402
403 ret = s390_set_memory_limit(machine->maxram_size, &hw_limit);
404 if (ret == -E2BIG) {
405 error_setg(errp, "host supports a maximum of %" PRIu64 " GB",
406 hw_limit / GiB);
407 } else if (ret) {
408 error_setg(errp, "setting the guest size failed");
409 }
410}
411
412static void sclp_memory_init(SCLPDevice *sclp)
413{
414 MachineState *machine = MACHINE(qdev_get_machine());
415 MachineClass *machine_class = MACHINE_GET_CLASS(qdev_get_machine());
416 ram_addr_t initial_mem = machine->ram_size;
417 int increment_size = 20;
418
419
420
421
422
423
424 while (machine_class->fixup_ram_size != NULL &&
425 (initial_mem >> increment_size) > MAX_STORAGE_INCREMENTS) {
426 increment_size++;
427 }
428 sclp->increment_size = increment_size;
429}
430
431static void sclp_init(Object *obj)
432{
433 SCLPDevice *sclp = SCLP(obj);
434 Object *new;
435
436 new = object_new(TYPE_SCLP_EVENT_FACILITY);
437 object_property_add_child(obj, TYPE_SCLP_EVENT_FACILITY, new);
438 object_unref(new);
439 sclp->event_facility = EVENT_FACILITY(new);
440
441 sclp_memory_init(sclp);
442}
443
444static void sclp_class_init(ObjectClass *oc, void *data)
445{
446 SCLPDeviceClass *sc = SCLP_CLASS(oc);
447 DeviceClass *dc = DEVICE_CLASS(oc);
448
449 dc->desc = "SCLP (Service-Call Logical Processor)";
450 dc->realize = sclp_realize;
451 dc->hotpluggable = false;
452 set_bit(DEVICE_CATEGORY_MISC, dc->categories);
453
454
455
456
457 dc->user_creatable = false;
458
459 sc->read_SCP_info = read_SCP_info;
460 sc->read_cpu_info = sclp_read_cpu_info;
461 sc->execute = sclp_execute;
462 sc->service_interrupt = service_interrupt;
463}
464
465static TypeInfo sclp_info = {
466 .name = TYPE_SCLP,
467 .parent = TYPE_DEVICE,
468 .instance_init = sclp_init,
469 .instance_size = sizeof(SCLPDevice),
470 .class_init = sclp_class_init,
471 .class_size = sizeof(SCLPDeviceClass),
472};
473
474static void register_types(void)
475{
476 type_register_static(&sclp_info);
477}
478type_init(register_types);
479