[mirror_qemu.git] / hw / acpi / cpu_hotplug.c

/*
 * QEMU ACPI hotplug utilities
 *
 * Copyright (C) 2013 Red Hat Inc
 *
 * Authors:
 *   Igor Mammedov <imammedo@redhat.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
 * See the COPYING file in the top-level directory.
 */
#include "qemu/osdep.h"
#include "hw/hw.h"
#include "hw/acpi/cpu_hotplug.h"
#include "qapi/error.h"
#include "qom/cpu.h"
#include "hw/i386/pc.h"

#define CPU_EJECT_METHOD "CPEJ"
#define CPU_MAT_METHOD "CPMA"
#define CPU_ON_BITMAP "CPON"
#define CPU_STATUS_METHOD "CPST"
#define CPU_STATUS_MAP "PRS"
#define CPU_SCAN_METHOD "PRSC"

static uint64_t cpu_status_read(void *opaque, hwaddr addr, unsigned int size)
{
    AcpiCpuHotplug *cpus = opaque;
    uint64_t val = cpus->sts[addr];

    return val;
}

static void cpu_status_write(void *opaque, hwaddr addr, uint64_t data,
                             unsigned int size)
{
    /* firmware never used to write in CPU present bitmap so use
       this fact as means to switch QEMU into modern CPU hotplug
       mode by writing 0 at the beginning of legacy CPU bitmap
     */
    if (addr == 0 && data == 0) {
        AcpiCpuHotplug *cpus = opaque;
        object_property_set_bool(cpus->device, false, "cpu-hotplug-legacy",
                                 &error_abort);
    }
}

static const MemoryRegionOps AcpiCpuHotplug_ops = {
    .read = cpu_status_read,
    .write = cpu_status_write,
    .endianness = DEVICE_LITTLE_ENDIAN,
    .valid = {
        .min_access_size = 1,
        .max_access_size = 1,
    },
};

static void acpi_set_cpu_present_bit(AcpiCpuHotplug *g, CPUState *cpu,
                                     Error **errp)
{
    CPUClass *k = CPU_GET_CLASS(cpu);
    int64_t cpu_id;

    cpu_id = k->get_arch_id(cpu);
    if ((cpu_id / 8) >= ACPI_GPE_PROC_LEN) {
        error_setg(errp, "acpi: invalid cpu id: %" PRIi64, cpu_id);
        return;
    }

    g->sts[cpu_id / 8] |= (1 << (cpu_id % 8));
}

void legacy_acpi_cpu_plug_cb(HotplugHandler *hotplug_dev,
                             AcpiCpuHotplug *g, DeviceState *dev, Error **errp)
{
    acpi_set_cpu_present_bit(g, CPU(dev), errp);
    if (*errp != NULL) {
        return;
    }
    acpi_send_event(DEVICE(hotplug_dev), ACPI_CPU_HOTPLUG_STATUS);
}

void legacy_acpi_cpu_hotplug_init(MemoryRegion *parent, Object *owner,
                                  AcpiCpuHotplug *gpe_cpu, uint16_t base)
{
    CPUState *cpu;

    CPU_FOREACH(cpu) {
        acpi_set_cpu_present_bit(gpe_cpu, cpu, &error_abort);
    }
    memory_region_init_io(&gpe_cpu->io, owner, &AcpiCpuHotplug_ops,
                          gpe_cpu, "acpi-cpu-hotplug", ACPI_GPE_PROC_LEN);
    memory_region_add_subregion(parent, base, &gpe_cpu->io);
    gpe_cpu->device = owner;
}

void acpi_switch_to_modern_cphp(AcpiCpuHotplug *gpe_cpu,
                                CPUHotplugState *cpuhp_state,
                                uint16_t io_port)
{
    MemoryRegion *parent = pci_address_space_io(PCI_DEVICE(gpe_cpu->device));

    memory_region_del_subregion(parent, &gpe_cpu->io);
    cpu_hotplug_hw_init(parent, gpe_cpu->device, cpuhp_state, io_port);
}

