[linux-block.git] / drivers / acpi / processor_core.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2005 Intel Corporation
 * Copyright (C) 2009 Hewlett-Packard Development Company, L.P.
 *
 *	Alex Chiang <achiang@hp.com>
 *	- Unified x86/ia64 implementations
 *
 * I/O APIC hotplug support
 *	Yinghai Lu <yinghai@kernel.org>
 *	Jiang Liu <jiang.liu@intel.com>
 */
#include <linux/export.h>
#include <linux/acpi.h>
#include <acpi/processor.h>

static struct acpi_table_madt *get_madt_table(void)
{
	static struct acpi_table_madt *madt;
	static int read_madt;

	if (!read_madt) {
		if (ACPI_FAILURE(acpi_get_table(ACPI_SIG_MADT, 0,
					(struct acpi_table_header **)&madt)))
			madt = NULL;
		read_madt++;
	}

	return madt;
}

static int map_lapic_id(struct acpi_subtable_header *entry,
		 u32 acpi_id, phys_cpuid_t *apic_id)
{
	struct acpi_madt_local_apic *lapic =
		container_of(entry, struct acpi_madt_local_apic, header);

	if (!(lapic->lapic_flags & ACPI_MADT_ENABLED))
		return -ENODEV;

	if (lapic->processor_id != acpi_id)
		return -EINVAL;

	*apic_id = lapic->id;
	return 0;
}

static int map_x2apic_id(struct acpi_subtable_header *entry,
		int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
{
	struct acpi_madt_local_x2apic *apic =
		container_of(entry, struct acpi_madt_local_x2apic, header);

	if (!(apic->lapic_flags & ACPI_MADT_ENABLED))
		return -ENODEV;

	if (device_declaration && (apic->uid == acpi_id)) {
		*apic_id = apic->local_apic_id;
		return 0;
	}

	return -EINVAL;
}

static int map_lsapic_id(struct acpi_subtable_header *entry,
		int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
{
	struct acpi_madt_local_sapic *lsapic =
		container_of(entry, struct acpi_madt_local_sapic, header);

	if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED))
		return -ENODEV;

	if (device_declaration) {
		if ((entry->length < 16) || (lsapic->uid != acpi_id))
			return -EINVAL;
	} else if (lsapic->processor_id != acpi_id)
		return -EINVAL;

	*apic_id = (lsapic->id << 8) | lsapic->eid;
	return 0;
}

/*
 * Retrieve the ARM CPU physical identifier (MPIDR)
 */
static int map_gicc_mpidr(struct acpi_subtable_header *entry,
		int device_declaration, u32 acpi_id, phys_cpuid_t *mpidr)
{
	struct acpi_madt_generic_interrupt *gicc =
	    container_of(entry, struct acpi_madt_generic_interrupt, header);

	if (!(gicc->flags & ACPI_MADT_ENABLED))
		return -ENODEV;

	/* device_declaration means Device object in DSDT, in the
	 * GIC interrupt model, logical processors are required to
	 * have a Processor Device object in the DSDT, so we should
	 * check device_declaration here
	 */
	if (device_declaration && (gicc->uid == acpi_id)) {
		*mpidr = gicc->arm_mpidr;
		return 0;
	}

	return -EINVAL;
}

static phys_cpuid_t map_madt_entry(struct acpi_table_madt *madt,
				   int type, u32 acpi_id)
{
	unsigned long madt_end, entry;
	phys_cpuid_t phys_id = PHYS_CPUID_INVALID;	/* CPU hardware ID */

	if (!madt)
		return phys_id;

	entry = (unsigned long)madt;
	madt_end = entry + madt->header.length;

	/* Parse all entries looking for a match. */

	entry += sizeof(struct acpi_table_madt);
	while (entry + sizeof(struct acpi_subtable_header) < madt_end) {
		struct acpi_subtable_header *header =
			(struct acpi_subtable_header *)entry;
		if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) {
			if (!map_lapic_id(header, acpi_id, &phys_id))
				break;
		} else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) {
			if (!map_x2apic_id(header, type, acpi_id, &phys_id))
				break;
		} else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) {
			if (!map_lsapic_id(header, type, acpi_id, &phys_id))
				break;
		} else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT) {
			if (!map_gicc_mpidr(header, type, acpi_id, &phys_id))
				break;
		}
		entry += header->length;
	}
	return phys_id;
}

