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 | |
7 | * Venkatesh Pallipadi <venkatesh.pallipadi@intel.com> | |
8 | * - Added _PDC for platforms with Intel CPUs | |
9 | */ | |
78f16996 | 10 | #include <linux/dmi.h> |
5a0e3ad6 | 11 | #include <linux/slab.h> |
78f16996 AC |
12 | |
13 | #include <acpi/acpi_drivers.h> | |
14 | #include <acpi/processor.h> | |
15 | ||
16 | #include "internal.h" | |
17 | ||
18 | #define PREFIX "ACPI: " | |
19 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT | |
4d5d4cd8 | 20 | ACPI_MODULE_NAME("processor_core"); |
78f16996 AC |
21 | |
22 | static int set_no_mwait(const struct dmi_system_id *id) | |
23 | { | |
24 | printk(KERN_NOTICE PREFIX "%s detected - " | |
25 | "disabling mwait for CPU C-states\n", id->ident); | |
d1896049 | 26 | boot_option_idle_override = IDLE_NOMWAIT; |
78f16996 AC |
27 | return 0; |
28 | } | |
29 | ||
30 | static struct dmi_system_id __cpuinitdata processor_idle_dmi_table[] = { | |
78f16996 AC |
31 | { |
32 | set_no_mwait, "Extensa 5220", { | |
33 | DMI_MATCH(DMI_BIOS_VENDOR, "Phoenix Technologies LTD"), | |
34 | DMI_MATCH(DMI_SYS_VENDOR, "Acer"), | |
35 | DMI_MATCH(DMI_PRODUCT_VERSION, "0100"), | |
36 | DMI_MATCH(DMI_BOARD_NAME, "Columbia") }, NULL}, | |
37 | {}, | |
38 | }; | |
39 | ||
78ed8bd2 | 40 | #ifdef CONFIG_SMP |
78ed8bd2 AC |
41 | static int map_lapic_id(struct acpi_subtable_header *entry, |
42 | u32 acpi_id, int *apic_id) | |
43 | { | |
44 | struct acpi_madt_local_apic *lapic = | |
45 | (struct acpi_madt_local_apic *)entry; | |
11130736 AC |
46 | |
47 | if (!(lapic->lapic_flags & ACPI_MADT_ENABLED)) | |
48 | return 0; | |
49 | ||
50 | if (lapic->processor_id != acpi_id) | |
51 | return 0; | |
52 | ||
53 | *apic_id = lapic->id; | |
54 | return 1; | |
78ed8bd2 AC |
55 | } |
56 | ||
57 | static int map_x2apic_id(struct acpi_subtable_header *entry, | |
58 | int device_declaration, u32 acpi_id, int *apic_id) | |
59 | { | |
60 | struct acpi_madt_local_x2apic *apic = | |
61 | (struct acpi_madt_local_x2apic *)entry; | |
78ed8bd2 | 62 | |
78ed8bd2 AC |
63 | if (!(apic->lapic_flags & ACPI_MADT_ENABLED)) |
64 | return 0; | |
65 | ||
d6742095 AC |
66 | if (device_declaration && (apic->uid == acpi_id)) { |
67 | *apic_id = apic->local_apic_id; | |
68 | return 1; | |
78ed8bd2 AC |
69 | } |
70 | ||
71 | return 0; | |
78ed8bd2 AC |
72 | } |
73 | ||
74 | static int map_lsapic_id(struct acpi_subtable_header *entry, | |
75 | int device_declaration, u32 acpi_id, int *apic_id) | |
76 | { | |
77 | struct acpi_madt_local_sapic *lsapic = | |
78 | (struct acpi_madt_local_sapic *)entry; | |
78ed8bd2 | 79 | |
78ed8bd2 AC |
80 | if (!(lsapic->lapic_flags & ACPI_MADT_ENABLED)) |
81 | return 0; | |
82 | ||
78ed8bd2 | 83 | if (device_declaration) { |
eae701ce AC |
84 | if ((entry->length < 16) || (lsapic->uid != acpi_id)) |
85 | return 0; | |
86 | } else if (lsapic->processor_id != acpi_id) | |
87 | return 0; | |
78ed8bd2 | 88 | |
eae701ce | 89 | *apic_id = (lsapic->id << 8) | lsapic->eid; |
78ed8bd2 AC |
90 | return 1; |
91 | } | |
92 | ||
93 | static int map_madt_entry(int type, u32 acpi_id) | |
94 | { | |
95 | unsigned long madt_end, entry; | |
149fe9c2 AC |
96 | static struct acpi_table_madt *madt; |
97 | static int read_madt; | |
78ed8bd2 AC |
98 | int apic_id = -1; |
99 | ||
149fe9c2 AC |
100 | if (!read_madt) { |
101 | if (ACPI_FAILURE(acpi_get_table(ACPI_SIG_MADT, 0, | |
102 | (struct acpi_table_header **)&madt))) | |
103 | madt = NULL; | |
104 | read_madt++; | |
105 | } | |
106 | ||
78ed8bd2 AC |
107 | if (!madt) |
108 | return apic_id; | |
109 | ||
110 | entry = (unsigned long)madt; | |
111 | madt_end = entry + madt->header.length; | |
112 | ||
113 | /* Parse all entries looking for a match. */ | |
114 | ||
115 | entry += sizeof(struct acpi_table_madt); | |
116 | while (entry + sizeof(struct acpi_subtable_header) < madt_end) { | |
117 | struct acpi_subtable_header *header = | |
118 | (struct acpi_subtable_header *)entry; | |
119 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) { | |
120 | if (map_lapic_id(header, acpi_id, &apic_id)) | |
121 | break; | |
122 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_X2APIC) { | |
123 | if (map_x2apic_id(header, type, acpi_id, &apic_id)) | |
124 | break; | |
125 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) { | |
126 | if (map_lsapic_id(header, type, acpi_id, &apic_id)) | |
127 | break; | |
128 | } | |
129 | entry += header->length; | |
130 | } | |
131 | return apic_id; | |
132 | } | |
133 | ||
134 | static int map_mat_entry(acpi_handle handle, int type, u32 acpi_id) | |
135 | { | |
136 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
137 | union acpi_object *obj; | |
138 | struct acpi_subtable_header *header; | |
139 | int apic_id = -1; | |
140 | ||
141 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer))) | |
142 | goto exit; | |
143 | ||
144 | if (!buffer.length || !buffer.pointer) | |
145 | goto exit; | |
146 | ||
147 | obj = buffer.pointer; | |
148 | if (obj->type != ACPI_TYPE_BUFFER || | |
149 | obj->buffer.length < sizeof(struct acpi_subtable_header)) { | |
150 | goto exit; | |
151 | } | |
152 | ||
153 | header = (struct acpi_subtable_header *)obj->buffer.pointer; | |
154 | if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) { | |
155 | map_lapic_id(header, acpi_id, &apic_id); | |
156 | } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) { | |
157 | map_lsapic_id(header, type, acpi_id, &apic_id); | |
158 | } | |
159 | ||
160 | exit: | |
161 | if (buffer.pointer) | |
162 | kfree(buffer.pointer); | |
163 | return apic_id; | |
164 | } | |
165 | ||
166 | int acpi_get_cpuid(acpi_handle handle, int type, u32 acpi_id) | |
167 | { | |
168 | int i; | |
169 | int apic_id = -1; | |
170 | ||
171 | apic_id = map_mat_entry(handle, type, acpi_id); | |
172 | if (apic_id == -1) | |
173 | apic_id = map_madt_entry(type, acpi_id); | |
174 | if (apic_id == -1) | |
175 | return apic_id; | |
176 | ||
177 | for_each_possible_cpu(i) { | |
178 | if (cpu_physical_id(i) == apic_id) | |
179 | return i; | |
180 | } | |
181 | return -1; | |
182 | } | |
183 | EXPORT_SYMBOL_GPL(acpi_get_cpuid); | |
184 | #endif | |
185 | ||
5d554a7b AC |
186 | static bool processor_physically_present(acpi_handle handle) |
187 | { | |
188 | int cpuid, type; | |
189 | u32 acpi_id; | |
190 | acpi_status status; | |
191 | acpi_object_type acpi_type; | |
192 | unsigned long long tmp; | |
193 | union acpi_object object = { 0 }; | |
194 | struct acpi_buffer buffer = { sizeof(union acpi_object), &object }; | |
195 | ||
196 | status = acpi_get_type(handle, &acpi_type); | |
197 | if (ACPI_FAILURE(status)) | |
198 | return false; | |
199 | ||
200 | switch (acpi_type) { | |
201 | case ACPI_TYPE_PROCESSOR: | |
202 | status = acpi_evaluate_object(handle, NULL, NULL, &buffer); | |
203 | if (ACPI_FAILURE(status)) | |
204 | return false; | |
205 | acpi_id = object.processor.proc_id; | |
206 | break; | |
207 | case ACPI_TYPE_DEVICE: | |
208 | status = acpi_evaluate_integer(handle, "_UID", NULL, &tmp); | |
209 | if (ACPI_FAILURE(status)) | |
210 | return false; | |
211 | acpi_id = tmp; | |
212 | break; | |
213 | default: | |
214 | return false; | |
215 | } | |
216 | ||
217 | type = (acpi_type == ACPI_TYPE_DEVICE) ? 1 : 0; | |
218 | cpuid = acpi_get_cpuid(handle, type, acpi_id); | |
219 | ||
856b185d | 220 | if ((cpuid == -1) && (num_possible_cpus() > 1)) |
5d554a7b AC |
221 | return false; |
222 | ||
223 | return true; | |
224 | } | |
78ed8bd2 | 225 | |
08ea48a3 AC |
226 | static void acpi_set_pdc_bits(u32 *buf) |
227 | { | |
228 | buf[0] = ACPI_PDC_REVISION_ID; | |
229 | buf[1] = 1; | |
230 | ||
231 | /* Enable coordination with firmware's _TSD info */ | |
232 | buf[2] = ACPI_PDC_SMP_T_SWCOORD; | |
6c5807d7 AC |
233 | |
234 | /* Twiddle arch-specific bits needed for _PDC */ | |
235 | arch_acpi_set_pdc_bits(buf); | |
08ea48a3 AC |
236 | } |
237 | ||
3b407aef | 238 | static struct acpi_object_list *acpi_processor_alloc_pdc(void) |
407cd87c AC |
239 | { |
240 | struct acpi_object_list *obj_list; | |
241 | union acpi_object *obj; | |
242 | u32 *buf; | |
243 | ||
407cd87c AC |
244 | /* allocate and initialize pdc. It will be used later. */ |
245 | obj_list = kmalloc(sizeof(struct acpi_object_list), GFP_KERNEL); | |
246 | if (!obj_list) { | |
247 | printk(KERN_ERR "Memory allocation error\n"); | |
3b407aef | 248 | return NULL; |
407cd87c AC |
249 | } |
250 | ||
251 | obj = kmalloc(sizeof(union acpi_object), GFP_KERNEL); | |
252 | if (!obj) { | |
253 | printk(KERN_ERR "Memory allocation error\n"); | |
254 | kfree(obj_list); | |
3b407aef | 255 | return NULL; |
407cd87c AC |
256 | } |
257 | ||
258 | buf = kmalloc(12, GFP_KERNEL); | |
259 | if (!buf) { | |
260 | printk(KERN_ERR "Memory allocation error\n"); | |
261 | kfree(obj); | |
262 | kfree(obj_list); | |
3b407aef | 263 | return NULL; |
407cd87c AC |
264 | } |
265 | ||
08ea48a3 AC |
266 | acpi_set_pdc_bits(buf); |
267 | ||
407cd87c AC |
268 | obj->type = ACPI_TYPE_BUFFER; |
269 | obj->buffer.length = 12; | |
270 | obj->buffer.pointer = (u8 *) buf; | |
271 | obj_list->count = 1; | |
272 | obj_list->pointer = obj; | |
407cd87c | 273 | |
3b407aef | 274 | return obj_list; |
407cd87c AC |
275 | } |
276 | ||
78f16996 AC |
277 | /* |
278 | * _PDC is required for a BIOS-OS handshake for most of the newer | |
279 | * ACPI processor features. | |
280 | */ | |
fa118564 AC |
281 | static int |
282 | acpi_processor_eval_pdc(acpi_handle handle, struct acpi_object_list *pdc_in) | |
78f16996 | 283 | { |
78f16996 AC |
284 | acpi_status status = AE_OK; |
285 | ||
d1896049 | 286 | if (boot_option_idle_override == IDLE_NOMWAIT) { |
78f16996 AC |
287 | /* |
288 | * If mwait is disabled for CPU C-states, the C2C3_FFH access | |
289 | * mode will be disabled in the parameter of _PDC object. | |
290 | * Of course C1_FFH access mode will also be disabled. | |
291 | */ | |
292 | union acpi_object *obj; | |
293 | u32 *buffer = NULL; | |
294 | ||
295 | obj = pdc_in->pointer; | |
296 | buffer = (u32 *)(obj->buffer.pointer); | |
297 | buffer[2] &= ~(ACPI_PDC_C_C2C3_FFH | ACPI_PDC_C_C1_FFH); | |
298 | ||
299 | } | |
fa118564 | 300 | status = acpi_evaluate_object(handle, "_PDC", pdc_in, NULL); |
78f16996 AC |
301 | |
302 | if (ACPI_FAILURE(status)) | |
303 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
304 | "Could not evaluate _PDC, using legacy perf. control.\n")); | |
305 | ||
306 | return status; | |
307 | } | |
308 | ||
43bab25c | 309 | void acpi_processor_set_pdc(acpi_handle handle) |
78f16996 | 310 | { |
3b407aef AC |
311 | struct acpi_object_list *obj_list; |
312 | ||
1d9cb470 AC |
313 | if (arch_has_acpi_pdc() == false) |
314 | return; | |
315 | ||
3b407aef AC |
316 | obj_list = acpi_processor_alloc_pdc(); |
317 | if (!obj_list) | |
318 | return; | |
319 | ||
43bab25c | 320 | acpi_processor_eval_pdc(handle, obj_list); |
b9c2db78 AC |
321 | |
322 | kfree(obj_list->pointer->buffer.pointer); | |
323 | kfree(obj_list->pointer); | |
324 | kfree(obj_list); | |
78f16996 AC |
325 | } |
326 | EXPORT_SYMBOL_GPL(acpi_processor_set_pdc); | |
327 | ||
328 | static acpi_status | |
329 | early_init_pdc(acpi_handle handle, u32 lvl, void *context, void **rv) | |
330 | { | |
5d554a7b AC |
331 | if (processor_physically_present(handle) == false) |
332 | return AE_OK; | |
333 | ||
43bab25c | 334 | acpi_processor_set_pdc(handle); |
78f16996 AC |
335 | return AE_OK; |
336 | } | |
337 | ||
7a0b73a4 | 338 | void __init acpi_early_processor_set_pdc(void) |
78f16996 AC |
339 | { |
340 | /* | |
341 | * Check whether the system is DMI table. If yes, OSPM | |
342 | * should not use mwait for CPU-states. | |
343 | */ | |
344 | dmi_check_system(processor_idle_dmi_table); | |
345 | ||
346 | acpi_walk_namespace(ACPI_TYPE_PROCESSOR, ACPI_ROOT_OBJECT, | |
347 | ACPI_UINT32_MAX, | |
348 | early_init_pdc, NULL, NULL, NULL); | |
c1e0ddbf | 349 | acpi_get_devices("ACPI0007", early_init_pdc, NULL, NULL); |
78f16996 | 350 | } |