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