phys_cpuid_t __init acpi_map_madt_entry(u32 acpi_id)
{
	struct acpi_table_madt *madt = NULL;
	phys_cpuid_t rv;

	acpi_get_table(ACPI_SIG_MADT, 0,
		       (struct acpi_table_header **)&madt);
	if (!madt)
		return PHYS_CPUID_INVALID;

	rv = map_madt_entry(madt, 1, acpi_id);

	acpi_put_table((struct acpi_table_header *)madt);

	return rv;
}

static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id)
{
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *obj;
	struct acpi_subtable_header *header;
	phys_cpuid_t phys_id = PHYS_CPUID_INVALID;

	if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
		goto exit;

	if (!buffer.length || !buffer.pointer)
		goto exit;

	obj = buffer.pointer;
	if (obj->type != ACPI_TYPE_BUFFER ||
	    obj->buffer.length < sizeof(struct acpi_subtable_header)) {
		goto exit;
	}

	header = (struct acpi_subtable_header *)obj->buffer.pointer;
	if (header->type == ACPI_MADT_TYPE_LOCAL_APIC)
		map_lapic_id(header, acpi_id, &phys_id);
	else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC)
		map_lsapic_id(header, type, acpi_id, &phys_id);
	else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC)
		map_x2apic_id(header, type, acpi_id, &phys_id);
	else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT)
		map_gicc_mpidr(header, type, acpi_id, &phys_id);

exit:
	kfree(buffer.pointer);
	return phys_id;
}

phys_cpuid_t acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id)
{
	phys_cpuid_t phys_id;

	phys_id = map_mat_entry(handle, type, acpi_id);
	if (invalid_phys_cpuid(phys_id))
		phys_id = map_madt_entry(get_madt_table(), type, acpi_id);

	return phys_id;
}
EXPORT_SYMBOL_GPL(acpi_get_phys_id);

int acpi_map_cpuid(phys_cpuid_t phys_id, u32 acpi_id)
{
#ifdef CONFIG_SMP
	int i;
#endif

	if (invalid_phys_cpuid(phys_id)) {
		/*
		 * On UP processor, there is no _MAT or MADT table.
		 * So above phys_id is always set to PHYS_CPUID_INVALID.
		 *
		 * BIOS may define multiple CPU handles even for UP processor.
		 * For example,
		 *
		 * Scope (_PR)
		 * {
		 *     Processor (CPU0, 0x00, 0x00000410, 0x06) {}
		 *     Processor (CPU1, 0x01, 0x00000410, 0x06) {}
		 *     Processor (CPU2, 0x02, 0x00000410, 0x06) {}
		 *     Processor (CPU3, 0x03, 0x00000410, 0x06) {}
		 * }
		 *
		 * Ignores phys_id and always returns 0 for the processor
		 * handle with acpi id 0 if nr_cpu_ids is 1.
		 * This should be the case if SMP tables are not found.
		 * Return -EINVAL for other CPU's handle.
		 */
		if (nr_cpu_ids <= 1 && acpi_id == 0)
			return acpi_id;
		else
			return -EINVAL;
	}

#ifdef CONFIG_SMP
	for_each_possible_cpu(i) {
		if (cpu_physical_id(i) == phys_id)
			return i;
	}
#else
	/* In UP kernel, only processor 0 is valid */
	if (phys_id == 0)
		return phys_id;
#endif
	return -ENODEV;
}

