Commit | Line | Data |
---|---|---|
47817254 AC |
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 | |
ecf5636d YL |
7 | * |
8 | * I/O APIC hotplug support | |
9 | * Yinghai Lu <yinghai@kernel.org> | |
10 | * Jiang Liu <jiang.liu@intel.com> | |
47817254 | 11 | */ |
214f2c90 | 12 | #include <linux/export.h> |
8b48463f | 13 | #include <linux/acpi.h> |
78f16996 AC |
14 | #include <acpi/processor.h> |
15 | ||
78f16996 | 16 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT |
4d5d4cd8 | 17 | ACPI_MODULE_NAME("processor_core"); |
78f16996 | 18 | |
ecf5636d YL |
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 | ||
78ed8bd2 AC |
34 | static int map_lapic_id(struct acpi_subtable_header *entry, |
35 | u32 acpi_id, int *apic_id) | |
36 | { | |
37 | struct acpi_madt_local_apic *lapic = | |
ef86c3f4 | 38 | container_of(entry, struct acpi_madt_local_apic, header); |
11130736 AC |
39 | |
40 | if (!(lapic->lapic_flags & ACPI_MADT_ENABLED)) | |
038d7b59 | 41 | return -ENODEV; |
11130736 AC |
42 | |
43 | if (lapic->processor_id != acpi_id) | |
038d7b59 | 44 | return -EINVAL; |
11130736 AC |
45 | |
46 | *apic_id = lapic->id; | |
038d7b59 | 47 | return 0; |
78ed8bd2 AC |
48 | } |
49 | ||
50 | static int map_x2apic_id(struct acpi_subtable_header *entry, | |
51 | int device_declaration, u32 acpi_id, int *apic_id) | |
52 | { | |
53 | struct acpi_madt_local_x2apic *apic = | |
ef86c3f4 | 54 | container_of(entry, struct acpi_madt_local_x2apic, header); |
78ed8bd2 | 55 | |
78ed8bd2 | 56 | if (!(apic->lapic_flags & ACPI_MADT_ENABLED)) |
038d7b59 | 57 | return -ENODEV; |
78ed8bd2 | 58 | |
d6742095 AC |
59 | if (device_declaration && (apic->uid == acpi_id)) { |
60 | *apic_id = apic->local_apic_id; | |
038d7b59 | 61 | return 0; |
78ed8bd2 AC |
62 | } |
63 | ||
038d7b59 | 64 | return -EINVAL; |
78ed8bd2 AC |
65 | } |
66 | ||
67 | static int map_lsapic_id(struct acpi_subtable_header *entry, | |
68 | int device_declaration, u32 acpi_id, int *apic_id) | |
69 | { | |
70 | struct acpi_madt_local_sapic *lsapic = | |
ef86c3f4 | 71 | container_of(entry, struct acpi_madt_local_sapic, header); |
78ed8bd2 | 72 | |
78ed8bd2 | 73 | if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED)) |
038d7b59 | 74 | return -ENODEV; |
78ed8bd2 | 75 | |
78ed8bd2 | 76 | if (device_declaration) { |
eae701ce | 77 | if ((entry->length < 16) || (lsapic->uid != acpi_id)) |
038d7b59 | 78 | return -EINVAL; |
eae701ce | 79 | } else if (lsapic->processor_id != acpi_id) |
038d7b59 | 80 | return -EINVAL; |
78ed8bd2 | 81 | |
eae701ce | 82 | *apic_id = (lsapic->id << 8) | lsapic->eid; |
038d7b59 | 83 | return 0; |
78ed8bd2 AC |
84 | } |
85 | ||
86 | static int map_madt_entry(int type, u32 acpi_id) | |
87 | { | |
88 | unsigned long madt_end, entry; | |
af8f3f51 | 89 | int phys_id = -1; /* CPU hardware ID */ |
ecf5636d | 90 | struct acpi_table_madt *madt; |
78ed8bd2 | 91 | |
ecf5636d | 92 | madt = get_madt_table(); |
78ed8bd2 | 93 | if (!madt) |
af8f3f51 | 94 | return phys_id; |
78ed8bd2 AC |
95 | |
96 | entry = (unsigned long)madt; | |
97 | madt_end = entry + madt->header.length; | |
98 | ||
99 | /* Parse all entries looking for a match. */ | |
100 | ||
101 | entry += sizeof(struct acpi_table_madt); | |
102 | while (entry + sizeof(struct acpi_subtable_header) < madt_end) { | |
103 | struct acpi_subtable_header *header = | |
104 | (struct acpi_subtable_header *)entry; | |
105 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) { | |
af8f3f51 | 106 | if (!map_lapic_id(header, acpi_id, &phys_id)) |
78ed8bd2 AC |
107 | break; |
108 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) { | |
af8f3f51 | 109 | if (!map_x2apic_id(header, type, acpi_id, &phys_id)) |
78ed8bd2 AC |
110 | break; |
111 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) { | |
af8f3f51 | 112 | if (!map_lsapic_id(header, type, acpi_id, &phys_id)) |
78ed8bd2 AC |
113 | break; |
114 | } | |
115 | entry += header->length; | |
116 | } | |
af8f3f51 | 117 | return phys_id; |
78ed8bd2 AC |
118 | } |
119 | ||
120 | static int map_mat_entry(acpi_handle handle, int type, u32 acpi_id) | |
121 | { | |
122 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
123 | union acpi_object *obj; | |
124 | struct acpi_subtable_header *header; | |
af8f3f51 | 125 | int phys_id = -1; |
78ed8bd2 AC |
126 | |
127 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer))) | |
128 | goto exit; | |
129 | ||
130 | if (!buffer.length || !buffer.pointer) | |
131 | goto exit; | |
132 | ||
133 | obj = buffer.pointer; | |
134 | if (obj->type != ACPI_TYPE_BUFFER || | |
135 | obj->buffer.length < sizeof(struct acpi_subtable_header)) { | |
136 | goto exit; | |
137 | } | |
138 | ||
139 | header = (struct acpi_subtable_header *)obj->buffer.pointer; | |
13ca62b2 | 140 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) |
af8f3f51 | 141 | map_lapic_id(header, acpi_id, &phys_id); |
13ca62b2 | 142 | else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) |
af8f3f51 | 143 | map_lsapic_id(header, type, acpi_id, &phys_id); |
13ca62b2 | 144 | else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) |
af8f3f51 | 145 | map_x2apic_id(header, type, acpi_id, &phys_id); |
78ed8bd2 AC |
146 | |
147 | exit: | |
5273a258 | 148 | kfree(buffer.pointer); |
af8f3f51 | 149 | return phys_id; |
78ed8bd2 AC |
150 | } |
151 | ||
af8f3f51 | 152 | int acpi_get_phys_id(acpi_handle handle, int type, u32 acpi_id) |
78ed8bd2 | 153 | { |
af8f3f51 | 154 | int phys_id; |
78ed8bd2 | 155 | |
af8f3f51 HG |
156 | phys_id = map_mat_entry(handle, type, acpi_id); |
157 | if (phys_id == -1) | |
158 | phys_id = map_madt_entry(type, acpi_id); | |
ca9f62ac | 159 | |
af8f3f51 | 160 | return phys_id; |
ca9f62ac JL |
161 | } |
162 | ||
af8f3f51 | 163 | int acpi_map_cpuid(int phys_id, u32 acpi_id) |
ca9f62ac JL |
164 | { |
165 | #ifdef CONFIG_SMP | |
166 | int i; | |
167 | #endif | |
168 | ||
af8f3f51 | 169 | if (phys_id == -1) { |
d640113f LM |
170 | /* |
171 | * On UP processor, there is no _MAT or MADT table. | |
af8f3f51 | 172 | * So above phys_id is always set to -1. |
d640113f LM |
173 | * |
174 | * BIOS may define multiple CPU handles even for UP processor. | |
175 | * For example, | |
176 | * | |
177 | * Scope (_PR) | |
13ca62b2 | 178 | * { |
d640113f LM |
179 | * Processor (CPU0, 0x00, 0x00000410, 0x06) {} |
180 | * Processor (CPU1, 0x01, 0x00000410, 0x06) {} | |
181 | * Processor (CPU2, 0x02, 0x00000410, 0x06) {} | |
182 | * Processor (CPU3, 0x03, 0x00000410, 0x06) {} | |
183 | * } | |
184 | * | |
af8f3f51 | 185 | * Ignores phys_id and always returns 0 for the processor |
c4686c71 TR |
186 | * handle with acpi id 0 if nr_cpu_ids is 1. |
187 | * This should be the case if SMP tables are not found. | |
d640113f LM |
188 | * Return -1 for other CPU's handle. |
189 | */ | |
c4686c71 | 190 | if (nr_cpu_ids <= 1 && acpi_id == 0) |
d640113f LM |
191 | return acpi_id; |
192 | else | |
af8f3f51 | 193 | return phys_id; |
d640113f | 194 | } |
78ed8bd2 | 195 | |
932df741 | 196 | #ifdef CONFIG_SMP |
78ed8bd2 | 197 | for_each_possible_cpu(i) { |
af8f3f51 | 198 | if (cpu_physical_id(i) == phys_id) |
78ed8bd2 AC |
199 | return i; |
200 | } | |
932df741 LM |
201 | #else |
202 | /* In UP kernel, only processor 0 is valid */ | |
af8f3f51 HG |
203 | if (phys_id == 0) |
204 | return phys_id; | |
932df741 | 205 | #endif |
78ed8bd2 AC |
206 | return -1; |
207 | } | |
ca9f62ac JL |
208 | |
209 | int acpi_get_cpuid(acpi_handle handle, int type, u32 acpi_id) | |
210 | { | |
af8f3f51 | 211 | int phys_id; |
ca9f62ac | 212 | |
af8f3f51 | 213 | phys_id = acpi_get_phys_id(handle, type, acpi_id); |
ca9f62ac | 214 | |
af8f3f51 | 215 | return acpi_map_cpuid(phys_id, acpi_id); |
ca9f62ac | 216 | } |
78ed8bd2 | 217 | EXPORT_SYMBOL_GPL(acpi_get_cpuid); |
ecf5636d YL |
218 | |
219 | #ifdef CONFIG_ACPI_HOTPLUG_IOAPIC | |
220 | static int get_ioapic_id(struct acpi_subtable_header *entry, u32 gsi_base, | |
221 | u64 *phys_addr, int *ioapic_id) | |
222 | { | |
223 | struct acpi_madt_io_apic *ioapic = (struct acpi_madt_io_apic *)entry; | |
224 | ||
225 | if (ioapic->global_irq_base != gsi_base) | |
226 | return 0; | |
227 | ||
228 | *phys_addr = ioapic->address; | |
229 | *ioapic_id = ioapic->id; | |
230 | return 1; | |
231 | } | |
232 | ||
233 | static int parse_madt_ioapic_entry(u32 gsi_base, u64 *phys_addr) | |
234 | { | |
235 | struct acpi_subtable_header *hdr; | |
236 | unsigned long madt_end, entry; | |
237 | struct acpi_table_madt *madt; | |
238 | int apic_id = -1; | |
239 | ||
240 | madt = get_madt_table(); | |
241 | if (!madt) | |
242 | return apic_id; | |
243 | ||
244 | entry = (unsigned long)madt; | |
245 | madt_end = entry + madt->header.length; | |
246 | ||
247 | /* Parse all entries looking for a match. */ | |
248 | entry += sizeof(struct acpi_table_madt); | |
249 | while (entry + sizeof(struct acpi_subtable_header) < madt_end) { | |
250 | hdr = (struct acpi_subtable_header *)entry; | |
251 | if (hdr->type == ACPI_MADT_TYPE_IO_APIC && | |
252 | get_ioapic_id(hdr, gsi_base, phys_addr, &apic_id)) | |
253 | break; | |
254 | else | |
255 | entry += hdr->length; | |
256 | } | |
257 | ||
258 | return apic_id; | |
259 | } | |
260 | ||
261 | static int parse_mat_ioapic_entry(acpi_handle handle, u32 gsi_base, | |
262 | u64 *phys_addr) | |
263 | { | |
264 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
265 | struct acpi_subtable_header *header; | |
266 | union acpi_object *obj; | |
267 | int apic_id = -1; | |
268 | ||
269 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer))) | |
270 | goto exit; | |
271 | ||
272 | if (!buffer.length || !buffer.pointer) | |
273 | goto exit; | |
274 | ||
275 | obj = buffer.pointer; | |
276 | if (obj->type != ACPI_TYPE_BUFFER || | |
277 | obj->buffer.length < sizeof(struct acpi_subtable_header)) | |
278 | goto exit; | |
279 | ||
280 | header = (struct acpi_subtable_header *)obj->buffer.pointer; | |
281 | if (header->type == ACPI_MADT_TYPE_IO_APIC) | |
282 | get_ioapic_id(header, gsi_base, phys_addr, &apic_id); | |
283 | ||
284 | exit: | |
285 | kfree(buffer.pointer); | |
286 | return apic_id; | |
287 | } | |
288 | ||
289 | /** | |
290 | * acpi_get_ioapic_id - Get IOAPIC ID and physical address matching @gsi_base | |
291 | * @handle: ACPI object for IOAPIC device | |
292 | * @gsi_base: GSI base to match with | |
293 | * @phys_addr: Pointer to store physical address of matching IOAPIC record | |
294 | * | |
295 | * Walk resources returned by ACPI_MAT method, then ACPI MADT table, to search | |
296 | * for an ACPI IOAPIC record matching @gsi_base. | |
297 | * Return IOAPIC id and store physical address in @phys_addr if found a match, | |
298 | * otherwise return <0. | |
299 | */ | |
300 | int acpi_get_ioapic_id(acpi_handle handle, u32 gsi_base, u64 *phys_addr) | |
301 | { | |
302 | int apic_id; | |
303 | ||
304 | apic_id = parse_mat_ioapic_entry(handle, gsi_base, phys_addr); | |
305 | if (apic_id == -1) | |
306 | apic_id = parse_madt_ioapic_entry(gsi_base, phys_addr); | |
307 | ||
308 | return apic_id; | |
309 | } | |
310 | #endif /* CONFIG_ACPI_HOTPLUG_IOAPIC */ |