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