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> |
16 | ||
78f16996 | 17 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT |
4d5d4cd8 | 18 | ACPI_MODULE_NAME("processor_core"); |
78f16996 | 19 | |
ecf5636d YL |
20 | static struct acpi_table_madt *get_madt_table(void) |
21 | { | |
22 | static struct acpi_table_madt *madt; | |
23 | static int read_madt; | |
24 | ||
25 | if (!read_madt) { | |
26 | if (ACPI_FAILURE(acpi_get_table(ACPI_SIG_MADT, 0, | |
27 | (struct acpi_table_header **)&madt))) | |
28 | madt = NULL; | |
29 | read_madt++; | |
30 | } | |
31 | ||
32 | return madt; | |
33 | } | |
34 | ||
78ed8bd2 | 35 | static int map_lapic_id(struct acpi_subtable_header *entry, |
09c3f2bd | 36 | u32 acpi_id, phys_cpuid_t *apic_id) |
78ed8bd2 AC |
37 | { |
38 | struct acpi_madt_local_apic *lapic = | |
ef86c3f4 | 39 | container_of(entry, struct acpi_madt_local_apic, header); |
11130736 | 40 | |
09c3f2bd | 41 | if (!(lapic->lapic_flags & ACPI_MADT_ENABLED)) |
038d7b59 | 42 | return -ENODEV; |
11130736 AC |
43 | |
44 | if (lapic->processor_id != acpi_id) | |
038d7b59 | 45 | return -EINVAL; |
11130736 AC |
46 | |
47 | *apic_id = lapic->id; | |
038d7b59 | 48 | return 0; |
78ed8bd2 AC |
49 | } |
50 | ||
51 | static int map_x2apic_id(struct acpi_subtable_header *entry, | |
09c3f2bd | 52 | int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id) |
78ed8bd2 AC |
53 | { |
54 | struct acpi_madt_local_x2apic *apic = | |
ef86c3f4 | 55 | container_of(entry, struct acpi_madt_local_x2apic, header); |
78ed8bd2 | 56 | |
09c3f2bd | 57 | if (!(apic->lapic_flags & ACPI_MADT_ENABLED)) |
038d7b59 | 58 | return -ENODEV; |
78ed8bd2 | 59 | |
d6742095 AC |
60 | if (device_declaration && (apic->uid == acpi_id)) { |
61 | *apic_id = apic->local_apic_id; | |
038d7b59 | 62 | return 0; |
78ed8bd2 AC |
63 | } |
64 | ||
038d7b59 | 65 | return -EINVAL; |
78ed8bd2 AC |
66 | } |
67 | ||
68 | static int map_lsapic_id(struct acpi_subtable_header *entry, | |
09c3f2bd | 69 | int device_declaration, u32 acpi_id, phys_cpuid_t *apic_id) |
78ed8bd2 AC |
70 | { |
71 | struct acpi_madt_local_sapic *lsapic = | |
ef86c3f4 | 72 | container_of(entry, struct acpi_madt_local_sapic, header); |
78ed8bd2 | 73 | |
09c3f2bd | 74 | if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED)) |
038d7b59 | 75 | return -ENODEV; |
78ed8bd2 | 76 | |
78ed8bd2 | 77 | if (device_declaration) { |
eae701ce | 78 | if ((entry->length < 16) || (lsapic->uid != acpi_id)) |
038d7b59 | 79 | return -EINVAL; |
eae701ce | 80 | } else if (lsapic->processor_id != acpi_id) |
038d7b59 | 81 | return -EINVAL; |
78ed8bd2 | 82 | |
eae701ce | 83 | *apic_id = (lsapic->id << 8) | lsapic->eid; |
038d7b59 | 84 | return 0; |
78ed8bd2 AC |
85 | } |
86 | ||
020295b4 HG |
87 | /* |
88 | * Retrieve the ARM CPU physical identifier (MPIDR) | |
89 | */ | |
90 | static int map_gicc_mpidr(struct acpi_subtable_header *entry, | |
09c3f2bd | 91 | int device_declaration, u32 acpi_id, phys_cpuid_t *mpidr) |
020295b4 HG |
92 | { |
93 | struct acpi_madt_generic_interrupt *gicc = | |
94 | container_of(entry, struct acpi_madt_generic_interrupt, header); | |
95 | ||
09c3f2bd | 96 | if (!(gicc->flags & ACPI_MADT_ENABLED)) |
020295b4 HG |
97 | return -ENODEV; |
98 | ||
99 | /* device_declaration means Device object in DSDT, in the | |
100 | * GIC interrupt model, logical processors are required to | |
101 | * have a Processor Device object in the DSDT, so we should | |
102 | * check device_declaration here | |
103 | */ | |
104 | if (device_declaration && (gicc->uid == acpi_id)) { | |
105 | *mpidr = gicc->arm_mpidr; | |
106 | return 0; | |
107 | } | |
108 | ||
109 | return -EINVAL; | |
110 | } | |
111 | ||
fb7c2bae | 112 | static phys_cpuid_t map_madt_entry(struct acpi_table_madt *madt, |
09c3f2bd | 113 | int type, u32 acpi_id) |
78ed8bd2 AC |
114 | { |
115 | unsigned long madt_end, entry; | |
828aef37 | 116 | phys_cpuid_t phys_id = PHYS_CPUID_INVALID; /* CPU hardware ID */ |
78ed8bd2 AC |
117 | |
118 | if (!madt) | |
af8f3f51 | 119 | return phys_id; |
78ed8bd2 AC |
120 | |
121 | entry = (unsigned long)madt; | |
122 | madt_end = entry + madt->header.length; | |
123 | ||
124 | /* Parse all entries looking for a match. */ | |
125 | ||
126 | entry += sizeof(struct acpi_table_madt); | |
127 | while (entry + sizeof(struct acpi_subtable_header) < madt_end) { | |
128 | struct acpi_subtable_header *header = | |
129 | (struct acpi_subtable_header *)entry; | |
130 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) { | |
09c3f2bd | 131 | if (!map_lapic_id(header, acpi_id, &phys_id)) |
78ed8bd2 AC |
132 | break; |
133 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) { | |
09c3f2bd | 134 | if (!map_x2apic_id(header, type, acpi_id, &phys_id)) |
78ed8bd2 AC |
135 | break; |
136 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) { | |
09c3f2bd | 137 | if (!map_lsapic_id(header, type, acpi_id, &phys_id)) |
78ed8bd2 | 138 | break; |
020295b4 | 139 | } else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT) { |
09c3f2bd | 140 | if (!map_gicc_mpidr(header, type, acpi_id, &phys_id)) |
020295b4 | 141 | break; |
78ed8bd2 AC |
142 | } |
143 | entry += header->length; | |
144 | } | |
af8f3f51 | 145 | return phys_id; |
78ed8bd2 AC |
146 | } |
147 | ||
fb7c2bae DD |
148 | phys_cpuid_t __init acpi_map_madt_entry(u32 acpi_id) |
149 | { | |
150 | struct acpi_table_madt *madt = NULL; | |
fb7c2bae DD |
151 | phys_cpuid_t rv; |
152 | ||
6b11d1d6 LZ |
153 | acpi_get_table(ACPI_SIG_MADT, 0, |
154 | (struct acpi_table_header **)&madt); | |
fb7c2bae DD |
155 | if (!madt) |
156 | return PHYS_CPUID_INVALID; | |
157 | ||
09c3f2bd | 158 | rv = map_madt_entry(madt, 1, acpi_id); |
fb7c2bae | 159 | |
6b11d1d6 | 160 | acpi_put_table((struct acpi_table_header *)madt); |
fb7c2bae DD |
161 | |
162 | return rv; | |
163 | } | |
164 | ||
09c3f2bd | 165 | static phys_cpuid_t map_mat_entry(acpi_handle handle, int type, u32 acpi_id) |
78ed8bd2 AC |
166 | { |
167 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
168 | union acpi_object *obj; | |
169 | struct acpi_subtable_header *header; | |
828aef37 | 170 | phys_cpuid_t phys_id = PHYS_CPUID_INVALID; |
78ed8bd2 AC |
171 | |
172 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer))) | |
173 | goto exit; | |
174 | ||
175 | if (!buffer.length || !buffer.pointer) | |
176 | goto exit; | |
177 | ||
178 | obj = buffer.pointer; | |
179 | if (obj->type != ACPI_TYPE_BUFFER || | |
180 | obj->buffer.length < sizeof(struct acpi_subtable_header)) { | |
181 | goto exit; | |
182 | } | |
183 | ||
184 | header = (struct acpi_subtable_header *)obj->buffer.pointer; | |
13ca62b2 | 185 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) |
09c3f2bd | 186 | map_lapic_id(header, acpi_id, &phys_id); |
13ca62b2 | 187 | else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) |
09c3f2bd | 188 | map_lsapic_id(header, type, acpi_id, &phys_id); |
13ca62b2 | 189 | else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) |
09c3f2bd | 190 | map_x2apic_id(header, type, acpi_id, &phys_id); |
020295b4 | 191 | else if (header->type == ACPI_MADT_TYPE_GENERIC_INTERRUPT) |
09c3f2bd | 192 | map_gicc_mpidr(header, type, acpi_id, &phys_id); |
78ed8bd2 AC |
193 | |
194 | exit: | |
5273a258 | 195 | kfree(buffer.pointer); |
af8f3f51 | 196 | return phys_id; |
78ed8bd2 AC |
197 | } |
198 | ||
09c3f2bd | 199 | phys_cpuid_t acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id) |
78ed8bd2 | 200 | { |
828aef37 | 201 | phys_cpuid_t phys_id; |
78ed8bd2 | 202 | |
09c3f2bd | 203 | phys_id = map_mat_entry(handle, type, acpi_id); |
ddcc18f5 | 204 | if (invalid_phys_cpuid(phys_id)) |
09c3f2bd | 205 | phys_id = map_madt_entry(get_madt_table(), type, acpi_id); |
ca9f62ac | 206 | |
af8f3f51 | 207 | return phys_id; |
ca9f62ac | 208 | } |
166deb0f | 209 | EXPORT_SYMBOL_GPL(acpi_get_phys_id); |
ca9f62ac | 210 | |
828aef37 | 211 | int acpi_map_cpuid(phys_cpuid_t phys_id, u32 acpi_id) |
ca9f62ac JL |
212 | { |
213 | #ifdef CONFIG_SMP | |
214 | int i; | |
215 | #endif | |
216 | ||
ddcc18f5 | 217 | if (invalid_phys_cpuid(phys_id)) { |
d640113f LM |
218 | /* |
219 | * On UP processor, there is no _MAT or MADT table. | |
828aef37 | 220 | * So above phys_id is always set to PHYS_CPUID_INVALID. |
d640113f LM |
221 | * |
222 | * BIOS may define multiple CPU handles even for UP processor. | |
223 | * For example, | |
224 | * | |
225 | * Scope (_PR) | |
13ca62b2 | 226 | * { |
d640113f LM |
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 | * | |
af8f3f51 | 233 | * Ignores phys_id and always returns 0 for the processor |
c4686c71 TR |
234 | * handle with acpi id 0 if nr_cpu_ids is 1. |
235 | * This should be the case if SMP tables are not found. | |
d3da7cb9 | 236 | * Return -EINVAL for other CPU's handle. |
d640113f | 237 | */ |
c4686c71 | 238 | if (nr_cpu_ids <= 1 && acpi_id == 0) |
d640113f LM |
239 | return acpi_id; |
240 | else | |
d3da7cb9 | 241 | return -EINVAL; |
d640113f | 242 | } |
78ed8bd2 | 243 | |
932df741 | 244 | #ifdef CONFIG_SMP |
78ed8bd2 | 245 | for_each_possible_cpu(i) { |
af8f3f51 | 246 | if (cpu_physical_id(i) == phys_id) |
78ed8bd2 AC |
247 | return i; |
248 | } | |
932df741 LM |
249 | #else |
250 | /* In UP kernel, only processor 0 is valid */ | |
af8f3f51 HG |
251 | if (phys_id == 0) |
252 | return phys_id; | |
932df741 | 253 | #endif |
d3da7cb9 | 254 | return -ENODEV; |
78ed8bd2 | 255 | } |
ca9f62ac JL |
256 | |
257 | int acpi_get_cpuid(acpi_handle handle, int type, u32 acpi_id) | |
258 | { | |
828aef37 | 259 | phys_cpuid_t phys_id; |
ca9f62ac | 260 | |
af8f3f51 | 261 | phys_id = acpi_get_phys_id(handle, type, acpi_id); |
ca9f62ac | 262 | |
af8f3f51 | 263 | return acpi_map_cpuid(phys_id, acpi_id); |
ca9f62ac | 264 | } |
78ed8bd2 | 265 | EXPORT_SYMBOL_GPL(acpi_get_cpuid); |
ecf5636d YL |
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 */ |