xref: /openbmc/qemu/hw/acpi/core.c (revision 6a0acfff)
1 /*
2  * ACPI implementation
3  *
4  * Copyright (c) 2006 Fabrice Bellard
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License version 2 as published by the Free Software Foundation.
9  *
10  * This library is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13  * Lesser General Public License for more details.
14  *
15  * You should have received a copy of the GNU Lesser General Public
16  * License along with this library; if not, see <http://www.gnu.org/licenses/>
17  *
18  * Contributions after 2012-01-13 are licensed under the terms of the
19  * GNU GPL, version 2 or (at your option) any later version.
20  */
21 
22 #include "qemu/osdep.h"
23 #include "sysemu/sysemu.h"
24 #include "hw/hw.h"
25 #include "hw/irq.h"
26 #include "hw/acpi/acpi.h"
27 #include "hw/nvram/fw_cfg.h"
28 #include "qemu/config-file.h"
29 #include "qapi/error.h"
30 #include "qapi/opts-visitor.h"
31 #include "qapi/qapi-events-run-state.h"
32 #include "qapi/qapi-visit-misc.h"
33 #include "qemu/error-report.h"
34 #include "qemu/module.h"
35 #include "qemu/option.h"
36 
37 struct acpi_table_header {
38     uint16_t _length;         /* our length, not actual part of the hdr */
39                               /* allows easier parsing for fw_cfg clients */
40     char sig[4]
41              QEMU_NONSTRING;  /* ACPI signature (4 ASCII characters) */
42     uint32_t length;          /* Length of table, in bytes, including header */
43     uint8_t revision;         /* ACPI Specification minor version # */
44     uint8_t checksum;         /* To make sum of entire table == 0 */
45     char oem_id[6]
46              QEMU_NONSTRING;  /* OEM identification */
47     char oem_table_id[8]
48              QEMU_NONSTRING;  /* OEM table identification */
49     uint32_t oem_revision;    /* OEM revision number */
50     char asl_compiler_id[4]
51              QEMU_NONSTRING;  /* ASL compiler vendor ID */
52     uint32_t asl_compiler_revision; /* ASL compiler revision number */
53 } QEMU_PACKED;
54 
55 #define ACPI_TABLE_HDR_SIZE sizeof(struct acpi_table_header)
56 #define ACPI_TABLE_PFX_SIZE sizeof(uint16_t)  /* size of the extra prefix */
57 
58 static const char unsigned dfl_hdr[ACPI_TABLE_HDR_SIZE - ACPI_TABLE_PFX_SIZE] =
59     "QEMU\0\0\0\0\1\0"       /* sig (4), len(4), revno (1), csum (1) */
60     "QEMUQEQEMUQEMU\1\0\0\0" /* OEM id (6), table (8), revno (4) */
61     "QEMU\1\0\0\0"           /* ASL compiler ID (4), version (4) */
62     ;
63 
64 char unsigned *acpi_tables;
65 size_t acpi_tables_len;
66 
67 static QemuOptsList qemu_acpi_opts = {
68     .name = "acpi",
69     .implied_opt_name = "data",
70     .head = QTAILQ_HEAD_INITIALIZER(qemu_acpi_opts.head),
71     .desc = { { 0 } } /* validated with OptsVisitor */
72 };
73 
74 static void acpi_register_config(void)
75 {
76     qemu_add_opts(&qemu_acpi_opts);
77 }
78 
79 opts_init(acpi_register_config);
80 
81 static int acpi_checksum(const uint8_t *data, int len)
82 {
83     int sum, i;
84     sum = 0;
85     for (i = 0; i < len; i++) {
86         sum += data[i];
87     }
88     return (-sum) & 0xff;
89 }
90 
91 
92 /* Install a copy of the ACPI table specified in @blob.
93  *
94  * If @has_header is set, @blob starts with the System Description Table Header
95  * structure. Otherwise, "dfl_hdr" is prepended. In any case, each header field
96  * is optionally overwritten from @hdrs.
97  *
98  * It is valid to call this function with
99  * (@blob == NULL && bloblen == 0 && !has_header).
100  *
101  * @hdrs->file and @hdrs->data are ignored.
102  *
103  * SIZE_MAX is considered "infinity" in this function.
104  *
105  * The number of tables that can be installed is not limited, but the 16-bit
106  * counter at the beginning of "acpi_tables" wraps around after UINT16_MAX.
107  */
108 static void acpi_table_install(const char unsigned *blob, size_t bloblen,
109                                bool has_header,
110                                const struct AcpiTableOptions *hdrs,
111                                Error **errp)
112 {
113     size_t body_start;
114     const char unsigned *hdr_src;
115     size_t body_size, acpi_payload_size;
116     struct acpi_table_header *ext_hdr;
117     unsigned changed_fields;
118 
119     /* Calculate where the ACPI table body starts within the blob, plus where
120      * to copy the ACPI table header from.
121      */
122     if (has_header) {
123         /*   _length             | ACPI header in blob | blob body
124          *   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^
125          *   ACPI_TABLE_PFX_SIZE     sizeof dfl_hdr      body_size
126          *                           == body_start
127          *
128          *                         ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
129          *                           acpi_payload_size == bloblen
130          */
131         body_start = sizeof dfl_hdr;
132 
133         if (bloblen < body_start) {
134             error_setg(errp, "ACPI table claiming to have header is too "
135                        "short, available: %zu, expected: %zu", bloblen,
136                        body_start);
137             return;
138         }
139         hdr_src = blob;
140     } else {
141         /*   _length             | ACPI header in template | blob body
142          *   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^
143          *   ACPI_TABLE_PFX_SIZE       sizeof dfl_hdr        body_size
144          *                                                   == bloblen
145          *
146          *                         ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
147          *                                  acpi_payload_size
148          */
149         body_start = 0;
150         hdr_src = dfl_hdr;
151     }
152     body_size = bloblen - body_start;
153     acpi_payload_size = sizeof dfl_hdr + body_size;
154 
155     if (acpi_payload_size > UINT16_MAX) {
156         error_setg(errp, "ACPI table too big, requested: %zu, max: %u",
157                    acpi_payload_size, (unsigned)UINT16_MAX);
158         return;
159     }
160 
161     /* We won't fail from here on. Initialize / extend the globals. */
162     if (acpi_tables == NULL) {
163         acpi_tables_len = sizeof(uint16_t);
164         acpi_tables = g_malloc0(acpi_tables_len);
165     }
166 
167     acpi_tables = g_realloc(acpi_tables, acpi_tables_len +
168                                          ACPI_TABLE_PFX_SIZE +
169                                          sizeof dfl_hdr + body_size);
170 
171     ext_hdr = (struct acpi_table_header *)(acpi_tables + acpi_tables_len);
172     acpi_tables_len += ACPI_TABLE_PFX_SIZE;
173 
174     memcpy(acpi_tables + acpi_tables_len, hdr_src, sizeof dfl_hdr);
175     acpi_tables_len += sizeof dfl_hdr;
176 
177     if (blob != NULL) {
178         memcpy(acpi_tables + acpi_tables_len, blob + body_start, body_size);
179         acpi_tables_len += body_size;
180     }
181 
182     /* increase number of tables */
183     stw_le_p(acpi_tables, lduw_le_p(acpi_tables) + 1u);
184 
185     /* Update the header fields. The strings need not be NUL-terminated. */
186     changed_fields = 0;
187     ext_hdr->_length = cpu_to_le16(acpi_payload_size);
188 
189     if (hdrs->has_sig) {
190         strncpy(ext_hdr->sig, hdrs->sig, sizeof ext_hdr->sig);
191         ++changed_fields;
192     }
193 
194     if (has_header && le32_to_cpu(ext_hdr->length) != acpi_payload_size) {
195         warn_report("ACPI table has wrong length, header says "
196                     "%" PRIu32 ", actual size %zu bytes",
197                     le32_to_cpu(ext_hdr->length), acpi_payload_size);
198     }
199     ext_hdr->length = cpu_to_le32(acpi_payload_size);
200 
201     if (hdrs->has_rev) {
202         ext_hdr->revision = hdrs->rev;
203         ++changed_fields;
204     }
205 
206     ext_hdr->checksum = 0;
207 
208     if (hdrs->has_oem_id) {
209         strncpy(ext_hdr->oem_id, hdrs->oem_id, sizeof ext_hdr->oem_id);
210         ++changed_fields;
211     }
212     if (hdrs->has_oem_table_id) {
213         strncpy(ext_hdr->oem_table_id, hdrs->oem_table_id,
214                 sizeof ext_hdr->oem_table_id);
215         ++changed_fields;
216     }
217     if (hdrs->has_oem_rev) {
218         ext_hdr->oem_revision = cpu_to_le32(hdrs->oem_rev);
219         ++changed_fields;
220     }
221     if (hdrs->has_asl_compiler_id) {
222         strncpy(ext_hdr->asl_compiler_id, hdrs->asl_compiler_id,
223                 sizeof ext_hdr->asl_compiler_id);
224         ++changed_fields;
225     }
226     if (hdrs->has_asl_compiler_rev) {
227         ext_hdr->asl_compiler_revision = cpu_to_le32(hdrs->asl_compiler_rev);
228         ++changed_fields;
229     }
230 
231     if (!has_header && changed_fields == 0) {
232         warn_report("ACPI table: no headers are specified");
233     }
234 
235     /* recalculate checksum */
236     ext_hdr->checksum = acpi_checksum((const char unsigned *)ext_hdr +
237                                       ACPI_TABLE_PFX_SIZE, acpi_payload_size);
238 }
239 
240 void acpi_table_add(const QemuOpts *opts, Error **errp)
241 {
242     AcpiTableOptions *hdrs = NULL;
243     Error *err = NULL;
244     char **pathnames = NULL;
245     char **cur;
246     size_t bloblen = 0;
247     char unsigned *blob = NULL;
248 
249     {
250         Visitor *v;
251 
252         v = opts_visitor_new(opts);
253         visit_type_AcpiTableOptions(v, NULL, &hdrs, &err);
254         visit_free(v);
255     }
256 
257     if (err) {
258         goto out;
259     }
260     if (hdrs->has_file == hdrs->has_data) {
261         error_setg(&err, "'-acpitable' requires one of 'data' or 'file'");
262         goto out;
263     }
264 
265     pathnames = g_strsplit(hdrs->has_file ? hdrs->file : hdrs->data, ":", 0);
266     if (pathnames == NULL || pathnames[0] == NULL) {
267         error_setg(&err, "'-acpitable' requires at least one pathname");
268         goto out;
269     }
270 
271     /* now read in the data files, reallocating buffer as needed */
272     for (cur = pathnames; *cur; ++cur) {
273         int fd = open(*cur, O_RDONLY | O_BINARY);
274 
275         if (fd < 0) {
276             error_setg(&err, "can't open file %s: %s", *cur, strerror(errno));
277             goto out;
278         }
279 
280         for (;;) {
281             char unsigned data[8192];
282             ssize_t r;
283 
284             r = read(fd, data, sizeof data);
285             if (r == 0) {
286                 break;
287             } else if (r > 0) {
288                 blob = g_realloc(blob, bloblen + r);
289                 memcpy(blob + bloblen, data, r);
290                 bloblen += r;
291             } else if (errno != EINTR) {
292                 error_setg(&err, "can't read file %s: %s",
293                            *cur, strerror(errno));
294                 close(fd);
295                 goto out;
296             }
297         }
298 
299         close(fd);
300     }
301 
302     acpi_table_install(blob, bloblen, hdrs->has_file, hdrs, &err);
303 
304 out:
305     g_free(blob);
306     g_strfreev(pathnames);
307     qapi_free_AcpiTableOptions(hdrs);
308 
309     error_propagate(errp, err);
310 }
311 
312 unsigned acpi_table_len(void *current)
313 {
314     struct acpi_table_header *hdr = current - sizeof(hdr->_length);
315     return hdr->_length;
316 }
317 
318 static
319 void *acpi_table_hdr(void *h)
320 {
321     struct acpi_table_header *hdr = h;
322     return &hdr->sig;
323 }
324 
325 uint8_t *acpi_table_first(void)
326 {
327     if (!acpi_tables) {
328         return NULL;
329     }
330     return acpi_table_hdr(acpi_tables + ACPI_TABLE_PFX_SIZE);
331 }
332 
333 uint8_t *acpi_table_next(uint8_t *current)
334 {
335     uint8_t *next = current + acpi_table_len(current);
336 
337     if (next - acpi_tables >= acpi_tables_len) {
338         return NULL;
339     } else {
340         return acpi_table_hdr(next);
341     }
342 }
343 
344 int acpi_get_slic_oem(AcpiSlicOem *oem)
345 {
346     uint8_t *u;
347 
348     for (u = acpi_table_first(); u; u = acpi_table_next(u)) {
349         struct acpi_table_header *hdr = (void *)(u - sizeof(hdr->_length));
350 
351         if (memcmp(hdr->sig, "SLIC", 4) == 0) {
352             oem->id = hdr->oem_id;
353             oem->table_id = hdr->oem_table_id;
354             return 0;
355         }
356     }
357     return -1;
358 }
359 
360 static void acpi_notify_wakeup(Notifier *notifier, void *data)
361 {
362     ACPIREGS *ar = container_of(notifier, ACPIREGS, wakeup);
363     WakeupReason *reason = data;
364 
365     switch (*reason) {
366     case QEMU_WAKEUP_REASON_RTC:
367         ar->pm1.evt.sts |=
368             (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_RT_CLOCK_STATUS);
369         break;
370     case QEMU_WAKEUP_REASON_PMTIMER:
371         ar->pm1.evt.sts |=
372             (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_TIMER_STATUS);
373         break;
374     case QEMU_WAKEUP_REASON_OTHER:
375         /* ACPI_BITMASK_WAKE_STATUS should be set on resume.
376            Pretend that resume was caused by power button */
377         ar->pm1.evt.sts |=
378             (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS);
379         break;
380     default:
381         break;
382     }
383 }
384 
385 /* ACPI PM1a EVT */
386 uint16_t acpi_pm1_evt_get_sts(ACPIREGS *ar)
387 {
388     /* Compare ns-clock, not PM timer ticks, because
389        acpi_pm_tmr_update function uses ns for setting the timer. */
390     int64_t d = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
391     if (d >= muldiv64(ar->tmr.overflow_time,
392                       NANOSECONDS_PER_SECOND, PM_TIMER_FREQUENCY)) {
393         ar->pm1.evt.sts |= ACPI_BITMASK_TIMER_STATUS;
394     }
395     return ar->pm1.evt.sts;
396 }
397 
398 static void acpi_pm1_evt_write_sts(ACPIREGS *ar, uint16_t val)
399 {
400     uint16_t pm1_sts = acpi_pm1_evt_get_sts(ar);
401     if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) {
402         /* if TMRSTS is reset, then compute the new overflow time */
403         acpi_pm_tmr_calc_overflow_time(ar);
404     }
405     ar->pm1.evt.sts &= ~val;
406 }
407 
408 static void acpi_pm1_evt_write_en(ACPIREGS *ar, uint16_t val)
409 {
410     ar->pm1.evt.en = val;
411     qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC,
412                               val & ACPI_BITMASK_RT_CLOCK_ENABLE);
413     qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER,
414                               val & ACPI_BITMASK_TIMER_ENABLE);
415 }
416 
417 void acpi_pm1_evt_power_down(ACPIREGS *ar)
418 {
419     if (ar->pm1.evt.en & ACPI_BITMASK_POWER_BUTTON_ENABLE) {
420         ar->pm1.evt.sts |= ACPI_BITMASK_POWER_BUTTON_STATUS;
421         ar->tmr.update_sci(ar);
422     }
423 }
424 
425 void acpi_pm1_evt_reset(ACPIREGS *ar)
426 {
427     ar->pm1.evt.sts = 0;
428     ar->pm1.evt.en = 0;
429     qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 0);
430     qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 0);
431 }
432 
433 static uint64_t acpi_pm_evt_read(void *opaque, hwaddr addr, unsigned width)
434 {
435     ACPIREGS *ar = opaque;
436     switch (addr) {
437     case 0:
438         return acpi_pm1_evt_get_sts(ar);
439     case 2:
440         return ar->pm1.evt.en;
441     default:
442         return 0;
443     }
444 }
445 
446 static void acpi_pm_evt_write(void *opaque, hwaddr addr, uint64_t val,
447                               unsigned width)
448 {
449     ACPIREGS *ar = opaque;
450     switch (addr) {
451     case 0:
452         acpi_pm1_evt_write_sts(ar, val);
453         ar->pm1.evt.update_sci(ar);
454         break;
455     case 2:
456         acpi_pm1_evt_write_en(ar, val);
457         ar->pm1.evt.update_sci(ar);
458         break;
459     }
460 }
461 
462 static const MemoryRegionOps acpi_pm_evt_ops = {
463     .read = acpi_pm_evt_read,
464     .write = acpi_pm_evt_write,
465     .valid.min_access_size = 2,
466     .valid.max_access_size = 2,
467     .endianness = DEVICE_LITTLE_ENDIAN,
468 };
469 
470 void acpi_pm1_evt_init(ACPIREGS *ar, acpi_update_sci_fn update_sci,
471                        MemoryRegion *parent)
472 {
473     ar->pm1.evt.update_sci = update_sci;
474     memory_region_init_io(&ar->pm1.evt.io, memory_region_owner(parent),
475                           &acpi_pm_evt_ops, ar, "acpi-evt", 4);
476     memory_region_add_subregion(parent, 0, &ar->pm1.evt.io);
477 }
478 
479 /* ACPI PM_TMR */
480 void acpi_pm_tmr_update(ACPIREGS *ar, bool enable)
481 {
482     int64_t expire_time;
483 
484     /* schedule a timer interruption if needed */
485     if (enable) {
486         expire_time = muldiv64(ar->tmr.overflow_time, NANOSECONDS_PER_SECOND,
487                                PM_TIMER_FREQUENCY);
488         timer_mod(ar->tmr.timer, expire_time);
489     } else {
490         timer_del(ar->tmr.timer);
491     }
492 }
493 
494 static inline int64_t acpi_pm_tmr_get_clock(void)
495 {
496     return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), PM_TIMER_FREQUENCY,
497                     NANOSECONDS_PER_SECOND);
498 }
499 
500 void acpi_pm_tmr_calc_overflow_time(ACPIREGS *ar)
501 {
502     int64_t d = acpi_pm_tmr_get_clock();
503     ar->tmr.overflow_time = (d + 0x800000LL) & ~0x7fffffLL;
504 }
505 
506 static uint32_t acpi_pm_tmr_get(ACPIREGS *ar)
507 {
508     uint32_t d = acpi_pm_tmr_get_clock();
509     return d & 0xffffff;
510 }
511 
512 static void acpi_pm_tmr_timer(void *opaque)
513 {
514     ACPIREGS *ar = opaque;
515 
516     qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER, NULL);
517     ar->tmr.update_sci(ar);
518 }
519 
520 static uint64_t acpi_pm_tmr_read(void *opaque, hwaddr addr, unsigned width)
521 {
522     return acpi_pm_tmr_get(opaque);
523 }
524 
525 static void acpi_pm_tmr_write(void *opaque, hwaddr addr, uint64_t val,
526                               unsigned width)
527 {
528     /* nothing */
529 }
530 
531 static const MemoryRegionOps acpi_pm_tmr_ops = {
532     .read = acpi_pm_tmr_read,
533     .write = acpi_pm_tmr_write,
534     .valid.min_access_size = 4,
535     .valid.max_access_size = 4,
536     .endianness = DEVICE_LITTLE_ENDIAN,
537 };
538 
539 void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci,
540                       MemoryRegion *parent)
541 {
542     ar->tmr.update_sci = update_sci;
543     ar->tmr.timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, acpi_pm_tmr_timer, ar);
544     memory_region_init_io(&ar->tmr.io, memory_region_owner(parent),
545                           &acpi_pm_tmr_ops, ar, "acpi-tmr", 4);
546     memory_region_add_subregion(parent, 8, &ar->tmr.io);
547 }
548 
549 void acpi_pm_tmr_reset(ACPIREGS *ar)
550 {
551     ar->tmr.overflow_time = 0;
552     timer_del(ar->tmr.timer);
553 }
554 
555 /* ACPI PM1aCNT */
556 static void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val)
557 {
558     ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE);
559 
560     if (val & ACPI_BITMASK_SLEEP_ENABLE) {
561         /* change suspend type */
562         uint16_t sus_typ = (val >> 10) & 7;
563         switch(sus_typ) {
564         case 0: /* soft power off */
565             qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
566             break;
567         case 1:
568             qemu_system_suspend_request();
569             break;
570         default:
571             if (sus_typ == ar->pm1.cnt.s4_val) { /* S4 request */
572                 qapi_event_send_suspend_disk();
573                 qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
574             }
575             break;
576         }
577     }
578 }
579 
580 void acpi_pm1_cnt_update(ACPIREGS *ar,
581                          bool sci_enable, bool sci_disable)
582 {
583     /* ACPI specs 3.0, 4.7.2.5 */
584     if (sci_enable) {
585         ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE;
586     } else if (sci_disable) {
587         ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE;
588     }
589 }
590 
591 static uint64_t acpi_pm_cnt_read(void *opaque, hwaddr addr, unsigned width)
592 {
593     ACPIREGS *ar = opaque;
594     return ar->pm1.cnt.cnt;
595 }
596 
597 static void acpi_pm_cnt_write(void *opaque, hwaddr addr, uint64_t val,
598                               unsigned width)
599 {
600     acpi_pm1_cnt_write(opaque, val);
601 }
602 
603 static const MemoryRegionOps acpi_pm_cnt_ops = {
604     .read = acpi_pm_cnt_read,
605     .write = acpi_pm_cnt_write,
606     .valid.min_access_size = 2,
607     .valid.max_access_size = 2,
608     .endianness = DEVICE_LITTLE_ENDIAN,
609 };
610 
611 void acpi_pm1_cnt_init(ACPIREGS *ar, MemoryRegion *parent,
612                        bool disable_s3, bool disable_s4, uint8_t s4_val)
613 {
614     FWCfgState *fw_cfg;
615 
616     ar->pm1.cnt.s4_val = s4_val;
617     ar->wakeup.notify = acpi_notify_wakeup;
618     qemu_register_wakeup_notifier(&ar->wakeup);
619 
620     /*
621      * Register wake-up support in QMP query-current-machine API
622      */
623     qemu_register_wakeup_support();
624 
625     memory_region_init_io(&ar->pm1.cnt.io, memory_region_owner(parent),
626                           &acpi_pm_cnt_ops, ar, "acpi-cnt", 2);
627     memory_region_add_subregion(parent, 4, &ar->pm1.cnt.io);
628 
629     fw_cfg = fw_cfg_find();
630     if (fw_cfg) {
631         uint8_t suspend[6] = {128, 0, 0, 129, 128, 128};
632         suspend[3] = 1 | ((!disable_s3) << 7);
633         suspend[4] = s4_val | ((!disable_s4) << 7);
634 
635         fw_cfg_add_file(fw_cfg, "etc/system-states", g_memdup(suspend, 6), 6);
636     }
637 }
638 
639 void acpi_pm1_cnt_reset(ACPIREGS *ar)
640 {
641     ar->pm1.cnt.cnt = 0;
642 }
643 
644 /* ACPI GPE */
645 void acpi_gpe_init(ACPIREGS *ar, uint8_t len)
646 {
647     ar->gpe.len = len;
648     /* Only first len / 2 bytes are ever used,
649      * but the caller in ich9.c migrates full len bytes.
650      * TODO: fix ich9.c and drop the extra allocation.
651      */
652     ar->gpe.sts = g_malloc0(len);
653     ar->gpe.en = g_malloc0(len);
654 }
655 
656 void acpi_gpe_reset(ACPIREGS *ar)
657 {
658     memset(ar->gpe.sts, 0, ar->gpe.len / 2);
659     memset(ar->gpe.en, 0, ar->gpe.len / 2);
660 }
661 
662 static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr)
663 {
664     uint8_t *cur = NULL;
665 
666     if (addr < ar->gpe.len / 2) {
667         cur = ar->gpe.sts + addr;
668     } else if (addr < ar->gpe.len) {
669         cur = ar->gpe.en + addr - ar->gpe.len / 2;
670     } else {
671         abort();
672     }
673 
674     return cur;
675 }
676 
677 void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val)
678 {
679     uint8_t *cur;
680 
681     cur = acpi_gpe_ioport_get_ptr(ar, addr);
682     if (addr < ar->gpe.len / 2) {
683         /* GPE_STS */
684         *cur = (*cur) & ~val;
685     } else if (addr < ar->gpe.len) {
686         /* GPE_EN */
687         *cur = val;
688     } else {
689         abort();
690     }
691 }
692 
693 uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr)
694 {
695     uint8_t *cur;
696     uint32_t val;
697 
698     cur = acpi_gpe_ioport_get_ptr(ar, addr);
699     val = 0;
700     if (cur != NULL) {
701         val = *cur;
702     }
703 
704     return val;
705 }
706 
707 void acpi_send_gpe_event(ACPIREGS *ar, qemu_irq irq,
708                          AcpiEventStatusBits status)
709 {
710     ar->gpe.sts[0] |= status;
711     acpi_update_sci(ar, irq);
712 }
713 
714 void acpi_update_sci(ACPIREGS *regs, qemu_irq irq)
715 {
716     int sci_level, pm1a_sts;
717 
718     pm1a_sts = acpi_pm1_evt_get_sts(regs);
719 
720     sci_level = ((pm1a_sts &
721                   regs->pm1.evt.en & ACPI_BITMASK_PM1_COMMON_ENABLED) != 0) ||
722                 ((regs->gpe.sts[0] & regs->gpe.en[0]) != 0);
723 
724     qemu_set_irq(irq, sci_level);
725 
726     /* schedule a timer interruption if needed */
727     acpi_pm_tmr_update(regs,
728                        (regs->pm1.evt.en & ACPI_BITMASK_TIMER_ENABLE) &&
729                        !(pm1a_sts & ACPI_BITMASK_TIMER_STATUS));
730 }
731