hw/acpi/core.c

   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 #include "qemu/osdep.h"
  22 #include "sysemu/sysemu.h"
  23 #include "hw/hw.h"
  24 #include "hw/i386/pc.h"
  25 #include "hw/acpi/acpi.h"
  26 #include "hw/nvram/fw_cfg.h"
  27 #include "qemu/config-file.h"
  28 #include "qapi/opts-visitor.h"
  29 #include "qapi-visit.h"
  30 #include "qapi-event.h"
  31
  32 struct acpi_table_header {
  33     uint16_t _length;         /* our length, not actual part of the hdr */
  34                               /* allows easier parsing for fw_cfg clients */
  35     char sig[4];              /* ACPI signature (4 ASCII characters) */
  36     uint32_t length;          /* Length of table, in bytes, including header */
  37     uint8_t revision;         /* ACPI Specification minor version # */
  38     uint8_t checksum;         /* To make sum of entire table == 0 */
  39     char oem_id[6];           /* OEM identification */
  40     char oem_table_id[8];     /* OEM table identification */
  41     uint32_t oem_revision;    /* OEM revision number */
  42     char asl_compiler_id[4];  /* ASL compiler vendor ID */
  43     uint32_t asl_compiler_revision; /* ASL compiler revision number */
  44 } QEMU_PACKED;
  45
  46 #define ACPI_TABLE_HDR_SIZE sizeof(struct acpi_table_header)
  47 #define ACPI_TABLE_PFX_SIZE sizeof(uint16_t)  /* size of the extra prefix */
  48
  49 static const char unsigned dfl_hdr[ACPI_TABLE_HDR_SIZE - ACPI_TABLE_PFX_SIZE] =
  50     "QEMU\0\0\0\0\1\0"       /* sig (4), len(4), revno (1), csum (1) */
  51     "QEMUQEQEMUQEMU\1\0\0\0" /* OEM id (6), table (8), revno (4) */
  52     "QEMU\1\0\0\0"           /* ASL compiler ID (4), version (4) */
  53     ;
  54
  55 char unsigned *acpi_tables;
  56 size_t acpi_tables_len;
  57
  58 static QemuOptsList qemu_acpi_opts = {
  59     .name = "acpi",
  60     .implied_opt_name = "data",
  61     .head = QTAILQ_HEAD_INITIALIZER(qemu_acpi_opts.head),
  62     .desc = { { 0 } } /* validated with OptsVisitor */
  63 };
  64
  65 static void acpi_register_config(void)
  66 {
  67     qemu_add_opts(&qemu_acpi_opts);
  68 }
  69
  70 opts_init(acpi_register_config);
  71
  72 static int acpi_checksum(const uint8_t *data, int len)
  73 {
  74     int sum, i;
  75     sum = 0;
  76     for (i = 0; i < len; i++) {
  77         sum += data[i];
  78     }
  79     return (-sum) & 0xff;
  80 }
  81
  82
  83 /* Install a copy of the ACPI table specified in @blob.
  84  *
  85  * If @has_header is set, @blob starts with the System Description Table Header
  86  * structure. Otherwise, "dfl_hdr" is prepended. In any case, each header field
  87  * is optionally overwritten from @hdrs.
  88  *
  89  * It is valid to call this function with
  90  * (@blob == NULL && bloblen == 0 && !has_header).
  91  *
  92  * @hdrs->file and @hdrs->data are ignored.
  93  *
  94  * SIZE_MAX is considered "infinity" in this function.
  95  *
  96  * The number of tables that can be installed is not limited, but the 16-bit
  97  * counter at the beginning of "acpi_tables" wraps around after UINT16_MAX.
  98  */
  99 static void acpi_table_install(const char unsigned *blob, size_t bloblen,
 100                                bool has_header,
 101                                const struct AcpiTableOptions *hdrs,
 102                                Error **errp)
 103 {
 104     size_t body_start;
 105     const char unsigned *hdr_src;
 106     size_t body_size, acpi_payload_size;
 107     struct acpi_table_header *ext_hdr;
 108     unsigned changed_fields;
 109
 110     /* Calculate where the ACPI table body starts within the blob, plus where
 111      * to copy the ACPI table header from.
 112      */
 113     if (has_header) {
 114         /*   _length             | ACPI header in blob | blob body
 115          *   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^
 116          *   ACPI_TABLE_PFX_SIZE     sizeof dfl_hdr      body_size
 117          *                           == body_start
 118          *
 119          *                         ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
 120          *                           acpi_payload_size == bloblen
 121          */
 122         body_start = sizeof dfl_hdr;
 123
 124         if (bloblen < body_start) {
 125             error_setg(errp, "ACPI table claiming to have header is too "
 126                        "short, available: %zu, expected: %zu", bloblen,
 127                        body_start);
 128             return;
 129         }
 130         hdr_src = blob;
 131     } else {
 132         /*   _length             | ACPI header in template | blob body
 133          *   ^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^^^^^^^^^^^^^^   ^^^^^^^^^^
 134          *   ACPI_TABLE_PFX_SIZE       sizeof dfl_hdr        body_size
 135          *                                                   == bloblen
 136          *
 137          *                         ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
 138          *                                  acpi_payload_size
 139          */
 140         body_start = 0;
 141         hdr_src = dfl_hdr;
 142     }
 143     body_size = bloblen - body_start;
 144     acpi_payload_size = sizeof dfl_hdr + body_size;
 145
 146     if (acpi_payload_size > UINT16_MAX) {
 147         error_setg(errp, "ACPI table too big, requested: %zu, max: %u",
 148                    acpi_payload_size, (unsigned)UINT16_MAX);
 149         return;
 150     }
 151
 152     /* We won't fail from here on. Initialize / extend the globals. */
 153     if (acpi_tables == NULL) {
 154         acpi_tables_len = sizeof(uint16_t);
 155         acpi_tables = g_malloc0(acpi_tables_len);
 156     }
 157
 158     acpi_tables = g_realloc(acpi_tables, acpi_tables_len +
 159                                          ACPI_TABLE_PFX_SIZE +
 160                                          sizeof dfl_hdr + body_size);
 161
 162     ext_hdr = (struct acpi_table_header *)(acpi_tables + acpi_tables_len);
 163     acpi_tables_len += ACPI_TABLE_PFX_SIZE;
 164
 165     memcpy(acpi_tables + acpi_tables_len, hdr_src, sizeof dfl_hdr);
 166     acpi_tables_len += sizeof dfl_hdr;
 167
 168     if (blob != NULL) {
 169         memcpy(acpi_tables + acpi_tables_len, blob + body_start, body_size);
 170         acpi_tables_len += body_size;
 171     }
 172
 173     /* increase number of tables */
 174     stw_le_p(acpi_tables, lduw_le_p(acpi_tables) + 1u);
 175
 176     /* Update the header fields. The strings need not be NUL-terminated. */
 177     changed_fields = 0;
 178     ext_hdr->_length = cpu_to_le16(acpi_payload_size);
 179
 180     if (hdrs->has_sig) {
 181         strncpy(ext_hdr->sig, hdrs->sig, sizeof ext_hdr->sig);
 182         ++changed_fields;
 183     }
 184
 185     if (has_header && le32_to_cpu(ext_hdr->length) != acpi_payload_size) {
 186         fprintf(stderr,
 187                 "warning: ACPI table has wrong length, header says "
 188                 "%" PRIu32 ", actual size %zu bytes\n",
 189                 le32_to_cpu(ext_hdr->length), acpi_payload_size);
 190     }
 191     ext_hdr->length = cpu_to_le32(acpi_payload_size);
 192
 193     if (hdrs->has_rev) {
 194         ext_hdr->revision = hdrs->rev;
 195         ++changed_fields;
 196     }
 197
 198     ext_hdr->checksum = 0;
 199
 200     if (hdrs->has_oem_id) {
 201         strncpy(ext_hdr->oem_id, hdrs->oem_id, sizeof ext_hdr->oem_id);
 202         ++changed_fields;
 203     }
 204     if (hdrs->has_oem_table_id) {
 205         strncpy(ext_hdr->oem_table_id, hdrs->oem_table_id,
 206                 sizeof ext_hdr->oem_table_id);
 207         ++changed_fields;
 208     }
 209     if (hdrs->has_oem_rev) {
 210         ext_hdr->oem_revision = cpu_to_le32(hdrs->oem_rev);
 211         ++changed_fields;
 212     }
 213     if (hdrs->has_asl_compiler_id) {
 214         strncpy(ext_hdr->asl_compiler_id, hdrs->asl_compiler_id,
 215                 sizeof ext_hdr->asl_compiler_id);
 216         ++changed_fields;
 217     }
 218     if (hdrs->has_asl_compiler_rev) {
 219         ext_hdr->asl_compiler_revision = cpu_to_le32(hdrs->asl_compiler_rev);
 220         ++changed_fields;
 221     }
 222
 223     if (!has_header && changed_fields == 0) {
 224         fprintf(stderr, "warning: ACPI table: no headers are specified\n");
 225     }
 226
 227     /* recalculate checksum */
 228     ext_hdr->checksum = acpi_checksum((const char unsigned *)ext_hdr +
 229                                       ACPI_TABLE_PFX_SIZE, acpi_payload_size);
 230 }
 231
 232 void acpi_table_add(const QemuOpts *opts, Error **errp)
 233 {
 234     AcpiTableOptions *hdrs = NULL;
 235     Error *err = NULL;
 236     char **pathnames = NULL;
 237     char **cur;
 238     size_t bloblen = 0;
 239     char unsigned *blob = NULL;
 240
 241     {
 242         OptsVisitor *ov;
 243
 244         ov = opts_visitor_new(opts);
 245         visit_type_AcpiTableOptions(opts_get_visitor(ov), NULL, &hdrs, &err);
 246         opts_visitor_cleanup(ov);
 247     }
 248
 249     if (err) {
 250         goto out;
 251     }
 252     if (hdrs->has_file == hdrs->has_data) {
 253         error_setg(&err, "'-acpitable' requires one of 'data' or 'file'");
 254         goto out;
 255     }
 256
 257     pathnames = g_strsplit(hdrs->has_file ? hdrs->file : hdrs->data, ":", 0);
 258     if (pathnames == NULL || pathnames[0] == NULL) {
 259         error_setg(&err, "'-acpitable' requires at least one pathname");
 260         goto out;
 261     }
 262
 263     /* now read in the data files, reallocating buffer as needed */
 264     for (cur = pathnames; *cur; ++cur) {
 265         int fd = open(*cur, O_RDONLY | O_BINARY);
 266
 267         if (fd < 0) {
 268             error_setg(&err, "can't open file %s: %s", *cur, strerror(errno));
 269             goto out;
 270         }
 271
 272         for (;;) {
 273             char unsigned data[8192];
 274             ssize_t r;
 275
 276             r = read(fd, data, sizeof data);
 277             if (r == 0) {
 278                 break;
 279             } else if (r > 0) {
 280                 blob = g_realloc(blob, bloblen + r);
 281                 memcpy(blob + bloblen, data, r);
 282                 bloblen += r;
 283             } else if (errno != EINTR) {
 284                 error_setg(&err, "can't read file %s: %s",
 285                            *cur, strerror(errno));
 286                 close(fd);
 287                 goto out;
 288             }
 289         }
 290
 291         close(fd);
 292     }
 293
 294     acpi_table_install(blob, bloblen, hdrs->has_file, hdrs, &err);
 295
 296 out:
 297     g_free(blob);
 298     g_strfreev(pathnames);
 299     qapi_free_AcpiTableOptions(hdrs);
 300
 301     error_propagate(errp, err);
 302 }
 303
 304 static bool acpi_table_builtin = false;
 305
 306 void acpi_table_add_builtin(const QemuOpts *opts, Error **errp)
 307 {
 308     acpi_table_builtin = true;
 309     acpi_table_add(opts, errp);
 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_table_builtin || !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     qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER);
 516     ar->tmr.update_sci(ar);
 517 }
 518
 519 static uint64_t acpi_pm_tmr_read(void *opaque, hwaddr addr, unsigned width)
 520 {
 521     return acpi_pm_tmr_get(opaque);
 522 }
 523
 524 static void acpi_pm_tmr_write(void *opaque, hwaddr addr, uint64_t val,
 525                               unsigned width)
 526 {
 527     /* nothing */
 528 }
 529
 530 static const MemoryRegionOps acpi_pm_tmr_ops = {
 531     .read = acpi_pm_tmr_read,
 532     .write = acpi_pm_tmr_write,
 533     .valid.min_access_size = 4,
 534     .valid.max_access_size = 4,
 535     .endianness = DEVICE_LITTLE_ENDIAN,
 536 };
 537
 538 void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci,
 539                       MemoryRegion *parent)
 540 {
 541     ar->tmr.update_sci = update_sci;
 542     ar->tmr.timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, acpi_pm_tmr_timer, ar);
 543     memory_region_init_io(&ar->tmr.io, memory_region_owner(parent),
 544                           &acpi_pm_tmr_ops, ar, "acpi-tmr", 4);
 545     memory_region_add_subregion(parent, 8, &ar->tmr.io);
 546 }
 547
 548 void acpi_pm_tmr_reset(ACPIREGS *ar)
 549 {
 550     ar->tmr.overflow_time = 0;
 551     timer_del(ar->tmr.timer);
 552 }
 553
 554 /* ACPI PM1aCNT */
 555 static void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val)
 556 {
 557     ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE);
 558
 559     if (val & ACPI_BITMASK_SLEEP_ENABLE) {
 560         /* change suspend type */
 561         uint16_t sus_typ = (val >> 10) & 7;
 562         switch(sus_typ) {
 563         case 0: /* soft power off */
 564             qemu_system_shutdown_request();
 565             break;
 566         case 1:
 567             qemu_system_suspend_request();
 568             break;
 569         default:
 570             if (sus_typ == ar->pm1.cnt.s4_val) { /* S4 request */
 571                 qapi_event_send_suspend_disk(&error_abort);
 572                 qemu_system_shutdown_request();
 573             }
 574             break;
 575         }
 576     }
 577 }
 578
 579 void acpi_pm1_cnt_update(ACPIREGS *ar,
 580                          bool sci_enable, bool sci_disable)
 581 {
 582     /* ACPI specs 3.0, 4.7.2.5 */
 583     if (sci_enable) {
 584         ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE;
 585     } else if (sci_disable) {
 586         ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE;
 587     }
 588 }
 589
 590 static uint64_t acpi_pm_cnt_read(void *opaque, hwaddr addr, unsigned width)
 591 {
 592     ACPIREGS *ar = opaque;
 593     return ar->pm1.cnt.cnt;
 594 }
 595
 596 static void acpi_pm_cnt_write(void *opaque, hwaddr addr, uint64_t val,
 597                               unsigned width)
 598 {
 599     acpi_pm1_cnt_write(opaque, val);
 600 }
 601
 602 static const MemoryRegionOps acpi_pm_cnt_ops = {
 603     .read = acpi_pm_cnt_read,
 604     .write = acpi_pm_cnt_write,
 605     .valid.min_access_size = 2,
 606     .valid.max_access_size = 2,
 607     .endianness = DEVICE_LITTLE_ENDIAN,
 608 };
 609
 610 void acpi_pm1_cnt_init(ACPIREGS *ar, MemoryRegion *parent,
 611                        bool disable_s3, bool disable_s4, uint8_t s4_val)
 612 {
 613     FWCfgState *fw_cfg;
 614
 615     ar->pm1.cnt.s4_val = s4_val;
 616     ar->wakeup.notify = acpi_notify_wakeup;
 617     qemu_register_wakeup_notifier(&ar->wakeup);
 618     memory_region_init_io(&ar->pm1.cnt.io, memory_region_owner(parent),
 619                           &acpi_pm_cnt_ops, ar, "acpi-cnt", 2);
 620     memory_region_add_subregion(parent, 4, &ar->pm1.cnt.io);
 621
 622     fw_cfg = fw_cfg_find();
 623     if (fw_cfg) {
 624         uint8_t suspend[6] = {128, 0, 0, 129, 128, 128};
 625         suspend[3] = 1 | ((!disable_s3) << 7);
 626         suspend[4] = s4_val | ((!disable_s4) << 7);
 627
 628         fw_cfg_add_file(fw_cfg, "etc/system-states", g_memdup(suspend, 6), 6);
 629     }
 630 }
 631
 632 void acpi_pm1_cnt_reset(ACPIREGS *ar)
 633 {
 634     ar->pm1.cnt.cnt = 0;
 635 }
 636
 637 /* ACPI GPE */
 638 void acpi_gpe_init(ACPIREGS *ar, uint8_t len)
 639 {
 640     ar->gpe.len = len;
 641     /* Only first len / 2 bytes are ever used,
 642      * but the caller in ich9.c migrates full len bytes.
 643      * TODO: fix ich9.c and drop the extra allocation.
 644      */
 645     ar->gpe.sts = g_malloc0(len);
 646     ar->gpe.en = g_malloc0(len);
 647 }
 648
 649 void acpi_gpe_reset(ACPIREGS *ar)
 650 {
 651     memset(ar->gpe.sts, 0, ar->gpe.len / 2);
 652     memset(ar->gpe.en, 0, ar->gpe.len / 2);
 653 }
 654
 655 static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr)
 656 {
 657     uint8_t *cur = NULL;
 658
 659     if (addr < ar->gpe.len / 2) {
 660         cur = ar->gpe.sts + addr;
 661     } else if (addr < ar->gpe.len) {
 662         cur = ar->gpe.en + addr - ar->gpe.len / 2;
 663     } else {
 664         abort();
 665     }
 666
 667     return cur;
 668 }
 669
 670 void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val)
 671 {
 672     uint8_t *cur;
 673
 674     cur = acpi_gpe_ioport_get_ptr(ar, addr);
 675     if (addr < ar->gpe.len / 2) {
 676         /* GPE_STS */
 677         *cur = (*cur) & ~val;
 678     } else if (addr < ar->gpe.len) {
 679         /* GPE_EN */
 680         *cur = val;
 681     } else {
 682         abort();
 683     }
 684 }
 685
 686 uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr)
 687 {
 688     uint8_t *cur;
 689     uint32_t val;
 690
 691     cur = acpi_gpe_ioport_get_ptr(ar, addr);
 692     val = 0;
 693     if (cur != NULL) {
 694         val = *cur;
 695     }
 696
 697     return val;
 698 }
 699
 700 void acpi_send_gpe_event(ACPIREGS *ar, qemu_irq irq,
 701                          AcpiEventStatusBits status)
 702 {
 703     ar->gpe.sts[0] |= status;
 704     acpi_update_sci(ar, irq);
 705 }
 706
 707 void acpi_update_sci(ACPIREGS *regs, qemu_irq irq)
 708 {
 709     int sci_level, pm1a_sts;
 710
 711     pm1a_sts = acpi_pm1_evt_get_sts(regs);
 712
 713     sci_level = ((pm1a_sts &
 714                   regs->pm1.evt.en & ACPI_BITMASK_PM1_COMMON_ENABLED) != 0) ||
 715                 ((regs->gpe.sts[0] & regs->gpe.en[0]) != 0);
 716
 717     qemu_set_irq(irq, sci_level);
 718
 719     /* schedule a timer interruption if needed */
 720     acpi_pm_tmr_update(regs,
 721                        (regs->pm1.evt.en & ACPI_BITMASK_TIMER_ENABLE) &&
 722                        !(pm1a_sts & ACPI_BITMASK_TIMER_STATUS));
 723 }