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 "hw/boards.h"
42
43#include <libfdt.h>
44#include "hw/ppc/spapr_drc.h"
45#include "qemu/cutils.h"
46#include "trace.h"
47#include "hw/ppc/fdt.h"
48
49static void rtas_display_character(PowerPCCPU *cpu, sPAPRMachineState *spapr,
50 uint32_t token, uint32_t nargs,
51 target_ulong args,
52 uint32_t nret, target_ulong rets)
53{
54 uint8_t c = rtas_ld(args, 0);
55 VIOsPAPRDevice *sdev = vty_lookup(spapr, 0);
56
57 if (!sdev) {
58 rtas_st(rets, 0, RTAS_OUT_HW_ERROR);
59 } else {
60 vty_putchars(sdev, &c, sizeof(c));
61 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
62 }
63}
64
65static void rtas_power_off(PowerPCCPU *cpu, sPAPRMachineState *spapr,
66 uint32_t token, uint32_t nargs, target_ulong args,
67 uint32_t nret, target_ulong rets)
68{
69 if (nargs != 2 || nret != 1) {
70 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
71 return;
72 }
73 qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
74 cpu_stop_current();
75 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
76}
77
78static void rtas_system_reboot(PowerPCCPU *cpu, sPAPRMachineState *spapr,
79 uint32_t token, uint32_t nargs,
80 target_ulong args,
81 uint32_t nret, target_ulong rets)
82{
83 if (nargs != 0 || nret != 1) {
84 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
85 return;
86 }
87 qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
88 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
89}
90
91static void rtas_query_cpu_stopped_state(PowerPCCPU *cpu_,
92 sPAPRMachineState *spapr,
93 uint32_t token, uint32_t nargs,
94 target_ulong args,
95 uint32_t nret, target_ulong rets)
96{
97 target_ulong id;
98 PowerPCCPU *cpu;
99
100 if (nargs != 1 || nret != 2) {
101 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
102 return;
103 }
104
105 id = rtas_ld(args, 0);
106 cpu = spapr_find_cpu(id);
107 if (cpu != NULL) {
108 if (CPU(cpu)->halted) {
109 rtas_st(rets, 1, 0);
110 } else {
111 rtas_st(rets, 1, 2);
112 }
113
114 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
115 return;
116 }
117
118
119 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
120}
121
122
123
124
125
126static void spapr_cpu_update_tb_offset(PowerPCCPU *cpu)
127{
128 PowerPCCPU *fcpu = POWERPC_CPU(first_cpu);
129
130 cpu->env.tb_env->tb_offset = fcpu->env.tb_env->tb_offset;
131}
132
133static void spapr_cpu_set_endianness(PowerPCCPU *cpu)
134{
135 PowerPCCPU *fcpu = POWERPC_CPU(first_cpu);
136 PowerPCCPUClass *pcc = POWERPC_CPU_GET_CLASS(fcpu);
137
138 if (!pcc->interrupts_big_endian(fcpu)) {
139 cpu->env.spr[SPR_LPCR] |= LPCR_ILE;
140 }
141}
142
143static void rtas_start_cpu(PowerPCCPU *cpu_, sPAPRMachineState *spapr,
144 uint32_t token, uint32_t nargs,
145 target_ulong args,
146 uint32_t nret, target_ulong rets)
147{
148 target_ulong id, start, r3;
149 PowerPCCPU *cpu;
150
151 if (nargs != 3 || nret != 1) {
152 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
153 return;
154 }
155
156 id = rtas_ld(args, 0);
157 start = rtas_ld(args, 1);
158 r3 = rtas_ld(args, 2);
159
160 cpu = spapr_find_cpu(id);
161 if (cpu != NULL) {
162 CPUState *cs = CPU(cpu);
163 CPUPPCState *env = &cpu->env;
164 PowerPCCPUClass *pcc = POWERPC_CPU_GET_CLASS(cpu);
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
178
179 env->spr[SPR_LPCR] |= pcc->lpcr_pm;
180
181 env->nip = start;
182 env->gpr[3] = r3;
183 cs->halted = 0;
184 spapr_cpu_set_endianness(cpu);
185 spapr_cpu_update_tb_offset(cpu);
186
187 qemu_cpu_kick(cs);
188
189 rtas_st(rets, 0, RTAS_OUT_SUCCESS);
190 return;
191 }
192
193
194 rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
195}
196
197static void rtas_stop_self(PowerPCCPU *cpu, sPAPRMachineState *spapr,
198 uint32_t token, uint32_t nargs,
199 target_ulong args,
200 uint32_t nret, target_ulong rets)
201{
202 CPUState *cs = CPU(cpu);
203 CPUPPCState *env = &cpu->env;
204 PowerPCCPUClass *pcc = POWERPC_CPU_GET_CLASS(cpu);
205
206 cs->halted = 1;
207 qemu_cpu_kick(cs);
208
209
210
211
212 env->spr[SPR_LPCR] &= ~pcc->lpcr_pm;
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
