xref: /qemu/hw/ppc/spapr_rtas.c (revision e6fc9568c865f2f81499475a4e322cd563fdfd90)
1 /*
2  * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
3  *
4  * Hypercall based emulated RTAS
5  *
6  * Copyright (c) 2010-2011 David Gibson, IBM Corporation.
7  *
8  * Permission is hereby granted, free of charge, to any person obtaining a copy
9  * of this software and associated documentation files (the "Software"), to deal
10  * in the Software without restriction, including without limitation the rights
11  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
12  * copies of the Software, and to permit persons to whom the Software is
13  * furnished to do so, subject to the following conditions:
14  *
15  * The above copyright notice and this permission notice shall be included in
16  * all copies or substantial portions of the Software.
17  *
18  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
21  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
22  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
23  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
24  * THE SOFTWARE.
25  *
26  */
27 #include "cpu.h"
28 #include "sysemu/sysemu.h"
29 #include "sysemu/char.h"
30 #include "hw/qdev.h"
31 #include "sysemu/device_tree.h"
32 #include "sysemu/cpus.h"
33 
34 #include "hw/ppc/spapr.h"
35 #include "hw/ppc/spapr_vio.h"
36 #include "qapi-event.h"
37 #include "hw/boards.h"
38 
39 #include <libfdt.h>
40 #include "hw/ppc/spapr_drc.h"
41 
42 /* #define DEBUG_SPAPR */
43 
44 #ifdef DEBUG_SPAPR
45 #define DPRINTF(fmt, ...) \
46     do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
47 #else
48 #define DPRINTF(fmt, ...) \
49     do { } while (0)
50 #endif
51 
52 static sPAPRConfigureConnectorState *spapr_ccs_find(sPAPRMachineState *spapr,
53                                                     uint32_t drc_index)
54 {
55     sPAPRConfigureConnectorState *ccs = NULL;
56 
57     QTAILQ_FOREACH(ccs, &spapr->ccs_list, next) {
58         if (ccs->drc_index == drc_index) {
59             break;
60         }
61     }
62 
63     return ccs;
64 }
65 
66 static void spapr_ccs_add(sPAPRMachineState *spapr,
67                           sPAPRConfigureConnectorState *ccs)
68 {
69     g_assert(!spapr_ccs_find(spapr, ccs->drc_index));
70     QTAILQ_INSERT_HEAD(&spapr->ccs_list, ccs, next);
71 }
72 
73 static void spapr_ccs_remove(sPAPRMachineState *spapr,
74                              sPAPRConfigureConnectorState *ccs)
75 {
76     QTAILQ_REMOVE(&spapr->ccs_list, ccs, next);
77     g_free(ccs);
78 }
79 
80 void spapr_ccs_reset_hook(void *opaque)
81 {
82     sPAPRMachineState *spapr = opaque;
83     sPAPRConfigureConnectorState *ccs, *ccs_tmp;
84 
85     QTAILQ_FOREACH_SAFE(ccs, &spapr->ccs_list, next, ccs_tmp) {
86         spapr_ccs_remove(spapr, ccs);
87     }
88 }
89 
90 static void rtas_display_character(PowerPCCPU *cpu, sPAPRMachineState *spapr,
91                                    uint32_t token, uint32_t nargs,
92                                    target_ulong args,
93                                    uint32_t nret, target_ulong rets)
94 {
95     uint8_t c = rtas_ld(args, 0);
96     VIOsPAPRDevice *sdev = vty_lookup(spapr, 0);
97 
98     if (!sdev) {
99         rtas_st(rets, 0, RTAS_OUT_HW_ERROR);
100     } else {
101         vty_putchars(sdev, &c, sizeof(c));
102         rtas_st(rets, 0, RTAS_OUT_SUCCESS);
103     }
104 }
105 
106 static void rtas_power_off(PowerPCCPU *cpu, sPAPRMachineState *spapr,
107                            uint32_t token, uint32_t nargs, target_ulong args,
108                            uint32_t nret, target_ulong rets)
109 {
110     if (nargs != 2 || nret != 1) {
111         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
112         return;
113     }
114     qemu_system_shutdown_request();
115     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
116 }
117 
118 static void rtas_system_reboot(PowerPCCPU *cpu, sPAPRMachineState *spapr,
119                                uint32_t token, uint32_t nargs,
120                                target_ulong args,
121                                uint32_t nret, target_ulong rets)
122 {
123     if (nargs != 0 || nret != 1) {
124         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
125         return;
126     }
127     qemu_system_reset_request();
128     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
129 }
130 
131 static void rtas_query_cpu_stopped_state(PowerPCCPU *cpu_,
132                                          sPAPRMachineState *spapr,
133                                          uint32_t token, uint32_t nargs,
134                                          target_ulong args,
135                                          uint32_t nret, target_ulong rets)
136 {
137     target_ulong id;
138     PowerPCCPU *cpu;
139 
140     if (nargs != 1 || nret != 2) {
141         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
142         return;
143     }
144 
145     id = rtas_ld(args, 0);
146     cpu = ppc_get_vcpu_by_dt_id(id);
147     if (cpu != NULL) {
148         if (CPU(cpu)->halted) {
149             rtas_st(rets, 1, 0);
150         } else {
151             rtas_st(rets, 1, 2);
152         }
153 
154         rtas_st(rets, 0, RTAS_OUT_SUCCESS);
155         return;
156     }
157 
158     /* Didn't find a matching cpu */
159     rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
160 }
161 
162 static void rtas_start_cpu(PowerPCCPU *cpu_, sPAPRMachineState *spapr,
163                            uint32_t token, uint32_t nargs,
164                            target_ulong args,
165                            uint32_t nret, target_ulong rets)
166 {
167     target_ulong id, start, r3;
168     PowerPCCPU *cpu;
169 
170     if (nargs != 3 || nret != 1) {
171         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
172         return;
173     }
174 
175     id = rtas_ld(args, 0);
176     start = rtas_ld(args, 1);
177     r3 = rtas_ld(args, 2);
178 
179     cpu = ppc_get_vcpu_by_dt_id(id);
180     if (cpu != NULL) {
181         CPUState *cs = CPU(cpu);
182         CPUPPCState *env = &cpu->env;
183 
184         if (!cs->halted) {
185             rtas_st(rets, 0, RTAS_OUT_HW_ERROR);
186             return;
187         }
188 
189         /* This will make sure qemu state is up to date with kvm, and
190          * mark it dirty so our changes get flushed back before the
191          * new cpu enters */
192         kvm_cpu_synchronize_state(cs);
193 
194         env->msr = (1ULL << MSR_SF) | (1ULL << MSR_ME);
195         env->nip = start;
196         env->gpr[3] = r3;
197         cs->halted = 0;
198 
199         qemu_cpu_kick(cs);
200 
201         rtas_st(rets, 0, RTAS_OUT_SUCCESS);
202         return;
203     }
204 
205     /* Didn't find a matching cpu */
206     rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
207 }
208 
209 static void rtas_stop_self(PowerPCCPU *cpu, sPAPRMachineState *spapr,
210                            uint32_t token, uint32_t nargs,
211                            target_ulong args,
212                            uint32_t nret, target_ulong rets)
213 {
214     CPUState *cs = CPU(cpu);
215     CPUPPCState *env = &cpu->env;
216 
217     cs->halted = 1;
218     qemu_cpu_kick(cs);
219     /*
220      * While stopping a CPU, the guest calls H_CPPR which
221      * effectively disables interrupts on XICS level.
222      * However decrementer interrupts in TCG can still
223      * wake the CPU up so here we disable interrupts in MSR
224      * as well.
225      * As rtas_start_cpu() resets the whole MSR anyway, there is
226      * no need to bother with specific bits, we just clear it.
227      */
228     env->msr = 0;
229 }
230 
231 static void rtas_ibm_get_system_parameter(PowerPCCPU *cpu,
232                                           sPAPRMachineState *spapr,
233                                           uint32_t token, uint32_t nargs,
234                                           target_ulong args,
235                                           uint32_t nret, target_ulong rets)
236 {
237     target_ulong parameter = rtas_ld(args, 0);
238     target_ulong buffer = rtas_ld(args, 1);
239     target_ulong length = rtas_ld(args, 2);
240     target_ulong ret = RTAS_OUT_SUCCESS;
241 
242     switch (parameter) {
243     case RTAS_SYSPARM_SPLPAR_CHARACTERISTICS: {
244         char *param_val = g_strdup_printf("MaxEntCap=%d,"
245                                           "DesMem=%llu,"
246                                           "DesProcs=%d,"
247                                           "MaxPlatProcs=%d",
248                                           max_cpus,
249                                           current_machine->ram_size / M_BYTE,
250                                           smp_cpus,
251                                           max_cpus);
252         rtas_st_buffer(buffer, length, (uint8_t *)param_val, strlen(param_val));
253         g_free(param_val);
254         break;
255     }
256     case RTAS_SYSPARM_DIAGNOSTICS_RUN_MODE: {
257         uint8_t param_val = DIAGNOSTICS_RUN_MODE_DISABLED;
258 
259         rtas_st_buffer(buffer, length, &param_val, sizeof(param_val));
260         break;
261     }
262     case RTAS_SYSPARM_UUID:
263         rtas_st_buffer(buffer, length, qemu_uuid, (qemu_uuid_set ? 16 : 0));
264         break;
265     default:
266         ret = RTAS_OUT_NOT_SUPPORTED;
267     }
268 
269     rtas_st(rets, 0, ret);
270 }
271 
272 static void rtas_ibm_set_system_parameter(PowerPCCPU *cpu,
273                                           sPAPRMachineState *spapr,
274                                           uint32_t token, uint32_t nargs,
275                                           target_ulong args,
276                                           uint32_t nret, target_ulong rets)
277 {
278     target_ulong parameter = rtas_ld(args, 0);
279     target_ulong ret = RTAS_OUT_NOT_SUPPORTED;
280 
281     switch (parameter) {
282     case RTAS_SYSPARM_SPLPAR_CHARACTERISTICS:
283     case RTAS_SYSPARM_DIAGNOSTICS_RUN_MODE:
284     case RTAS_SYSPARM_UUID:
285         ret = RTAS_OUT_NOT_AUTHORIZED;
286         break;
287     }
288 
289     rtas_st(rets, 0, ret);
290 }
291 
292 static void rtas_ibm_os_term(PowerPCCPU *cpu,
293                             sPAPRMachineState *spapr,
294                             uint32_t token, uint32_t nargs,
295                             target_ulong args,
296                             uint32_t nret, target_ulong rets)
297 {
298     target_ulong ret = 0;
299 
300     qapi_event_send_guest_panicked(GUEST_PANIC_ACTION_PAUSE, &error_abort);
301 
302     rtas_st(rets, 0, ret);
303 }
304 
305 static void rtas_set_power_level(PowerPCCPU *cpu, sPAPRMachineState *spapr,
306                                  uint32_t token, uint32_t nargs,
307                                  target_ulong args, uint32_t nret,
308                                  target_ulong rets)
309 {
310     int32_t power_domain;
311 
312     if (nargs != 2 || nret != 2) {
313         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
314         return;
315     }
316 
317     /* we currently only use a single, "live insert" powerdomain for
318      * hotplugged/dlpar'd resources, so the power is always live/full (100)
319      */
320     power_domain = rtas_ld(args, 0);
321     if (power_domain != -1) {
322         rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
323         return;
324     }
325 
326     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
327     rtas_st(rets, 1, 100);
328 }
329 
330 static void rtas_get_power_level(PowerPCCPU *cpu, sPAPRMachineState *spapr,
331                                   uint32_t token, uint32_t nargs,
332                                   target_ulong args, uint32_t nret,
333                                   target_ulong rets)
334 {
335     int32_t power_domain;
336 
337     if (nargs != 1 || nret != 2) {
338         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
339         return;
340     }
341 
342     /* we currently only use a single, "live insert" powerdomain for
343      * hotplugged/dlpar'd resources, so the power is always live/full (100)
344      */
345     power_domain = rtas_ld(args, 0);
346     if (power_domain != -1) {
347         rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
348         return;
349     }
350 
351     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
352     rtas_st(rets, 1, 100);
353 }
354 
355 static bool sensor_type_is_dr(uint32_t sensor_type)
356 {
357     switch (sensor_type) {
358     case RTAS_SENSOR_TYPE_ISOLATION_STATE:
359     case RTAS_SENSOR_TYPE_DR:
360     case RTAS_SENSOR_TYPE_ALLOCATION_STATE:
361         return true;
362     }
363 
364     return false;
365 }
366 
367 static void rtas_set_indicator(PowerPCCPU *cpu, sPAPRMachineState *spapr,
368                                uint32_t token, uint32_t nargs,
369                                target_ulong args, uint32_t nret,
370                                target_ulong rets)
371 {
372     uint32_t sensor_type;
373     uint32_t sensor_index;
374     uint32_t sensor_state;
375     sPAPRDRConnector *drc;
376     sPAPRDRConnectorClass *drck;
377 
378     if (nargs != 3 || nret != 1) {
379         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
380         return;
381     }
382 
383     sensor_type = rtas_ld(args, 0);
384     sensor_index = rtas_ld(args, 1);
385     sensor_state = rtas_ld(args, 2);
386 
387     if (!sensor_type_is_dr(sensor_type)) {
388         goto out_unimplemented;
389     }
390 
391     /* if this is a DR sensor we can assume sensor_index == drc_index */
392     drc = spapr_dr_connector_by_index(sensor_index);
393     if (!drc) {
394         DPRINTF("rtas_set_indicator: invalid sensor/DRC index: %xh\n",
395                 sensor_index);
396         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
397         return;
398     }
399     drck = SPAPR_DR_CONNECTOR_GET_CLASS(drc);
400 
401     switch (sensor_type) {
402     case RTAS_SENSOR_TYPE_ISOLATION_STATE:
403         /* if the guest is configuring a device attached to this
404          * DRC, we should reset the configuration state at this
405          * point since it may no longer be reliable (guest released
406          * device and needs to start over, or unplug occurred so
407          * the FDT is no longer valid)
408          */
409         if (sensor_state == SPAPR_DR_ISOLATION_STATE_ISOLATED) {
410             sPAPRConfigureConnectorState *ccs = spapr_ccs_find(spapr,
411                                                                sensor_index);
412             if (ccs) {
413                 spapr_ccs_remove(spapr, ccs);
414             }
415         }
416         drck->set_isolation_state(drc, sensor_state);
417         break;
418     case RTAS_SENSOR_TYPE_DR:
419         drck->set_indicator_state(drc, sensor_state);
420         break;
421     case RTAS_SENSOR_TYPE_ALLOCATION_STATE:
422         drck->set_allocation_state(drc, sensor_state);
423         break;
424     default:
425         goto out_unimplemented;
426     }
427 
428     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
429     return;
430 
431 out_unimplemented:
432     /* currently only DR-related sensors are implemented */
433     DPRINTF("rtas_set_indicator: sensor/indicator not implemented: %d\n",
434             sensor_type);
435     rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
436 }
437 
438 static void rtas_get_sensor_state(PowerPCCPU *cpu, sPAPRMachineState *spapr,
439                                   uint32_t token, uint32_t nargs,
440                                   target_ulong args, uint32_t nret,
441                                   target_ulong rets)
442 {
443     uint32_t sensor_type;
444     uint32_t sensor_index;
445     sPAPRDRConnector *drc;
446     sPAPRDRConnectorClass *drck;
447     uint32_t entity_sense;
448 
449     if (nargs != 2 || nret != 2) {
450         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
451         return;
452     }
453 
454     sensor_type = rtas_ld(args, 0);
455     sensor_index = rtas_ld(args, 1);
456 
457     if (sensor_type != RTAS_SENSOR_TYPE_ENTITY_SENSE) {
458         /* currently only DR-related sensors are implemented */
459         DPRINTF("rtas_get_sensor_state: sensor/indicator not implemented: %d\n",
460                 sensor_type);
461         rtas_st(rets, 0, RTAS_OUT_NOT_SUPPORTED);
462         return;
463     }
464 
465     drc = spapr_dr_connector_by_index(sensor_index);
466     if (!drc) {
467         DPRINTF("rtas_get_sensor_state: invalid sensor/DRC index: %xh\n",
468                 sensor_index);
469         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
470         return;
471     }
472     drck = SPAPR_DR_CONNECTOR_GET_CLASS(drc);
473     entity_sense = drck->entity_sense(drc);
474 
475     rtas_st(rets, 0, RTAS_OUT_SUCCESS);
476     rtas_st(rets, 1, entity_sense);
477 }
478 
479 /* configure-connector work area offsets, int32_t units for field
480  * indexes, bytes for field offset/len values.
481  *
482  * as documented by PAPR+ v2.7, 13.5.3.5
483  */
484 #define CC_IDX_NODE_NAME_OFFSET 2
485 #define CC_IDX_PROP_NAME_OFFSET 2
486 #define CC_IDX_PROP_LEN 3
487 #define CC_IDX_PROP_DATA_OFFSET 4
488 #define CC_VAL_DATA_OFFSET ((CC_IDX_PROP_DATA_OFFSET + 1) * 4)
489 #define CC_WA_LEN 4096
490 
491 static void rtas_ibm_configure_connector(PowerPCCPU *cpu,
492                                          sPAPRMachineState *spapr,
493                                          uint32_t token, uint32_t nargs,
494                                          target_ulong args, uint32_t nret,
495                                          target_ulong rets)
496 {
497     uint64_t wa_addr;
498     uint64_t wa_offset;
499     uint32_t drc_index;
500     sPAPRDRConnector *drc;
501     sPAPRDRConnectorClass *drck;
502     sPAPRConfigureConnectorState *ccs;
503     sPAPRDRCCResponse resp = SPAPR_DR_CC_RESPONSE_CONTINUE;
504     int rc;
505     const void *fdt;
506 
507     if (nargs != 2 || nret != 1) {
508         rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
509         return;
510     }
511 
512     wa_addr = ((uint64_t)rtas_ld(args, 1) << 32) | rtas_ld(args, 0);
513 
514     drc_index = rtas_ld(wa_addr, 0);
515     drc = spapr_dr_connector_by_index(drc_index);
516     if (!drc) {
517         DPRINTF("rtas_ibm_configure_connector: invalid DRC index: %xh\n",
518                 drc_index);
519         rc = RTAS_OUT_PARAM_ERROR;
520         goto out;
521     }
522 
523     drck = SPAPR_DR_CONNECTOR_GET_CLASS(drc);
524     fdt = drck->get_fdt(drc, NULL);
525     if (!fdt) {
526         DPRINTF("rtas_ibm_configure_connector: Missing FDT for DRC index: %xh\n",
527                 drc_index);
528         rc = SPAPR_DR_CC_RESPONSE_NOT_CONFIGURABLE;
529         goto out;
530     }
531 
532     ccs = spapr_ccs_find(spapr, drc_index);
533     if (!ccs) {
534         ccs = g_new0(sPAPRConfigureConnectorState, 1);
535         (void)drck->get_fdt(drc, &ccs->fdt_offset);
536         ccs->drc_index = drc_index;
537         spapr_ccs_add(spapr, ccs);
538     }
539 
540     do {
541         uint32_t tag;
542         const char *name;
543         const struct fdt_property *prop;
544         int fdt_offset_next, prop_len;
545 
546         tag = fdt_next_tag(fdt, ccs->fdt_offset, &fdt_offset_next);
547 
548         switch (tag) {
549         case FDT_BEGIN_NODE:
550             ccs->fdt_depth++;
551             name = fdt_get_name(fdt, ccs->fdt_offset, NULL);
552 
553             /* provide the name of the next OF node */
554             wa_offset = CC_VAL_DATA_OFFSET;
555             rtas_st(wa_addr, CC_IDX_NODE_NAME_OFFSET, wa_offset);
556             rtas_st_buffer_direct(wa_addr + wa_offset, CC_WA_LEN - wa_offset,
557                                   (uint8_t *)name, strlen(name) + 1);
558             resp = SPAPR_DR_CC_RESPONSE_NEXT_CHILD;
559             break;
560         case FDT_END_NODE:
561             ccs->fdt_depth--;
562             if (ccs->fdt_depth == 0) {
563                 /* done sending the device tree, don't need to track
564                  * the state anymore
565                  */
566                 drck->set_configured(drc);
567                 spapr_ccs_remove(spapr, ccs);
568                 ccs = NULL;
569                 resp = SPAPR_DR_CC_RESPONSE_SUCCESS;
570             } else {
571                 resp = SPAPR_DR_CC_RESPONSE_PREV_PARENT;
572             }
573             break;
574         case FDT_PROP:
575             prop = fdt_get_property_by_offset(fdt, ccs->fdt_offset,
576                                               &prop_len);
577             name = fdt_string(fdt, fdt32_to_cpu(prop->nameoff));
578 
579             /* provide the name of the next OF property */
580             wa_offset = CC_VAL_DATA_OFFSET;
581             rtas_st(wa_addr, CC_IDX_PROP_NAME_OFFSET, wa_offset);
582             rtas_st_buffer_direct(wa_addr + wa_offset, CC_WA_LEN - wa_offset,
583                                   (uint8_t *)name, strlen(name) + 1);
584 
585             /* provide the length and value of the OF property. data gets
586              * placed immediately after NULL terminator of the OF property's
587              * name string
588              */
589             wa_offset += strlen(name) + 1,
590             rtas_st(wa_addr, CC_IDX_PROP_LEN, prop_len);
591             rtas_st(wa_addr, CC_IDX_PROP_DATA_OFFSET, wa_offset);
592             rtas_st_buffer_direct(wa_addr + wa_offset, CC_WA_LEN - wa_offset,
593                                   (uint8_t *)((struct fdt_property *)prop)->data,
594                                   prop_len);
595             resp = SPAPR_DR_CC_RESPONSE_NEXT_PROPERTY;
596             break;
597         case FDT_END:
598             resp = SPAPR_DR_CC_RESPONSE_ERROR;
599         default:
600             /* keep seeking for an actionable tag */
601             break;
602         }
603         if (ccs) {
604             ccs->fdt_offset = fdt_offset_next;
605         }
606     } while (resp == SPAPR_DR_CC_RESPONSE_CONTINUE);
607 
608     rc = resp;
609 out:
610     rtas_st(rets, 0, rc);
611 }
612 
613 static struct rtas_call {
614     const char *name;
615     spapr_rtas_fn fn;
616 } rtas_table[RTAS_TOKEN_MAX - RTAS_TOKEN_BASE];
617 
618 target_ulong spapr_rtas_call(PowerPCCPU *cpu, sPAPRMachineState *spapr,
619                              uint32_t token, uint32_t nargs, target_ulong args,
620                              uint32_t nret, target_ulong rets)
621 {
622     if ((token >= RTAS_TOKEN_BASE) && (token < RTAS_TOKEN_MAX)) {
623         struct rtas_call *call = rtas_table + (token - RTAS_TOKEN_BASE);
624 
625         if (call->fn) {
626             call->fn(cpu, spapr, token, nargs, args, nret, rets);
627             return H_SUCCESS;
628         }
629     }
630 
631     /* HACK: Some Linux early debug code uses RTAS display-character,
632      * but assumes the token value is 0xa (which it is on some real
633      * machines) without looking it up in the device tree.  This
634      * special case makes this work */
635     if (token == 0xa) {
636         rtas_display_character(cpu, spapr, 0xa, nargs, args, nret, rets);
637         return H_SUCCESS;
638     }
639 
640     hcall_dprintf("Unknown RTAS token 0x%x\n", token);
641     rtas_st(rets, 0, RTAS_OUT_PARAM_ERROR);
642     return H_PARAMETER;
643 }
644 
645 void spapr_rtas_register(int token, const char *name, spapr_rtas_fn fn)
646 {
647     if (!((token >= RTAS_TOKEN_BASE) && (token < RTAS_TOKEN_MAX))) {
648         fprintf(stderr, "RTAS invalid token 0x%x\n", token);
649         exit(1);
650     }
651 
652     token -= RTAS_TOKEN_BASE;
653     if (rtas_table[token].name) {
654         fprintf(stderr, "RTAS call \"%s\" is registered already as 0x%x\n",
655                 rtas_table[token].name, token);
656         exit(1);
657     }
658 
659     rtas_table[token].name = name;
660     rtas_table[token].fn = fn;
661 }
662 
663 int spapr_rtas_device_tree_setup(void *fdt, hwaddr rtas_addr,
664                                  hwaddr rtas_size)
665 {
666     int ret;
667     int i;
668     uint32_t lrdr_capacity[5];
669     MachineState *machine = MACHINE(qdev_get_machine());
670 
671     ret = fdt_add_mem_rsv(fdt, rtas_addr, rtas_size);
672     if (ret < 0) {
673         fprintf(stderr, "Couldn't add RTAS reserve entry: %s\n",
674                 fdt_strerror(ret));
675         return ret;
676     }
677 
678     ret = qemu_fdt_setprop_cell(fdt, "/rtas", "linux,rtas-base",
679                                 rtas_addr);
680     if (ret < 0) {
681         fprintf(stderr, "Couldn't add linux,rtas-base property: %s\n",
682                 fdt_strerror(ret));
683         return ret;
684     }
685 
686     ret = qemu_fdt_setprop_cell(fdt, "/rtas", "linux,rtas-entry",
687                                 rtas_addr);
688     if (ret < 0) {
689         fprintf(stderr, "Couldn't add linux,rtas-entry property: %s\n",
690                 fdt_strerror(ret));
691         return ret;
692     }
693 
694     ret = qemu_fdt_setprop_cell(fdt, "/rtas", "rtas-size",
695                                 rtas_size);
696     if (ret < 0) {
697         fprintf(stderr, "Couldn't add rtas-size property: %s\n",
698                 fdt_strerror(ret));
699         return ret;
700     }
701 
702     for (i = 0; i < RTAS_TOKEN_MAX - RTAS_TOKEN_BASE; i++) {
703         struct rtas_call *call = &rtas_table[i];
704 
705         if (!call->name) {
706             continue;
707         }
708 
709         ret = qemu_fdt_setprop_cell(fdt, "/rtas", call->name,
710                                     i + RTAS_TOKEN_BASE);
711         if (ret < 0) {
712             fprintf(stderr, "Couldn't add rtas token for %s: %s\n",
713                     call->name, fdt_strerror(ret));
714             return ret;
715         }
716 
717     }
718 
719     lrdr_capacity[0] = cpu_to_be32(((uint64_t)machine->maxram_size) >> 32);
720     lrdr_capacity[1] = cpu_to_be32(machine->maxram_size & 0xffffffff);
721     lrdr_capacity[2] = 0;
722     lrdr_capacity[3] = cpu_to_be32(SPAPR_MEMORY_BLOCK_SIZE);
723     lrdr_capacity[4] = cpu_to_be32(max_cpus/smp_threads);
724     ret = qemu_fdt_setprop(fdt, "/rtas", "ibm,lrdr-capacity", lrdr_capacity,
725                      sizeof(lrdr_capacity));
726     if (ret < 0) {
727         fprintf(stderr, "Couldn't add ibm,lrdr-capacity rtas property\n");
728         return ret;
729     }
730 
731     return 0;
732 }
733 
734 static void core_rtas_register_types(void)
735 {
736     spapr_rtas_register(RTAS_DISPLAY_CHARACTER, "display-character",
737                         rtas_display_character);
738     spapr_rtas_register(RTAS_POWER_OFF, "power-off", rtas_power_off);
739     spapr_rtas_register(RTAS_SYSTEM_REBOOT, "system-reboot",
740                         rtas_system_reboot);
741     spapr_rtas_register(RTAS_QUERY_CPU_STOPPED_STATE, "query-cpu-stopped-state",
742                         rtas_query_cpu_stopped_state);
743     spapr_rtas_register(RTAS_START_CPU, "start-cpu", rtas_start_cpu);
744     spapr_rtas_register(RTAS_STOP_SELF, "stop-self", rtas_stop_self);
745     spapr_rtas_register(RTAS_IBM_GET_SYSTEM_PARAMETER,
746                         "ibm,get-system-parameter",
747                         rtas_ibm_get_system_parameter);
748     spapr_rtas_register(RTAS_IBM_SET_SYSTEM_PARAMETER,
749                         "ibm,set-system-parameter",
750                         rtas_ibm_set_system_parameter);
751     spapr_rtas_register(RTAS_IBM_OS_TERM, "ibm,os-term",
752                         rtas_ibm_os_term);
753     spapr_rtas_register(RTAS_SET_POWER_LEVEL, "set-power-level",
754                         rtas_set_power_level);
755     spapr_rtas_register(RTAS_GET_POWER_LEVEL, "get-power-level",
756                         rtas_get_power_level);
757     spapr_rtas_register(RTAS_SET_INDICATOR, "set-indicator",
758                         rtas_set_indicator);
759     spapr_rtas_register(RTAS_GET_SENSOR_STATE, "get-sensor-state",
760                         rtas_get_sensor_state);
761     spapr_rtas_register(RTAS_IBM_CONFIGURE_CONNECTOR, "ibm,configure-connector",
762                         rtas_ibm_configure_connector);
763 }
764 
765 type_init(core_rtas_register_types)
766