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