pc-bios/bios-pq/0011_read-additional-acpi-tables-from-a-vm.patch

   1 Read additional ACPI tables from a VM (Gleb Natapov)
   2
   3 Signed-off-by: Gleb Natapov <gleb@redhat.com>
   4 Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
   5
   6 diff --git a/bios/rombios32.c b/bios/rombios32.c
   7 index 27c5952..7be4216 100644
   8 --- a/bios/rombios32.c
   9 +++ b/bios/rombios32.c
  10 @@ -469,6 +469,8 @@ void wrmsr_smp(uint32_t index, uint64_t val)
  11  #define QEMU_CFG_SIGNATURE  0x00
  12  #define QEMU_CFG_ID         0x01
  13  #define QEMU_CFG_UUID       0x02
  14 +#define QEMU_CFG_ARCH_LOCAL     0x8000
  15 +#define QEMU_CFG_ACPI_TABLES  (QEMU_CFG_ARCH_LOCAL + 0)
  16
  17  int qemu_cfg_port;
  18
  19 @@ -496,6 +498,27 @@ void qemu_cfg_read(uint8_t *buf, int len)
  20      while (len--)
  21          *(buf++) = inb(QEMU_CFG_DATA_PORT);
  22  }
  23 +
  24 +static uint16_t acpi_additional_tables(void)
  25 +{
  26 +    uint16_t cnt;
  27 +
  28 +    qemu_cfg_select(QEMU_CFG_ACPI_TABLES);
  29 +    qemu_cfg_read((uint8_t*)&cnt, sizeof(cnt));
  30 +
  31 +    return cnt;
  32 +}
  33 +
  34 +static int acpi_load_table(int i, uint32_t addr, uint16_t *len)
  35 +{
  36 +    qemu_cfg_read((uint8_t*)len, sizeof(*len));
  37 +
  38 +    if (!*len)
  39 +        return -1;
  40 +
  41 +    qemu_cfg_read((uint8_t*)addr, *len);
  42 +    return 0;
  43 +}
  44  #endif
  45
  46  void uuid_probe(void)
  47 @@ -1550,8 +1573,8 @@ void acpi_bios_init(void)
  48      uint32_t hpet_addr;
  49  #endif
  50      uint32_t base_addr, rsdt_addr, fadt_addr, addr, facs_addr, dsdt_addr, ssdt_addr;
  51 -    uint32_t acpi_tables_size, madt_addr, madt_size;
  52 -    int i;
  53 +    uint32_t acpi_tables_size, madt_addr, madt_size, rsdt_size;
  54 +    uint16_t i, external_tables;
  55
  56      /* reserve memory space for tables */
  57  #ifdef BX_USE_EBDA_TABLES
  58 @@ -1564,10 +1587,17 @@ void acpi_bios_init(void)
  59      bios_table_cur_addr += sizeof(*rsdp);
  60  #endif
  61
  62 +#ifdef BX_QEMU
  63 +    external_tables = acpi_additional_tables();
  64 +#else
  65 +    external_tables = 0;
  66 +#endif
  67 +
  68      addr = base_addr = ram_size - ACPI_DATA_SIZE;
  69      rsdt_addr = addr;
  70      rsdt = (void *)(addr);
  71 -    addr += sizeof(*rsdt);
  72 +    rsdt_size = sizeof(*rsdt) + external_tables * 4;
  73 +    addr += rsdt_size;
  74
  75      fadt_addr = addr;
  76      fadt = (void *)(addr);
  77 @@ -1606,12 +1636,6 @@ void acpi_bios_init(void)
  78      addr += sizeof(*hpet);
  79  #endif
  80
  81 -    acpi_tables_size = addr - base_addr;
  82 -
  83 -    BX_INFO("ACPI tables: RSDP addr=0x%08lx ACPI DATA addr=0x%08lx size=0x%x\n",
  84 -            (unsigned long)rsdp,
  85 -            (unsigned long)rsdt, acpi_tables_size);
  86 -
  87      /* RSDP */
  88      memset(rsdp, 0, sizeof(*rsdp));
  89      memcpy(rsdp->signature, "RSD PTR ", 8);
  90 @@ -1623,17 +1647,6 @@ void acpi_bios_init(void)
  91      rsdp->rsdt_physical_address = cpu_to_le32(rsdt_addr);
  92      rsdp->checksum = acpi_checksum((void *)rsdp, 20);
  93
  94 -    /* RSDT */
  95 -    memset(rsdt, 0, sizeof(*rsdt));
  96 -    rsdt->table_offset_entry[0] = cpu_to_le32(fadt_addr);
  97 -    rsdt->table_offset_entry[1] = cpu_to_le32(madt_addr);
  98 -    rsdt->table_offset_entry[2] = cpu_to_le32(ssdt_addr);
  99 -#ifdef BX_QEMU
 100 -    rsdt->table_offset_entry[3] = cpu_to_le32(hpet_addr);
 101 -#endif
 102 -    acpi_build_table_header((struct acpi_table_header *)rsdt,
 103 -                            "RSDT", sizeof(*rsdt), 1);
 104 -
 105      /* FADT */
 106      memset(fadt, 0, sizeof(*fadt));
 107      fadt->firmware_ctrl = cpu_to_le32(facs_addr);
 108 @@ -1710,6 +1723,7 @@ void acpi_bios_init(void)
 109                                  "APIC", madt_size, 1);
 110      }
 111
 112 +    memset(rsdt, 0, rsdt_size);
 113  #ifdef BX_QEMU
 114      /* HPET */
 115      memset(hpet, 0, sizeof(*hpet));
 116 @@ -1720,7 +1734,34 @@ void acpi_bios_init(void)
 117      hpet->addr.address = cpu_to_le32(ACPI_HPET_ADDRESS);
 118      acpi_build_table_header((struct  acpi_table_header *)hpet,
 119                               "HPET", sizeof(*hpet), 1);
 120 +
 121 +    acpi_additional_tables(); /* resets cfg to required entry */
 122 +    for(i = 0; i < external_tables; i++) {
 123 +        uint16_t len;
 124 +        if(acpi_load_table(i, addr, &len) < 0)
 125 +            BX_PANIC("Failed to load ACPI table from QEMU\n");
 126 +        rsdt->table_offset_entry[i+4] = cpu_to_le32(addr);
 127 +        addr += len;
 128 +        if(addr >= ram_size)
 129 +            BX_PANIC("ACPI table overflow\n");
 130 +    }
 131 +#endif
 132 +
 133 +    /* RSDT */
 134 +    rsdt->table_offset_entry[0] = cpu_to_le32(fadt_addr);
 135 +    rsdt->table_offset_entry[1] = cpu_to_le32(madt_addr);
 136 +    rsdt->table_offset_entry[2] = cpu_to_le32(ssdt_addr);
 137 +#ifdef BX_QEMU
 138 +    rsdt->table_offset_entry[3] = cpu_to_le32(hpet_addr);
 139  #endif
 140 +    acpi_build_table_header((struct acpi_table_header *)rsdt,
 141 +                            "RSDT", rsdt_size, 1);
 142 +
 143 +    acpi_tables_size = addr - base_addr;
 144 +
 145 +    BX_INFO("ACPI tables: RSDP addr=0x%08lx ACPI DATA addr=0x%08lx size=0x%x\n",
 146 +            (unsigned long)rsdp,
 147 +            (unsigned long)rsdt, acpi_tables_size);
 148
 149  }
 150