tests/qtest/acpi-utils.c

   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>
  17 #include "qemu-common.h"
  18 #include "qemu/bitmap.h"
  19 #include "acpi-utils.h"
  20 #include "boot-sector.h"
  21
  22 uint8_t acpi_calc_checksum(const uint8_t *data, int len)
  23 {
  24     int i;
  25     uint8_t sum = 0;
  26
  27     for (i = 0; i < len; i++) {
  28         sum += data[i];
  29     }
  30
  31     return sum;
  32 }
  33
  34 uint32_t acpi_find_rsdp_address(QTestState *qts)
  35 {
  36     uint32_t off;
  37
  38     /* RSDP location can vary across a narrow range */
  39     for (off = 0xf0000; off < 0x100000; off += 0x10) {
  40         uint8_t sig[] = "RSD PTR ";
  41         int i;
  42
  43         for (i = 0; i < sizeof sig - 1; ++i) {
  44             sig[i] = qtest_readb(qts, off + i);
  45         }
  46
  47         if (!memcmp(sig, "RSD PTR ", sizeof sig)) {
  48             break;
  49         }
  50     }
  51     return off;
  52 }
  53
  54 void acpi_fetch_rsdp_table(QTestState *qts, uint64_t addr, uint8_t *rsdp_table)
  55 {
  56     uint8_t revision;
  57
  58     /* Read mandatory revision 0 table data (20 bytes) first */
  59     qtest_memread(qts, addr, rsdp_table, 20);
  60     revision = rsdp_table[15 /* Revision offset */];
  61
  62     switch (revision) {
  63     case 0: /* ACPI 1.0 RSDP */
  64         break;
  65     case 2: /* ACPI 2.0+ RSDP */
  66         /* Read the rest of the RSDP table */
  67         qtest_memread(qts, addr + 20, rsdp_table + 20, 16);
  68         break;
  69     default:
  70         g_assert_not_reached();
  71     }
  72
  73     ACPI_ASSERT_CMP64(*((uint64_t *)(rsdp_table)), "RSD PTR ");
  74 }
  75
  76 /** acpi_fetch_table
  77  *  load ACPI table at @addr_ptr offset pointer into buffer and return it in
  78  *  @aml, its length in @aml_len and check that signature/checksum matches
  79  *  actual one.
  80  */
  81 void acpi_fetch_table(QTestState *qts, uint8_t **aml, uint32_t *aml_len,
  82                       const uint8_t *addr_ptr, int addr_size, const char *sig,
  83                       bool verify_checksum)
  84 {
  85     uint32_t len;
  86     uint64_t addr = 0;
  87
  88     g_assert(addr_size == 4 || addr_size == 8);
  89     memcpy(&addr, addr_ptr , addr_size);
  90     addr = le64_to_cpu(addr);
  91     qtest_memread(qts, addr + 4, &len, 4); /* Length of ACPI table */
  92     *aml_len = le32_to_cpu(len);
  93     *aml = g_malloc0(*aml_len);
  94     /* get whole table */
  95     qtest_memread(qts, addr, *aml, *aml_len);
  96
  97     if (sig) {
  98         ACPI_ASSERT_CMP(**aml, sig);
  99     }
 100     if (verify_checksum) {
 101         g_assert(!acpi_calc_checksum(*aml, *aml_len));
 102     }
 103 }
 104
 105 #define GUID_SIZE 16
 106 static const uint8_t AcpiTestSupportGuid[GUID_SIZE] = {
 107        0xb1, 0xa6, 0x87, 0xab,
 108        0x34, 0x20,
 109        0xa0, 0xbd,
 110        0x71, 0xbd, 0x37, 0x50, 0x07, 0x75, 0x77, 0x85 };
 111
 112 typedef struct {
 113     uint8_t signature_guid[GUID_SIZE];
 114     uint64_t rsdp10;
 115     uint64_t rsdp20;
 116 } __attribute__((packed)) UefiTestSupport;
 117
 118 /* Wait at most 600 seconds (test is slow with TCG and --enable-debug) */
 119 #define TEST_DELAY (1 * G_USEC_PER_SEC / 10)
 120 #define TEST_CYCLES MAX((600 * G_USEC_PER_SEC / TEST_DELAY), 1)
 121 #define MB 0x100000ULL
 122 uint64_t acpi_find_rsdp_address_uefi(QTestState *qts, uint64_t start,
 123                                      uint64_t size)
 124 {
 125     int i, j;
 126     uint8_t data[GUID_SIZE];
 127
 128     for (i = 0; i < TEST_CYCLES; ++i) {
 129         for (j = 0; j < size / MB; j++) {
 130             /* look for GUID at every 1Mb block */
 131             uint64_t addr = start + j * MB;
 132
 133             qtest_memread(qts, addr, data, sizeof(data));
 134             if (!memcmp(AcpiTestSupportGuid, data, sizeof(data))) {
 135                 UefiTestSupport ret;
 136
 137                 qtest_memread(qts, addr, &ret, sizeof(ret));
 138                 ret.rsdp10 = le64_to_cpu(ret.rsdp10);
 139                 ret.rsdp20 = le64_to_cpu(ret.rsdp20);
 140                 return ret.rsdp20 ? ret.rsdp20 : ret.rsdp10;
 141             }
 142         }
 143         g_usleep(TEST_DELAY);
 144     }
 145     g_assert_not_reached();
 146     return 0;
 147 }