void build_legacy_cpu_hotplug_aml(Aml *ctx, MachineState *machine,
                                  uint16_t io_base)
{
    Aml *dev;
    Aml *crs;
    Aml *pkg;
    Aml *field;
    Aml *method;
    Aml *if_ctx;
    Aml *else_ctx;
    int i, apic_idx;
    Aml *sb_scope = aml_scope("_SB");
    uint8_t madt_tmpl[8] = {0x00, 0x08, 0x00, 0x00, 0x00, 0, 0, 0};
    Aml *cpu_id = aml_arg(1);
    Aml *apic_id = aml_arg(0);
    Aml *cpu_on = aml_local(0);
    Aml *madt = aml_local(1);
    Aml *cpus_map = aml_name(CPU_ON_BITMAP);
    Aml *zero = aml_int(0);
    Aml *one = aml_int(1);
    MachineClass *mc = MACHINE_GET_CLASS(machine);
    CPUArchIdList *apic_ids = mc->possible_cpu_arch_ids(machine);
    PCMachineState *pcms = PC_MACHINE(machine);

    /*
     * _MAT method - creates an madt apic buffer
     * apic_id = Arg0 = Local APIC ID
     * cpu_id  = Arg1 = Processor ID
     * cpu_on = Local0 = CPON flag for this cpu
     * madt = Local1 = Buffer (in madt apic form) to return
     */
    method = aml_method(CPU_MAT_METHOD, 2, AML_NOTSERIALIZED);
    aml_append(method,
        aml_store(aml_derefof(aml_index(cpus_map, apic_id)), cpu_on));
    aml_append(method,
        aml_store(aml_buffer(sizeof(madt_tmpl), madt_tmpl), madt));
    /* Update the processor id, lapic id, and enable/disable status */
    aml_append(method, aml_store(cpu_id, aml_index(madt, aml_int(2))));
    aml_append(method, aml_store(apic_id, aml_index(madt, aml_int(3))));
    aml_append(method, aml_store(cpu_on, aml_index(madt, aml_int(4))));
    aml_append(method, aml_return(madt));
    aml_append(sb_scope, method);

    /*
     * _STA method - return ON status of cpu
     * apic_id = Arg0 = Local APIC ID
     * cpu_on = Local0 = CPON flag for this cpu
     */
    method = aml_method(CPU_STATUS_METHOD, 1, AML_NOTSERIALIZED);
    aml_append(method,
        aml_store(aml_derefof(aml_index(cpus_map, apic_id)), cpu_on));
    if_ctx = aml_if(cpu_on);
    {
        aml_append(if_ctx, aml_return(aml_int(0xF)));
    }
    aml_append(method, if_ctx);
    else_ctx = aml_else();
    {
        aml_append(else_ctx, aml_return(zero));
    }
    aml_append(method, else_ctx);
    aml_append(sb_scope, method);

    method = aml_method(CPU_EJECT_METHOD, 2, AML_NOTSERIALIZED);
    aml_append(method, aml_sleep(200));
    aml_append(sb_scope, method);

    method = aml_method(CPU_SCAN_METHOD, 0, AML_NOTSERIALIZED);
    {
        Aml *while_ctx, *if_ctx2, *else_ctx2;
        Aml *bus_check_evt = aml_int(1);
        Aml *remove_evt = aml_int(3);
        Aml *status_map = aml_local(5); /* Local5 = active cpu bitmap */
        Aml *byte = aml_local(2); /* Local2 = last read byte from bitmap */
        Aml *idx = aml_local(0); /* Processor ID / APIC ID iterator */
        Aml *is_cpu_on = aml_local(1); /* Local1 = CPON flag for cpu */
        Aml *status = aml_local(3); /* Local3 = active state for cpu */

        aml_append(method, aml_store(aml_name(CPU_STATUS_MAP), status_map));
        aml_append(method, aml_store(zero, byte));
        aml_append(method, aml_store(zero, idx));

        /* While (idx < SizeOf(CPON)) */
        while_ctx = aml_while(aml_lless(idx, aml_sizeof(cpus_map)));
        aml_append(while_ctx,
            aml_store(aml_derefof(aml_index(cpus_map, idx)), is_cpu_on));

        if_ctx = aml_if(aml_and(idx, aml_int(0x07), NULL));
        {
            /* Shift down previously read bitmap byte */
            aml_append(if_ctx, aml_shiftright(byte, one, byte));
        }
        aml_append(while_ctx, if_ctx);

        else_ctx = aml_else();
        {
            /* Read next byte from cpu bitmap */
            aml_append(else_ctx, aml_store(aml_derefof(aml_index(status_map,
                       aml_shiftright(idx, aml_int(3), NULL))), byte));
        }
        aml_append(while_ctx, else_ctx);

        aml_append(while_ctx, aml_store(aml_and(byte, one, NULL), status));
        if_ctx = aml_if(aml_lnot(aml_equal(is_cpu_on, status)));
        {
            /* State change - update CPON with new state */
            aml_append(if_ctx, aml_store(status, aml_index(cpus_map, idx)));
            if_ctx2 = aml_if(aml_equal(status, one));
            {
                aml_append(if_ctx2,
                    aml_call2(AML_NOTIFY_METHOD, idx, bus_check_evt));
            }
            aml_append(if_ctx, if_ctx2);
            else_ctx2 = aml_else();
            {
                aml_append(else_ctx2,
                    aml_call2(AML_NOTIFY_METHOD, idx, remove_evt));
            }
        }
        aml_append(if_ctx, else_ctx2);
        aml_append(while_ctx, if_ctx);

        aml_append(while_ctx, aml_increment(idx)); /* go to next cpu */
        aml_append(method, while_ctx);
    }
    aml_append(sb_scope, method);

    /* The current AML generator can cover the APIC ID range [0..255],
     * inclusive, for VCPU hotplug. */
    QEMU_BUILD_BUG_ON(ACPI_CPU_HOTPLUG_ID_LIMIT > 256);
    g_assert(pcms->apic_id_limit <= ACPI_CPU_HOTPLUG_ID_LIMIT);

    /* create PCI0.PRES device and its _CRS to reserve CPU hotplug MMIO */
    dev = aml_device("PCI0." stringify(CPU_HOTPLUG_RESOURCE_DEVICE));
    aml_append(dev, aml_name_decl("_HID", aml_eisaid("PNP0A06")));
    aml_append(dev,
        aml_name_decl("_UID", aml_string("CPU Hotplug resources"))
    );
    /* device present, functioning, decoding, not shown in UI */
    aml_append(dev, aml_name_decl("_STA", aml_int(0xB)));
    crs = aml_resource_template();
    aml_append(crs,
        aml_io(AML_DECODE16, io_base, io_base, 1, ACPI_GPE_PROC_LEN)
    );
    aml_append(dev, aml_name_decl("_CRS", crs));
    aml_append(sb_scope, dev);
    /* declare CPU hotplug MMIO region and PRS field to access it */
    aml_append(sb_scope, aml_operation_region(
        "PRST", AML_SYSTEM_IO, aml_int(io_base), ACPI_GPE_PROC_LEN));
    field = aml_field("PRST", AML_BYTE_ACC, AML_NOLOCK, AML_PRESERVE);
    aml_append(field, aml_named_field("PRS", 256));
    aml_append(sb_scope, field);

    /* build Processor object for each processor */
    for (i = 0; i < apic_ids->len; i++) {
        int apic_id = apic_ids->cpus[i].arch_id;

        assert(apic_id < ACPI_CPU_HOTPLUG_ID_LIMIT);

        dev = aml_processor(i, 0, 0, "CP%.02X", apic_id);

        method = aml_method("_MAT", 0, AML_NOTSERIALIZED);
        aml_append(method,
            aml_return(aml_call2(CPU_MAT_METHOD, aml_int(apic_id), aml_int(i))
        ));
        aml_append(dev, method);

        method = aml_method("_STA", 0, AML_NOTSERIALIZED);
        aml_append(method,
            aml_return(aml_call1(CPU_STATUS_METHOD, aml_int(apic_id))));
        aml_append(dev, method);

        method = aml_method("_EJ0", 1, AML_NOTSERIALIZED);
        aml_append(method,
            aml_return(aml_call2(CPU_EJECT_METHOD, aml_int(apic_id),
                aml_arg(0)))
        );
        aml_append(dev, method);

        aml_append(sb_scope, dev);
    }

    /* build this code:
     *   Method(NTFY, 2) {If (LEqual(Arg0, 0x00)) {Notify(CP00, Arg1)} ...}
     */
    /* Arg0 = APIC ID */
    method = aml_method(AML_NOTIFY_METHOD, 2, AML_NOTSERIALIZED);
    for (i = 0; i < apic_ids->len; i++) {
        int apic_id = apic_ids->cpus[i].arch_id;

        if_ctx = aml_if(aml_equal(aml_arg(0), aml_int(apic_id)));
        aml_append(if_ctx,
            aml_notify(aml_name("CP%.02X", apic_id), aml_arg(1))
        );
        aml_append(method, if_ctx);
    }
    aml_append(sb_scope, method);

    /* build "Name(CPON, Package() { One, One, ..., Zero, Zero, ... })"
     *
     * Note: The ability to create variable-sized packages was first
     * introduced in ACPI 2.0. ACPI 1.0 only allowed fixed-size packages
     * ith up to 255 elements. Windows guests up to win2k8 fail when
     * VarPackageOp is used.
     */
    pkg = pcms->apic_id_limit <= 255 ? aml_package(pcms->apic_id_limit) :
                                       aml_varpackage(pcms->apic_id_limit);

    for (i = 0, apic_idx = 0; i < apic_ids->len; i++) {
        int apic_id = apic_ids->cpus[i].arch_id;

        for (; apic_idx < apic_id; apic_idx++) {
            aml_append(pkg, aml_int(0));
        }
        aml_append(pkg, aml_int(apic_ids->cpus[i].cpu ? 1 : 0));
        apic_idx = apic_id + 1;
    }
    aml_append(sb_scope, aml_name_decl(CPU_ON_BITMAP, pkg));
    g_free(apic_ids);

    aml_append(ctx, sb_scope);

    method = aml_method("\\_GPE._E02", 0, AML_NOTSERIALIZED);
    aml_append(method, aml_call0("\\_SB." CPU_SCAN_METHOD));
    aml_append(ctx, method);
}
Commit	Line	Data
81cea5e7 IM	1	/*
	2	* QEMU ACPI hotplug utilities
	3	*
	4	* Copyright (C) 2013 Red Hat Inc
	5	*
	6	* Authors:
	7	* Igor Mammedov <imammedo@redhat.com>
	8	*
	9	* This work is licensed under the terms of the GNU GPL, version 2 or later.
	10	* See the COPYING file in the top-level directory.
	11	*/