int acpi_get_cpuid(acpi_handle handle, int type, u32 acpi_id)
{
	phys_cpuid_t phys_id;

	phys_id = acpi_get_phys_id(handle, type, acpi_id);

	return acpi_map_cpuid(phys_id, acpi_id);
}
EXPORT_SYMBOL_GPL(acpi_get_cpuid);

#ifdef CONFIG_ACPI_HOTPLUG_IOAPIC
static int get_ioapic_id(struct acpi_subtable_header *entry, u32 gsi_base,
			 u64 *phys_addr, int *ioapic_id)
{
	struct acpi_madt_io_apic *ioapic = (struct acpi_madt_io_apic *)entry;

	if (ioapic->global_irq_base != gsi_base)
		return 0;

	*phys_addr = ioapic->address;
	*ioapic_id = ioapic->id;
	return 1;
}

static int parse_madt_ioapic_entry(u32 gsi_base, u64 *phys_addr)
{
	struct acpi_subtable_header *hdr;
	unsigned long madt_end, entry;
	struct acpi_table_madt *madt;
	int apic_id = -1;

	madt = get_madt_table();
	if (!madt)
		return apic_id;

	entry = (unsigned long)madt;
	madt_end = entry + madt->header.length;

	/* Parse all entries looking for a match. */
	entry += sizeof(struct acpi_table_madt);
	while (entry + sizeof(struct acpi_subtable_header) < madt_end) {
		hdr = (struct acpi_subtable_header *)entry;
		if (hdr->type == ACPI_MADT_TYPE_IO_APIC &&
		    get_ioapic_id(hdr, gsi_base, phys_addr, &apic_id))
			break;
		else
			entry += hdr->length;
	}

	return apic_id;
}

static int parse_mat_ioapic_entry(acpi_handle handle, u32 gsi_base,
				  u64 *phys_addr)
{
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	struct acpi_subtable_header *header;
	union acpi_object *obj;
	int apic_id = -1;

	if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
		goto exit;

	if (!buffer.length || !buffer.pointer)
		goto exit;

	obj = buffer.pointer;
	if (obj->type != ACPI_TYPE_BUFFER ||
	    obj->buffer.length < sizeof(struct acpi_subtable_header))
		goto exit;

	header = (struct acpi_subtable_header *)obj->buffer.pointer;
	if (header->type == ACPI_MADT_TYPE_IO_APIC)
		get_ioapic_id(header, gsi_base, phys_addr, &apic_id);

exit:
	kfree(buffer.pointer);
	return apic_id;
}

/**
 * acpi_get_ioapic_id - Get IOAPIC ID and physical address matching @gsi_base
 * @handle:	ACPI object for IOAPIC device
 * @gsi_base:	GSI base to match with
 * @phys_addr:	Pointer to store physical address of matching IOAPIC record
 *
 * Walk resources returned by ACPI_MAT method, then ACPI MADT table, to search
 * for an ACPI IOAPIC record matching @gsi_base.
 * Return IOAPIC id and store physical address in @phys_addr if found a match,
 * otherwise return <0.
 */
int acpi_get_ioapic_id(acpi_handle handle, u32 gsi_base, u64 *phys_addr)
{
	int apic_id;

	apic_id = parse_mat_ioapic_entry(handle, gsi_base, phys_addr);
	if (apic_id == -1)
		apic_id = parse_madt_ioapic_entry(gsi_base, phys_addr);

	return apic_id;
}
#endif /* CONFIG_ACPI_HOTPLUG_IOAPIC */
Commit	Line	Data
457c8996	1	// SPDX-License-Identifier: GPL-2.0-only
47817254 AC	2	/*
	3	* Copyright (C) 2005 Intel Corporation
	4	* Copyright (C) 2009 Hewlett-Packard Development Company, L.P.
	5	*
	6	* Alex Chiang <achiang@hp.com>
	7	* - Unified x86/ia64 implementations
ecf5636d YL	8	*
	9	* I/O APIC hotplug support
	10	* Yinghai Lu <yinghai@kernel.org>
	11	* Jiang Liu <jiang.liu@intel.com>
47817254	12	*/
214f2c90	13	#include <linux/export.h>
8b48463f	14	#include <linux/acpi.h>
78f16996 AC	15	#include <acpi/processor.h>
78f16996 AC	16
ecf5636d YL	17	static struct acpi_table_madt *get_madt_table(void)
	18	{
	19	static struct acpi_table_madt *madt;
	20	static int read_madt;
	21
	22	if (!read_madt) {
	23	if (ACPI_FAILURE(acpi_get_table(ACPI_SIG_MADT, 0,
	24	(struct acpi_table_header **)&madt)))
	25	madt = NULL;
	26	read_madt++;
	27	}
	28
	29	return madt;
	30	}
	31
