16515b203Sbellard /* 26515b203Sbellard * ACPI implementation 36515b203Sbellard * 46515b203Sbellard * Copyright (c) 2006 Fabrice Bellard 56515b203Sbellard * 66515b203Sbellard * This library is free software; you can redistribute it and/or 76515b203Sbellard * modify it under the terms of the GNU Lesser General Public 86515b203Sbellard * License version 2 as published by the Free Software Foundation. 96515b203Sbellard * 106515b203Sbellard * This library is distributed in the hope that it will be useful, 116515b203Sbellard * but WITHOUT ANY WARRANTY; without even the implied warranty of 126515b203Sbellard * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 136515b203Sbellard * Lesser General Public License for more details. 146515b203Sbellard * 156515b203Sbellard * You should have received a copy of the GNU Lesser General Public 168167ee88SBlue Swirl * License along with this library; if not, see <http://www.gnu.org/licenses/> 176b620ca3SPaolo Bonzini * 186b620ca3SPaolo Bonzini * Contributions after 2012-01-13 are licensed under the terms of the 196b620ca3SPaolo Bonzini * GNU GPL, version 2 or (at your option) any later version. 206515b203Sbellard */ 219c17d615SPaolo Bonzini #include "sysemu/sysemu.h" 2283c9f4caSPaolo Bonzini #include "hw/hw.h" 230d09e41aSPaolo Bonzini #include "hw/i386/pc.h" 240d09e41aSPaolo Bonzini #include "hw/acpi/acpi.h" 2583c9089eSPaolo Bonzini #include "monitor/monitor.h" 260c764a9dSLaszlo Ersek #include "qemu/config-file.h" 270c764a9dSLaszlo Ersek #include "qapi/opts-visitor.h" 280c764a9dSLaszlo Ersek #include "qapi/dealloc-visitor.h" 290c764a9dSLaszlo Ersek #include "qapi-visit.h" 306515b203Sbellard 31104bf02eSMichael Tokarev struct acpi_table_header { 32104bf02eSMichael Tokarev uint16_t _length; /* our length, not actual part of the hdr */ 33e980f2bfSLaszlo Ersek /* allows easier parsing for fw_cfg clients */ 34104bf02eSMichael Tokarev char sig[4]; /* ACPI signature (4 ASCII characters) */ 358a92ea2fSaliguori uint32_t length; /* Length of table, in bytes, including header */ 368a92ea2fSaliguori uint8_t revision; /* ACPI Specification minor version # */ 378a92ea2fSaliguori uint8_t checksum; /* To make sum of entire table == 0 */ 388a92ea2fSaliguori char oem_id[6]; /* OEM identification */ 398a92ea2fSaliguori char oem_table_id[8]; /* OEM table identification */ 408a92ea2fSaliguori uint32_t oem_revision; /* OEM revision number */ 418a92ea2fSaliguori char asl_compiler_id[4]; /* ASL compiler vendor ID */ 428a92ea2fSaliguori uint32_t asl_compiler_revision; /* ASL compiler revision number */ 43541dc0d4SStefan Weil } QEMU_PACKED; 448a92ea2fSaliguori 45104bf02eSMichael Tokarev #define ACPI_TABLE_HDR_SIZE sizeof(struct acpi_table_header) 46104bf02eSMichael Tokarev #define ACPI_TABLE_PFX_SIZE sizeof(uint16_t) /* size of the extra prefix */ 47104bf02eSMichael Tokarev 48e980f2bfSLaszlo Ersek static const char unsigned dfl_hdr[ACPI_TABLE_HDR_SIZE - ACPI_TABLE_PFX_SIZE] = 49104bf02eSMichael Tokarev "QEMU\0\0\0\0\1\0" /* sig (4), len(4), revno (1), csum (1) */ 50104bf02eSMichael Tokarev "QEMUQEQEMUQEMU\1\0\0\0" /* OEM id (6), table (8), revno (4) */ 51104bf02eSMichael Tokarev "QEMU\1\0\0\0" /* ASL compiler ID (4), version (4) */ 52104bf02eSMichael Tokarev ; 53104bf02eSMichael Tokarev 54cb88a4eaSLaszlo Ersek char unsigned *acpi_tables; 558a92ea2fSaliguori size_t acpi_tables_len; 568a92ea2fSaliguori 570c764a9dSLaszlo Ersek static QemuOptsList qemu_acpi_opts = { 580c764a9dSLaszlo Ersek .name = "acpi", 590c764a9dSLaszlo Ersek .implied_opt_name = "data", 600c764a9dSLaszlo Ersek .head = QTAILQ_HEAD_INITIALIZER(qemu_acpi_opts.head), 610c764a9dSLaszlo Ersek .desc = { { 0 } } /* validated with OptsVisitor */ 620c764a9dSLaszlo Ersek }; 630c764a9dSLaszlo Ersek 640c764a9dSLaszlo Ersek static void acpi_register_config(void) 650c764a9dSLaszlo Ersek { 660c764a9dSLaszlo Ersek qemu_add_opts(&qemu_acpi_opts); 670c764a9dSLaszlo Ersek } 680c764a9dSLaszlo Ersek 690c764a9dSLaszlo Ersek machine_init(acpi_register_config); 700c764a9dSLaszlo Ersek 718a92ea2fSaliguori static int acpi_checksum(const uint8_t *data, int len) 728a92ea2fSaliguori { 738a92ea2fSaliguori int sum, i; 748a92ea2fSaliguori sum = 0; 75104bf02eSMichael Tokarev for (i = 0; i < len; i++) { 768a92ea2fSaliguori sum += data[i]; 77104bf02eSMichael Tokarev } 788a92ea2fSaliguori return (-sum) & 0xff; 798a92ea2fSaliguori } 808a92ea2fSaliguori 81e980f2bfSLaszlo Ersek 82e980f2bfSLaszlo Ersek /* Install a copy of the ACPI table specified in @blob. 83e980f2bfSLaszlo Ersek * 84e980f2bfSLaszlo Ersek * If @has_header is set, @blob starts with the System Description Table Header 85e980f2bfSLaszlo Ersek * structure. Otherwise, "dfl_hdr" is prepended. In any case, each header field 86e980f2bfSLaszlo Ersek * is optionally overwritten from @hdrs. 87e980f2bfSLaszlo Ersek * 88e980f2bfSLaszlo Ersek * It is valid to call this function with 89e980f2bfSLaszlo Ersek * (@blob == NULL && bloblen == 0 && !has_header). 90e980f2bfSLaszlo Ersek * 91e980f2bfSLaszlo Ersek * @hdrs->file and @hdrs->data are ignored. 92e980f2bfSLaszlo Ersek * 93e980f2bfSLaszlo Ersek * SIZE_MAX is considered "infinity" in this function. 94e980f2bfSLaszlo Ersek * 95e980f2bfSLaszlo Ersek * The number of tables that can be installed is not limited, but the 16-bit 96e980f2bfSLaszlo Ersek * counter at the beginning of "acpi_tables" wraps around after UINT16_MAX. 97e980f2bfSLaszlo Ersek */ 98e980f2bfSLaszlo Ersek static void acpi_table_install(const char unsigned *blob, size_t bloblen, 99e980f2bfSLaszlo Ersek bool has_header, 100e980f2bfSLaszlo Ersek const struct AcpiTableOptions *hdrs, 101e980f2bfSLaszlo Ersek Error **errp) 102e980f2bfSLaszlo Ersek { 103e980f2bfSLaszlo Ersek size_t body_start; 104e980f2bfSLaszlo Ersek const char unsigned *hdr_src; 105e980f2bfSLaszlo Ersek size_t body_size, acpi_payload_size; 106e980f2bfSLaszlo Ersek struct acpi_table_header *ext_hdr; 107e980f2bfSLaszlo Ersek unsigned changed_fields; 108e980f2bfSLaszlo Ersek 109e980f2bfSLaszlo Ersek /* Calculate where the ACPI table body starts within the blob, plus where 110e980f2bfSLaszlo Ersek * to copy the ACPI table header from. 111e980f2bfSLaszlo Ersek */ 112e980f2bfSLaszlo Ersek if (has_header) { 113e980f2bfSLaszlo Ersek /* _length | ACPI header in blob | blob body 114e980f2bfSLaszlo Ersek * ^^^^^^^^^^^^^^^^^^^ ^^^^^^^^^^^^^^^^^^^ ^^^^^^^^^ 115e980f2bfSLaszlo Ersek * ACPI_TABLE_PFX_SIZE sizeof dfl_hdr body_size 116e980f2bfSLaszlo Ersek * == body_start 117e980f2bfSLaszlo Ersek * 118e980f2bfSLaszlo Ersek * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ 119e980f2bfSLaszlo Ersek * acpi_payload_size == bloblen 120e980f2bfSLaszlo Ersek */ 121e980f2bfSLaszlo Ersek body_start = sizeof dfl_hdr; 122e980f2bfSLaszlo Ersek 123e980f2bfSLaszlo Ersek if (bloblen < body_start) { 124e980f2bfSLaszlo Ersek error_setg(errp, "ACPI table claiming to have header is too " 125e980f2bfSLaszlo Ersek "short, available: %zu, expected: %zu", bloblen, 126e980f2bfSLaszlo Ersek body_start); 127e980f2bfSLaszlo Ersek return; 128e980f2bfSLaszlo Ersek } 129e980f2bfSLaszlo Ersek hdr_src = blob; 130e980f2bfSLaszlo Ersek } else { 131e980f2bfSLaszlo Ersek /* _length | ACPI header in template | blob body 132e980f2bfSLaszlo Ersek * ^^^^^^^^^^^^^^^^^^^ ^^^^^^^^^^^^^^^^^^^^^^^ ^^^^^^^^^^ 133e980f2bfSLaszlo Ersek * ACPI_TABLE_PFX_SIZE sizeof dfl_hdr body_size 134e980f2bfSLaszlo Ersek * == bloblen 135e980f2bfSLaszlo Ersek * 136e980f2bfSLaszlo Ersek * ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^ 137e980f2bfSLaszlo Ersek * acpi_payload_size 138e980f2bfSLaszlo Ersek */ 139e980f2bfSLaszlo Ersek body_start = 0; 140e980f2bfSLaszlo Ersek hdr_src = dfl_hdr; 141e980f2bfSLaszlo Ersek } 142e980f2bfSLaszlo Ersek body_size = bloblen - body_start; 143e980f2bfSLaszlo Ersek acpi_payload_size = sizeof dfl_hdr + body_size; 144e980f2bfSLaszlo Ersek 145e980f2bfSLaszlo Ersek if (acpi_payload_size > UINT16_MAX) { 146e980f2bfSLaszlo Ersek error_setg(errp, "ACPI table too big, requested: %zu, max: %u", 147e980f2bfSLaszlo Ersek acpi_payload_size, (unsigned)UINT16_MAX); 148e980f2bfSLaszlo Ersek return; 149e980f2bfSLaszlo Ersek } 150e980f2bfSLaszlo Ersek 151e980f2bfSLaszlo Ersek /* We won't fail from here on. Initialize / extend the globals. */ 152e980f2bfSLaszlo Ersek if (acpi_tables == NULL) { 153e980f2bfSLaszlo Ersek acpi_tables_len = sizeof(uint16_t); 154e980f2bfSLaszlo Ersek acpi_tables = g_malloc0(acpi_tables_len); 155e980f2bfSLaszlo Ersek } 156e980f2bfSLaszlo Ersek 157e980f2bfSLaszlo Ersek acpi_tables = g_realloc(acpi_tables, acpi_tables_len + 158e980f2bfSLaszlo Ersek ACPI_TABLE_PFX_SIZE + 159e980f2bfSLaszlo Ersek sizeof dfl_hdr + body_size); 160e980f2bfSLaszlo Ersek 161e980f2bfSLaszlo Ersek ext_hdr = (struct acpi_table_header *)(acpi_tables + acpi_tables_len); 162e980f2bfSLaszlo Ersek acpi_tables_len += ACPI_TABLE_PFX_SIZE; 163e980f2bfSLaszlo Ersek 164e980f2bfSLaszlo Ersek memcpy(acpi_tables + acpi_tables_len, hdr_src, sizeof dfl_hdr); 165e980f2bfSLaszlo Ersek acpi_tables_len += sizeof dfl_hdr; 166e980f2bfSLaszlo Ersek 167e980f2bfSLaszlo Ersek if (blob != NULL) { 168e980f2bfSLaszlo Ersek memcpy(acpi_tables + acpi_tables_len, blob + body_start, body_size); 169e980f2bfSLaszlo Ersek acpi_tables_len += body_size; 170e980f2bfSLaszlo Ersek } 171e980f2bfSLaszlo Ersek 172e980f2bfSLaszlo Ersek /* increase number of tables */ 173*c65e5de9SPeter Maydell stw_le_p(acpi_tables, lduw_le_p(acpi_tables) + 1u); 174e980f2bfSLaszlo Ersek 175e980f2bfSLaszlo Ersek /* Update the header fields. The strings need not be NUL-terminated. */ 176e980f2bfSLaszlo Ersek changed_fields = 0; 177e980f2bfSLaszlo Ersek ext_hdr->_length = cpu_to_le16(acpi_payload_size); 178e980f2bfSLaszlo Ersek 179e980f2bfSLaszlo Ersek if (hdrs->has_sig) { 180e980f2bfSLaszlo Ersek strncpy(ext_hdr->sig, hdrs->sig, sizeof ext_hdr->sig); 181e980f2bfSLaszlo Ersek ++changed_fields; 182e980f2bfSLaszlo Ersek } 183e980f2bfSLaszlo Ersek 184e980f2bfSLaszlo Ersek if (has_header && le32_to_cpu(ext_hdr->length) != acpi_payload_size) { 185e980f2bfSLaszlo Ersek fprintf(stderr, 186e980f2bfSLaszlo Ersek "warning: ACPI table has wrong length, header says " 187e980f2bfSLaszlo Ersek "%" PRIu32 ", actual size %zu bytes\n", 188e980f2bfSLaszlo Ersek le32_to_cpu(ext_hdr->length), acpi_payload_size); 189e980f2bfSLaszlo Ersek } 190e980f2bfSLaszlo Ersek ext_hdr->length = cpu_to_le32(acpi_payload_size); 191e980f2bfSLaszlo Ersek 192e980f2bfSLaszlo Ersek if (hdrs->has_rev) { 193e980f2bfSLaszlo Ersek ext_hdr->revision = hdrs->rev; 194e980f2bfSLaszlo Ersek ++changed_fields; 195e980f2bfSLaszlo Ersek } 196e980f2bfSLaszlo Ersek 197e980f2bfSLaszlo Ersek ext_hdr->checksum = 0; 198e980f2bfSLaszlo Ersek 199e980f2bfSLaszlo Ersek if (hdrs->has_oem_id) { 200e980f2bfSLaszlo Ersek strncpy(ext_hdr->oem_id, hdrs->oem_id, sizeof ext_hdr->oem_id); 201e980f2bfSLaszlo Ersek ++changed_fields; 202e980f2bfSLaszlo Ersek } 203e980f2bfSLaszlo Ersek if (hdrs->has_oem_table_id) { 204e980f2bfSLaszlo Ersek strncpy(ext_hdr->oem_table_id, hdrs->oem_table_id, 205e980f2bfSLaszlo Ersek sizeof ext_hdr->oem_table_id); 206e980f2bfSLaszlo Ersek ++changed_fields; 207e980f2bfSLaszlo Ersek } 208e980f2bfSLaszlo Ersek if (hdrs->has_oem_rev) { 209e980f2bfSLaszlo Ersek ext_hdr->oem_revision = cpu_to_le32(hdrs->oem_rev); 210e980f2bfSLaszlo Ersek ++changed_fields; 211e980f2bfSLaszlo Ersek } 212e980f2bfSLaszlo Ersek if (hdrs->has_asl_compiler_id) { 213e980f2bfSLaszlo Ersek strncpy(ext_hdr->asl_compiler_id, hdrs->asl_compiler_id, 214e980f2bfSLaszlo Ersek sizeof ext_hdr->asl_compiler_id); 215e980f2bfSLaszlo Ersek ++changed_fields; 216e980f2bfSLaszlo Ersek } 217e980f2bfSLaszlo Ersek if (hdrs->has_asl_compiler_rev) { 218e980f2bfSLaszlo Ersek ext_hdr->asl_compiler_revision = cpu_to_le32(hdrs->asl_compiler_rev); 219e980f2bfSLaszlo Ersek ++changed_fields; 220e980f2bfSLaszlo Ersek } 221e980f2bfSLaszlo Ersek 222e980f2bfSLaszlo Ersek if (!has_header && changed_fields == 0) { 223e980f2bfSLaszlo Ersek fprintf(stderr, "warning: ACPI table: no headers are specified\n"); 224e980f2bfSLaszlo Ersek } 225e980f2bfSLaszlo Ersek 226e980f2bfSLaszlo Ersek /* recalculate checksum */ 227e980f2bfSLaszlo Ersek ext_hdr->checksum = acpi_checksum((const char unsigned *)ext_hdr + 228e980f2bfSLaszlo Ersek ACPI_TABLE_PFX_SIZE, acpi_payload_size); 229e980f2bfSLaszlo Ersek } 230e980f2bfSLaszlo Ersek 23123084327SLaszlo Ersek void acpi_table_add(const QemuOpts *opts, Error **errp) 2328a92ea2fSaliguori { 2330c764a9dSLaszlo Ersek AcpiTableOptions *hdrs = NULL; 234445d9caeSLaszlo Ersek Error *err = NULL; 2350c764a9dSLaszlo Ersek char **pathnames = NULL; 2360c764a9dSLaszlo Ersek char **cur; 237e980f2bfSLaszlo Ersek size_t bloblen = 0; 238e980f2bfSLaszlo Ersek char unsigned *blob = NULL; 2398a92ea2fSaliguori 2400c764a9dSLaszlo Ersek { 2410c764a9dSLaszlo Ersek OptsVisitor *ov; 2420c764a9dSLaszlo Ersek 2430c764a9dSLaszlo Ersek ov = opts_visitor_new(opts); 2440c764a9dSLaszlo Ersek visit_type_AcpiTableOptions(opts_get_visitor(ov), &hdrs, NULL, &err); 2450c764a9dSLaszlo Ersek opts_visitor_cleanup(ov); 2460c764a9dSLaszlo Ersek } 2470c764a9dSLaszlo Ersek 2480c764a9dSLaszlo Ersek if (err) { 2490c764a9dSLaszlo Ersek goto out; 2500c764a9dSLaszlo Ersek } 2510c764a9dSLaszlo Ersek if (hdrs->has_file == hdrs->has_data) { 2520c764a9dSLaszlo Ersek error_setg(&err, "'-acpitable' requires one of 'data' or 'file'"); 2530c764a9dSLaszlo Ersek goto out; 2540c764a9dSLaszlo Ersek } 2550c764a9dSLaszlo Ersek 2560c764a9dSLaszlo Ersek pathnames = g_strsplit(hdrs->has_file ? hdrs->file : hdrs->data, ":", 0); 2570c764a9dSLaszlo Ersek if (pathnames == NULL || pathnames[0] == NULL) { 2580c764a9dSLaszlo Ersek error_setg(&err, "'-acpitable' requires at least one pathname"); 259445d9caeSLaszlo Ersek goto out; 2608a92ea2fSaliguori } 2618a92ea2fSaliguori 262104bf02eSMichael Tokarev /* now read in the data files, reallocating buffer as needed */ 2630c764a9dSLaszlo Ersek for (cur = pathnames; *cur; ++cur) { 2640c764a9dSLaszlo Ersek int fd = open(*cur, O_RDONLY | O_BINARY); 265104bf02eSMichael Tokarev 266104bf02eSMichael Tokarev if (fd < 0) { 2670c764a9dSLaszlo Ersek error_setg(&err, "can't open file %s: %s", *cur, strerror(errno)); 268445d9caeSLaszlo Ersek goto out; 269d729bb9aSIsaku Yamahata } 2708a92ea2fSaliguori 271104bf02eSMichael Tokarev for (;;) { 272cb88a4eaSLaszlo Ersek char unsigned data[8192]; 273e980f2bfSLaszlo Ersek ssize_t r; 274e980f2bfSLaszlo Ersek 275e980f2bfSLaszlo Ersek r = read(fd, data, sizeof data); 276104bf02eSMichael Tokarev if (r == 0) { 2778a92ea2fSaliguori break; 278104bf02eSMichael Tokarev } else if (r > 0) { 279e980f2bfSLaszlo Ersek blob = g_realloc(blob, bloblen + r); 280e980f2bfSLaszlo Ersek memcpy(blob + bloblen, data, r); 281e980f2bfSLaszlo Ersek bloblen += r; 282104bf02eSMichael Tokarev } else if (errno != EINTR) { 283445d9caeSLaszlo Ersek error_setg(&err, "can't read file %s: %s", 2840c764a9dSLaszlo Ersek *cur, strerror(errno)); 285104bf02eSMichael Tokarev close(fd); 286445d9caeSLaszlo Ersek goto out; 2878a92ea2fSaliguori } 288d729bb9aSIsaku Yamahata } 2898a92ea2fSaliguori 290104bf02eSMichael Tokarev close(fd); 291104bf02eSMichael Tokarev } 292104bf02eSMichael Tokarev 293e980f2bfSLaszlo Ersek acpi_table_install(blob, bloblen, hdrs->has_file, hdrs, &err); 294104bf02eSMichael Tokarev 295445d9caeSLaszlo Ersek out: 296e980f2bfSLaszlo Ersek g_free(blob); 2970c764a9dSLaszlo Ersek g_strfreev(pathnames); 2980c764a9dSLaszlo Ersek 2990c764a9dSLaszlo Ersek if (hdrs != NULL) { 3000c764a9dSLaszlo Ersek QapiDeallocVisitor *dv; 3010c764a9dSLaszlo Ersek 3020c764a9dSLaszlo Ersek dv = qapi_dealloc_visitor_new(); 3030c764a9dSLaszlo Ersek visit_type_AcpiTableOptions(qapi_dealloc_get_visitor(dv), &hdrs, NULL, 3040c764a9dSLaszlo Ersek NULL); 3050c764a9dSLaszlo Ersek qapi_dealloc_visitor_cleanup(dv); 3060c764a9dSLaszlo Ersek } 3070c764a9dSLaszlo Ersek 30823084327SLaszlo Ersek error_propagate(errp, err); 3090c764a9dSLaszlo Ersek } 310a54d41a8SIsaku Yamahata 31160de1163SMichael S. Tsirkin static bool acpi_table_builtin = false; 31260de1163SMichael S. Tsirkin 31360de1163SMichael S. Tsirkin void acpi_table_add_builtin(const QemuOpts *opts, Error **errp) 31460de1163SMichael S. Tsirkin { 31560de1163SMichael S. Tsirkin acpi_table_builtin = true; 31660de1163SMichael S. Tsirkin acpi_table_add(opts, errp); 31760de1163SMichael S. Tsirkin } 31860de1163SMichael S. Tsirkin 31960de1163SMichael S. Tsirkin unsigned acpi_table_len(void *current) 32060de1163SMichael S. Tsirkin { 32160de1163SMichael S. Tsirkin struct acpi_table_header *hdr = current - sizeof(hdr->_length); 32260de1163SMichael S. Tsirkin return hdr->_length; 32360de1163SMichael S. Tsirkin } 32460de1163SMichael S. Tsirkin 32560de1163SMichael S. Tsirkin static 32660de1163SMichael S. Tsirkin void *acpi_table_hdr(void *h) 32760de1163SMichael S. Tsirkin { 32860de1163SMichael S. Tsirkin struct acpi_table_header *hdr = h; 32960de1163SMichael S. Tsirkin return &hdr->sig; 33060de1163SMichael S. Tsirkin } 33160de1163SMichael S. Tsirkin 33260de1163SMichael S. Tsirkin uint8_t *acpi_table_first(void) 33360de1163SMichael S. Tsirkin { 33460de1163SMichael S. Tsirkin if (acpi_table_builtin || !acpi_tables) { 33560de1163SMichael S. Tsirkin return NULL; 33660de1163SMichael S. Tsirkin } 33760de1163SMichael S. Tsirkin return acpi_table_hdr(acpi_tables + ACPI_TABLE_PFX_SIZE); 33860de1163SMichael S. Tsirkin } 33960de1163SMichael S. Tsirkin 34060de1163SMichael S. Tsirkin uint8_t *acpi_table_next(uint8_t *current) 34160de1163SMichael S. Tsirkin { 34260de1163SMichael S. Tsirkin uint8_t *next = current + acpi_table_len(current); 34360de1163SMichael S. Tsirkin 34460de1163SMichael S. Tsirkin if (next - acpi_tables >= acpi_tables_len) { 34560de1163SMichael S. Tsirkin return NULL; 34660de1163SMichael S. Tsirkin } else { 34760de1163SMichael S. Tsirkin return acpi_table_hdr(next); 34860de1163SMichael S. Tsirkin } 34960de1163SMichael S. Tsirkin } 35060de1163SMichael S. Tsirkin 351da98c8ebSGerd Hoffmann static void acpi_notify_wakeup(Notifier *notifier, void *data) 352da98c8ebSGerd Hoffmann { 353da98c8ebSGerd Hoffmann ACPIREGS *ar = container_of(notifier, ACPIREGS, wakeup); 354da98c8ebSGerd Hoffmann WakeupReason *reason = data; 355da98c8ebSGerd Hoffmann 356da98c8ebSGerd Hoffmann switch (*reason) { 35762aeb0f7SGerd Hoffmann case QEMU_WAKEUP_REASON_RTC: 35862aeb0f7SGerd Hoffmann ar->pm1.evt.sts |= 35962aeb0f7SGerd Hoffmann (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_RT_CLOCK_STATUS); 36062aeb0f7SGerd Hoffmann break; 3616595abc0SGerd Hoffmann case QEMU_WAKEUP_REASON_PMTIMER: 3626595abc0SGerd Hoffmann ar->pm1.evt.sts |= 3636595abc0SGerd Hoffmann (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_TIMER_STATUS); 3646595abc0SGerd Hoffmann break; 365da98c8ebSGerd Hoffmann case QEMU_WAKEUP_REASON_OTHER: 366da98c8ebSGerd Hoffmann /* ACPI_BITMASK_WAKE_STATUS should be set on resume. 367da98c8ebSGerd Hoffmann Pretend that resume was caused by power button */ 368da98c8ebSGerd Hoffmann ar->pm1.evt.sts |= 369da98c8ebSGerd Hoffmann (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS); 370da98c8ebSGerd Hoffmann break; 3714bc78a87SLiu, Jinsong default: 3724bc78a87SLiu, Jinsong break; 373da98c8ebSGerd Hoffmann } 374da98c8ebSGerd Hoffmann } 375da98c8ebSGerd Hoffmann 37604dc308fSIsaku Yamahata /* ACPI PM1a EVT */ 3772886be1bSGerd Hoffmann uint16_t acpi_pm1_evt_get_sts(ACPIREGS *ar) 37804dc308fSIsaku Yamahata { 37904dc308fSIsaku Yamahata int64_t d = acpi_pm_tmr_get_clock(); 3802886be1bSGerd Hoffmann if (d >= ar->tmr.overflow_time) { 381355bf2e5SGerd Hoffmann ar->pm1.evt.sts |= ACPI_BITMASK_TIMER_STATUS; 38204dc308fSIsaku Yamahata } 383355bf2e5SGerd Hoffmann return ar->pm1.evt.sts; 38404dc308fSIsaku Yamahata } 38504dc308fSIsaku Yamahata 386b5a7c024SGerd Hoffmann static void acpi_pm1_evt_write_sts(ACPIREGS *ar, uint16_t val) 38704dc308fSIsaku Yamahata { 3882886be1bSGerd Hoffmann uint16_t pm1_sts = acpi_pm1_evt_get_sts(ar); 38904dc308fSIsaku Yamahata if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) { 39004dc308fSIsaku Yamahata /* if TMRSTS is reset, then compute the new overflow time */ 391355bf2e5SGerd Hoffmann acpi_pm_tmr_calc_overflow_time(ar); 39204dc308fSIsaku Yamahata } 393355bf2e5SGerd Hoffmann ar->pm1.evt.sts &= ~val; 39404dc308fSIsaku Yamahata } 39504dc308fSIsaku Yamahata 396b5a7c024SGerd Hoffmann static void acpi_pm1_evt_write_en(ACPIREGS *ar, uint16_t val) 3978283c4f5SGerd Hoffmann { 3988283c4f5SGerd Hoffmann ar->pm1.evt.en = val; 39962aeb0f7SGerd Hoffmann qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 40062aeb0f7SGerd Hoffmann val & ACPI_BITMASK_RT_CLOCK_ENABLE); 4016595abc0SGerd Hoffmann qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 4026595abc0SGerd Hoffmann val & ACPI_BITMASK_TIMER_ENABLE); 4038283c4f5SGerd Hoffmann } 4048283c4f5SGerd Hoffmann 405355bf2e5SGerd Hoffmann void acpi_pm1_evt_power_down(ACPIREGS *ar) 40604dc308fSIsaku Yamahata { 407355bf2e5SGerd Hoffmann if (ar->pm1.evt.en & ACPI_BITMASK_POWER_BUTTON_ENABLE) { 408355bf2e5SGerd Hoffmann ar->pm1.evt.sts |= ACPI_BITMASK_POWER_BUTTON_STATUS; 409355bf2e5SGerd Hoffmann ar->tmr.update_sci(ar); 41004dc308fSIsaku Yamahata } 41104dc308fSIsaku Yamahata } 41204dc308fSIsaku Yamahata 413355bf2e5SGerd Hoffmann void acpi_pm1_evt_reset(ACPIREGS *ar) 41404dc308fSIsaku Yamahata { 415355bf2e5SGerd Hoffmann ar->pm1.evt.sts = 0; 416355bf2e5SGerd Hoffmann ar->pm1.evt.en = 0; 41762aeb0f7SGerd Hoffmann qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 0); 4186595abc0SGerd Hoffmann qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 0); 41904dc308fSIsaku Yamahata } 42004dc308fSIsaku Yamahata 421b5a7c024SGerd Hoffmann static uint64_t acpi_pm_evt_read(void *opaque, hwaddr addr, unsigned width) 422b5a7c024SGerd Hoffmann { 423b5a7c024SGerd Hoffmann ACPIREGS *ar = opaque; 424b5a7c024SGerd Hoffmann switch (addr) { 425b5a7c024SGerd Hoffmann case 0: 426b5a7c024SGerd Hoffmann return acpi_pm1_evt_get_sts(ar); 427b5a7c024SGerd Hoffmann case 2: 428b5a7c024SGerd Hoffmann return ar->pm1.evt.en; 429b5a7c024SGerd Hoffmann default: 430b5a7c024SGerd Hoffmann return 0; 431b5a7c024SGerd Hoffmann } 432b5a7c024SGerd Hoffmann } 433b5a7c024SGerd Hoffmann 434b5a7c024SGerd Hoffmann static void acpi_pm_evt_write(void *opaque, hwaddr addr, uint64_t val, 435b5a7c024SGerd Hoffmann unsigned width) 436b5a7c024SGerd Hoffmann { 437b5a7c024SGerd Hoffmann ACPIREGS *ar = opaque; 438b5a7c024SGerd Hoffmann switch (addr) { 439b5a7c024SGerd Hoffmann case 0: 440b5a7c024SGerd Hoffmann acpi_pm1_evt_write_sts(ar, val); 441b5a7c024SGerd Hoffmann ar->pm1.evt.update_sci(ar); 442b5a7c024SGerd Hoffmann break; 443b5a7c024SGerd Hoffmann case 2: 444b5a7c024SGerd Hoffmann acpi_pm1_evt_write_en(ar, val); 445b5a7c024SGerd Hoffmann ar->pm1.evt.update_sci(ar); 446b5a7c024SGerd Hoffmann break; 447b5a7c024SGerd Hoffmann } 448b5a7c024SGerd Hoffmann } 449b5a7c024SGerd Hoffmann 450b5a7c024SGerd Hoffmann static const MemoryRegionOps acpi_pm_evt_ops = { 451b5a7c024SGerd Hoffmann .read = acpi_pm_evt_read, 452b5a7c024SGerd Hoffmann .write = acpi_pm_evt_write, 453b5a7c024SGerd Hoffmann .valid.min_access_size = 2, 454b5a7c024SGerd Hoffmann .valid.max_access_size = 2, 455b5a7c024SGerd Hoffmann .endianness = DEVICE_LITTLE_ENDIAN, 456b5a7c024SGerd Hoffmann }; 457b5a7c024SGerd Hoffmann 458b5a7c024SGerd Hoffmann void acpi_pm1_evt_init(ACPIREGS *ar, acpi_update_sci_fn update_sci, 459b5a7c024SGerd Hoffmann MemoryRegion *parent) 460b5a7c024SGerd Hoffmann { 461b5a7c024SGerd Hoffmann ar->pm1.evt.update_sci = update_sci; 46264bde0f3SPaolo Bonzini memory_region_init_io(&ar->pm1.evt.io, memory_region_owner(parent), 46364bde0f3SPaolo Bonzini &acpi_pm_evt_ops, ar, "acpi-evt", 4); 464b5a7c024SGerd Hoffmann memory_region_add_subregion(parent, 0, &ar->pm1.evt.io); 465b5a7c024SGerd Hoffmann } 466b5a7c024SGerd Hoffmann 467a54d41a8SIsaku Yamahata /* ACPI PM_TMR */ 468355bf2e5SGerd Hoffmann void acpi_pm_tmr_update(ACPIREGS *ar, bool enable) 469a54d41a8SIsaku Yamahata { 470a54d41a8SIsaku Yamahata int64_t expire_time; 471a54d41a8SIsaku Yamahata 472a54d41a8SIsaku Yamahata /* schedule a timer interruption if needed */ 473a54d41a8SIsaku Yamahata if (enable) { 474355bf2e5SGerd Hoffmann expire_time = muldiv64(ar->tmr.overflow_time, get_ticks_per_sec(), 475a54d41a8SIsaku Yamahata PM_TIMER_FREQUENCY); 476bc72ad67SAlex Bligh timer_mod(ar->tmr.timer, expire_time); 477a54d41a8SIsaku Yamahata } else { 478bc72ad67SAlex Bligh timer_del(ar->tmr.timer); 479a54d41a8SIsaku Yamahata } 480a54d41a8SIsaku Yamahata } 481a54d41a8SIsaku Yamahata 482355bf2e5SGerd Hoffmann void acpi_pm_tmr_calc_overflow_time(ACPIREGS *ar) 483a54d41a8SIsaku Yamahata { 484a54d41a8SIsaku Yamahata int64_t d = acpi_pm_tmr_get_clock(); 485355bf2e5SGerd Hoffmann ar->tmr.overflow_time = (d + 0x800000LL) & ~0x7fffffLL; 486a54d41a8SIsaku Yamahata } 487a54d41a8SIsaku Yamahata 48877d58b1eSGerd Hoffmann static uint32_t acpi_pm_tmr_get(ACPIREGS *ar) 489a54d41a8SIsaku Yamahata { 4903a93113aSDong Xu Wang uint32_t d = acpi_pm_tmr_get_clock(); 491a54d41a8SIsaku Yamahata return d & 0xffffff; 492a54d41a8SIsaku Yamahata } 493a54d41a8SIsaku Yamahata 494a54d41a8SIsaku Yamahata static void acpi_pm_tmr_timer(void *opaque) 495a54d41a8SIsaku Yamahata { 496355bf2e5SGerd Hoffmann ACPIREGS *ar = opaque; 4976595abc0SGerd Hoffmann qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER); 498355bf2e5SGerd Hoffmann ar->tmr.update_sci(ar); 499a54d41a8SIsaku Yamahata } 500a54d41a8SIsaku Yamahata 50177d58b1eSGerd Hoffmann static uint64_t acpi_pm_tmr_read(void *opaque, hwaddr addr, unsigned width) 50277d58b1eSGerd Hoffmann { 50377d58b1eSGerd Hoffmann return acpi_pm_tmr_get(opaque); 50477d58b1eSGerd Hoffmann } 50577d58b1eSGerd Hoffmann 5062d3b9895SGerd Hoffmann static void acpi_pm_tmr_write(void *opaque, hwaddr addr, uint64_t val, 5072d3b9895SGerd Hoffmann unsigned width) 5082d3b9895SGerd Hoffmann { 5092d3b9895SGerd Hoffmann /* nothing */ 5102d3b9895SGerd Hoffmann } 5112d3b9895SGerd Hoffmann 51277d58b1eSGerd Hoffmann static const MemoryRegionOps acpi_pm_tmr_ops = { 51377d58b1eSGerd Hoffmann .read = acpi_pm_tmr_read, 5142d3b9895SGerd Hoffmann .write = acpi_pm_tmr_write, 51577d58b1eSGerd Hoffmann .valid.min_access_size = 4, 51677d58b1eSGerd Hoffmann .valid.max_access_size = 4, 51777d58b1eSGerd Hoffmann .endianness = DEVICE_LITTLE_ENDIAN, 51877d58b1eSGerd Hoffmann }; 51977d58b1eSGerd Hoffmann 52077d58b1eSGerd Hoffmann void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci, 52177d58b1eSGerd Hoffmann MemoryRegion *parent) 522a54d41a8SIsaku Yamahata { 523355bf2e5SGerd Hoffmann ar->tmr.update_sci = update_sci; 524bc72ad67SAlex Bligh ar->tmr.timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, acpi_pm_tmr_timer, ar); 52564bde0f3SPaolo Bonzini memory_region_init_io(&ar->tmr.io, memory_region_owner(parent), 52664bde0f3SPaolo Bonzini &acpi_pm_tmr_ops, ar, "acpi-tmr", 4); 52777d58b1eSGerd Hoffmann memory_region_add_subregion(parent, 8, &ar->tmr.io); 528a54d41a8SIsaku Yamahata } 529a54d41a8SIsaku Yamahata 530355bf2e5SGerd Hoffmann void acpi_pm_tmr_reset(ACPIREGS *ar) 531a54d41a8SIsaku Yamahata { 532355bf2e5SGerd Hoffmann ar->tmr.overflow_time = 0; 533bc72ad67SAlex Bligh timer_del(ar->tmr.timer); 534a54d41a8SIsaku Yamahata } 535eaba51c5SIsaku Yamahata 536eaba51c5SIsaku Yamahata /* ACPI PM1aCNT */ 537afafe4bbSGerd Hoffmann static void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val) 538eaba51c5SIsaku Yamahata { 539355bf2e5SGerd Hoffmann ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE); 540eaba51c5SIsaku Yamahata 541eaba51c5SIsaku Yamahata if (val & ACPI_BITMASK_SLEEP_ENABLE) { 542eaba51c5SIsaku Yamahata /* change suspend type */ 543eaba51c5SIsaku Yamahata uint16_t sus_typ = (val >> 10) & 7; 544eaba51c5SIsaku Yamahata switch(sus_typ) { 545eaba51c5SIsaku Yamahata case 0: /* soft power off */ 546eaba51c5SIsaku Yamahata qemu_system_shutdown_request(); 547eaba51c5SIsaku Yamahata break; 548eaba51c5SIsaku Yamahata case 1: 549da98c8ebSGerd Hoffmann qemu_system_suspend_request(); 550da98c8ebSGerd Hoffmann break; 551eaba51c5SIsaku Yamahata default: 552afafe4bbSGerd Hoffmann if (sus_typ == ar->pm1.cnt.s4_val) { /* S4 request */ 55325df49f6SLuiz Capitulino monitor_protocol_event(QEVENT_SUSPEND_DISK, NULL); 554459ae5eaSGleb Natapov qemu_system_shutdown_request(); 555459ae5eaSGleb Natapov } 556eaba51c5SIsaku Yamahata break; 557eaba51c5SIsaku Yamahata } 558eaba51c5SIsaku Yamahata } 559eaba51c5SIsaku Yamahata } 560eaba51c5SIsaku Yamahata 561355bf2e5SGerd Hoffmann void acpi_pm1_cnt_update(ACPIREGS *ar, 562eaba51c5SIsaku Yamahata bool sci_enable, bool sci_disable) 563eaba51c5SIsaku Yamahata { 564eaba51c5SIsaku Yamahata /* ACPI specs 3.0, 4.7.2.5 */ 565eaba51c5SIsaku Yamahata if (sci_enable) { 566355bf2e5SGerd Hoffmann ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE; 567eaba51c5SIsaku Yamahata } else if (sci_disable) { 568355bf2e5SGerd Hoffmann ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE; 569eaba51c5SIsaku Yamahata } 570eaba51c5SIsaku Yamahata } 571eaba51c5SIsaku Yamahata 572afafe4bbSGerd Hoffmann static uint64_t acpi_pm_cnt_read(void *opaque, hwaddr addr, unsigned width) 573afafe4bbSGerd Hoffmann { 574afafe4bbSGerd Hoffmann ACPIREGS *ar = opaque; 575afafe4bbSGerd Hoffmann return ar->pm1.cnt.cnt; 576afafe4bbSGerd Hoffmann } 577afafe4bbSGerd Hoffmann 578afafe4bbSGerd Hoffmann static void acpi_pm_cnt_write(void *opaque, hwaddr addr, uint64_t val, 579afafe4bbSGerd Hoffmann unsigned width) 580afafe4bbSGerd Hoffmann { 581afafe4bbSGerd Hoffmann acpi_pm1_cnt_write(opaque, val); 582afafe4bbSGerd Hoffmann } 583afafe4bbSGerd Hoffmann 584afafe4bbSGerd Hoffmann static const MemoryRegionOps acpi_pm_cnt_ops = { 585afafe4bbSGerd Hoffmann .read = acpi_pm_cnt_read, 586afafe4bbSGerd Hoffmann .write = acpi_pm_cnt_write, 587afafe4bbSGerd Hoffmann .valid.min_access_size = 2, 588afafe4bbSGerd Hoffmann .valid.max_access_size = 2, 589afafe4bbSGerd Hoffmann .endianness = DEVICE_LITTLE_ENDIAN, 590afafe4bbSGerd Hoffmann }; 591afafe4bbSGerd Hoffmann 592560e6396SBruce Rogers void acpi_pm1_cnt_init(ACPIREGS *ar, MemoryRegion *parent, uint8_t s4_val) 593afafe4bbSGerd Hoffmann { 594560e6396SBruce Rogers ar->pm1.cnt.s4_val = s4_val; 595afafe4bbSGerd Hoffmann ar->wakeup.notify = acpi_notify_wakeup; 596afafe4bbSGerd Hoffmann qemu_register_wakeup_notifier(&ar->wakeup); 59764bde0f3SPaolo Bonzini memory_region_init_io(&ar->pm1.cnt.io, memory_region_owner(parent), 59864bde0f3SPaolo Bonzini &acpi_pm_cnt_ops, ar, "acpi-cnt", 2); 599afafe4bbSGerd Hoffmann memory_region_add_subregion(parent, 4, &ar->pm1.cnt.io); 600afafe4bbSGerd Hoffmann } 601afafe4bbSGerd Hoffmann 602355bf2e5SGerd Hoffmann void acpi_pm1_cnt_reset(ACPIREGS *ar) 603eaba51c5SIsaku Yamahata { 604355bf2e5SGerd Hoffmann ar->pm1.cnt.cnt = 0; 605eaba51c5SIsaku Yamahata } 60623910d3fSIsaku Yamahata 60723910d3fSIsaku Yamahata /* ACPI GPE */ 608355bf2e5SGerd Hoffmann void acpi_gpe_init(ACPIREGS *ar, uint8_t len) 60923910d3fSIsaku Yamahata { 610355bf2e5SGerd Hoffmann ar->gpe.len = len; 611355bf2e5SGerd Hoffmann ar->gpe.sts = g_malloc0(len / 2); 612355bf2e5SGerd Hoffmann ar->gpe.en = g_malloc0(len / 2); 61323910d3fSIsaku Yamahata } 61423910d3fSIsaku Yamahata 615355bf2e5SGerd Hoffmann void acpi_gpe_reset(ACPIREGS *ar) 61623910d3fSIsaku Yamahata { 617355bf2e5SGerd Hoffmann memset(ar->gpe.sts, 0, ar->gpe.len / 2); 618355bf2e5SGerd Hoffmann memset(ar->gpe.en, 0, ar->gpe.len / 2); 61923910d3fSIsaku Yamahata } 62023910d3fSIsaku Yamahata 621355bf2e5SGerd Hoffmann static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr) 62223910d3fSIsaku Yamahata { 62323910d3fSIsaku Yamahata uint8_t *cur = NULL; 62423910d3fSIsaku Yamahata 625355bf2e5SGerd Hoffmann if (addr < ar->gpe.len / 2) { 626355bf2e5SGerd Hoffmann cur = ar->gpe.sts + addr; 627355bf2e5SGerd Hoffmann } else if (addr < ar->gpe.len) { 628355bf2e5SGerd Hoffmann cur = ar->gpe.en + addr - ar->gpe.len / 2; 62923910d3fSIsaku Yamahata } else { 63023910d3fSIsaku Yamahata abort(); 63123910d3fSIsaku Yamahata } 63223910d3fSIsaku Yamahata 63323910d3fSIsaku Yamahata return cur; 63423910d3fSIsaku Yamahata } 63523910d3fSIsaku Yamahata 636355bf2e5SGerd Hoffmann void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val) 63723910d3fSIsaku Yamahata { 63823910d3fSIsaku Yamahata uint8_t *cur; 63923910d3fSIsaku Yamahata 640355bf2e5SGerd Hoffmann cur = acpi_gpe_ioport_get_ptr(ar, addr); 641355bf2e5SGerd Hoffmann if (addr < ar->gpe.len / 2) { 64223910d3fSIsaku Yamahata /* GPE_STS */ 64323910d3fSIsaku Yamahata *cur = (*cur) & ~val; 644355bf2e5SGerd Hoffmann } else if (addr < ar->gpe.len) { 64523910d3fSIsaku Yamahata /* GPE_EN */ 64623910d3fSIsaku Yamahata *cur = val; 64723910d3fSIsaku Yamahata } else { 64823910d3fSIsaku Yamahata abort(); 64923910d3fSIsaku Yamahata } 65023910d3fSIsaku Yamahata } 65123910d3fSIsaku Yamahata 652355bf2e5SGerd Hoffmann uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr) 65323910d3fSIsaku Yamahata { 65423910d3fSIsaku Yamahata uint8_t *cur; 65523910d3fSIsaku Yamahata uint32_t val; 65623910d3fSIsaku Yamahata 657355bf2e5SGerd Hoffmann cur = acpi_gpe_ioport_get_ptr(ar, addr); 65823910d3fSIsaku Yamahata val = 0; 65923910d3fSIsaku Yamahata if (cur != NULL) { 66023910d3fSIsaku Yamahata val = *cur; 66123910d3fSIsaku Yamahata } 66223910d3fSIsaku Yamahata 66323910d3fSIsaku Yamahata return val; 66423910d3fSIsaku Yamahata } 665