root / hw / spapr_rtas.c @ 3a9d8549
History | View | Annotate | Download (7.9 kB)
1 | 39ac8455 | David Gibson | /*
|
---|---|---|---|
2 | 39ac8455 | David Gibson | * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
|
3 | 39ac8455 | David Gibson | *
|
4 | 39ac8455 | David Gibson | * Hypercall based emulated RTAS
|
5 | 39ac8455 | David Gibson | *
|
6 | 39ac8455 | David Gibson | * Copyright (c) 2010-2011 David Gibson, IBM Corporation.
|
7 | 39ac8455 | David Gibson | *
|
8 | 39ac8455 | David Gibson | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
9 | 39ac8455 | David Gibson | * of this software and associated documentation files (the "Software"), to deal
|
10 | 39ac8455 | David Gibson | * in the Software without restriction, including without limitation the rights
|
11 | 39ac8455 | David Gibson | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
12 | 39ac8455 | David Gibson | * copies of the Software, and to permit persons to whom the Software is
|
13 | 39ac8455 | David Gibson | * furnished to do so, subject to the following conditions:
|
14 | 39ac8455 | David Gibson | *
|
15 | 39ac8455 | David Gibson | * The above copyright notice and this permission notice shall be included in
|
16 | 39ac8455 | David Gibson | * all copies or substantial portions of the Software.
|
17 | 39ac8455 | David Gibson | *
|
18 | 39ac8455 | David Gibson | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19 | 39ac8455 | David Gibson | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20 | 39ac8455 | David Gibson | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
21 | 39ac8455 | David Gibson | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22 | 39ac8455 | David Gibson | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23 | 39ac8455 | David Gibson | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
24 | 39ac8455 | David Gibson | * THE SOFTWARE.
|
25 | 39ac8455 | David Gibson | *
|
26 | 39ac8455 | David Gibson | */
|
27 | 39ac8455 | David Gibson | #include "cpu.h" |
28 | 39ac8455 | David Gibson | #include "sysemu.h" |
29 | 39ac8455 | David Gibson | #include "qemu-char.h" |
30 | 39ac8455 | David Gibson | #include "hw/qdev.h" |
31 | 39ac8455 | David Gibson | #include "device_tree.h" |
32 | 39ac8455 | David Gibson | |
33 | 39ac8455 | David Gibson | #include "hw/spapr.h" |
34 | 39ac8455 | David Gibson | #include "hw/spapr_vio.h" |
35 | 39ac8455 | David Gibson | |
36 | 39ac8455 | David Gibson | #include <libfdt.h> |
37 | 39ac8455 | David Gibson | |
38 | 39ac8455 | David Gibson | #define TOKEN_BASE 0x2000 |
39 | 39ac8455 | David Gibson | #define TOKEN_MAX 0x100 |
40 | 39ac8455 | David Gibson | |
41 | 821303f5 | David Gibson | static void rtas_display_character(sPAPREnvironment *spapr, |
42 | 821303f5 | David Gibson | uint32_t token, uint32_t nargs, |
43 | 821303f5 | David Gibson | target_ulong args, |
44 | 821303f5 | David Gibson | uint32_t nret, target_ulong rets) |
45 | 821303f5 | David Gibson | { |
46 | 821303f5 | David Gibson | uint8_t c = rtas_ld(args, 0);
|
47 | 821303f5 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, 0);
|
48 | 821303f5 | David Gibson | |
49 | 821303f5 | David Gibson | if (!sdev) {
|
50 | 821303f5 | David Gibson | rtas_st(rets, 0, -1); |
51 | 821303f5 | David Gibson | } else {
|
52 | 821303f5 | David Gibson | vty_putchars(sdev, &c, sizeof(c));
|
53 | 821303f5 | David Gibson | rtas_st(rets, 0, 0); |
54 | 821303f5 | David Gibson | } |
55 | 821303f5 | David Gibson | } |
56 | 821303f5 | David Gibson | |
57 | 821303f5 | David Gibson | static void rtas_get_time_of_day(sPAPREnvironment *spapr, |
58 | 821303f5 | David Gibson | uint32_t token, uint32_t nargs, |
59 | 821303f5 | David Gibson | target_ulong args, |
60 | 821303f5 | David Gibson | uint32_t nret, target_ulong rets) |
61 | 821303f5 | David Gibson | { |
62 | 821303f5 | David Gibson | struct tm tm;
|
63 | 821303f5 | David Gibson | |
64 | 821303f5 | David Gibson | if (nret != 8) { |
65 | 821303f5 | David Gibson | rtas_st(rets, 0, -3); |
66 | 821303f5 | David Gibson | return;
|
67 | 821303f5 | David Gibson | } |
68 | 821303f5 | David Gibson | |
69 | 821303f5 | David Gibson | qemu_get_timedate(&tm, 0);
|
70 | 821303f5 | David Gibson | |
71 | 821303f5 | David Gibson | rtas_st(rets, 0, 0); /* Success */ |
72 | 821303f5 | David Gibson | rtas_st(rets, 1, tm.tm_year + 1900); |
73 | 821303f5 | David Gibson | rtas_st(rets, 2, tm.tm_mon + 1); |
74 | 821303f5 | David Gibson | rtas_st(rets, 3, tm.tm_mday);
|
75 | 821303f5 | David Gibson | rtas_st(rets, 4, tm.tm_hour);
|
76 | 821303f5 | David Gibson | rtas_st(rets, 5, tm.tm_min);
|
77 | 821303f5 | David Gibson | rtas_st(rets, 6, tm.tm_sec);
|
78 | 821303f5 | David Gibson | rtas_st(rets, 7, 0); /* we don't do nanoseconds */ |
79 | 821303f5 | David Gibson | } |
80 | 821303f5 | David Gibson | |
81 | 821303f5 | David Gibson | static void rtas_power_off(sPAPREnvironment *spapr, |
82 | 821303f5 | David Gibson | uint32_t token, uint32_t nargs, target_ulong args, |
83 | 821303f5 | David Gibson | uint32_t nret, target_ulong rets) |
84 | 821303f5 | David Gibson | { |
85 | 821303f5 | David Gibson | if (nargs != 2 || nret != 1) { |
86 | 821303f5 | David Gibson | rtas_st(rets, 0, -3); |
87 | 821303f5 | David Gibson | return;
|
88 | 821303f5 | David Gibson | } |
89 | 821303f5 | David Gibson | qemu_system_shutdown_request(); |
90 | 821303f5 | David Gibson | rtas_st(rets, 0, 0); |
91 | 821303f5 | David Gibson | } |
92 | 821303f5 | David Gibson | |
93 | a9f8ad8f | David Gibson | static void rtas_query_cpu_stopped_state(sPAPREnvironment *spapr, |
94 | a9f8ad8f | David Gibson | uint32_t token, uint32_t nargs, |
95 | a9f8ad8f | David Gibson | target_ulong args, |
96 | a9f8ad8f | David Gibson | uint32_t nret, target_ulong rets) |
97 | a9f8ad8f | David Gibson | { |
98 | a9f8ad8f | David Gibson | target_ulong id; |
99 | a9f8ad8f | David Gibson | CPUState *env; |
100 | a9f8ad8f | David Gibson | |
101 | a9f8ad8f | David Gibson | if (nargs != 1 || nret != 2) { |
102 | a9f8ad8f | David Gibson | rtas_st(rets, 0, -3); |
103 | a9f8ad8f | David Gibson | return;
|
104 | a9f8ad8f | David Gibson | } |
105 | a9f8ad8f | David Gibson | |
106 | a9f8ad8f | David Gibson | id = rtas_ld(args, 0);
|
107 | a9f8ad8f | David Gibson | for (env = first_cpu; env; env = env->next_cpu) {
|
108 | a9f8ad8f | David Gibson | if (env->cpu_index != id) {
|
109 | a9f8ad8f | David Gibson | continue;
|
110 | a9f8ad8f | David Gibson | } |
111 | a9f8ad8f | David Gibson | |
112 | a9f8ad8f | David Gibson | if (env->halted) {
|
113 | a9f8ad8f | David Gibson | rtas_st(rets, 1, 0); |
114 | a9f8ad8f | David Gibson | } else {
|
115 | a9f8ad8f | David Gibson | rtas_st(rets, 1, 2); |
116 | a9f8ad8f | David Gibson | } |
117 | a9f8ad8f | David Gibson | |
118 | a9f8ad8f | David Gibson | rtas_st(rets, 0, 0); |
119 | a9f8ad8f | David Gibson | return;
|
120 | a9f8ad8f | David Gibson | } |
121 | a9f8ad8f | David Gibson | |
122 | a9f8ad8f | David Gibson | /* Didn't find a matching cpu */
|
123 | a9f8ad8f | David Gibson | rtas_st(rets, 0, -3); |
124 | a9f8ad8f | David Gibson | } |
125 | a9f8ad8f | David Gibson | |
126 | a9f8ad8f | David Gibson | static void rtas_start_cpu(sPAPREnvironment *spapr, |
127 | a9f8ad8f | David Gibson | uint32_t token, uint32_t nargs, |
128 | a9f8ad8f | David Gibson | target_ulong args, |
129 | a9f8ad8f | David Gibson | uint32_t nret, target_ulong rets) |
130 | a9f8ad8f | David Gibson | { |
131 | a9f8ad8f | David Gibson | target_ulong id, start, r3; |
132 | a9f8ad8f | David Gibson | CPUState *env; |
133 | a9f8ad8f | David Gibson | |
134 | a9f8ad8f | David Gibson | if (nargs != 3 || nret != 1) { |
135 | a9f8ad8f | David Gibson | rtas_st(rets, 0, -3); |
136 | a9f8ad8f | David Gibson | return;
|
137 | a9f8ad8f | David Gibson | } |
138 | a9f8ad8f | David Gibson | |
139 | a9f8ad8f | David Gibson | id = rtas_ld(args, 0);
|
140 | a9f8ad8f | David Gibson | start = rtas_ld(args, 1);
|
141 | a9f8ad8f | David Gibson | r3 = rtas_ld(args, 2);
|
142 | a9f8ad8f | David Gibson | |
143 | a9f8ad8f | David Gibson | for (env = first_cpu; env; env = env->next_cpu) {
|
144 | a9f8ad8f | David Gibson | if (env->cpu_index != id) {
|
145 | a9f8ad8f | David Gibson | continue;
|
146 | a9f8ad8f | David Gibson | } |
147 | a9f8ad8f | David Gibson | |
148 | a9f8ad8f | David Gibson | if (!env->halted) {
|
149 | a9f8ad8f | David Gibson | rtas_st(rets, 0, -1); |
150 | a9f8ad8f | David Gibson | return;
|
151 | a9f8ad8f | David Gibson | } |
152 | a9f8ad8f | David Gibson | |
153 | a9f8ad8f | David Gibson | env->msr = (1ULL << MSR_SF) | (1ULL << MSR_ME); |
154 | a9f8ad8f | David Gibson | env->nip = start; |
155 | a9f8ad8f | David Gibson | env->gpr[3] = r3;
|
156 | a9f8ad8f | David Gibson | env->halted = 0;
|
157 | a9f8ad8f | David Gibson | |
158 | a9f8ad8f | David Gibson | qemu_cpu_kick(env); |
159 | a9f8ad8f | David Gibson | |
160 | a9f8ad8f | David Gibson | rtas_st(rets, 0, 0); |
161 | a9f8ad8f | David Gibson | return;
|
162 | a9f8ad8f | David Gibson | } |
163 | a9f8ad8f | David Gibson | |
164 | a9f8ad8f | David Gibson | /* Didn't find a matching cpu */
|
165 | a9f8ad8f | David Gibson | rtas_st(rets, 0, -3); |
166 | a9f8ad8f | David Gibson | } |
167 | a9f8ad8f | David Gibson | |
168 | 39ac8455 | David Gibson | static struct rtas_call { |
169 | 39ac8455 | David Gibson | const char *name; |
170 | 39ac8455 | David Gibson | spapr_rtas_fn fn; |
171 | 39ac8455 | David Gibson | } rtas_table[TOKEN_MAX]; |
172 | 39ac8455 | David Gibson | |
173 | 39ac8455 | David Gibson | struct rtas_call *rtas_next = rtas_table;
|
174 | 39ac8455 | David Gibson | |
175 | 39ac8455 | David Gibson | target_ulong spapr_rtas_call(sPAPREnvironment *spapr, |
176 | 39ac8455 | David Gibson | uint32_t token, uint32_t nargs, target_ulong args, |
177 | 39ac8455 | David Gibson | uint32_t nret, target_ulong rets) |
178 | 39ac8455 | David Gibson | { |
179 | 39ac8455 | David Gibson | if ((token >= TOKEN_BASE)
|
180 | 39ac8455 | David Gibson | && ((token - TOKEN_BASE) < TOKEN_MAX)) { |
181 | 39ac8455 | David Gibson | struct rtas_call *call = rtas_table + (token - TOKEN_BASE);
|
182 | 39ac8455 | David Gibson | |
183 | 39ac8455 | David Gibson | if (call->fn) {
|
184 | 39ac8455 | David Gibson | call->fn(spapr, token, nargs, args, nret, rets); |
185 | 39ac8455 | David Gibson | return H_SUCCESS;
|
186 | 39ac8455 | David Gibson | } |
187 | 39ac8455 | David Gibson | } |
188 | 39ac8455 | David Gibson | |
189 | 821303f5 | David Gibson | /* HACK: Some Linux early debug code uses RTAS display-character,
|
190 | 821303f5 | David Gibson | * but assumes the token value is 0xa (which it is on some real
|
191 | 821303f5 | David Gibson | * machines) without looking it up in the device tree. This
|
192 | 821303f5 | David Gibson | * special case makes this work */
|
193 | 821303f5 | David Gibson | if (token == 0xa) { |
194 | 821303f5 | David Gibson | rtas_display_character(spapr, 0xa, nargs, args, nret, rets);
|
195 | 821303f5 | David Gibson | return H_SUCCESS;
|
196 | 821303f5 | David Gibson | } |
197 | 821303f5 | David Gibson | |
198 | 39ac8455 | David Gibson | hcall_dprintf("Unknown RTAS token 0x%x\n", token);
|
199 | 39ac8455 | David Gibson | rtas_st(rets, 0, -3); |
200 | 39ac8455 | David Gibson | return H_PARAMETER;
|
201 | 39ac8455 | David Gibson | } |
202 | 39ac8455 | David Gibson | |
203 | 39ac8455 | David Gibson | void spapr_rtas_register(const char *name, spapr_rtas_fn fn) |
204 | 39ac8455 | David Gibson | { |
205 | 39ac8455 | David Gibson | assert(rtas_next < (rtas_table + TOKEN_MAX)); |
206 | 39ac8455 | David Gibson | |
207 | 39ac8455 | David Gibson | rtas_next->name = name; |
208 | 39ac8455 | David Gibson | rtas_next->fn = fn; |
209 | 39ac8455 | David Gibson | |
210 | 39ac8455 | David Gibson | rtas_next++; |
211 | 39ac8455 | David Gibson | } |
212 | 39ac8455 | David Gibson | |
213 | 39ac8455 | David Gibson | int spapr_rtas_device_tree_setup(void *fdt, target_phys_addr_t rtas_addr, |
214 | 39ac8455 | David Gibson | target_phys_addr_t rtas_size) |
215 | 39ac8455 | David Gibson | { |
216 | 39ac8455 | David Gibson | int ret;
|
217 | 39ac8455 | David Gibson | int i;
|
218 | 39ac8455 | David Gibson | |
219 | 39ac8455 | David Gibson | ret = fdt_add_mem_rsv(fdt, rtas_addr, rtas_size); |
220 | 39ac8455 | David Gibson | if (ret < 0) { |
221 | 39ac8455 | David Gibson | fprintf(stderr, "Couldn't add RTAS reserve entry: %s\n",
|
222 | 39ac8455 | David Gibson | fdt_strerror(ret)); |
223 | 39ac8455 | David Gibson | return ret;
|
224 | 39ac8455 | David Gibson | } |
225 | 39ac8455 | David Gibson | |
226 | 39ac8455 | David Gibson | ret = qemu_devtree_setprop_cell(fdt, "/rtas", "linux,rtas-base", |
227 | 39ac8455 | David Gibson | rtas_addr); |
228 | 39ac8455 | David Gibson | if (ret < 0) { |
229 | 39ac8455 | David Gibson | fprintf(stderr, "Couldn't add linux,rtas-base property: %s\n",
|
230 | 39ac8455 | David Gibson | fdt_strerror(ret)); |
231 | 39ac8455 | David Gibson | return ret;
|
232 | 39ac8455 | David Gibson | } |
233 | 39ac8455 | David Gibson | |
234 | 39ac8455 | David Gibson | ret = qemu_devtree_setprop_cell(fdt, "/rtas", "linux,rtas-entry", |
235 | 39ac8455 | David Gibson | rtas_addr); |
236 | 39ac8455 | David Gibson | if (ret < 0) { |
237 | 39ac8455 | David Gibson | fprintf(stderr, "Couldn't add linux,rtas-entry property: %s\n",
|
238 | 39ac8455 | David Gibson | fdt_strerror(ret)); |
239 | 39ac8455 | David Gibson | return ret;
|
240 | 39ac8455 | David Gibson | } |
241 | 39ac8455 | David Gibson | |
242 | 39ac8455 | David Gibson | ret = qemu_devtree_setprop_cell(fdt, "/rtas", "rtas-size", |
243 | 39ac8455 | David Gibson | rtas_size); |
244 | 39ac8455 | David Gibson | if (ret < 0) { |
245 | 39ac8455 | David Gibson | fprintf(stderr, "Couldn't add rtas-size property: %s\n",
|
246 | 39ac8455 | David Gibson | fdt_strerror(ret)); |
247 | 39ac8455 | David Gibson | return ret;
|
248 | 39ac8455 | David Gibson | } |
249 | 39ac8455 | David Gibson | |
250 | 39ac8455 | David Gibson | for (i = 0; i < TOKEN_MAX; i++) { |
251 | 39ac8455 | David Gibson | struct rtas_call *call = &rtas_table[i];
|
252 | 39ac8455 | David Gibson | |
253 | 39ac8455 | David Gibson | if (!call->fn) {
|
254 | 39ac8455 | David Gibson | continue;
|
255 | 39ac8455 | David Gibson | } |
256 | 39ac8455 | David Gibson | |
257 | 39ac8455 | David Gibson | ret = qemu_devtree_setprop_cell(fdt, "/rtas", call->name,
|
258 | 39ac8455 | David Gibson | i + TOKEN_BASE); |
259 | 39ac8455 | David Gibson | if (ret < 0) { |
260 | 39ac8455 | David Gibson | fprintf(stderr, "Couldn't add rtas token for %s: %s\n",
|
261 | 39ac8455 | David Gibson | call->name, fdt_strerror(ret)); |
262 | 39ac8455 | David Gibson | return ret;
|
263 | 39ac8455 | David Gibson | } |
264 | 39ac8455 | David Gibson | |
265 | 39ac8455 | David Gibson | } |
266 | 39ac8455 | David Gibson | return 0; |
267 | 39ac8455 | David Gibson | } |
268 | 821303f5 | David Gibson | |
269 | 821303f5 | David Gibson | static void register_core_rtas(void) |
270 | 821303f5 | David Gibson | { |
271 | 821303f5 | David Gibson | spapr_rtas_register("display-character", rtas_display_character);
|
272 | 821303f5 | David Gibson | spapr_rtas_register("get-time-of-day", rtas_get_time_of_day);
|
273 | 821303f5 | David Gibson | spapr_rtas_register("power-off", rtas_power_off);
|
274 | a9f8ad8f | David Gibson | spapr_rtas_register("query-cpu-stopped-state",
|
275 | a9f8ad8f | David Gibson | rtas_query_cpu_stopped_state); |
276 | a9f8ad8f | David Gibson | spapr_rtas_register("start-cpu", rtas_start_cpu);
|
277 | 821303f5 | David Gibson | } |
278 | 821303f5 | David Gibson | device_init(register_core_rtas); |