78ed8bd2	32	static int map_lapic_id(struct acpi_subtable_header *entry,
09c3f2bd	33	u32 acpi_id, phys_cpuid_t *apic_id)
78ed8bd2 AC	34	{
78ed8bd2 AC	35	struct acpi_madt_local_apic *lapic =
ef86c3f4	36	container_of(entry, struct acpi_madt_local_apic, header);
11130736	37
09c3f2bd	38	if (!(lapic->lapic_flags & ACPI_MADT_ENABLED))
038d7b59	39	return -ENODEV;
11130736 AC	40
11130736 AC	41	if (lapic->processor_id != acpi_id)
038d7b59	42	return -EINVAL;
11130736 AC	43
11130736 AC	44	*apic_id = lapic->id;
038d7b59	45	return 0;
78ed8bd2 AC	46	}
	47
	48	static int map_x2apic_id(struct acpi_subtable_header *entry,
09c3f2bd	49	int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
78ed8bd2 AC	50	{
78ed8bd2 AC	51	struct acpi_madt_local_x2apic *apic =
ef86c3f4	52	container_of(entry, struct acpi_madt_local_x2apic, header);
78ed8bd2	53
09c3f2bd	54	if (!(apic->lapic_flags & ACPI_MADT_ENABLED))
038d7b59	55	return -ENODEV;
78ed8bd2	56
d6742095 AC	57	if (device_declaration && (apic->uid == acpi_id)) {
d6742095 AC	58	*apic_id = apic->local_apic_id;
038d7b59	59	return 0;
78ed8bd2 AC	60	}
78ed8bd2 AC	61
038d7b59	62	return -EINVAL;
78ed8bd2 AC	63	}
	64
	65	static int map_lsapic_id(struct acpi_subtable_header *entry,
09c3f2bd	66	int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
78ed8bd2 AC	67	{
78ed8bd2 AC	68	struct acpi_madt_local_sapic *lsapic =
ef86c3f4	69	container_of(entry, struct acpi_madt_local_sapic, header);
78ed8bd2	70
09c3f2bd	71	if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED))
038d7b59	72	return -ENODEV;
78ed8bd2	73
78ed8bd2	74	if (device_declaration) {
eae701ce	75	if ((entry->length < 16) \|\| (lsapic->uid != acpi_id))
038d7b59	76	return -EINVAL;
eae701ce	77	} else if (lsapic->processor_id != acpi_id)
038d7b59	78	return -EINVAL;
78ed8bd2	79
eae701ce	80	*apic_id = (lsapic->id << 8) \| lsapic->eid;
038d7b59	81	return 0;
78ed8bd2 AC	82	}
78ed8bd2 AC	83
020295b4 HG	84	/*
	85	* Retrieve the ARM CPU physical identifier (MPIDR)
	86	*/
	87	static int map_gicc_mpidr(struct acpi_subtable_header *entry,
09c3f2bd	88	int device_declaration, u32 acpi_id, phys_cpuid_t *mpidr)
020295b4 HG	89	{
	90	struct acpi_madt_generic_interrupt *gicc =
	91	container_of(entry, struct acpi_madt_generic_interrupt, header);
	92
09c3f2bd	93	if (!(gicc->flags & ACPI_MADT_ENABLED))
020295b4 HG	94	return -ENODEV;
	95
	96	/* device_declaration means Device object in DSDT, in the
	97	* GIC interrupt model, logical processors are required to
	98	* have a Processor Device object in the DSDT, so we should
	99	* check device_declaration here
	100	*/
	101	if (device_declaration && (gicc->uid == acpi_id)) {
	102	*mpidr = gicc->arm_mpidr;
	103	return 0;
	104	}
	105
	106	return -EINVAL;
	107	}
	108