b6a0aa05	12	#include "qemu/osdep.h"
81cea5e7 IM	13	#include "hw/hw.h"
81cea5e7 IM	14	#include "hw/acpi/cpu_hotplug.h"
da34e65c	15	#include "qapi/error.h"
508127e2	16	#include "qom/cpu.h"
672a2872 IM	17	#include "hw/i386/pc.h"
	18
	19	#define CPU_EJECT_METHOD "CPEJ"
	20	#define CPU_MAT_METHOD "CPMA"
	21	#define CPU_ON_BITMAP "CPON"
	22	#define CPU_STATUS_METHOD "CPST"
	23	#define CPU_STATUS_MAP "PRS"
	24	#define CPU_SCAN_METHOD "PRSC"
81cea5e7 IM	25
	26	static uint64_t cpu_status_read(void *opaque, hwaddr addr, unsigned int size)
	27	{
	28	AcpiCpuHotplug *cpus = opaque;
	29	uint64_t val = cpus->sts[addr];
	30
	31	return val;
	32	}
	33
	34	static void cpu_status_write(void *opaque, hwaddr addr, uint64_t data,
	35	unsigned int size)
	36	{
679dd1a9 IM	37	/* firmware never used to write in CPU present bitmap so use
	38	this fact as means to switch QEMU into modern CPU hotplug
	39	mode by writing 0 at the beginning of legacy CPU bitmap
	40	*/
	41	if (addr == 0 && data == 0) {
	42	AcpiCpuHotplug *cpus = opaque;
	43	object_property_set_bool(cpus->device, false, "cpu-hotplug-legacy",
	44	&error_abort);
	45	}
81cea5e7 IM	46	}
	47
	48	static const MemoryRegionOps AcpiCpuHotplug_ops = {
	49	.read = cpu_status_read,
	50	.write = cpu_status_write,
	51	.endianness = DEVICE_LITTLE_ENDIAN,
	52	.valid = {
	53	.min_access_size = 1,
	54	.max_access_size = 1,
	55	},
	56	};
	57
