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
27#include "qemu/osdep.h"
28#include "cpu.h"
29#include "qemu/log.h"
30#include "qemu/error-report.h"
31#include "sysemu/sysemu.h"
32#include "hw/qdev.h"
33#include "sysemu/device_tree.h"
34#include "sysemu/cpus.h"
35#include "sysemu/kvm.h"
36
37#include "hw/ppc/spapr.h"
38#include "hw/ppc/spapr_vio.h"
39#include "hw/ppc/spapr_rtas.h"
40#include "hw/ppc/ppc.h"
41#include "qapi-event.h"
42#include "hw/boards.h"
43
44#include <libfdt.h>
45#include "hw/ppc/spapr_drc.h"
46#include "qemu/cutils.h"
47#include "trace.h"
48#include "hw/ppc/fdt.h"
49
50static void rtas_display_character(PowerPCCPU *cpu, sPAPRMachineState *spapr,
51 uint32_t token, uint32_t nargs,
52 target_ulong args,
53 uint32_t nret, target_ulong rets)
54{
55 uint8_t c = rtas_ld(args, 0);
56 VIOsPAPRDevice *sdev = vty_lookup(spapr, 0);
57
58 if (!sdev) {
59 rtas_st(rets, 0, RTAS_OUT_HW_ERROR);
60 } else {
61 vty_putchars(sdev, &c, sizeof(c));
62 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
63 }
64}
65
66static void rtas_power_off(PowerPCCPU *cpu, sPAPRMachineState *spapr,
67 uint32_t token, uint32_t nargs, target_ulong args,
68 uint32_t nret, target_ulong rets)
69{
70 if (nargs != 2 || nret != 1) {
71 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
72 return;
73 }
74 qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
75 cpu_stop_current();
76 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
77}
78
79static void rtas_system_reboot(PowerPCCPU *cpu, sPAPRMachineState *spapr,
80 uint32_t token, uint32_t nargs,
81 target_ulong args,
82 uint32_t nret, target_ulong rets)
83{
84 if (nargs != 0 || nret != 1) {
85 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
86 return;
87 }
88 qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
89 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
90}
91
92static void rtas_query_cpu_stopped_state(PowerPCCPU *cpu_,
93 sPAPRMachineState *spapr,
94 uint32_t token, uint32_t nargs,
95 target_ulong args,
96 uint32_t nret, target_ulong rets)
97{
98 target_ulong id;
99 PowerPCCPU *cpu;
100
101 if (nargs != 1 || nret != 2) {
102 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
103 return;
104 }
105
106 id = rtas_ld(args, 0);
107 cpu = spapr_find_cpu(id);
108 if (cpu != NULL) {
109 if (CPU(cpu)->halted) {
110 rtas_st(rets, 1, 0);
111 } else {
112 rtas_st(rets, 1, 2);
113 }
114
115 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
116 return;
117 }
118
119
120 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
121}
122
123
124
125
126
127static void spapr_cpu_update_tb_offset(PowerPCCPU *cpu)
128{
129 PowerPCCPU *fcpu = POWERPC_CPU(first_cpu);
130
131 cpu->env.tb_env->tb_offset = fcpu->env.tb_env->tb_offset;
132}
133
134static void spapr_cpu_set_endianness(PowerPCCPU *cpu)
135{
136 PowerPCCPU *fcpu = POWERPC_CPU(first_cpu);
137 PowerPCCPUClass *pcc = POWERPC_CPU_GET_CLASS(fcpu);
138
139 if (!pcc->interrupts_big_endian(fcpu)) {
140 cpu->env.spr[SPR_LPCR] |= LPCR_ILE;
141 }
142}
143
144static void rtas_start_cpu(PowerPCCPU *cpu_, sPAPRMachineState *spapr,
145 uint32_t token, uint32_t nargs,
146 target_ulong args,
147 uint32_t nret, target_ulong rets)
148{
149 target_ulong id, start, r3;
150 PowerPCCPU *cpu;
151
152 if (nargs != 3 || nret != 1) {
153 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
154 return;
155 }
156
157 id = rtas_ld(args, 0);
158 start = rtas_ld(args, 1);
159 r3 = rtas_ld(args, 2);
160
161 cpu = spapr_find_cpu(id);
162 if (cpu != NULL) {
163 CPUState *cs = CPU(cpu);
164 CPUPPCState *env = &cpu->env;
165
166 if (!cs->halted) {
167 rtas_st(rets, 0, RTAS_OUT_HW_ERROR);
168 return;
169 }
170
171
172
173
174 kvm_cpu_synchronize_state(cs);
175
176 env->msr = (1ULL << MSR_SF) | (1ULL << MSR_ME);
177 env->nip = start;
178 env->gpr[3] = r3;
179 cs->halted = 0;
180 spapr_cpu_set_endianness(cpu);
181 spapr_cpu_update_tb_offset(cpu);
182
183 qemu_cpu_kick(cs);
184
185 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
186 return;
187 }
188
189
190 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
191}
192
193static void rtas_stop_self(PowerPCCPU *cpu, sPAPRMachineState *spapr,
194 uint32_t token, uint32_t nargs,
195 target_ulong args,
196 uint32_t nret, target_ulong rets)
197{
198 CPUState *cs = CPU(cpu);
199 CPUPPCState *env = &cpu->env;
200
201 cs->halted = 1;
202 qemu_cpu_kick(cs);
203
204
205
206
207
208
209
210
211
212 env->msr = 0;
213}
214
215static inline int sysparm_st(target_ulong addr, target_ulong len,
216 const void *val, uint16_t vallen)
217{
218 hwaddr phys = ppc64_phys_to_real(addr);
219
220 if (len < 2) {
221 return RTAS_OUT_SYSPARM_PARAM_ERROR;
222 }
223 stw_be_phys(&address_space_memory, phys, vallen);
224 cpu_physical_memory_write(phys + 2, val, MIN(len - 2, vallen));
225 return RTAS_OUT_SUCCESS;
226}
227
228static void rtas_ibm_get_system_parameter(PowerPCCPU *cpu,
229 sPAPRMachineState *spapr,
230 uint32_t token, uint32_t nargs,
231 target_ulong args,
232 uint32_t nret, target_ulong rets)
233{
234 target_ulong parameter = rtas_ld(args, 0);
235 target_ulong buffer = rtas_ld(args, 1);
236 target_ulong length = rtas_ld(args, 2);
237 target_ulong ret;
238
239 switch (parameter) {
240 case RTAS_SYSPARM_SPLPAR_CHARACTERISTICS: {
241 char *param_val = g_strdup_printf("MaxEntCap=%d,"
242 "DesMem=%llu,"
243 "DesProcs=%d,"
244 "MaxPlatProcs=%d",
245 max_cpus,
246 current_machine->ram_size / M_BYTE,
247 smp_cpus,
248 max_cpus);
249 ret = sysparm_st(buffer, length, param_val, strlen(param_val) + 1);
250 g_free(param_val);
251 break;
252 }
253 case RTAS_SYSPARM_DIAGNOSTICS_RUN_MODE: {
254 uint8_t param_val = DIAGNOSTICS_RUN_MODE_DISABLED;
255
256 ret = sysparm_st(buffer, length, ¶m_val, sizeof(param_val));
257 break;
258 }
259 case RTAS_SYSPARM_UUID:
260 ret = sysparm_st(buffer, length, (unsigned char *)&qemu_uuid,
261 (qemu_uuid_set ? 16 : 0));
262 break;
263 default:
264 ret = RTAS_OUT_NOT_SUPPORTED;
265 }
266
267 rtas_st(rets, 0, ret);
268}
269
270static void rtas_ibm_set_system_parameter(PowerPCCPU *cpu,
271 sPAPRMachineState *spapr,
272 uint32_t token, uint32_t nargs,
273 target_ulong args,
274 uint32_t nret, target_ulong rets)
275{
276 target_ulong parameter = rtas_ld(args, 0);
277 target_ulong ret = RTAS_OUT_NOT_SUPPORTED;
278
279 switch (parameter) {
280 case RTAS_SYSPARM_SPLPAR_CHARACTERISTICS:
281 case RTAS_SYSPARM_DIAGNOSTICS_RUN_MODE:
282 case RTAS_SYSPARM_UUID:
283 ret = RTAS_OUT_NOT_AUTHORIZED;
284 break;
285 }
286
287 rtas_st(rets, 0, ret);
288}
289
290static void rtas_ibm_os_term(PowerPCCPU *cpu,
291 sPAPRMachineState *spapr,
292 uint32_t token, uint32_t nargs,
293 target_ulong args,
294 uint32_t nret, target_ulong rets)
295{
296 qemu_system_guest_panicked(NULL);
297
298 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
299}
300
301static void rtas_set_power_level(PowerPCCPU *cpu, sPAPRMachineState *spapr,
302 uint32_t token, uint32_t nargs,
303 target_ulong args, uint32_t nret,
304 target_ulong rets)
305{
306 int32_t power_domain;
307
308 if (nargs != 2 || nret != 2) {
309 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
310 return;
311 }
312
313
314
315
316 power_domain = rtas_ld(args, 0);
317 if (power_domain != -1) {
318 rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
319 return;
320 }
321
322 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
323 rtas_st(rets, 1, 100);
324}
325
326static void rtas_get_power_level(PowerPCCPU *cpu, sPAPRMachineState *spapr,
327 uint32_t token, uint32_t nargs,
328 target_ulong args, uint32_t nret,
329 target_ulong rets)
330{
331 int32_t power_domain;
332
333 if (nargs != 1 || nret != 2) {
334 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
335 return;
336 }
337
338
339
340
341 power_domain = rtas_ld(args, 0);
342 if (power_domain != -1) {
343 rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
344 return;
345 }
346
347 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
348 rtas_st(rets, 1, 100);
349}
350
351static struct rtas_call {
352 const char *name;
353 spapr_rtas_fn fn;
354} rtas_table[RTAS_TOKEN_MAX - RTAS_TOKEN_BASE];
355
356target_ulong spapr_rtas_call(PowerPCCPU *cpu, sPAPRMachineState *spapr,
357 uint32_t token, uint32_t nargs, target_ulong args,
358 uint32_t nret, target_ulong rets)
359{
360 if ((token >= RTAS_TOKEN_BASE) && (token < RTAS_TOKEN_MAX)) {
361 struct rtas_call *call = rtas_table + (token - RTAS_TOKEN_BASE);
362
363 if (call->fn) {
364 call->fn(cpu, spapr, token, nargs, args, nret, rets);
365 return H_SUCCESS;
366 }
367 }
368
369
370
371
372
373 if (token == 0xa) {
374 rtas_display_character(cpu, spapr, 0xa, nargs, args, nret, rets);
375 return H_SUCCESS;
376 }
377
378 hcall_dprintf("Unknown RTAS token 0x%x\n", token);
379 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
380 return H_PARAMETER;
381}
382
383uint64_t qtest_rtas_call(char *cmd, uint32_t nargs, uint64_t args,
384 uint32_t nret, uint64_t rets)
385{
386 int token;
387
388 for (token = 0; token < RTAS_TOKEN_MAX - RTAS_TOKEN_BASE; token++) {
389 if (strcmp(cmd, rtas_table[token].name) == 0) {
390 sPAPRMachineState *spapr = SPAPR_MACHINE(qdev_get_machine());
391 PowerPCCPU *cpu = POWERPC_CPU(first_cpu);
392
393 rtas_table[token].fn(cpu, spapr, token + RTAS_TOKEN_BASE,
394 nargs, args, nret, rets);
395 return H_SUCCESS;
396 }
397 }
398 return H_PARAMETER;
399}
400
401void spapr_rtas_register(int token, const char *name, spapr_rtas_fn fn)
402{
403 assert((token >= RTAS_TOKEN_BASE) && (token < RTAS_TOKEN_MAX));
404
405 token -= RTAS_TOKEN_BASE;
406
407 assert(!rtas_table[token].name);
408
409 rtas_table[token].name = name;
410 rtas_table[token].fn = fn;
411}
412
413void spapr_dt_rtas_tokens(void *fdt, int rtas)
414{
415 int i;
416
417 for (i = 0; i < RTAS_TOKEN_MAX - RTAS_TOKEN_BASE; i++) {
418 struct rtas_call *call = &rtas_table[i];
419
420 if (!call->name) {
421 continue;
422 }
423
424 _FDT(fdt_setprop_cell(fdt, rtas, call->name, i + RTAS_TOKEN_BASE));
425 }
426}
427
428void spapr_load_rtas(sPAPRMachineState *spapr, void *fdt, hwaddr addr)
429{
430 int rtas_node;
431 int ret;
432
433
434 cpu_physical_memory_write(addr, spapr->rtas_blob, spapr->rtas_size);
435
436 ret = fdt_add_mem_rsv(fdt, addr, spapr->rtas_size);
437 if (ret < 0) {
438 error_report("Couldn't add RTAS reserve entry: %s",
439 fdt_strerror(ret));
440 exit(1);
441 }
442
443
444 rtas_node = fdt_path_offset(fdt, "/rtas");
445 assert(rtas_node >= 0);
446
447 ret = fdt_setprop_cell(fdt, rtas_node, "linux,rtas-base", addr);
448 if (ret < 0) {
449 error_report("Couldn't add linux,rtas-base property: %s",
450 fdt_strerror(ret));
451 exit(1);
452 }
453
454 ret = fdt_setprop_cell(fdt, rtas_node, "linux,rtas-entry", addr);
455 if (ret < 0) {
456 error_report("Couldn't add linux,rtas-entry property: %s",
457 fdt_strerror(ret));
458 exit(1);
459 }
460
461 ret = fdt_setprop_cell(fdt, rtas_node, "rtas-size", spapr->rtas_size);
462 if (ret < 0) {
463 error_report("Couldn't add rtas-size property: %s",
464 fdt_strerror(ret));
465 exit(1);
466 }
467}
468
469static void core_rtas_register_types(void)
470{
471 spapr_rtas_register(RTAS_DISPLAY_CHARACTER, "display-character",
472 rtas_display_character);
473 spapr_rtas_register(RTAS_POWER_OFF, "power-off", rtas_power_off);
474 spapr_rtas_register(RTAS_SYSTEM_REBOOT, "system-reboot",
475 rtas_system_reboot);
476 spapr_rtas_register(RTAS_QUERY_CPU_STOPPED_STATE, "query-cpu-stopped-state",
477 rtas_query_cpu_stopped_state);
478 spapr_rtas_register(RTAS_START_CPU, "start-cpu", rtas_start_cpu);
479 spapr_rtas_register(RTAS_STOP_SELF, "stop-self", rtas_stop_self);
480 spapr_rtas_register(RTAS_IBM_GET_SYSTEM_PARAMETER,
481 "ibm,get-system-parameter",
482 rtas_ibm_get_system_parameter);
483 spapr_rtas_register(RTAS_IBM_SET_SYSTEM_PARAMETER,
484 "ibm,set-system-parameter",
485 rtas_ibm_set_system_parameter);
486 spapr_rtas_register(RTAS_IBM_OS_TERM, "ibm,os-term",
487 rtas_ibm_os_term);
488 spapr_rtas_register(RTAS_SET_POWER_LEVEL, "set-power-level",
489 rtas_set_power_level);
490 spapr_rtas_register(RTAS_GET_POWER_LEVEL, "get-power-level",
491 rtas_get_power_level);
492}
493
494type_init(core_rtas_register_types)
495