fb7c2bae	109	static phys_cpuid_t map_madt_entry(struct acpi_table_madt *madt,
09c3f2bd	110	int type, u32 acpi_id)
78ed8bd2 AC	111	{
78ed8bd2 AC	112	unsigned long madt_end, entry;
828aef37	113	phys_cpuid_t phys_id = PHYS_CPUID_INVALID; /* CPU hardware ID */
78ed8bd2 AC	114
78ed8bd2 AC	115	if (!madt)
af8f3f51	116	return phys_id;
78ed8bd2 AC	117
	118	entry = (unsigned long)madt;
	119	madt_end = entry + madt->header.length;
	120
	121	/* Parse all entries looking for a match. */
	122
	123	entry += sizeof(struct acpi_table_madt);
	124	while (entry + sizeof(struct acpi_subtable_header) < madt_end) {
	125	struct acpi_subtable_header *header =
	126	(struct acpi_subtable_header *)entry;
	127	if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) {
09c3f2bd	128	if (!map_lapic_id(header, acpi_id, &phys_id))
78ed8bd2 AC	129	break;
78ed8bd2 AC	130	} else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) {
09c3f2bd	131	if (!map_x2apic_id(header, type, acpi_id, &phys_id))
78ed8bd2 AC	132	break;
78ed8bd2 AC	133	} else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) {
09c3f2bd	134	if (!map_lsapic_id(header, type, acpi_id, &phys_id))
78ed8bd2	135	break;
020295b4	136	} else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT) {
09c3f2bd	137	if (!map_gicc_mpidr(header, type, acpi_id, &phys_id))
020295b4	138	break;
78ed8bd2 AC	139	}
	140	entry += header->length;
	141	}
af8f3f51	142	return phys_id;
78ed8bd2 AC	143	}
78ed8bd2 AC	144
fb7c2bae DD	145	phys_cpuid_t __init acpi_map_madt_entry(u32 acpi_id)
	146	{
	147	struct acpi_table_madt *madt = NULL;
fb7c2bae DD	148	phys_cpuid_t rv;
fb7c2bae DD	149
6b11d1d6 LZ	150	acpi_get_table(ACPI_SIG_MADT, 0,
6b11d1d6 LZ	151	(struct acpi_table_header **)&madt);
fb7c2bae DD	152	if (!madt)
	153	return PHYS_CPUID_INVALID;
	154
09c3f2bd	155	rv = map_madt_entry(madt, 1, acpi_id);
fb7c2bae	156
6b11d1d6	157	acpi_put_table((struct acpi_table_header *)madt);
fb7c2bae DD	158
	159	return rv;
	160	}
	161