cc43364d GZ	58	static void acpi_set_cpu_present_bit(AcpiCpuHotplug g, CPUState cpu,
cc43364d GZ	59	Error **errp)
1be6b511	60	{
1be6b511 GZ	61	CPUClass *k = CPU_GET_CLASS(cpu);
	62	int64_t cpu_id;
	63
	64	cpu_id = k->get_arch_id(cpu);
	65	if ((cpu_id / 8) >= ACPI_GPE_PROC_LEN) {
	66	error_setg(errp, "acpi: invalid cpu id: %" PRIi64, cpu_id);
	67	return;
	68	}
	69
08bba95b	70	g->sts[cpu_id / 8] \|= (1 << (cpu_id % 8));
cc43364d GZ	71	}
cc43364d GZ	72
0058c082	73	void legacy_acpi_cpu_plug_cb(HotplugHandler *hotplug_dev,
96e3e12b	74	AcpiCpuHotplug g, DeviceState dev, Error **errp)
cc43364d GZ	75	{
	76	acpi_set_cpu_present_bit(g, CPU(dev), errp);
	77	if (*errp != NULL) {
	78	return;
	79	}
0058c082	80	acpi_send_event(DEVICE(hotplug_dev), ACPI_CPU_HOTPLUG_STATUS);
1be6b511 GZ	81	}
1be6b511 GZ	82
96e3e12b IM	83	void legacy_acpi_cpu_hotplug_init(MemoryRegion parent, Object owner,
96e3e12b IM	84	AcpiCpuHotplug *gpe_cpu, uint16_t base)
81cea5e7 IM	85	{
	86	CPUState *cpu;
	87
	88	CPU_FOREACH(cpu) {
cc43364d	89	acpi_set_cpu_present_bit(gpe_cpu, cpu, &error_abort);
81cea5e7 IM	90	}
	91	memory_region_init_io(&gpe_cpu->io, owner, &AcpiCpuHotplug_ops,
	92	gpe_cpu, "acpi-cpu-hotplug", ACPI_GPE_PROC_LEN);
	93	memory_region_add_subregion(parent, base, &gpe_cpu->io);
679dd1a9 IM	94	gpe_cpu->device = owner;
	95	}
	96
	97	void acpi_switch_to_modern_cphp(AcpiCpuHotplug *gpe_cpu,
	98	CPUHotplugState *cpuhp_state,
	99	uint16_t io_port)
	100	{
	101	MemoryRegion *parent = pci_address_space_io(PCI_DEVICE(gpe_cpu->device));
	102
	103	memory_region_del_subregion(parent, &gpe_cpu->io);
	104	cpu_hotplug_hw_init(parent, gpe_cpu->device, cpuhp_state, io_port);
81cea5e7	105	}
672a2872 IM	106
672a2872 IM	107	void build_legacy_cpu_hotplug_aml(Aml ctx, MachineState machine,
ebd8ea82	108	uint16_t io_base)
672a2872 IM	109	{
	110	Aml *dev;
	111	Aml *crs;
	112	Aml *pkg;
	113	Aml *field;
	114	Aml *method;
	115	Aml *if_ctx;
	116	Aml *else_ctx;
	117	int i, apic_idx;
	118	Aml *sb_scope = aml_scope("_SB");
	119	uint8_t madt_tmpl[8] = {0x00, 0x08, 0x00, 0x00, 0x00, 0, 0, 0};
76bdd24e IM	120	Aml *cpu_id = aml_arg(1);
76bdd24e IM	121	Aml *apic_id = aml_arg(0);
672a2872 IM	122	Aml *cpu_on = aml_local(0);
	123	Aml *madt = aml_local(1);
	124	Aml *cpus_map = aml_name(CPU_ON_BITMAP);
	125	Aml *zero = aml_int(0);
	126	Aml *one = aml_int(1);
	127	MachineClass *mc = MACHINE_GET_CLASS(machine);
	128	CPUArchIdList *apic_ids = mc->possible_cpu_arch_ids(machine);
	129	PCMachineState *pcms = PC_MACHINE(machine);
	130
	131	/*
	132	* _MAT method - creates an madt apic buffer
76bdd24e IM	133	* apic_id = Arg0 = Local APIC ID
76bdd24e IM	134	* cpu_id = Arg1 = Processor ID
672a2872 IM	135	* cpu_on = Local0 = CPON flag for this cpu
	136	* madt = Local1 = Buffer (in madt apic form) to return
	137	*/
76bdd24e	138	method = aml_method(CPU_MAT_METHOD, 2, AML_NOTSERIALIZED);
672a2872	139	aml_append(method,
76bdd24e	140	aml_store(aml_derefof(aml_index(cpus_map, apic_id)), cpu_on));
672a2872 IM	141	aml_append(method,
	142	aml_store(aml_buffer(sizeof(madt_tmpl), madt_tmpl), madt));
	143	/* Update the processor id, lapic id, and enable/disable status */
	144	aml_append(method, aml_store(cpu_id, aml_index(madt, aml_int(2))));
76bdd24e	145	aml_append(method, aml_store(apic_id, aml_index(madt, aml_int(3))));
672a2872 IM	146	aml_append(method, aml_store(cpu_on, aml_index(madt, aml_int(4))));
	147	aml_append(method, aml_return(madt));
	148	aml_append(sb_scope, method);
	149
	150	/*
	151	* _STA method - return ON status of cpu
76bdd24e	152	* apic_id = Arg0 = Local APIC ID
672a2872 IM	153	* cpu_on = Local0 = CPON flag for this cpu
	154	*/
	155	method = aml_method(CPU_STATUS_METHOD, 1, AML_NOTSERIALIZED);
	156	aml_append(method,
76bdd24e	157	aml_store(aml_derefof(aml_index(cpus_map, apic_id)), cpu_on));
672a2872 IM	158	if_ctx = aml_if(cpu_on);
	159	{
	160	aml_append(if_ctx, aml_return(aml_int(0xF)));
	161	}
	162	aml_append(method, if_ctx);
	163	else_ctx = aml_else();
	164	{
	165	aml_append(else_ctx, aml_return(zero));
	166	}
	167	aml_append(method, else_ctx);
	168	aml_append(sb_scope, method);
	169
	170	method = aml_method(CPU_EJECT_METHOD, 2, AML_NOTSERIALIZED);
	171	aml_append(method, aml_sleep(200));
	172	aml_append(sb_scope, method);
	173
	174	method = aml_method(CPU_SCAN_METHOD, 0, AML_NOTSERIALIZED);
	175	{
	176	Aml while_ctx, if_ctx2, *else_ctx2;
	177	Aml *bus_check_evt = aml_int(1);
	178	Aml *remove_evt = aml_int(3);
	179	Aml status_map = aml_local(5); / Local5 = active cpu bitmap */
	180	Aml byte = aml_local(2); / Local2 = last read byte from bitmap */
	181	Aml idx = aml_local(0); / Processor ID / APIC ID iterator */
	182	Aml is_cpu_on = aml_local(1); / Local1 = CPON flag for cpu */
	183	Aml status = aml_local(3); / Local3 = active state for cpu */
	184
	185	aml_append(method, aml_store(aml_name(CPU_STATUS_MAP), status_map));
	186	aml_append(method, aml_store(zero, byte));
	187	aml_append(method, aml_store(zero, idx));
	188
	189	/* While (idx < SizeOf(CPON)) */
	190	while_ctx = aml_while(aml_lless(idx, aml_sizeof(cpus_map)));
	191	aml_append(while_ctx,
	192	aml_store(aml_derefof(aml_index(cpus_map, idx)), is_cpu_on));
	193
	194	if_ctx = aml_if(aml_and(idx, aml_int(0x07), NULL));
	195	{
	196	/* Shift down previously read bitmap byte */
	197	aml_append(if_ctx, aml_shiftright(byte, one, byte));
	198	}
	199	aml_append(while_ctx, if_ctx);
	200
	201	else_ctx = aml_else();
	202	{
	203	/* Read next byte from cpu bitmap */
	204	aml_append(else_ctx, aml_store(aml_derefof(aml_index(status_map,
	205	aml_shiftright(idx, aml_int(3), NULL))), byte));
	206	}
	207	aml_append(while_ctx, else_ctx);
	208
	209	aml_append(while_ctx, aml_store(aml_and(byte, one, NULL), status));
	210	if_ctx = aml_if(aml_lnot(aml_equal(is_cpu_on, status)));
	211	{
	212	/* State change - update CPON with new state */
	213	aml_append(if_ctx, aml_store(status, aml_index(cpus_map, idx)));
	214	if_ctx2 = aml_if(aml_equal(status, one));
	215	{
	216	aml_append(if_ctx2,
	217	aml_call2(AML_NOTIFY_METHOD, idx, bus_check_evt));
	218	}
	219	aml_append(if_ctx, if_ctx2);
	220	else_ctx2 = aml_else();
	221	{
222	aml_append(else_ctx2,
223	aml_call2(AML_NOTIFY_METHOD, idx, remove_evt));
224	}
225	}
226	aml_append(if_ctx, else_ctx2);
227	aml_append(while_ctx, if_ctx);
228
229	aml_append(while_ctx, aml_increment(idx)); /* go to next cpu */
230	aml_append(method, while_ctx);
231	}
232	aml_append(sb_scope, method);
233
234	/* The current AML generator can cover the APIC ID range [0..255],
235	* inclusive, for VCPU hotplug. */
236	QEMU_BUILD_BUG_ON(ACPI_CPU_HOTPLUG_ID_LIMIT > 256);
237	g_assert(pcms->apic_id_limit <= ACPI_CPU_HOTPLUG_ID_LIMIT);
238
239	/* create PCI0.PRES device and its _CRS to reserve CPU hotplug MMIO */
240	dev = aml_device("PCI0." stringify(CPU_HOTPLUG_RESOURCE_DEVICE));
241	aml_append(dev, aml_name_decl("_HID", aml_eisaid("PNP0A06")));
242	aml_append(dev,
243	aml_name_decl("_UID", aml_string("CPU Hotplug resources"))
244	);
245	/* device present, functioning, decoding, not shown in UI */
246	aml_append(dev, aml_name_decl("_STA", aml_int(0xB)));
247	crs = aml_resource_template();
248	aml_append(crs,
ebd8ea82	249	aml_io(AML_DECODE16, io_base, io_base, 1, ACPI_GPE_PROC_LEN)
672a2872 IM	250	);
	251	aml_append(dev, aml_name_decl("_CRS", crs));
	252	aml_append(sb_scope, dev);
	253	/* declare CPU hotplug MMIO region and PRS field to access it */
	254	aml_append(sb_scope, aml_operation_region(
ebd8ea82	255	"PRST", AML_SYSTEM_IO, aml_int(io_base), ACPI_GPE_PROC_LEN));
672a2872 IM	256	field = aml_field("PRST", AML_BYTE_ACC, AML_NOLOCK, AML_PRESERVE);
	257	aml_append(field, aml_named_field("PRS", 256));
	258	aml_append(sb_scope, field);
	259
	260	/* build Processor object for each processor */
	261	for (i = 0; i < apic_ids->len; i++) {
	262	int apic_id = apic_ids->cpus[i].arch_id;
	263
	264	assert(apic_id < ACPI_CPU_HOTPLUG_ID_LIMIT);
	265
76bdd24e	266	dev = aml_processor(i, 0, 0, "CP%.02X", apic_id);
672a2872 IM	267
	268	method = aml_method("_MAT", 0, AML_NOTSERIALIZED);
	269	aml_append(method,
76bdd24e IM	270	aml_return(aml_call2(CPU_MAT_METHOD, aml_int(apic_id), aml_int(i))
76bdd24e IM	271	));
672a2872 IM	272	aml_append(dev, method);
	273
	274	method = aml_method("_STA", 0, AML_NOTSERIALIZED);
	275	aml_append(method,
	276	aml_return(aml_call1(CPU_STATUS_METHOD, aml_int(apic_id))));
	277	aml_append(dev, method);
	278
	279	method = aml_method("_EJ0", 1, AML_NOTSERIALIZED);
	280	aml_append(method,
	281	aml_return(aml_call2(CPU_EJECT_METHOD, aml_int(apic_id),
	282	aml_arg(0)))
	283	);
	284	aml_append(dev, method);
	285
	286	aml_append(sb_scope, dev);
	287	}
	288
	289	/* build this code:
	290	* Method(NTFY, 2) {If (LEqual(Arg0, 0x00)) {Notify(CP00, Arg1)} ...}
	291	*/
76bdd24e	292	/* Arg0 = APIC ID */
672a2872 IM	293	method = aml_method(AML_NOTIFY_METHOD, 2, AML_NOTSERIALIZED);
	294	for (i = 0; i < apic_ids->len; i++) {
	295	int apic_id = apic_ids->cpus[i].arch_id;
	296
	297	if_ctx = aml_if(aml_equal(aml_arg(0), aml_int(apic_id)));
	298	aml_append(if_ctx,
	299	aml_notify(aml_name("CP%.02X", apic_id), aml_arg(1))
	300	);
	301	aml_append(method, if_ctx);
	302	}
	303	aml_append(sb_scope, method);
	304
	305	/* build "Name(CPON, Package() { One, One, ..., Zero, Zero, ... })"
	306	*
	307	* Note: The ability to create variable-sized packages was first
	308	* introduced in ACPI 2.0. ACPI 1.0 only allowed fixed-size packages
	309	* ith up to 255 elements. Windows guests up to win2k8 fail when
	310	* VarPackageOp is used.
	311	*/
	312	pkg = pcms->apic_id_limit <= 255 ? aml_package(pcms->apic_id_limit) :
	313	aml_varpackage(pcms->apic_id_limit);
	314
	315	for (i = 0, apic_idx = 0; i < apic_ids->len; i++) {
	316	int apic_id = apic_ids->cpus[i].arch_id;
	317
	318	for (; apic_idx < apic_id; apic_idx++) {
	319	aml_append(pkg, aml_int(0));
	320	}
	321	aml_append(pkg, aml_int(apic_ids->cpus[i].cpu ? 1 : 0));
	322	apic_idx = apic_id + 1;
	323	}
	324	aml_append(sb_scope, aml_name_decl(CPU_ON_BITMAP, pkg));
	325	g_free(apic_ids);
	326
	327	aml_append(ctx, sb_scope);
	328
	329	method = aml_method("\\_GPE._E02", 0, AML_NOTSERIALIZED);
	330	aml_append(method, aml_call0("\\_SB." CPU_SCAN_METHOD));
	331	aml_append(ctx, method);
	332	}