Ben Warren | 3248f1b | 2017-02-16 15:15:38 -0800 | [diff] [blame] | 1 | /* |
| 2 | * ACPI Utility Functions |
| 3 | * |
| 4 | * Copyright (c) 2013 Red Hat Inc. |
| 5 | * Copyright (c) 2017 Skyport Systems |
| 6 | * |
| 7 | * Authors: |
| 8 | * Michael S. Tsirkin <mst@redhat.com>, |
| 9 | * Ben Warren <ben@skyportsystems.com> |
| 10 | * |
| 11 | * This work is licensed under the terms of the GNU GPL, version 2 or later. |
| 12 | * See the COPYING file in the top-level directory. |
| 13 | */ |
| 14 | |
| 15 | #include "qemu/osdep.h" |
| 16 | #include <glib/gstdio.h> |
Ben Warren | 3248f1b | 2017-02-16 15:15:38 -0800 | [diff] [blame] | 17 | #include "qemu/bitmap.h" |
| 18 | #include "acpi-utils.h" |
| 19 | #include "boot-sector.h" |
| 20 | |
| 21 | uint8_t acpi_calc_checksum(const uint8_t *data, int len) |
| 22 | { |
| 23 | int i; |
| 24 | uint8_t sum = 0; |
| 25 | |
| 26 | for (i = 0; i < len; i++) { |
| 27 | sum += data[i]; |
| 28 | } |
| 29 | |
| 30 | return sum; |
| 31 | } |
| 32 | |
Eric Blake | 273e3d9 | 2017-09-11 12:20:08 -0500 | [diff] [blame] | 33 | uint32_t acpi_find_rsdp_address(QTestState *qts) |
Ben Warren | 3248f1b | 2017-02-16 15:15:38 -0800 | [diff] [blame] | 34 | { |
| 35 | uint32_t off; |
| 36 | |
| 37 | /* RSDP location can vary across a narrow range */ |
| 38 | for (off = 0xf0000; off < 0x100000; off += 0x10) { |
| 39 | uint8_t sig[] = "RSD PTR "; |
| 40 | int i; |
| 41 | |
| 42 | for (i = 0; i < sizeof sig - 1; ++i) { |
Eric Blake | 273e3d9 | 2017-09-11 12:20:08 -0500 | [diff] [blame] | 43 | sig[i] = qtest_readb(qts, off + i); |
Ben Warren | 3248f1b | 2017-02-16 15:15:38 -0800 | [diff] [blame] | 44 | } |
| 45 | |
| 46 | if (!memcmp(sig, "RSD PTR ", sizeof sig)) { |
| 47 | break; |
| 48 | } |
| 49 | } |
| 50 | return off; |
| 51 | } |
| 52 | |
Igor Mammedov | 9c04188 | 2019-05-02 16:51:52 +0200 | [diff] [blame] | 53 | void acpi_fetch_rsdp_table(QTestState *qts, uint64_t addr, uint8_t *rsdp_table) |
Samuel Ortiz | d6caf36 | 2018-12-20 16:02:55 +0100 | [diff] [blame] | 54 | { |
| 55 | uint8_t revision; |
| 56 | |
| 57 | /* Read mandatory revision 0 table data (20 bytes) first */ |
| 58 | qtest_memread(qts, addr, rsdp_table, 20); |
| 59 | revision = rsdp_table[15 /* Revision offset */]; |
| 60 | |
| 61 | switch (revision) { |
| 62 | case 0: /* ACPI 1.0 RSDP */ |
| 63 | break; |
| 64 | case 2: /* ACPI 2.0+ RSDP */ |
| 65 | /* Read the rest of the RSDP table */ |
| 66 | qtest_memread(qts, addr + 20, rsdp_table + 20, 16); |
| 67 | break; |
| 68 | default: |
| 69 | g_assert_not_reached(); |
| 70 | } |
| 71 | |
| 72 | ACPI_ASSERT_CMP64(*((uint64_t *)(rsdp_table)), "RSD PTR "); |
Ben Warren | 3248f1b | 2017-02-16 15:15:38 -0800 | [diff] [blame] | 73 | } |
Igor Mammedov | acee774 | 2018-12-27 15:13:31 +0100 | [diff] [blame] | 74 | |
| 75 | /** acpi_fetch_table |
| 76 | * load ACPI table at @addr_ptr offset pointer into buffer and return it in |
| 77 | * @aml, its length in @aml_len and check that signature/checksum matches |
| 78 | * actual one. |
| 79 | */ |
| 80 | void acpi_fetch_table(QTestState *qts, uint8_t **aml, uint32_t *aml_len, |
Igor Mammedov | 4b14d54 | 2019-05-02 16:51:50 +0200 | [diff] [blame] | 81 | const uint8_t *addr_ptr, int addr_size, const char *sig, |
Igor Mammedov | acee774 | 2018-12-27 15:13:31 +0100 | [diff] [blame] | 82 | bool verify_checksum) |
| 83 | { |
Igor Mammedov | 4b14d54 | 2019-05-02 16:51:50 +0200 | [diff] [blame] | 84 | uint32_t len; |
| 85 | uint64_t addr = 0; |
Igor Mammedov | acee774 | 2018-12-27 15:13:31 +0100 | [diff] [blame] | 86 | |
Igor Mammedov | 4b14d54 | 2019-05-02 16:51:50 +0200 | [diff] [blame] | 87 | g_assert(addr_size == 4 || addr_size == 8); |
| 88 | memcpy(&addr, addr_ptr , addr_size); |
| 89 | addr = le64_to_cpu(addr); |
Igor Mammedov | acee774 | 2018-12-27 15:13:31 +0100 | [diff] [blame] | 90 | qtest_memread(qts, addr + 4, &len, 4); /* Length of ACPI table */ |
| 91 | *aml_len = le32_to_cpu(len); |
| 92 | *aml = g_malloc0(*aml_len); |
| 93 | /* get whole table */ |
| 94 | qtest_memread(qts, addr, *aml, *aml_len); |
| 95 | |
| 96 | if (sig) { |
| 97 | ACPI_ASSERT_CMP(**aml, sig); |
| 98 | } |
| 99 | if (verify_checksum) { |
Igor Mammedov | 685db13 | 2021-09-02 07:35:37 -0400 | [diff] [blame] | 100 | if (acpi_calc_checksum(*aml, *aml_len)) { |
| 101 | gint fd, ret; |
| 102 | char *fname = NULL; |
| 103 | GError *error = NULL; |
| 104 | |
| 105 | fprintf(stderr, "Invalid '%.4s'(%d)\n", *aml, *aml_len); |
| 106 | fd = g_file_open_tmp("malformed-XXXXXX.dat", &fname, &error); |
| 107 | g_assert_no_error(error); |
| 108 | fprintf(stderr, "Dumping invalid table into '%s'\n", fname); |
| 109 | ret = qemu_write_full(fd, *aml, *aml_len); |
| 110 | g_assert(ret == *aml_len); |
| 111 | close(fd); |
| 112 | g_free(fname); |
| 113 | } |
Igor Mammedov | acee774 | 2018-12-27 15:13:31 +0100 | [diff] [blame] | 114 | g_assert(!acpi_calc_checksum(*aml, *aml_len)); |
| 115 | } |
| 116 | } |
Igor Mammedov | a37d547 | 2019-05-02 16:51:56 +0200 | [diff] [blame] | 117 | |
| 118 | #define GUID_SIZE 16 |
| 119 | static const uint8_t AcpiTestSupportGuid[GUID_SIZE] = { |
| 120 | 0xb1, 0xa6, 0x87, 0xab, |
| 121 | 0x34, 0x20, |
| 122 | 0xa0, 0xbd, |
| 123 | 0x71, 0xbd, 0x37, 0x50, 0x07, 0x75, 0x77, 0x85 }; |
| 124 | |
| 125 | typedef struct { |
| 126 | uint8_t signature_guid[GUID_SIZE]; |
| 127 | uint64_t rsdp10; |
| 128 | uint64_t rsdp20; |
| 129 | } __attribute__((packed)) UefiTestSupport; |
| 130 | |
| 131 | /* Wait at most 600 seconds (test is slow with TCG and --enable-debug) */ |
| 132 | #define TEST_DELAY (1 * G_USEC_PER_SEC / 10) |
| 133 | #define TEST_CYCLES MAX((600 * G_USEC_PER_SEC / TEST_DELAY), 1) |
| 134 | #define MB 0x100000ULL |
| 135 | uint64_t acpi_find_rsdp_address_uefi(QTestState *qts, uint64_t start, |
| 136 | uint64_t size) |
| 137 | { |
| 138 | int i, j; |
| 139 | uint8_t data[GUID_SIZE]; |
| 140 | |
| 141 | for (i = 0; i < TEST_CYCLES; ++i) { |
| 142 | for (j = 0; j < size / MB; j++) { |
| 143 | /* look for GUID at every 1Mb block */ |
| 144 | uint64_t addr = start + j * MB; |
| 145 | |
| 146 | qtest_memread(qts, addr, data, sizeof(data)); |
| 147 | if (!memcmp(AcpiTestSupportGuid, data, sizeof(data))) { |
| 148 | UefiTestSupport ret; |
| 149 | |
| 150 | qtest_memread(qts, addr, &ret, sizeof(ret)); |
| 151 | ret.rsdp10 = le64_to_cpu(ret.rsdp10); |
| 152 | ret.rsdp20 = le64_to_cpu(ret.rsdp20); |
| 153 | return ret.rsdp20 ? ret.rsdp20 : ret.rsdp10; |
| 154 | } |
| 155 | } |
| 156 | g_usleep(TEST_DELAY); |
| 157 | } |
| 158 | g_assert_not_reached(); |
Igor Mammedov | a37d547 | 2019-05-02 16:51:56 +0200 | [diff] [blame] | 159 | } |