 d4e5de1ae0
			
		
	
	
		d4e5de1ae0
		
	
	
	
	
		
			
			Add PCIe controller in ACPI DSDT table, so the guest can detect the PCIe. Signed-off-by: Shannon Zhao <zhaoshenglong@huawei.com> Signed-off-by: Shannon Zhao <shannon.zhao@linaro.org> Message-id: 1432522520-8068-23-git-send-email-zhaoshenglong@huawei.com Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
		
			
				
	
	
		
			645 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			645 lines
		
	
	
		
			22 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /* Support for generating ACPI tables and passing them to Guests
 | |
|  *
 | |
|  * ARM virt ACPI generation
 | |
|  *
 | |
|  * Copyright (C) 2008-2010  Kevin O'Connor <kevin@koconnor.net>
 | |
|  * Copyright (C) 2006 Fabrice Bellard
 | |
|  * Copyright (C) 2013 Red Hat Inc
 | |
|  *
 | |
|  * Author: Michael S. Tsirkin <mst@redhat.com>
 | |
|  *
 | |
|  * Copyright (c) 2015 HUAWEI TECHNOLOGIES CO.,LTD.
 | |
|  *
 | |
|  * Author: Shannon Zhao <zhaoshenglong@huawei.com>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License as published by
 | |
|  * the Free Software Foundation; either version 2 of the License, or
 | |
|  * (at your option) any later version.
 | |
| 
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
| 
 | |
|  * You should have received a copy of the GNU General Public License along
 | |
|  * with this program; if not, see <http://www.gnu.org/licenses/>.
 | |
|  */
 | |
| 
 | |
| #include "qemu-common.h"
 | |
| #include "hw/arm/virt-acpi-build.h"
 | |
| #include "qemu/bitmap.h"
 | |
| #include "trace.h"
 | |
| #include "qom/cpu.h"
 | |
| #include "target-arm/cpu.h"
 | |
| #include "hw/acpi/acpi-defs.h"
 | |
| #include "hw/acpi/acpi.h"
 | |
| #include "hw/nvram/fw_cfg.h"
 | |
| #include "hw/acpi/bios-linker-loader.h"
 | |
| #include "hw/loader.h"
 | |
| #include "hw/hw.h"
 | |
| #include "hw/acpi/aml-build.h"
 | |
| #include "hw/pci/pcie_host.h"
 | |
| #include "hw/pci/pci.h"
 | |
| 
 | |
| #define ARM_SPI_BASE 32
 | |
| 
 | |
| typedef struct VirtAcpiCpuInfo {
 | |
|     DECLARE_BITMAP(found_cpus, VIRT_ACPI_CPU_ID_LIMIT);
 | |
| } VirtAcpiCpuInfo;
 | |
| 
 | |
| static void virt_acpi_get_cpu_info(VirtAcpiCpuInfo *cpuinfo)
 | |
