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 } 737