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