09c3f2bd	162	static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id)
78ed8bd2 AC	163	{
	164	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	165	union acpi_object *obj;
	166	struct acpi_subtable_header *header;
828aef37	167	phys_cpuid_t phys_id = PHYS_CPUID_INVALID;
78ed8bd2 AC	168
	169	if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
	170	goto exit;
	171
	172	if (!buffer.length \|\| !buffer.pointer)
	173	goto exit;
	174
	175	obj = buffer.pointer;
	176	if (obj->type != ACPI_TYPE_BUFFER \|\|
	177	obj->buffer.length < sizeof(struct acpi_subtable_header)) {
	178	goto exit;
	179	}
	180
	181	header = (struct acpi_subtable_header *)obj->buffer.pointer;
13ca62b2	182	if (header->type == ACPI_MADT_TYPE_LOCAL_APIC)
09c3f2bd	183	map_lapic_id(header, acpi_id, &phys_id);
13ca62b2	184	else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC)
09c3f2bd	185	map_lsapic_id(header, type, acpi_id, &phys_id);
13ca62b2	186	else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC)
09c3f2bd	187	map_x2apic_id(header, type, acpi_id, &phys_id);
020295b4	188	else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT)
09c3f2bd	189	map_gicc_mpidr(header, type, acpi_id, &phys_id);
78ed8bd2 AC	190
78ed8bd2 AC	191	exit:
5273a258	192	kfree(buffer.pointer);
af8f3f51	193	return phys_id;
78ed8bd2 AC	194	}
78ed8bd2 AC	195
09c3f2bd	196	phys_cpuid_t acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id)
78ed8bd2	197	{
828aef37	198	phys_cpuid_t phys_id;
78ed8bd2	199
09c3f2bd	200	phys_id = map_mat_entry(handle, type, acpi_id);
ddcc18f5	201	if (invalid_phys_cpuid(phys_id))
09c3f2bd	202	phys_id = map_madt_entry(get_madt_table(), type, acpi_id);
ca9f62ac	203
af8f3f51	204	return phys_id;
ca9f62ac	205	}
166deb0f	206	EXPORT_SYMBOL_GPL(acpi_get_phys_id);
ca9f62ac	207
828aef37	208	int acpi_map_cpuid(phys_cpuid_t phys_id, u32 acpi_id)
ca9f62ac JL	209	{
	210	#ifdef CONFIG_SMP
	211	int i;
	212	#endif
	213
ddcc18f5	214	if (invalid_phys_cpuid(phys_id)) {
d640113f LM	215	/*
d640113f LM	216	* On UP processor, there is no _MAT or MADT table.
828aef37	217	* So above phys_id is always set to PHYS_CPUID_INVALID.
d640113f LM	218	*
	219	* BIOS may define multiple CPU handles even for UP processor.
	220	* For example,
	221	*
	222	* Scope (_PR)
13ca62b2	223	* {
d640113f LM	224	* Processor (CPU0, 0x00, 0x00000410, 0x06) {}
	225	* Processor (CPU1, 0x01, 0x00000410, 0x06) {}
	226	* Processor (CPU2, 0x02, 0x00000410, 0x06) {}
	227	* Processor (CPU3, 0x03, 0x00000410, 0x06) {}
	228	* }
	229	*
af8f3f51	230	* Ignores phys_id and always returns 0 for the processor
c4686c71 TR	231	* handle with acpi id 0 if nr_cpu_ids is 1.
c4686c71 TR	232	* This should be the case if SMP tables are not found.
d3da7cb9	233	* Return -EINVAL for other CPU's handle.
d640113f	234	*/
c4686c71	235	if (nr_cpu_ids <= 1 && acpi_id == 0)
d640113f LM	236	return acpi_id;
d640113f LM	237	else
d3da7cb9	238	return -EINVAL;
d640113f	239	}
78ed8bd2	240
932df741	241	#ifdef CONFIG_SMP
78ed8bd2	242	for_each_possible_cpu(i) {
af8f3f51	243	if (cpu_physical_id(i) == phys_id)
78ed8bd2 AC	244	return i;
78ed8bd2 AC	245	}
932df741 LM	246	#else
932df741 LM	247	/* In UP kernel, only processor 0 is valid */
af8f3f51 HG	248	if (phys_id == 0)
af8f3f51 HG	249	return phys_id;
932df741	250	#endif
d3da7cb9	251	return -ENODEV;
78ed8bd2	252	}
ca9f62ac JL	253
	254	int acpi_get_cpuid(acpi_handle handle, int type, u32 acpi_id)
	255	{
828aef37	256	phys_cpuid_t phys_id;
ca9f62ac	257
af8f3f51	258	phys_id = acpi_get_phys_id(handle, type, acpi_id);
ca9f62ac	259
af8f3f51	260	return acpi_map_cpuid(phys_id, acpi_id);
ca9f62ac	261	}
78ed8bd2	262	EXPORT_SYMBOL_GPL(acpi_get_cpuid);
ecf5636d YL	263
	264	#ifdef CONFIG_ACPI_HOTPLUG_IOAPIC
	265	static int get_ioapic_id(struct acpi_subtable_header *entry, u32 gsi_base,
	266	u64 phys_addr, int ioapic_id)
	267	{
	268	struct acpi_madt_io_apic ioapic = (struct acpi_madt_io_apic )entry;
	269
	270	if (ioapic->global_irq_base != gsi_base)
	271	return 0;
	272
	273	*phys_addr = ioapic->address;
	274	*ioapic_id = ioapic->id;
	275	return 1;
	276	}
	277
	278	static int parse_madt_ioapic_entry(u32 gsi_base, u64 *phys_addr)
	279	{
	280	struct acpi_subtable_header *hdr;
	281	unsigned long madt_end, entry;
	282	struct acpi_table_madt *madt;
	283	int apic_id = -1;
	284
	285	madt = get_madt_table();
	286	if (!madt)
	287	return apic_id;
	288
	289	entry = (unsigned long)madt;
	290	madt_end = entry + madt->header.length;
	291
	292	/* Parse all entries looking for a match. */
	293	entry += sizeof(struct acpi_table_madt);
	294	while (entry + sizeof(struct acpi_subtable_header) < madt_end) {
	295	hdr = (struct acpi_subtable_header *)entry;
	296	if (hdr->type == ACPI_MADT_TYPE_IO_APIC &&
	297	get_ioapic_id(hdr, gsi_base, phys_addr, &apic_id))
	298	break;
	299	else
	300	entry += hdr->length;
	301	}
	302
	303	return apic_id;
	304	}
	305
	306	static int parse_mat_ioapic_entry(acpi_handle handle, u32 gsi_base,
	307	u64 *phys_addr)
	308	{
	309	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	310	struct acpi_subtable_header *header;
	311	union acpi_object *obj;
	312	int apic_id = -1;
	313
	314	if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
	315	goto exit;
	316
	317	if (!buffer.length \|\| !buffer.pointer)
	318	goto exit;
	319
	320	obj = buffer.pointer;
	321	if (obj->type != ACPI_TYPE_BUFFER \|\|
	322	obj->buffer.length < sizeof(struct acpi_subtable_header))
	323	goto exit;
	324
	325	header = (struct acpi_subtable_header *)obj->buffer.pointer;
	326	if (header->type == ACPI_MADT_TYPE_IO_APIC)
327	get_ioapic_id(header, gsi_base, phys_addr, &apic_id);
328
329	exit:
330	kfree(buffer.pointer);
331	return apic_id;
332	}
333
334	/**
335	* acpi_get_ioapic_id - Get IOAPIC ID and physical address matching @gsi_base
336	* @handle: ACPI object for IOAPIC device
337	* @gsi_base: GSI base to match with
338	* @phys_addr: Pointer to store physical address of matching IOAPIC record
339	*
340	* Walk resources returned by ACPI_MAT method, then ACPI MADT table, to search
341	* for an ACPI IOAPIC record matching @gsi_base.
342	* Return IOAPIC id and store physical address in @phys_addr if found a match,
343	* otherwise return <0.
344	*/
345	int acpi_get_ioapic_id(acpi_handle handle, u32 gsi_base, u64 *phys_addr)
346	{
347	int apic_id;
348
349	apic_id = parse_mat_ioapic_entry(handle, gsi_base, phys_addr);
350	if (apic_id == -1)
351	apic_id = parse_madt_ioapic_entry(gsi_base, phys_addr);
352
353	return apic_id;
354	}
355	#endif /* CONFIG_ACPI_HOTPLUG_IOAPIC */