1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "sysemu.h"
22#include "hw.h"
23#include "pc.h"
24#include "acpi.h"
25#include "monitor.h"
26
27struct acpi_table_header {
28 uint16_t _length;
29
30 char sig[4];
31 uint32_t length;
32 uint8_t revision;
33 uint8_t checksum;
34 char oem_id[6];
35 char oem_table_id[8];
36 uint32_t oem_revision;
37 char asl_compiler_id[4];
38 uint32_t asl_compiler_revision;
39} QEMU_PACKED;
40
41#define ACPI_TABLE_HDR_SIZE sizeof(struct acpi_table_header)
42#define ACPI_TABLE_PFX_SIZE sizeof(uint16_t)
43
44static const char dfl_hdr[ACPI_TABLE_HDR_SIZE] =
45 "\0\0"
46 "QEMU\0\0\0\0\1\0"
47 "QEMUQEQEMUQEMU\1\0\0\0"
48 "QEMU\1\0\0\0"
49 ;
50
51char *acpi_tables;
52size_t acpi_tables_len;
53
54static int acpi_checksum(const uint8_t *data, int len)
55{
56 int sum, i;
57 sum = 0;
58 for (i = 0; i < len; i++) {
59 sum += data[i];
60 }
61 return (-sum) & 0xff;
62}
63
64
65int acpi_table_add(const char *t)
66{
67 char buf[1024], *p, *f;
68 unsigned long val;
69 size_t len, start, allen;
70 bool has_header;
71 int changed;
72 int r;
73 struct acpi_table_header hdr;
74
75 r = 0;
76 r |= get_param_value(buf, sizeof(buf), "data", t) ? 1 : 0;
77 r |= get_param_value(buf, sizeof(buf), "file", t) ? 2 : 0;
78 switch (r) {
79 case 0:
80 buf[0] = '\0';
81
82 case 1:
83 has_header = false;
84 break;
85 case 2:
86 has_header = true;
87 break;
88 default:
89 fprintf(stderr, "acpitable: both data and file are specified\n");
90 return -1;
91 }
92
93 if (!acpi_tables) {
94 allen = sizeof(uint16_t);
95 acpi_tables = g_malloc0(allen);
96 } else {
97 allen = acpi_tables_len;
98 }
99
100 start = allen;
101 acpi_tables = g_realloc(acpi_tables, start + ACPI_TABLE_HDR_SIZE);
102 allen += has_header ? ACPI_TABLE_PFX_SIZE : ACPI_TABLE_HDR_SIZE;
103
104
105
106 for (f = strtok(buf, ":"); f; f = strtok(NULL, ":")) {
107 int fd = open(f, O_RDONLY);
108
109 if (fd < 0) {
110 fprintf(stderr, "can't open file %s: %s\n", f, strerror(errno));
111 return -1;
112 }
113
114 for (;;) {
115 char data[8192];
116 r = read(fd, data, sizeof(data));
117 if (r == 0) {
118 break;
119 } else if (r > 0) {
120 acpi_tables = g_realloc(acpi_tables, allen + r);
121 memcpy(acpi_tables + allen, data, r);
122 allen += r;
123 } else if (errno != EINTR) {
124 fprintf(stderr, "can't read file %s: %s\n",
125 f, strerror(errno));
126 close(fd);
127 return -1;
128 }
129 }
130
131 close(fd);
132 }
133
134
135
136 f = acpi_tables + start;
137 changed = 0;
138
139
140 memcpy(&hdr, has_header ? f : dfl_hdr, ACPI_TABLE_HDR_SIZE);
141
142
143 len = allen - start - ACPI_TABLE_PFX_SIZE;
144
145 hdr._length = cpu_to_le16(len);
146
147 if (get_param_value(buf, sizeof(buf), "sig", t)) {
148
149 strncpy(hdr.sig, buf, sizeof(hdr.sig));
150 ++changed;
151 }
152
153
154 if (has_header) {
155
156 val = le32_to_cpu(hdr.length);
157 if (val != len) {
158 fprintf(stderr,
159 "warning: acpitable has wrong length,"
160 " header says %lu, actual size %zu bytes\n",
161 val, len);
162 ++changed;
163 }
164 }
165
166 hdr.length = cpu_to_le32(len);
167
168 if (get_param_value(buf, sizeof(buf), "rev", t)) {
169 val = strtoul(buf, &p, 0);
170 if (val > 255 || *p) {
171 fprintf(stderr, "acpitable: \"rev=%s\" is invalid\n", buf);
172 return -1;
173 }
174 hdr.revision = (uint8_t)val;
175 ++changed;
176 }
177
178 if (get_param_value(buf, sizeof(buf), "oem_id", t)) {
179
180 strncpy(hdr.oem_id, buf, sizeof(hdr.oem_id));
181 ++changed;
182 }
183
184 if (get_param_value(buf, sizeof(buf), "oem_table_id", t)) {
185
186 strncpy(hdr.oem_table_id, buf, sizeof(hdr.oem_table_id));
187 ++changed;
188 }
189
190 if (get_param_value(buf, sizeof(buf), "oem_rev", t)) {
191 val = strtol(buf, &p, 0);
192 if (*p) {
193 fprintf(stderr, "acpitable: \"oem_rev=%s\" is invalid\n", buf);
194 return -1;
195 }
196 hdr.oem_revision = cpu_to_le32(val);
197 ++changed;
198 }
199
200 if (get_param_value(buf, sizeof(buf), "asl_compiler_id", t)) {
201
202 strncpy(hdr.asl_compiler_id, buf, sizeof(hdr.asl_compiler_id));
203 ++changed;
204 }
205
206 if (get_param_value(buf, sizeof(buf), "asl_compiler_rev", t)) {
207 val = strtol(buf, &p, 0);
208 if (*p) {
209 fprintf(stderr, "acpitable: \"%s=%s\" is invalid\n",
210 "asl_compiler_rev", buf);
211 return -1;
212 }
213 hdr.asl_compiler_revision = cpu_to_le32(val);
214 ++changed;
215 }
216
217 if (!has_header && !changed) {
218 fprintf(stderr, "warning: acpitable: no table headers are specified\n");
219 }
220
221
222
223
224
225 hdr.checksum = 0;
226
227
228 memcpy(f, &hdr, sizeof(hdr));
229
230 if (changed || !has_header || 1) {
231 ((struct acpi_table_header *)f)->checksum =
232 acpi_checksum((uint8_t *)f + ACPI_TABLE_PFX_SIZE, len);
233 }
234
235
236 (*(uint16_t *)acpi_tables) =
237 cpu_to_le32(le32_to_cpu(*(uint16_t *)acpi_tables) + 1);
238
239 acpi_tables_len = allen;
240 return 0;
241
242}
243
244static void acpi_notify_wakeup(Notifier *notifier, void *data)
245{
246 ACPIREGS *ar = container_of(notifier, ACPIREGS, wakeup);
247 WakeupReason *reason = data;
248
249 switch (*reason) {
250 case QEMU_WAKEUP_REASON_RTC:
251 ar->pm1.evt.sts |=
252 (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_RT_CLOCK_STATUS);
253 break;
254 case QEMU_WAKEUP_REASON_PMTIMER:
255 ar->pm1.evt.sts |=
256 (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_TIMER_STATUS);
257 break;
258 case QEMU_WAKEUP_REASON_OTHER:
259 default:
260
261
262 ar->pm1.evt.sts |=
263 (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS);
264 break;
265 }
266}
267
268
269uint16_t acpi_pm1_evt_get_sts(ACPIREGS *ar)
270{
271 int64_t d = acpi_pm_tmr_get_clock();
272 if (d >= ar->tmr.overflow_time) {
273 ar->pm1.evt.sts |= ACPI_BITMASK_TIMER_STATUS;
274 }
275 return ar->pm1.evt.sts;
276}
277
278void acpi_pm1_evt_write_sts(ACPIREGS *ar, uint16_t val)
279{
280 uint16_t pm1_sts = acpi_pm1_evt_get_sts(ar);
281 if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) {
282
283 acpi_pm_tmr_calc_overflow_time(ar);
284 }
285 ar->pm1.evt.sts &= ~val;
286}
287
288void acpi_pm1_evt_write_en(ACPIREGS *ar, uint16_t val)
289{
290 ar->pm1.evt.en = val;
291 qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC,
292 val & ACPI_BITMASK_RT_CLOCK_ENABLE);
293 qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER,
294 val & ACPI_BITMASK_TIMER_ENABLE);
295}
296
297void acpi_pm1_evt_power_down(ACPIREGS *ar)
298{
299 if (ar->pm1.evt.en & ACPI_BITMASK_POWER_BUTTON_ENABLE) {
300 ar->pm1.evt.sts |= ACPI_BITMASK_POWER_BUTTON_STATUS;
301 ar->tmr.update_sci(ar);
302 }
303}
304
305void acpi_pm1_evt_reset(ACPIREGS *ar)
306{
307 ar->pm1.evt.sts = 0;
308 ar->pm1.evt.en = 0;
309 qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 0);
310 qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 0);
311}
312
313
314void acpi_pm_tmr_update(ACPIREGS *ar, bool enable)
315{
316 int64_t expire_time;
317
318
319 if (enable) {
320 expire_time = muldiv64(ar->tmr.overflow_time, get_ticks_per_sec(),
321 PM_TIMER_FREQUENCY);
322 qemu_mod_timer(ar->tmr.timer, expire_time);
323 } else {
324 qemu_del_timer(ar->tmr.timer);
325 }
326}
327
328void acpi_pm_tmr_calc_overflow_time(ACPIREGS *ar)
329{
330 int64_t d = acpi_pm_tmr_get_clock();
331 ar->tmr.overflow_time = (d + 0x800000LL) & ~0x7fffffLL;
332}
333
334uint32_t acpi_pm_tmr_get(ACPIREGS *ar)
335{
336 uint32_t d = acpi_pm_tmr_get_clock();
337 return d & 0xffffff;
338}
339
340static void acpi_pm_tmr_timer(void *opaque)
341{
342 ACPIREGS *ar = opaque;
343 qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER);
344 ar->tmr.update_sci(ar);
345}
346
347void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci)
348{
349 ar->tmr.update_sci = update_sci;
350 ar->tmr.timer = qemu_new_timer_ns(vm_clock, acpi_pm_tmr_timer, ar);
351}
352
353void acpi_pm_tmr_reset(ACPIREGS *ar)
354{
355 ar->tmr.overflow_time = 0;
356 qemu_del_timer(ar->tmr.timer);
357}
358
359
360void acpi_pm1_cnt_init(ACPIREGS *ar)
361{
362 ar->wakeup.notify = acpi_notify_wakeup;
363 qemu_register_wakeup_notifier(&ar->wakeup);
364}
365
366void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val, char s4)
367{
368 ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE);
369
370 if (val & ACPI_BITMASK_SLEEP_ENABLE) {
371
372 uint16_t sus_typ = (val >> 10) & 7;
373 switch(sus_typ) {
374 case 0:
375 qemu_system_shutdown_request();
376 break;
377 case 1:
378 qemu_system_suspend_request();
379 break;
380 default:
381 if (sus_typ == s4) {
382 monitor_protocol_event(QEVENT_SUSPEND_DISK, NULL);
383 qemu_system_shutdown_request();
384 }
385 break;
386 }
387 }
388}
389
390void acpi_pm1_cnt_update(ACPIREGS *ar,
391 bool sci_enable, bool sci_disable)
392{
393
394 if (sci_enable) {
395 ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE;
396 } else if (sci_disable) {
397 ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE;
398 }
399}
400
401void acpi_pm1_cnt_reset(ACPIREGS *ar)
402{
403 ar->pm1.cnt.cnt = 0;
404}
405
406
407void acpi_gpe_init(ACPIREGS *ar, uint8_t len)
408{
409 ar->gpe.len = len;
410 ar->gpe.sts = g_malloc0(len / 2);
411 ar->gpe.en = g_malloc0(len / 2);
412}
413
414void acpi_gpe_blk(ACPIREGS *ar, uint32_t blk)
415{
416 ar->gpe.blk = blk;
417}
418
419void acpi_gpe_reset(ACPIREGS *ar)
420{
421 memset(ar->gpe.sts, 0, ar->gpe.len / 2);
422 memset(ar->gpe.en, 0, ar->gpe.len / 2);
423}
424
425static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr)
426{
427 uint8_t *cur = NULL;
428
429 if (addr < ar->gpe.len / 2) {
430 cur = ar->gpe.sts + addr;
431 } else if (addr < ar->gpe.len) {
432 cur = ar->gpe.en + addr - ar->gpe.len / 2;
433 } else {
434 abort();
435 }
436
437 return cur;
438}
439
440void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val)
441{
442 uint8_t *cur;
443
444 addr -= ar->gpe.blk;
445 cur = acpi_gpe_ioport_get_ptr(ar, addr);
446 if (addr < ar->gpe.len / 2) {
447
448 *cur = (*cur) & ~val;
449 } else if (addr < ar->gpe.len) {
450
451 *cur = val;
452 } else {
453 abort();
454 }
455}
456
457uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr)
458{
459 uint8_t *cur;
460 uint32_t val;
461
462 addr -= ar->gpe.blk;
463 cur = acpi_gpe_ioport_get_ptr(ar, addr);
464 val = 0;
465 if (cur != NULL) {
466 val = *cur;
467 }
468
469 return val;
470}
471