| {
 | |
|     CPUState *cpu;
 | |
| 
 | |
|     memset(cpuinfo->found_cpus, 0, sizeof cpuinfo->found_cpus);
 | |
|     CPU_FOREACH(cpu) {
 | |
|         set_bit(cpu->cpu_index, cpuinfo->found_cpus);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_cpus(Aml *scope, int smp_cpus)
 | |
| {
 | |
|     uint16_t i;
 | |
| 
 | |
|     for (i = 0; i < smp_cpus; i++) {
 | |
|         Aml *dev = aml_device("C%03x", i);
 | |
|         aml_append(dev, aml_name_decl("_HID", aml_string("ACPI0007")));
 | |
|         aml_append(dev, aml_name_decl("_UID", aml_int(i)));
 | |
|         aml_append(scope, dev);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_uart(Aml *scope, const MemMapEntry *uart_memmap,
 | |
|                                            int uart_irq)
 | |
| {
 | |
|     Aml *dev = aml_device("COM0");
 | |
|     aml_append(dev, aml_name_decl("_HID", aml_string("ARMH0011")));
 | |
|     aml_append(dev, aml_name_decl("_UID", aml_int(0)));
 | |
| 
 | |
|     Aml *crs = aml_resource_template();
 | |
|     aml_append(crs, aml_memory32_fixed(uart_memmap->base,
 | |
|                                        uart_memmap->size, AML_READ_WRITE));
 | |
|     aml_append(crs,
 | |
|                aml_interrupt(AML_CONSUMER, AML_LEVEL, AML_ACTIVE_HIGH,
 | |
|                              AML_EXCLUSIVE, uart_irq));
 | |
|     aml_append(dev, aml_name_decl("_CRS", crs));
 | |
|     aml_append(scope, dev);
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_rtc(Aml *scope, const MemMapEntry *rtc_memmap,
 | |
|                                           int rtc_irq)
 | |
| {
 | |
|     Aml *dev = aml_device("RTC0");
 | |
|     aml_append(dev, aml_name_decl("_HID", aml_string("LNRO0013")));
 | |
|     aml_append(dev, aml_name_decl("_UID", aml_int(0)));
 | |
| 
 | |
|     Aml *crs = aml_resource_template();
 | |
|     aml_append(crs, aml_memory32_fixed(rtc_memmap->base,
 | |
|                                        rtc_memmap->size, AML_READ_WRITE));
 | |
|     aml_append(crs,
 | |
|                aml_interrupt(AML_CONSUMER, AML_LEVEL, AML_ACTIVE_HIGH,
 | |
|                              AML_EXCLUSIVE, rtc_irq));
 | |
|     aml_append(dev, aml_name_decl("_CRS", crs));
 | |
|     aml_append(scope, dev);
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_flash(Aml *scope, const MemMapEntry *flash_memmap)
 | |
| {
 | |
|     Aml *dev, *crs;
 | |
|     hwaddr base = flash_memmap->base;
 | |
|     hwaddr size = flash_memmap->size;
 | |
| 
 | |
|     dev = aml_device("FLS0");
 | |
|     aml_append(dev, aml_name_decl("_HID", aml_string("LNRO0015")));
 | |
|     aml_append(dev, aml_name_decl("_UID", aml_int(0)));
 | |
| 
 | |
|     crs = aml_resource_template();
 | |
|     aml_append(crs, aml_memory32_fixed(base, size, AML_READ_WRITE));
 | |
|     aml_append(dev, aml_name_decl("_CRS", crs));
 | |
|     aml_append(scope, dev);
 | |
| 
 | |
|     dev = aml_device("FLS1");
 | |
|     aml_append(dev, aml_name_decl("_HID", aml_string("LNRO0015")));
 | |
|     aml_append(dev, aml_name_decl("_UID", aml_int(1)));
 | |
|     crs = aml_resource_template();
 | |
|     aml_append(crs, aml_memory32_fixed(base + size, size, AML_READ_WRITE));
 | |
|     aml_append(dev, aml_name_decl("_CRS", crs));
 | |
|     aml_append(scope, dev);
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_virtio(Aml *scope,
 | |
|                                  const MemMapEntry *virtio_mmio_memmap,
 | |
|                                  int mmio_irq, int num)
 | |
| {
 | |
|     hwaddr base = virtio_mmio_memmap->base;
 | |
|     hwaddr size = virtio_mmio_memmap->size;
 | |
|     int irq = mmio_irq;
 | |
|     int i;
 | |
| 
 | |
|     for (i = 0; i < num; i++) {
 | |
|         Aml *dev = aml_device("VR%02u", i);
 | |
|         aml_append(dev, aml_name_decl("_HID", aml_string("LNRO0005")));
 | |
|         aml_append(dev, aml_name_decl("_UID", aml_int(i)));
 | |
| 
 | |
|         Aml *crs = aml_resource_template();
 | |
|         aml_append(crs, aml_memory32_fixed(base, size, AML_READ_WRITE));
 | |
|         aml_append(crs,
 | |
|                    aml_interrupt(AML_CONSUMER, AML_LEVEL, AML_ACTIVE_HIGH,
 | |
|                                  AML_EXCLUSIVE, irq + i));
 | |
|         aml_append(dev, aml_name_decl("_CRS", crs));
 | |
|         aml_append(scope, dev);
 | |
|         base += size;
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void acpi_dsdt_add_pci(Aml *scope, const MemMapEntry *memmap, int irq)
 | |
| {
 | |
|     Aml *method, *crs, *ifctx, *UUID, *ifctx1, *elsectx, *buf;
 | |
|     int i, bus_no;
 | |
|     hwaddr base_mmio = memmap[VIRT_PCIE_MMIO].base;
 | |
|     hwaddr size_mmio = memmap[VIRT_PCIE_MMIO].size;
 | |
|     hwaddr base_pio = memmap[VIRT_PCIE_PIO].base;
 | |
|     hwaddr size_pio = memmap[VIRT_PCIE_PIO].size;
 | |
|     hwaddr base_ecam = memmap[VIRT_PCIE_ECAM].base;
 | |
|     hwaddr size_ecam = memmap[VIRT_PCIE_ECAM].size;
 | |
|     int nr_pcie_buses = size_ecam / PCIE_MMCFG_SIZE_MIN;
 | |
| 
 | |
|     Aml *dev = aml_device("%s", "PCI0");
 | |
|     aml_append(dev, aml_name_decl("_HID", aml_string("PNP0A08")));
 | |
|     aml_append(dev, aml_name_decl("_CID", aml_string("PNP0A03")));
 | |
|     aml_append(dev, aml_name_decl("_SEG", aml_int(0)));
 | |
|     aml_append(dev, aml_name_decl("_BBN", aml_int(0)));
 | |
|     aml_append(dev, aml_name_decl("_ADR", aml_int(0)));
 | |
|     aml_append(dev, aml_name_decl("_UID", aml_string("PCI0")));
 | |
|     aml_append(dev, aml_name_decl("_STR", aml_unicode("PCIe 0 Device")));
 | |
| 
 | |
|     /* Declare the PCI Routing Table. */
 | |
|     Aml *rt_pkg = aml_package(nr_pcie_buses * PCI_NUM_PINS);
 | |
|     for (bus_no = 0; bus_no < nr_pcie_buses; bus_no++) {
 | |
|         for (i = 0; i < PCI_NUM_PINS; i++) {
 | |
|             int gsi = (i + bus_no) % PCI_NUM_PINS;
 | |
|             Aml *pkg = aml_package(4);
 | |
|             aml_append(pkg, aml_int((bus_no << 16) | 0xFFFF));
 | |
|             aml_append(pkg, aml_int(i));
 | |
|             aml_append(pkg, aml_name("GSI%d", gsi));
 | |
|             aml_append(pkg, aml_int(0));
 | |
|             aml_append(rt_pkg, pkg);
 | |
|         }
 | |
|     }
 | |
|     aml_append(dev, aml_name_decl("_PRT", rt_pkg));
 | |
| 
 | |
|     /* Create GSI link device */
 | |
|     for (i = 0; i < PCI_NUM_PINS; i++) {
 | |
|         Aml *dev_gsi = aml_device("GSI%d", i);
 | |
|         aml_append(dev_gsi, aml_name_decl("_HID", aml_string("PNP0C0F")));
 | |
|         aml_append(dev_gsi, aml_name_decl("_UID", aml_int(0)));
 | |
|         crs = aml_resource_template();
 | |
|         aml_append(crs,
 | |
|                    aml_interrupt(AML_CONSUMER, AML_LEVEL, AML_ACTIVE_HIGH,
 | |
|                                  AML_EXCLUSIVE, irq + i));
 | |
|         aml_append(dev_gsi, aml_name_decl("_PRS", crs));
 | |
|         crs = aml_resource_template();
 | |
|         aml_append(crs,
 | |
|                    aml_interrupt(AML_CONSUMER, AML_LEVEL, AML_ACTIVE_HIGH,
 | |
|                                  AML_EXCLUSIVE, irq + i));
 | |
|         aml_append(dev_gsi, aml_name_decl("_CRS", crs));
 | |
|         method = aml_method("_SRS", 1);
 | |
|         aml_append(dev_gsi, method);
 | |
|         aml_append(dev, dev_gsi);
 | |
|     }
 | |
| 
 | |
|     method = aml_method("_CBA", 0);
 | |
|     aml_append(method, aml_return(aml_int(base_ecam)));
 | |
|     aml_append(dev, method);
 | |
| 
 | |
|     method = aml_method("_CRS", 0);
 | |
|     Aml *rbuf = aml_resource_template();
 | |
|     aml_append(rbuf,
 | |
|         aml_word_bus_number(AML_MIN_FIXED, AML_MAX_FIXED, AML_POS_DECODE,
 | |
|                             0x0000, 0x0000, nr_pcie_buses - 1, 0x0000,
 | |
|                             nr_pcie_buses));
 | |
|     aml_append(rbuf,
 | |
|         aml_dword_memory(AML_POS_DECODE, AML_MIN_FIXED, AML_MAX_FIXED,
 | |
|                          AML_NON_CACHEABLE, AML_READ_WRITE, 0x0000, base_mmio,
 | |
|                          base_mmio + size_mmio - 1, 0x0000, size_mmio));
 | |
|     aml_append(rbuf,
 | |
|         aml_dword_io(AML_MIN_FIXED, AML_MAX_FIXED, AML_POS_DECODE,
 | |
|                      AML_ENTIRE_RANGE, 0x0000, 0x0000, size_pio - 1, base_pio,
 | |
|                      size_pio));
 | |
| 
 | |
|     aml_append(method, aml_name_decl("RBUF", rbuf));
 | |
|     aml_append(method, aml_return(rbuf));
 | |
|     aml_append(dev, method);
 | |
| 
 | |
|     /* Declare an _OSC (OS Control Handoff) method */
 | |
|     aml_append(dev, aml_name_decl("SUPP", aml_int(0)));
 | |
|     aml_append(dev, aml_name_decl("CTRL", aml_int(0)));
 | |
|     method = aml_method("_OSC", 4);
 | |
|     aml_append(method,
 | |
|         aml_create_dword_field(aml_arg(3), aml_int(0), "CDW1"));
 | |
| 
 | |
|     /* PCI Firmware Specification 3.0
 | |
|      * 4.5.1. _OSC Interface for PCI Host Bridge Devices
 | |
|      * The _OSC interface for a PCI/PCI-X/PCI Express hierarchy is
 | |
|      * identified by the Universal Unique IDentifier (UUID)
 | |
|      * 33DB4D5B-1FF7-401C-9657-7441C03DD766
 | |
|      */
 | |
|     UUID = aml_touuid("33DB4D5B-1FF7-401C-9657-7441C03DD766");
 | |
|     ifctx = aml_if(aml_equal(aml_arg(0), UUID));
 | |
|     aml_append(ifctx,
 | |
|         aml_create_dword_field(aml_arg(3), aml_int(4), "CDW2"));
 | |
|     aml_append(ifctx,
 | |
|         aml_create_dword_field(aml_arg(3), aml_int(8), "CDW3"));
 | |
|     aml_append(ifctx, aml_store(aml_name("CDW2"), aml_name("SUPP")));
 | |
|     aml_append(ifctx, aml_store(aml_name("CDW3"), aml_name("CTRL")));
 | |
|     aml_append(ifctx, aml_store(aml_and(aml_name("CTRL"), aml_int(0x1D)),
 | |
|                                 aml_name("CTRL")));
 | |
| 
 | |
|     ifctx1 = aml_if(aml_lnot(aml_equal(aml_arg(1), aml_int(0x1))));
 | |
|     aml_append(ifctx1, aml_store(aml_or(aml_name("CDW1"), aml_int(0x08)),
 | |
|                                  aml_name("CDW1")));
 | |
|     aml_append(ifctx, ifctx1);
 | |
| 
 | |
|     ifctx1 = aml_if(aml_lnot(aml_equal(aml_name("CDW3"), aml_name("CTRL"))));
 | |
|     aml_append(ifctx1, aml_store(aml_or(aml_name("CDW1"), aml_int(0x10)),
 | |
|                                  aml_name("CDW1")));
 | |
|     aml_append(ifctx, ifctx1);
 | |
| 
 | |
|     aml_append(ifctx, aml_store(aml_name("CTRL"), aml_name("CDW3")));
 | |
|     aml_append(ifctx, aml_return(aml_arg(3)));
 | |
|     aml_append(method, ifctx);
 | |
| 
 | |
|     elsectx = aml_else();
 | |
|     aml_append(elsectx, aml_store(aml_or(aml_name("CDW1"), aml_int(4)),
 | |
|                                   aml_name("CDW1")));
 | |
|     aml_append(elsectx, aml_return(aml_arg(3)));
 | |
|     aml_append(method, elsectx);
 | |
|     aml_append(dev, method);
 | |
| 
 | |
|     method = aml_method("_DSM", 4);
 | |
| 
 | |
|     /* PCI Firmware Specification 3.0
 | |
|      * 4.6.1. _DSM for PCI Express Slot Information
 | |
|      * The UUID in _DSM in this context is
 | |
|      * {E5C937D0-3553-4D7A-9117-EA4D19C3434D}
 | |
|      */
 | |
|     UUID = aml_touuid("E5C937D0-3553-4D7A-9117-EA4D19C3434D");
 | |
|     ifctx = aml_if(aml_equal(aml_arg(0), UUID));
 | |
|     ifctx1 = aml_if(aml_equal(aml_arg(2), aml_int(0)));
 | |
|     uint8_t byte_list[1] = {1};
 | |
|     buf = aml_buffer(1, byte_list);
 | |
|     aml_append(ifctx1, aml_return(buf));
 | |
|     aml_append(ifctx, ifctx1);
 | |
|     aml_append(method, ifctx);
 | |
| 
 | |
|     byte_list[0] = 0;
 | |
|     buf = aml_buffer(1, byte_list);
 | |
|     aml_append(method, aml_return(buf));
 | |
|     aml_append(dev, method);
 | |
| 
 | |
|     Aml *dev_rp0 = aml_device("%s", "RP0");
 | |
|     aml_append(dev_rp0, aml_name_decl("_ADR", aml_int(0)));
 | |
|     aml_append(dev, dev_rp0);
 | |
|     aml_append(scope, dev);
 | |
| }
 | |
| 
 | |
| /* RSDP */
 | |
| static GArray *
 | |
| build_rsdp(GArray *rsdp_table, GArray *linker, unsigned rsdt)
 | |
| {
 | |
|     AcpiRsdpDescriptor *rsdp = acpi_data_push(rsdp_table, sizeof *rsdp);
 | |
| 
 | |
|     bios_linker_loader_alloc(linker, ACPI_BUILD_RSDP_FILE, 16,
 | |
|                              true /* fseg memory */);
 | |
| 
 | |
|     memcpy(&rsdp->signature, "RSD PTR ", sizeof(rsdp->signature));
 | |
|     memcpy(rsdp->oem_id, ACPI_BUILD_APPNAME6, sizeof(rsdp->oem_id));
 | |
|     rsdp->length = cpu_to_le32(sizeof(*rsdp));
 | |
|     rsdp->revision = 0x02;
 | |
| 
 | |
|     /* Point to RSDT */
 | |
|     rsdp->rsdt_physical_address = cpu_to_le32(rsdt);
 | |
|     /* Address to be filled by Guest linker */
 | |
|     bios_linker_loader_add_pointer(linker, ACPI_BUILD_RSDP_FILE,
 | |
|                                    ACPI_BUILD_TABLE_FILE,
 | |
|                                    rsdp_table, &rsdp->rsdt_physical_address,
 | |
|                                    sizeof rsdp->rsdt_physical_address);
 | |
|     rsdp->checksum = 0;
 | |
|     /* Checksum to be filled by Guest linker */
 | |
|     bios_linker_loader_add_checksum(linker, ACPI_BUILD_RSDP_FILE,
 | |
|                                     rsdp, rsdp, sizeof *rsdp, &rsdp->checksum);
 | |
| 
 | |
|     return rsdp_table;
 | |
| }
 | |
| 
 | |
| static void
 | |
| build_mcfg(GArray *table_data, GArray *linker, VirtGuestInfo *guest_info)
 | |
| {
 | |
|     AcpiTableMcfg *mcfg;
 | |
|     const MemMapEntry *memmap = guest_info->memmap;
 | |
|     int len = sizeof(*mcfg) + sizeof(mcfg->allocation[0]);
 | |
| 
 | |
|     mcfg = acpi_data_push(table_data, len);
 | |
|     mcfg->allocation[0].address = cpu_to_le64(memmap[VIRT_PCIE_ECAM].base);
 | |
| 
 | |
|     /* Only a single allocation so no need to play with segments */
 | |
|     mcfg->allocation[0].pci_segment = cpu_to_le16(0);
 | |
|     mcfg->allocation[0].start_bus_number = 0;
 | |
|     mcfg->allocation[0].end_bus_number = (memmap[VIRT_PCIE_ECAM].size
 | |
|                                           / PCIE_MMCFG_SIZE_MIN) - 1;
 | |
| 
 | |
|     build_header(linker, table_data, (void *)mcfg, "MCFG", len, 5);
 | |
| }
 | |
| 
 | |
| /* GTDT */
 | |
| static void
 | |
| build_gtdt(GArray *table_data, GArray *linker)
 | |
| {
 | |
|     int gtdt_start = table_data->len;
 | |
|     AcpiGenericTimerTable *gtdt;
 | |
| 
 | |
|     gtdt = acpi_data_push(table_data, sizeof *gtdt);
 | |
|     /* The interrupt values are the same with the device tree when adding 16 */
 | |
|     gtdt->secure_el1_interrupt = ARCH_TIMER_S_EL1_IRQ + 16;
 | |
|     gtdt->secure_el1_flags = ACPI_EDGE_SENSITIVE;
 | |
| 
 | |
|     gtdt->non_secure_el1_interrupt = ARCH_TIMER_NS_EL1_IRQ + 16;
 | |
|     gtdt->non_secure_el1_flags = ACPI_EDGE_SENSITIVE;
 | |
| 
 | |
|     gtdt->virtual_timer_interrupt = ARCH_TIMER_VIRT_IRQ + 16;
 | |
|     gtdt->virtual_timer_flags = ACPI_EDGE_SENSITIVE;
 | |
| 
 | |
|     gtdt->non_secure_el2_interrupt = ARCH_TIMER_NS_EL2_IRQ + 16;
 | |
|     gtdt->non_secure_el2_flags = ACPI_EDGE_SENSITIVE;
 | |
| 
 | |
|     build_header(linker, table_data,
 | |
|                  (void *)(table_data->data + gtdt_start), "GTDT",
 | |
|                  table_data->len - gtdt_start, 5);
 | |
| }
 | |
| 
 | |
| /* MADT */
 | |
| static void
 | |
| build_madt(GArray *table_data, GArray *linker, VirtGuestInfo *guest_info,
 | |
|            VirtAcpiCpuInfo *cpuinfo)
 | |
| {
 | |
|     int madt_start = table_data->len;
 | |
|     const MemMapEntry *memmap = guest_info->memmap;
 | |
|     AcpiMultipleApicTable *madt;
 | |
|     AcpiMadtGenericDistributor *gicd;
 | |
|     int i;
 | |
| 
 | |
|     madt = acpi_data_push(table_data, sizeof *madt);
 | |
| 
 | |
|     for (i = 0; i < guest_info->smp_cpus; i++) {
 | |
|         AcpiMadtGenericInterrupt *gicc = acpi_data_push(table_data,
 | |
|                                                      sizeof *gicc);
 | |
|         gicc->type = ACPI_APIC_GENERIC_INTERRUPT;
 | |
|         gicc->length = sizeof(*gicc);
 | |
|         gicc->base_address = memmap[VIRT_GIC_CPU].base;
 | |
|         gicc->cpu_interface_number = i;
 | |
|         gicc->arm_mpidr = i;
 | |
|         gicc->uid = i;
 | |
|         if (test_bit(i, cpuinfo->found_cpus)) {
 | |
|             gicc->flags = cpu_to_le32(ACPI_GICC_ENABLED);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     gicd = acpi_data_push(table_data, sizeof *gicd);
 | |
|     gicd->type = ACPI_APIC_GENERIC_DISTRIBUTOR;
 | |
|     gicd->length = sizeof(*gicd);
 | |
|     gicd->base_address = memmap[VIRT_GIC_DIST].base;
 | |
| 
 | |
|     build_header(linker, table_data,
 | |
|                  (void *)(table_data->data + madt_start), "APIC",
 | |
|                  table_data->len - madt_start, 5);
 | |
| }
 | |
| 
 | |
| /* FADT */
 | |
| static void
 | |
| build_fadt(GArray *table_data, GArray *linker, unsigned dsdt)
 | |
| {
 | |
|     AcpiFadtDescriptorRev5_1 *fadt = acpi_data_push(table_data, sizeof(*fadt));
 | |
| 
 | |
|     /* Hardware Reduced = 1 and use PSCI 0.2+ and with HVC */
 | |
|     fadt->flags = cpu_to_le32(1 << ACPI_FADT_F_HW_REDUCED_ACPI);
 | |
|     fadt->arm_boot_flags = cpu_to_le16((1 << ACPI_FADT_ARM_USE_PSCI_G_0_2) |
 | |
|                                        (1 << ACPI_FADT_ARM_PSCI_USE_HVC));
 | |
| 
 | |
|     /* ACPI v5.1 (fadt->revision.fadt->minor_revision) */
 | |
|     fadt->minor_revision = 0x1;
 | |
| 
 | |
|     fadt->dsdt = cpu_to_le32(dsdt);
 | |
|     /* DSDT address to be filled by Guest linker */
 | |
|     bios_linker_loader_add_pointer(linker, ACPI_BUILD_TABLE_FILE,
 | |
|                                    ACPI_BUILD_TABLE_FILE,
 | |
|                                    table_data, &fadt->dsdt,
 | |
|                                    sizeof fadt->dsdt);
 | |
| 
 | |
|     build_header(linker, table_data,
 | |
|                  (void *)fadt, "FACP", sizeof(*fadt), 5);
 | |
| }
 | |
| 
 | |
| /* DSDT */
 | |
| static void
 | |
| build_dsdt(GArray *table_data, GArray *linker, VirtGuestInfo *guest_info)
 | |
| {
 | |
|     Aml *scope, *dsdt;
 | |
|     const MemMapEntry *memmap = guest_info->memmap;
 | |
|     const int *irqmap = guest_info->irqmap;
 | |
| 
 | |
|     dsdt = init_aml_allocator();
 | |
|     /* Reserve space for header */
 | |
|     acpi_data_push(dsdt->buf, sizeof(AcpiTableHeader));
 | |
| 
 | |
|     scope = aml_scope("\\_SB");
 | |
|     acpi_dsdt_add_cpus(scope, guest_info->smp_cpus);
 | |
|     acpi_dsdt_add_uart(scope, &memmap[VIRT_UART],
 | |
|                        (irqmap[VIRT_UART] + ARM_SPI_BASE));
 | |
|     acpi_dsdt_add_rtc(scope, &memmap[VIRT_RTC],
 | |
|                       (irqmap[VIRT_RTC] + ARM_SPI_BASE));
 | |
|     acpi_dsdt_add_flash(scope, &memmap[VIRT_FLASH]);
 | |
|     acpi_dsdt_add_virtio(scope, &memmap[VIRT_MMIO],
 | |
|                     (irqmap[VIRT_MMIO] + ARM_SPI_BASE), NUM_VIRTIO_TRANSPORTS);
 | |
|     acpi_dsdt_add_pci(scope, memmap, (irqmap[VIRT_PCIE] + ARM_SPI_BASE));
 | |
| 
 | |
|     aml_append(dsdt, scope);
 | |
| 
 | |
|     /* copy AML table into ACPI tables blob and patch header there */
 | |
|     g_array_append_vals(table_data, dsdt->buf->data, dsdt->buf->len);
 | |
|     build_header(linker, table_data,
 | |
|         (void *)(table_data->data + table_data->len - dsdt->buf->len),
 | |
|         "DSDT", dsdt->buf->len, 5);
 | |
|     free_aml_allocator();
 | |
| }
 | |
| 
 | |
| typedef
 | |
| struct AcpiBuildState {
 | |
|     /* Copy of table in RAM (for patching). */
 | |
|     MemoryRegion *table_mr;
 | |
|     MemoryRegion *rsdp_mr;
 | |
|     MemoryRegion *linker_mr;
 | |
|     /* Is table patched? */
 | |
|     bool patched;
 | |
|     VirtGuestInfo *guest_info;
 | |
| } AcpiBuildState;
 | |
| 
 | |
| static
 | |
| void virt_acpi_build(VirtGuestInfo *guest_info, AcpiBuildTables *tables)
 | |
| {
 | |
|     GArray *table_offsets;
 | |
|     unsigned dsdt, rsdt;
 | |
|     VirtAcpiCpuInfo cpuinfo;
 | |
|     GArray *tables_blob = tables->table_data;
 | |
| 
 | |
|     virt_acpi_get_cpu_info(&cpuinfo);
 | |
| 
 | |
|     table_offsets = g_array_new(false, true /* clear */,
 | |
|                                         sizeof(uint32_t));
 | |
| 
 | |
|     bios_linker_loader_alloc(tables->linker, ACPI_BUILD_TABLE_FILE,
 | |
|                              64, false /* high memory */);
 | |
| 
 | |
|     /*
 | |
|      * The ACPI v5.1 tables for Hardware-reduced ACPI platform are:
 | |
|      * RSDP
 | |
|      * RSDT
 | |
|      * FADT
 | |
|      * GTDT
 | |
|      * MADT
 | |
|      * DSDT
 | |
|      */
 | |
| 
 | |
|     /* DSDT is pointed to by FADT */
 | |
|     dsdt = tables_blob->len;
 | |
|     build_dsdt(tables_blob, tables->linker, guest_info);
 | |
| 
 | |
|     /* FADT MADT GTDT pointed to by RSDT */
 | |
|     acpi_add_table(table_offsets, tables_blob);
 | |
|     build_fadt(tables_blob, tables->linker, dsdt);
 | |
| 
 | |
|     acpi_add_table(table_offsets, tables_blob);
 | |
|     build_madt(tables_blob, tables->linker, guest_info, &cpuinfo);
 | |
| 
 | |
|     acpi_add_table(table_offsets, tables_blob);
 | |
|     build_gtdt(tables_blob, tables->linker);
 | |
| 
 | |
|     acpi_add_table(table_offsets, tables_blob);
 | |
|     build_mcfg(tables_blob, tables->linker, guest_info);
 | |
| 
 | |
|     /* RSDT is pointed to by RSDP */
 | |
|     rsdt = tables_blob->len;
 | |
|     build_rsdt(tables_blob, tables->linker, table_offsets);
 | |
| 
 | |
|     /* RSDP is in FSEG memory, so allocate it separately */
 | |
|     build_rsdp(tables->rsdp, tables->linker, rsdt);
 | |
| 
 | |
|     /* Cleanup memory that's no longer used. */
 | |
|     g_array_free(table_offsets, true);
 | |
| }
 | |
| 
 | |
| static void acpi_ram_update(MemoryRegion *mr, GArray *data)
 | |
| {
 | |
|     uint32_t size = acpi_data_len(data);
 | |
| 
 | |
|     /* Make sure RAM size is correct - in case it got changed
 | |
|      * e.g. by migration */
 | |
|     memory_region_ram_resize(mr, size, &error_abort);
 | |
| 
 | |
|     memcpy(memory_region_get_ram_ptr(mr), data->data, size);
 | |
|     memory_region_set_dirty(mr, 0, size);
 | |
| }
 | |
| 
 | |
| static void virt_acpi_build_update(void *build_opaque, uint32_t offset)
 | |
| {
 | |
|     AcpiBuildState *build_state = build_opaque;
 | |
|     AcpiBuildTables tables;
 | |
| 
 | |
|     /* No state to update or already patched? Nothing to do. */
 | |
|     if (!build_state || build_state->patched) {
 | |
|         return;
 | |
|     }
 | |
|     build_state->patched = true;
 | |
| 
 | |
|     acpi_build_tables_init(&tables);
 | |
| 
 | |
|     virt_acpi_build(build_state->guest_info, &tables);
 | |
| 
 | |
|     acpi_ram_update(build_state->table_mr, tables.table_data);
 | |
|     acpi_ram_update(build_state->rsdp_mr, tables.rsdp);
 | |
|     acpi_ram_update(build_state->linker_mr, tables.linker);
 | |
| 
 | |
| 
 | |
|     acpi_build_tables_cleanup(&tables, true);
 | |
| }
 | |
| 
 | |
| static void virt_acpi_build_reset(void *build_opaque)
 | |
| {
 | |
|     AcpiBuildState *build_state = build_opaque;
 | |
|     build_state->patched = false;
 | |
| }
 | |
| 
 | |
| static MemoryRegion *acpi_add_rom_blob(AcpiBuildState *build_state,
 | |
|                                        GArray *blob, const char *name,
 | |
|                                        uint64_t max_size)
 | |
| {
 | |
|     return rom_add_blob(name, blob->data, acpi_data_len(blob), max_size, -1,
 | |
|                         name, virt_acpi_build_update, build_state);
 | |
| }
 | |
| 
 | |
| static const VMStateDescription vmstate_virt_acpi_build = {
 | |
|     .name = "virt_acpi_build",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_BOOL(patched, AcpiBuildState),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     },
 | |
| };
 | |
| 
 | |
| void virt_acpi_setup(VirtGuestInfo *guest_info)
 | |
| {
 | |
|     AcpiBuildTables tables;
 | |
|     AcpiBuildState *build_state;
 | |
| 
 | |
|     if (!guest_info->fw_cfg) {
 | |
|         trace_virt_acpi_setup();
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     if (!acpi_enabled) {
 | |
|         trace_virt_acpi_setup();
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     build_state = g_malloc0(sizeof *build_state);
 | |
|     build_state->guest_info = guest_info;
 | |
| 
 | |
|     acpi_build_tables_init(&tables);
 | |
|     virt_acpi_build(build_state->guest_info, &tables);
 | |
| 
 | |
|     /* Now expose it all to Guest */
 | |
|     build_state->table_mr = acpi_add_rom_blob(build_state, tables.table_data,
 | |
|                                                ACPI_BUILD_TABLE_FILE,
 | |
|                                                ACPI_BUILD_TABLE_MAX_SIZE);
 | |
|     assert(build_state->table_mr != NULL);
 | |
| 
 | |
|     build_state->linker_mr =
 | |
|         acpi_add_rom_blob(build_state, tables.linker, "etc/table-loader", 0);
 | |
| 
 | |
|     fw_cfg_add_file(guest_info->fw_cfg, ACPI_BUILD_TPMLOG_FILE,
 | |
|                     tables.tcpalog->data, acpi_data_len(tables.tcpalog));
 | |
| 
 | |
|     build_state->rsdp_mr = acpi_add_rom_blob(build_state, tables.rsdp,
 | |
|                                               ACPI_BUILD_RSDP_FILE, 0);
 | |
| 
 | |
|     qemu_register_reset(virt_acpi_build_reset, build_state);
 | |
|     virt_acpi_build_reset(build_state);
 | |
|     vmstate_register(NULL, 0, &vmstate_virt_acpi_build, build_state);
 | |
| 
 | |
|     /* Cleanup tables but don't free the memory: we track it
 | |
|      * in build_state.
 | |
|      */
 | |
|     acpi_build_tables_cleanup(&tables, false);
 | |
| }
 |