|
@@ -32,12 +32,12 @@ static struct acpi_table_madt *get_madt_table(void)
|
|
|
}
|
|
|
|
|
|
static int map_lapic_id(struct acpi_subtable_header *entry,
|
|
|
- u32 acpi_id, phys_cpuid_t *apic_id)
|
|
|
+ u32 acpi_id, phys_cpuid_t *apic_id, bool ignore_disabled)
|
|
|
{
|
|
|
struct acpi_madt_local_apic *lapic =
|
|
|
container_of(entry, struct acpi_madt_local_apic, header);
|
|
|
|
|
|
- if (!(lapic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
+ if (ignore_disabled && !(lapic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
return -ENODEV;
|
|
|
|
|
|
if (lapic->processor_id != acpi_id)
|
|
@@ -48,12 +48,13 @@ static int map_lapic_id(struct acpi_subtable_header *entry,
|
|
|
}
|
|
|
|
|
|
static int map_x2apic_id(struct acpi_subtable_header *entry,
|
|
|
- int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
|
|
|
+ int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id,
|
|
|
+ bool ignore_disabled)
|
|
|
{
|
|
|
struct acpi_madt_local_x2apic *apic =
|
|
|
container_of(entry, struct acpi_madt_local_x2apic, header);
|
|
|
|
|
|
- if (!(apic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
+ if (ignore_disabled && !(apic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
return -ENODEV;
|
|
|
|
|
|
if (device_declaration && (apic->uid == acpi_id)) {
|
|
@@ -65,12 +66,13 @@ static int map_x2apic_id(struct acpi_subtable_header *entry,
|
|
|
}
|
|
|
|
|
|
static int map_lsapic_id(struct acpi_subtable_header *entry,
|
|
|
- int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id)
|
|
|
+ int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id,
|
|
|
+ bool ignore_disabled)
|
|
|
{
|
|
|
struct acpi_madt_local_sapic *lsapic =
|
|
|
container_of(entry, struct acpi_madt_local_sapic, header);
|
|
|
|
|
|
- if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
+ if (ignore_disabled && !(lsapic->lapic_flags & ACPI_MADT_ENABLED))
|
|
|
return -ENODEV;
|
|
|
|
|
|
if (device_declaration) {
|
|
@@ -87,12 +89,13 @@ static int map_lsapic_id(struct acpi_subtable_header *entry,
|
|
|
* 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)
|
|
|
+ int device_declaration, u32 acpi_id, phys_cpuid_t *mpidr,
|
|
|
+ bool ignore_disabled)
|
|
|
{
|
|
|
struct acpi_madt_generic_interrupt *gicc =
|
|
|
container_of(entry, struct acpi_madt_generic_interrupt, header);
|
|
|
|
|
|
- if (!(gicc->flags & ACPI_MADT_ENABLED))
|
|
|
+ if (ignore_disabled && !(gicc->flags & ACPI_MADT_ENABLED))
|
|
|
return -ENODEV;
|
|
|
|
|
|
/* device_declaration means Device object in DSDT, in the
|
|
@@ -109,7 +112,7 @@ static int map_gicc_mpidr(struct acpi_subtable_header *entry,
|
|
|
}
|
|
|
|
|
|
static phys_cpuid_t map_madt_entry(struct acpi_table_madt *madt,
|
|
|
- int type, u32 acpi_id)
|
|
|
+ int type, u32 acpi_id, bool ignore_disabled)
|
|
|
{
|
|
|
unsigned long madt_end, entry;
|
|
|
phys_cpuid_t phys_id = PHYS_CPUID_INVALID; /* CPU hardware ID */
|
|
@@ -127,16 +130,20 @@ static phys_cpuid_t map_madt_entry(struct acpi_table_madt *madt,
|
|
|
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))
|
|
|
+ if (!map_lapic_id(header, acpi_id, &phys_id,
|
|
|
+ ignore_disabled))
|
|
|
break;
|
|
|
} else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) {
|
|
|
- if (!map_x2apic_id(header, type, acpi_id, &phys_id))
|
|
|
+ if (!map_x2apic_id(header, type, acpi_id, &phys_id,
|
|
|
+ ignore_disabled))
|
|
|
break;
|
|
|
} else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) {
|
|
|
- if (!map_lsapic_id(header, type, acpi_id, &phys_id))
|
|
|
+ if (!map_lsapic_id(header, type, acpi_id, &phys_id,
|
|
|
+ ignore_disabled))
|
|
|
break;
|
|
|
} else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT) {
|
|
|
- if (!map_gicc_mpidr(header, type, acpi_id, &phys_id))
|
|
|
+ if (!map_gicc_mpidr(header, type, acpi_id, &phys_id,
|
|
|
+ ignore_disabled))
|
|
|
break;
|
|
|
}
|
|
|
entry += header->length;
|
|
@@ -156,14 +163,15 @@ phys_cpuid_t __init acpi_map_madt_entry(u32 acpi_id)
|
|
|
if (!madt)
|
|
|
return PHYS_CPUID_INVALID;
|
|
|
|
|
|
- rv = map_madt_entry(madt, 1, acpi_id);
|
|
|
+ rv = map_madt_entry(madt, 1, acpi_id, true);
|
|
|
|
|
|
early_acpi_os_unmap_memory(madt, tbl_size);
|
|
|
|
|
|
return rv;
|
|
|
}
|
|
|
|
|
|
-static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id)
|
|
|
+static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id,
|
|
|
+ bool ignore_disabled)
|
|
|
{
|
|
|
struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
|
|
|
union acpi_object *obj;
|
|
@@ -184,30 +192,38 @@ static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id)
|
|
|
|
|
|
header = (struct acpi_subtable_header *)obj->buffer.pointer;
|
|
|
if (header->type == ACPI_MADT_TYPE_LOCAL_APIC)
|
|
|
- map_lapic_id(header, acpi_id, &phys_id);
|
|
|
+ map_lapic_id(header, acpi_id, &phys_id, ignore_disabled);
|
|
|
else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC)
|
|
|
- map_lsapic_id(header, type, acpi_id, &phys_id);
|
|
|
+ map_lsapic_id(header, type, acpi_id, &phys_id, ignore_disabled);
|
|
|
else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC)
|
|
|
- map_x2apic_id(header, type, acpi_id, &phys_id);
|
|
|
+ map_x2apic_id(header, type, acpi_id, &phys_id, ignore_disabled);
|
|
|
else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT)
|
|
|
- map_gicc_mpidr(header, type, acpi_id, &phys_id);
|
|
|
+ map_gicc_mpidr(header, type, acpi_id, &phys_id,
|
|
|
+ ignore_disabled);
|
|
|
|
|
|
exit:
|
|
|
kfree(buffer.pointer);
|
|
|
return phys_id;
|
|
|
}
|
|
|
|
|
|
-phys_cpuid_t acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id)
|
|
|
+static phys_cpuid_t __acpi_get_phys_id(acpi_handle handle, int type,
|
|
|
+ u32 acpi_id, bool ignore_disabled)
|
|
|
{
|
|
|
phys_cpuid_t phys_id;
|
|
|
|
|
|
- phys_id = map_mat_entry(handle, type, acpi_id);
|
|
|
+ phys_id = map_mat_entry(handle, type, acpi_id, ignore_disabled);
|
|
|
if (invalid_phys_cpuid(phys_id))
|
|
|
- phys_id = map_madt_entry(get_madt_table(), type, acpi_id);
|
|
|
+ phys_id = map_madt_entry(get_madt_table(), type, acpi_id,
|
|
|
+ ignore_disabled);
|
|
|
|
|
|
return phys_id;
|
|
|
}
|
|
|
|
|
|
+phys_cpuid_t acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id)
|
|
|
+{
|
|
|
+ return __acpi_get_phys_id(handle, type, acpi_id, true);
|
|
|
+}
|
|
|
+
|
|
|
int acpi_map_cpuid(phys_cpuid_t phys_id, u32 acpi_id)
|
|
|
{
|
|
|
#ifdef CONFIG_SMP
|