Commit | Line | Data |
---|---|---|
c942fddf | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 LT |
2 | /* |
3 | * processor_perflib.c - ACPI Processor P-States Library ($Revision: 71 $) | |
4 | * | |
5 | * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com> | |
6 | * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com> | |
7 | * Copyright (C) 2004 Dominik Brodowski <linux@brodo.de> | |
8 | * Copyright (C) 2004 Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com> | |
9 | * - Added processor hotplug support | |
1da177e4 LT |
10 | */ |
11 | ||
1da177e4 LT |
12 | #include <linux/kernel.h> |
13 | #include <linux/module.h> | |
14 | #include <linux/init.h> | |
15 | #include <linux/cpufreq.h> | |
5a0e3ad6 | 16 | #include <linux/slab.h> |
8b48463f LZ |
17 | #include <linux/acpi.h> |
18 | #include <acpi/processor.h> | |
16be87ea | 19 | #ifdef CONFIG_X86 |
910dfae2 | 20 | #include <asm/cpufeature.h> |
16be87ea | 21 | #endif |
1da177e4 | 22 | |
a192a958 LB |
23 | #define PREFIX "ACPI: " |
24 | ||
1da177e4 | 25 | #define ACPI_PROCESSOR_CLASS "processor" |
1da177e4 LT |
26 | #define ACPI_PROCESSOR_FILE_PERFORMANCE "performance" |
27 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT | |
f52fd66d | 28 | ACPI_MODULE_NAME("processor_perflib"); |
1da177e4 | 29 | |
65c19bbd | 30 | static DEFINE_MUTEX(performance_mutex); |
1da177e4 LT |
31 | |
32 | /* | |
33 | * _PPC support is implemented as a CPUfreq policy notifier: | |
34 | * This means each time a CPUfreq driver registered also with | |
35 | * the ACPI core is asked to change the speed policy, the maximum | |
36 | * value is adjusted so that it is within the platform limit. | |
37 | * | |
38 | * Also, when a new platform limit value is detected, the CPUfreq | |
39 | * policy is adjusted accordingly. | |
40 | */ | |
41 | ||
a1531acd TR |
42 | /* ignore_ppc: |
43 | * -1 -> cpufreq low level drivers not initialized -> _PSS, etc. not called yet | |
44 | * ignore _PPC | |
45 | * 0 -> cpufreq low level drivers initialized -> consider _PPC values | |
46 | * 1 -> ignore _PPC totally -> forced by user through boot param | |
47 | */ | |
9f497bcc | 48 | static int ignore_ppc = -1; |
613e5f33 | 49 | module_param(ignore_ppc, int, 0644); |
623b78c3 TR |
50 | MODULE_PARM_DESC(ignore_ppc, "If the frequency of your machine gets wrongly" \ |
51 | "limited by BIOS, this should help"); | |
52 | ||
d15ce412 | 53 | static bool acpi_processor_ppc_in_use; |
1da177e4 | 54 | |
4be44fcd | 55 | static int acpi_processor_get_platform_limit(struct acpi_processor *pr) |
1da177e4 | 56 | { |
4be44fcd | 57 | acpi_status status = 0; |
27663c58 | 58 | unsigned long long ppc = 0; |
d15ce412 | 59 | int ret; |
1da177e4 LT |
60 | |
61 | if (!pr) | |
d550d98d | 62 | return -EINVAL; |
1da177e4 LT |
63 | |
64 | /* | |
65 | * _PPC indicates the maximum state currently supported by the platform | |
66 | * (e.g. 0 = states 0..n; 1 = states 1..n; etc. | |
67 | */ | |
68 | status = acpi_evaluate_integer(pr->handle, "_PPC", NULL, &ppc); | |
69 | ||
70 | if (status != AE_NOT_FOUND) | |
d15ce412 | 71 | acpi_processor_ppc_in_use = true; |
1da177e4 | 72 | |
4be44fcd | 73 | if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) { |
a6fc6720 | 74 | ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PPC")); |
d550d98d | 75 | return -ENODEV; |
1da177e4 LT |
76 | } |
77 | ||
2d06d8c4 | 78 | pr_debug("CPU %d: _PPC is %d - frequency %s limited\n", pr->id, |
919158d1 TR |
79 | (int)ppc, ppc ? "" : "not"); |
80 | ||
4be44fcd | 81 | pr->performance_platform_limit = (int)ppc; |
1da177e4 | 82 | |
d15ce412 | 83 | if (ppc >= pr->performance->state_count || |
3000ce3c | 84 | unlikely(!freq_qos_request_active(&pr->perflib_req))) |
d15ce412 VK |
85 | return 0; |
86 | ||
3000ce3c | 87 | ret = freq_qos_update_request(&pr->perflib_req, |
d15ce412 VK |
88 | pr->performance->states[ppc].core_frequency * 1000); |
89 | if (ret < 0) { | |
90 | pr_warn("Failed to update perflib freq constraint: CPU%d (%d)\n", | |
91 | pr->id, ret); | |
92 | } | |
93 | ||
d550d98d | 94 | return 0; |
1da177e4 LT |
95 | } |
96 | ||
d81c45e1 ZY |
97 | #define ACPI_PROCESSOR_NOTIFY_PERFORMANCE 0x80 |
98 | /* | |
99 | * acpi_processor_ppc_ost: Notify firmware the _PPC evaluation status | |
100 | * @handle: ACPI processor handle | |
101 | * @status: the status code of _PPC evaluation | |
102 | * 0: success. OSPM is now using the performance state specificed. | |
103 | * 1: failure. OSPM has not changed the number of P-states in use | |
104 | */ | |
105 | static void acpi_processor_ppc_ost(acpi_handle handle, int status) | |
106 | { | |
4a6172a4 JL |
107 | if (acpi_has_method(handle, "_OST")) |
108 | acpi_evaluate_ost(handle, ACPI_PROCESSOR_NOTIFY_PERFORMANCE, | |
109 | status, NULL); | |
d81c45e1 ZY |
110 | } |
111 | ||
bca5f557 | 112 | void acpi_processor_ppc_has_changed(struct acpi_processor *pr, int event_flag) |
1da177e4 | 113 | { |
623b78c3 TR |
114 | int ret; |
115 | ||
ba1edb9a | 116 | if (ignore_ppc || !pr->performance) { |
d81c45e1 ZY |
117 | /* |
118 | * Only when it is notification event, the _OST object | |
119 | * will be evaluated. Otherwise it is skipped. | |
120 | */ | |
121 | if (event_flag) | |
122 | acpi_processor_ppc_ost(pr->handle, 1); | |
bca5f557 | 123 | return; |
d81c45e1 | 124 | } |
623b78c3 TR |
125 | |
126 | ret = acpi_processor_get_platform_limit(pr); | |
d81c45e1 ZY |
127 | /* |
128 | * Only when it is notification event, the _OST object | |
129 | * will be evaluated. Otherwise it is skipped. | |
130 | */ | |
131 | if (event_flag) { | |
132 | if (ret < 0) | |
133 | acpi_processor_ppc_ost(pr->handle, 1); | |
134 | else | |
135 | acpi_processor_ppc_ost(pr->handle, 0); | |
136 | } | |
bca5f557 | 137 | if (ret >= 0) |
5a25e3f7 | 138 | cpufreq_update_limits(pr->id); |
1da177e4 LT |
139 | } |
140 | ||
e2f74f35 TR |
141 | int acpi_processor_get_bios_limit(int cpu, unsigned int *limit) |
142 | { | |
143 | struct acpi_processor *pr; | |
144 | ||
145 | pr = per_cpu(processors, cpu); | |
146 | if (!pr || !pr->performance || !pr->performance->state_count) | |
147 | return -ENODEV; | |
148 | *limit = pr->performance->states[pr->performance_platform_limit]. | |
149 | core_frequency * 1000; | |
150 | return 0; | |
151 | } | |
152 | EXPORT_SYMBOL(acpi_processor_get_bios_limit); | |
153 | ||
d15ce412 | 154 | void acpi_processor_ignore_ppc_init(void) |
4be44fcd | 155 | { |
d15ce412 VK |
156 | if (ignore_ppc < 0) |
157 | ignore_ppc = 0; | |
158 | } | |
159 | ||
3000ce3c | 160 | void acpi_processor_ppc_init(struct cpufreq_policy *policy) |
d15ce412 | 161 | { |
a1bb46c3 | 162 | unsigned int cpu; |
d15ce412 | 163 | |
a1bb46c3 RW |
164 | for_each_cpu(cpu, policy->related_cpus) { |
165 | struct acpi_processor *pr = per_cpu(processors, cpu); | |
166 | int ret; | |
167 | ||
168 | if (!pr) | |
169 | continue; | |
2d8b39a6 | 170 | |
a1bb46c3 RW |
171 | ret = freq_qos_add_request(&policy->constraints, |
172 | &pr->perflib_req, | |
173 | FREQ_QOS_MAX, INT_MAX); | |
174 | if (ret < 0) | |
175 | pr_err("Failed to add freq constraint for CPU%d (%d)\n", | |
176 | cpu, ret); | |
177 | } | |
1da177e4 LT |
178 | } |
179 | ||
3000ce3c | 180 | void acpi_processor_ppc_exit(struct cpufreq_policy *policy) |
4be44fcd | 181 | { |
a1bb46c3 | 182 | unsigned int cpu; |
1da177e4 | 183 | |
a1bb46c3 RW |
184 | for_each_cpu(cpu, policy->related_cpus) { |
185 | struct acpi_processor *pr = per_cpu(processors, cpu); | |
186 | ||
187 | if (pr) | |
188 | freq_qos_remove_request(&pr->perflib_req); | |
189 | } | |
1da177e4 LT |
190 | } |
191 | ||
4be44fcd | 192 | static int acpi_processor_get_performance_control(struct acpi_processor *pr) |
1da177e4 | 193 | { |
4be44fcd LB |
194 | int result = 0; |
195 | acpi_status status = 0; | |
196 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
197 | union acpi_object *pct = NULL; | |
198 | union acpi_object obj = { 0 }; | |
1da177e4 | 199 | |
1da177e4 LT |
200 | |
201 | status = acpi_evaluate_object(pr->handle, "_PCT", NULL, &buffer); | |
4be44fcd | 202 | if (ACPI_FAILURE(status)) { |
a6fc6720 | 203 | ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PCT")); |
d550d98d | 204 | return -ENODEV; |
1da177e4 LT |
205 | } |
206 | ||
4be44fcd | 207 | pct = (union acpi_object *)buffer.pointer; |
1da177e4 | 208 | if (!pct || (pct->type != ACPI_TYPE_PACKAGE) |
4be44fcd | 209 | || (pct->package.count != 2)) { |
6468463a | 210 | printk(KERN_ERR PREFIX "Invalid _PCT data\n"); |
1da177e4 LT |
211 | result = -EFAULT; |
212 | goto end; | |
213 | } | |
214 | ||
215 | /* | |
216 | * control_register | |
217 | */ | |
218 | ||
219 | obj = pct->package.elements[0]; | |
220 | ||
221 | if ((obj.type != ACPI_TYPE_BUFFER) | |
4be44fcd LB |
222 | || (obj.buffer.length < sizeof(struct acpi_pct_register)) |
223 | || (obj.buffer.pointer == NULL)) { | |
6468463a | 224 | printk(KERN_ERR PREFIX "Invalid _PCT data (control_register)\n"); |
1da177e4 LT |
225 | result = -EFAULT; |
226 | goto end; | |
227 | } | |
4be44fcd LB |
228 | memcpy(&pr->performance->control_register, obj.buffer.pointer, |
229 | sizeof(struct acpi_pct_register)); | |
1da177e4 LT |
230 | |
231 | /* | |
232 | * status_register | |
233 | */ | |
234 | ||
235 | obj = pct->package.elements[1]; | |
236 | ||
237 | if ((obj.type != ACPI_TYPE_BUFFER) | |
4be44fcd LB |
238 | || (obj.buffer.length < sizeof(struct acpi_pct_register)) |
239 | || (obj.buffer.pointer == NULL)) { | |
6468463a | 240 | printk(KERN_ERR PREFIX "Invalid _PCT data (status_register)\n"); |
1da177e4 LT |
241 | result = -EFAULT; |
242 | goto end; | |
243 | } | |
244 | ||
4be44fcd LB |
245 | memcpy(&pr->performance->status_register, obj.buffer.pointer, |
246 | sizeof(struct acpi_pct_register)); | |
1da177e4 | 247 | |
4be44fcd | 248 | end: |
02438d87 | 249 | kfree(buffer.pointer); |
1da177e4 | 250 | |
d550d98d | 251 | return result; |
1da177e4 LT |
252 | } |
253 | ||
f594065f MG |
254 | #ifdef CONFIG_X86 |
255 | /* | |
256 | * Some AMDs have 50MHz frequency multiples, but only provide 100MHz rounding | |
257 | * in their ACPI data. Calculate the real values and fix up the _PSS data. | |
258 | */ | |
259 | static void amd_fixup_frequency(struct acpi_processor_px *px, int i) | |
260 | { | |
261 | u32 hi, lo, fid, did; | |
262 | int index = px->control & 0x00000007; | |
263 | ||
264 | if (boot_cpu_data.x86_vendor != X86_VENDOR_AMD) | |
265 | return; | |
266 | ||
267 | if ((boot_cpu_data.x86 == 0x10 && boot_cpu_data.x86_model < 10) | |
268 | || boot_cpu_data.x86 == 0x11) { | |
269 | rdmsr(MSR_AMD_PSTATE_DEF_BASE + index, lo, hi); | |
9855d8ce SB |
270 | /* |
271 | * MSR C001_0064+: | |
272 | * Bit 63: PstateEn. Read-write. If set, the P-state is valid. | |
273 | */ | |
274 | if (!(hi & BIT(31))) | |
275 | return; | |
276 | ||
f594065f MG |
277 | fid = lo & 0x3f; |
278 | did = (lo >> 6) & 7; | |
279 | if (boot_cpu_data.x86 == 0x10) | |
280 | px->core_frequency = (100 * (fid + 0x10)) >> did; | |
281 | else | |
282 | px->core_frequency = (100 * (fid + 8)) >> did; | |
283 | } | |
284 | } | |
285 | #else | |
286 | static void amd_fixup_frequency(struct acpi_processor_px *px, int i) {}; | |
287 | #endif | |
288 | ||
4be44fcd | 289 | static int acpi_processor_get_performance_states(struct acpi_processor *pr) |
1da177e4 | 290 | { |
4be44fcd LB |
291 | int result = 0; |
292 | acpi_status status = AE_OK; | |
293 | struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL }; | |
294 | struct acpi_buffer format = { sizeof("NNNNNN"), "NNNNNN" }; | |
295 | struct acpi_buffer state = { 0, NULL }; | |
296 | union acpi_object *pss = NULL; | |
297 | int i; | |
d8e725f3 | 298 | int last_invalid = -1; |
1da177e4 | 299 | |
1da177e4 LT |
300 | |
301 | status = acpi_evaluate_object(pr->handle, "_PSS", NULL, &buffer); | |
4be44fcd | 302 | if (ACPI_FAILURE(status)) { |
a6fc6720 | 303 | ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PSS")); |
d550d98d | 304 | return -ENODEV; |
1da177e4 LT |
305 | } |
306 | ||
50dd0969 | 307 | pss = buffer.pointer; |
1da177e4 | 308 | if (!pss || (pss->type != ACPI_TYPE_PACKAGE)) { |
6468463a | 309 | printk(KERN_ERR PREFIX "Invalid _PSS data\n"); |
1da177e4 LT |
310 | result = -EFAULT; |
311 | goto end; | |
312 | } | |
313 | ||
314 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d performance states\n", | |
4be44fcd | 315 | pss->package.count)); |
1da177e4 LT |
316 | |
317 | pr->performance->state_count = pss->package.count; | |
4be44fcd | 318 | pr->performance->states = |
6da2ec56 KC |
319 | kmalloc_array(pss->package.count, |
320 | sizeof(struct acpi_processor_px), | |
321 | GFP_KERNEL); | |
1da177e4 LT |
322 | if (!pr->performance->states) { |
323 | result = -ENOMEM; | |
324 | goto end; | |
325 | } | |
326 | ||
327 | for (i = 0; i < pr->performance->state_count; i++) { | |
328 | ||
329 | struct acpi_processor_px *px = &(pr->performance->states[i]); | |
330 | ||
331 | state.length = sizeof(struct acpi_processor_px); | |
332 | state.pointer = px; | |
333 | ||
334 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i)); | |
335 | ||
336 | status = acpi_extract_package(&(pss->package.elements[i]), | |
4be44fcd | 337 | &format, &state); |
1da177e4 | 338 | if (ACPI_FAILURE(status)) { |
a6fc6720 | 339 | ACPI_EXCEPTION((AE_INFO, status, "Invalid _PSS data")); |
1da177e4 LT |
340 | result = -EFAULT; |
341 | kfree(pr->performance->states); | |
342 | goto end; | |
343 | } | |
344 | ||
f594065f MG |
345 | amd_fixup_frequency(px, i); |
346 | ||
1da177e4 | 347 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
4be44fcd LB |
348 | "State [%d]: core_frequency[%d] power[%d] transition_latency[%d] bus_master_latency[%d] control[0x%x] status[0x%x]\n", |
349 | i, | |
350 | (u32) px->core_frequency, | |
351 | (u32) px->power, | |
352 | (u32) px->transition_latency, | |
353 | (u32) px->bus_master_latency, | |
354 | (u32) px->control, (u32) px->status)); | |
1da177e4 | 355 | |
34d531e6 LB |
356 | /* |
357 | * Check that ACPI's u64 MHz will be valid as u32 KHz in cpufreq | |
358 | */ | |
359 | if (!px->core_frequency || | |
360 | ((u32)(px->core_frequency * 1000) != | |
361 | (px->core_frequency * 1000))) { | |
362 | printk(KERN_ERR FW_BUG PREFIX | |
d8e725f3 MAC |
363 | "Invalid BIOS _PSS frequency found for processor %d: 0x%llx MHz\n", |
364 | pr->id, px->core_frequency); | |
365 | if (last_invalid == -1) | |
366 | last_invalid = i; | |
367 | } else { | |
368 | if (last_invalid != -1) { | |
369 | /* | |
370 | * Copy this valid entry over last_invalid entry | |
371 | */ | |
372 | memcpy(&(pr->performance->states[last_invalid]), | |
373 | px, sizeof(struct acpi_processor_px)); | |
374 | ++last_invalid; | |
375 | } | |
1da177e4 LT |
376 | } |
377 | } | |
378 | ||
d8e725f3 MAC |
379 | if (last_invalid == 0) { |
380 | printk(KERN_ERR FW_BUG PREFIX | |
381 | "No valid BIOS _PSS frequency found for processor %d\n", pr->id); | |
382 | result = -EFAULT; | |
383 | kfree(pr->performance->states); | |
384 | pr->performance->states = NULL; | |
385 | } | |
386 | ||
387 | if (last_invalid > 0) | |
388 | pr->performance->state_count = last_invalid; | |
389 | ||
4be44fcd | 390 | end: |
02438d87 | 391 | kfree(buffer.pointer); |
1da177e4 | 392 | |
d550d98d | 393 | return result; |
1da177e4 LT |
394 | } |
395 | ||
c705c78c | 396 | int acpi_processor_get_performance_info(struct acpi_processor *pr) |
1da177e4 | 397 | { |
4be44fcd | 398 | int result = 0; |
1da177e4 | 399 | |
1da177e4 | 400 | if (!pr || !pr->performance || !pr->handle) |
d550d98d | 401 | return -EINVAL; |
1da177e4 | 402 | |
952c63e9 | 403 | if (!acpi_has_method(pr->handle, "_PCT")) { |
1da177e4 | 404 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
4be44fcd | 405 | "ACPI-based processor performance control unavailable\n")); |
d550d98d | 406 | return -ENODEV; |
1da177e4 LT |
407 | } |
408 | ||
409 | result = acpi_processor_get_performance_control(pr); | |
410 | if (result) | |
910dfae2 | 411 | goto update_bios; |
1da177e4 LT |
412 | |
413 | result = acpi_processor_get_performance_states(pr); | |
414 | if (result) | |
910dfae2 | 415 | goto update_bios; |
1da177e4 | 416 | |
455c0d71 DW |
417 | /* We need to call _PPC once when cpufreq starts */ |
418 | if (ignore_ppc != 1) | |
419 | result = acpi_processor_get_platform_limit(pr); | |
420 | ||
421 | return result; | |
910dfae2 TR |
422 | |
423 | /* | |
424 | * Having _PPC but missing frequencies (_PSS, _PCT) is a very good hint that | |
425 | * the BIOS is older than the CPU and does not know its frequencies | |
426 | */ | |
427 | update_bios: | |
16be87ea | 428 | #ifdef CONFIG_X86 |
952c63e9 | 429 | if (acpi_has_method(pr->handle, "_PPC")) { |
910dfae2 TR |
430 | if(boot_cpu_has(X86_FEATURE_EST)) |
431 | printk(KERN_WARNING FW_BUG "BIOS needs update for CPU " | |
432 | "frequency support\n"); | |
433 | } | |
16be87ea | 434 | #endif |
910dfae2 | 435 | return result; |
1da177e4 | 436 | } |
c705c78c | 437 | EXPORT_SYMBOL_GPL(acpi_processor_get_performance_info); |
d0ea59e1 RW |
438 | |
439 | int acpi_processor_pstate_control(void) | |
4be44fcd LB |
440 | { |
441 | acpi_status status; | |
1da177e4 | 442 | |
d0ea59e1 RW |
443 | if (!acpi_gbl_FADT.smi_command || !acpi_gbl_FADT.pstate_control) |
444 | return 0; | |
445 | ||
446 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
447 | "Writing pstate_control [0x%x] to smi_command [0x%x]\n", | |
448 | acpi_gbl_FADT.pstate_control, acpi_gbl_FADT.smi_command)); | |
449 | ||
450 | status = acpi_os_write_port(acpi_gbl_FADT.smi_command, | |
451 | (u32)acpi_gbl_FADT.pstate_control, 8); | |
452 | if (ACPI_SUCCESS(status)) | |
453 | return 1; | |
454 | ||
455 | ACPI_EXCEPTION((AE_INFO, status, | |
456 | "Failed to write pstate_control [0x%x] to smi_command [0x%x]", | |
457 | acpi_gbl_FADT.pstate_control, acpi_gbl_FADT.smi_command)); | |
458 | return -EIO; | |
459 | } | |
460 | ||
461 | int acpi_processor_notify_smm(struct module *calling_module) | |
462 | { | |
463 | static int is_done = 0; | |
464 | int result; | |
1da177e4 | 465 | |
d15ce412 | 466 | if (!acpi_processor_cpufreq_init) |
d550d98d | 467 | return -EBUSY; |
1da177e4 LT |
468 | |
469 | if (!try_module_get(calling_module)) | |
d550d98d | 470 | return -EINVAL; |
1da177e4 | 471 | |
58f87ed0 LDM |
472 | /* is_done is set to negative if an error occurred, |
473 | * and to postitive if _no_ error occurred, but SMM | |
1da177e4 LT |
474 | * was already notified. This avoids double notification |
475 | * which might lead to unexpected results... | |
476 | */ | |
477 | if (is_done > 0) { | |
478 | module_put(calling_module); | |
d550d98d | 479 | return 0; |
4be44fcd | 480 | } else if (is_done < 0) { |
1da177e4 | 481 | module_put(calling_module); |
d550d98d | 482 | return is_done; |
1da177e4 LT |
483 | } |
484 | ||
485 | is_done = -EIO; | |
486 | ||
d0ea59e1 RW |
487 | result = acpi_processor_pstate_control(); |
488 | if (!result) { | |
ad71860a | 489 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No SMI port or pstate_control\n")); |
1da177e4 | 490 | module_put(calling_module); |
d550d98d | 491 | return 0; |
1da177e4 | 492 | } |
d0ea59e1 | 493 | if (result < 0) { |
1da177e4 | 494 | module_put(calling_module); |
d0ea59e1 | 495 | return result; |
1da177e4 LT |
496 | } |
497 | ||
498 | /* Success. If there's no _PPC, we need to fear nothing, so | |
499 | * we can allow the cpufreq driver to be rmmod'ed. */ | |
500 | is_done = 1; | |
501 | ||
d15ce412 | 502 | if (!acpi_processor_ppc_in_use) |
1da177e4 LT |
503 | module_put(calling_module); |
504 | ||
d550d98d | 505 | return 0; |
1da177e4 | 506 | } |
1da177e4 | 507 | |
4be44fcd | 508 | EXPORT_SYMBOL(acpi_processor_notify_smm); |
1da177e4 | 509 | |
4d0f1ce6 | 510 | int acpi_processor_get_psd(acpi_handle handle, struct acpi_psd_package *pdomain) |
3b2d9942 VP |
511 | { |
512 | int result = 0; | |
513 | acpi_status status = AE_OK; | |
514 | struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; | |
515 | struct acpi_buffer format = {sizeof("NNNNN"), "NNNNN"}; | |
516 | struct acpi_buffer state = {0, NULL}; | |
517 | union acpi_object *psd = NULL; | |
3b2d9942 | 518 | |
4d0f1ce6 | 519 | status = acpi_evaluate_object(handle, "_PSD", NULL, &buffer); |
3b2d9942 | 520 | if (ACPI_FAILURE(status)) { |
9011bff4 | 521 | return -ENODEV; |
3b2d9942 VP |
522 | } |
523 | ||
50dd0969 | 524 | psd = buffer.pointer; |
3b2d9942 | 525 | if (!psd || (psd->type != ACPI_TYPE_PACKAGE)) { |
55ac9a01 | 526 | printk(KERN_ERR PREFIX "Invalid _PSD data\n"); |
3b2d9942 VP |
527 | result = -EFAULT; |
528 | goto end; | |
529 | } | |
530 | ||
531 | if (psd->package.count != 1) { | |
55ac9a01 | 532 | printk(KERN_ERR PREFIX "Invalid _PSD data\n"); |
3b2d9942 VP |
533 | result = -EFAULT; |
534 | goto end; | |
535 | } | |
536 | ||
3b2d9942 VP |
537 | state.length = sizeof(struct acpi_psd_package); |
538 | state.pointer = pdomain; | |
539 | ||
540 | status = acpi_extract_package(&(psd->package.elements[0]), | |
541 | &format, &state); | |
542 | if (ACPI_FAILURE(status)) { | |
55ac9a01 | 543 | printk(KERN_ERR PREFIX "Invalid _PSD data\n"); |
3b2d9942 VP |
544 | result = -EFAULT; |
545 | goto end; | |
546 | } | |
547 | ||
548 | if (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES) { | |
55ac9a01 | 549 | printk(KERN_ERR PREFIX "Unknown _PSD:num_entries\n"); |
3b2d9942 VP |
550 | result = -EFAULT; |
551 | goto end; | |
552 | } | |
553 | ||
554 | if (pdomain->revision != ACPI_PSD_REV0_REVISION) { | |
55ac9a01 | 555 | printk(KERN_ERR PREFIX "Unknown _PSD:revision\n"); |
3b2d9942 VP |
556 | result = -EFAULT; |
557 | goto end; | |
558 | } | |
559 | ||
e1eb4779 SG |
560 | if (pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ALL && |
561 | pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ANY && | |
562 | pdomain->coord_type != DOMAIN_COORD_TYPE_HW_ALL) { | |
563 | printk(KERN_ERR PREFIX "Invalid _PSD:coord_type\n"); | |
564 | result = -EFAULT; | |
565 | goto end; | |
566 | } | |
3b2d9942 | 567 | end: |
02438d87 | 568 | kfree(buffer.pointer); |
9011bff4 | 569 | return result; |
3b2d9942 | 570 | } |
4d0f1ce6 | 571 | EXPORT_SYMBOL(acpi_processor_get_psd); |
3b2d9942 VP |
572 | |
573 | int acpi_processor_preregister_performance( | |
a29d8b8e | 574 | struct acpi_processor_performance __percpu *performance) |
3b2d9942 | 575 | { |
09d5ca80 | 576 | int count_target; |
3b2d9942 VP |
577 | int retval = 0; |
578 | unsigned int i, j; | |
2fdf66b4 | 579 | cpumask_var_t covered_cpus; |
3b2d9942 VP |
580 | struct acpi_processor *pr; |
581 | struct acpi_psd_package *pdomain; | |
582 | struct acpi_processor *match_pr; | |
583 | struct acpi_psd_package *match_pdomain; | |
584 | ||
79f55997 | 585 | if (!zalloc_cpumask_var(&covered_cpus, GFP_KERNEL)) |
2fdf66b4 RR |
586 | return -ENOMEM; |
587 | ||
785fcccd | 588 | mutex_lock(&performance_mutex); |
3b2d9942 | 589 | |
e1eb4779 SG |
590 | /* |
591 | * Check if another driver has already registered, and abort before | |
592 | * changing pr->performance if it has. Check input data as well. | |
593 | */ | |
193de0c7 | 594 | for_each_possible_cpu(i) { |
706546d0 | 595 | pr = per_cpu(processors, i); |
3b2d9942 VP |
596 | if (!pr) { |
597 | /* Look only at processors in ACPI namespace */ | |
598 | continue; | |
599 | } | |
600 | ||
601 | if (pr->performance) { | |
602 | retval = -EBUSY; | |
e1eb4779 | 603 | goto err_out; |
3b2d9942 VP |
604 | } |
605 | ||
b36128c8 | 606 | if (!performance || !per_cpu_ptr(performance, i)) { |
3b2d9942 | 607 | retval = -EINVAL; |
e1eb4779 | 608 | goto err_out; |
3b2d9942 | 609 | } |
e1eb4779 SG |
610 | } |
611 | ||
612 | /* Call _PSD for all CPUs */ | |
613 | for_each_possible_cpu(i) { | |
614 | pr = per_cpu(processors, i); | |
615 | if (!pr) | |
616 | continue; | |
3b2d9942 | 617 | |
b36128c8 | 618 | pr->performance = per_cpu_ptr(performance, i); |
2fdf66b4 | 619 | cpumask_set_cpu(i, pr->performance->shared_cpu_map); |
4d0f1ce6 JM |
620 | pdomain = &(pr->performance->domain_info); |
621 | if (acpi_processor_get_psd(pr->handle, pdomain)) { | |
3b2d9942 VP |
622 | retval = -EINVAL; |
623 | continue; | |
624 | } | |
625 | } | |
626 | if (retval) | |
627 | goto err_ret; | |
628 | ||
629 | /* | |
630 | * Now that we have _PSD data from all CPUs, lets setup P-state | |
631 | * domain info. | |
632 | */ | |
193de0c7 | 633 | for_each_possible_cpu(i) { |
706546d0 | 634 | pr = per_cpu(processors, i); |
3b2d9942 VP |
635 | if (!pr) |
636 | continue; | |
637 | ||
2fdf66b4 | 638 | if (cpumask_test_cpu(i, covered_cpus)) |
3b2d9942 VP |
639 | continue; |
640 | ||
641 | pdomain = &(pr->performance->domain_info); | |
2fdf66b4 RR |
642 | cpumask_set_cpu(i, pr->performance->shared_cpu_map); |
643 | cpumask_set_cpu(i, covered_cpus); | |
3b2d9942 VP |
644 | if (pdomain->num_processors <= 1) |
645 | continue; | |
646 | ||
647 | /* Validate the Domain info */ | |
648 | count_target = pdomain->num_processors; | |
46f18e3a | 649 | if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ALL) |
3b2d9942 | 650 | pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL; |
46f18e3a VP |
651 | else if (pdomain->coord_type == DOMAIN_COORD_TYPE_HW_ALL) |
652 | pr->performance->shared_type = CPUFREQ_SHARED_TYPE_HW; | |
653 | else if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ANY) | |
3b2d9942 | 654 | pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ANY; |
3b2d9942 | 655 | |
193de0c7 | 656 | for_each_possible_cpu(j) { |
3b2d9942 VP |
657 | if (i == j) |
658 | continue; | |
659 | ||
706546d0 | 660 | match_pr = per_cpu(processors, j); |
3b2d9942 VP |
661 | if (!match_pr) |
662 | continue; | |
663 | ||
664 | match_pdomain = &(match_pr->performance->domain_info); | |
665 | if (match_pdomain->domain != pdomain->domain) | |
666 | continue; | |
667 | ||
668 | /* Here i and j are in the same domain */ | |
669 | ||
670 | if (match_pdomain->num_processors != count_target) { | |
671 | retval = -EINVAL; | |
672 | goto err_ret; | |
673 | } | |
674 | ||
675 | if (pdomain->coord_type != match_pdomain->coord_type) { | |
676 | retval = -EINVAL; | |
677 | goto err_ret; | |
678 | } | |
679 | ||
2fdf66b4 RR |
680 | cpumask_set_cpu(j, covered_cpus); |
681 | cpumask_set_cpu(j, pr->performance->shared_cpu_map); | |
3b2d9942 VP |
682 | } |
683 | ||
193de0c7 | 684 | for_each_possible_cpu(j) { |
3b2d9942 VP |
685 | if (i == j) |
686 | continue; | |
687 | ||
706546d0 | 688 | match_pr = per_cpu(processors, j); |
3b2d9942 VP |
689 | if (!match_pr) |
690 | continue; | |
691 | ||
692 | match_pdomain = &(match_pr->performance->domain_info); | |
693 | if (match_pdomain->domain != pdomain->domain) | |
694 | continue; | |
695 | ||
696 | match_pr->performance->shared_type = | |
697 | pr->performance->shared_type; | |
2fdf66b4 RR |
698 | cpumask_copy(match_pr->performance->shared_cpu_map, |
699 | pr->performance->shared_cpu_map); | |
3b2d9942 VP |
700 | } |
701 | } | |
702 | ||
703 | err_ret: | |
193de0c7 | 704 | for_each_possible_cpu(i) { |
706546d0 | 705 | pr = per_cpu(processors, i); |
3b2d9942 VP |
706 | if (!pr || !pr->performance) |
707 | continue; | |
708 | ||
709 | /* Assume no coordination on any error parsing domain info */ | |
710 | if (retval) { | |
2fdf66b4 RR |
711 | cpumask_clear(pr->performance->shared_cpu_map); |
712 | cpumask_set_cpu(i, pr->performance->shared_cpu_map); | |
3b2d9942 VP |
713 | pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL; |
714 | } | |
715 | pr->performance = NULL; /* Will be set for real in register */ | |
716 | } | |
717 | ||
e1eb4779 | 718 | err_out: |
785fcccd | 719 | mutex_unlock(&performance_mutex); |
2fdf66b4 | 720 | free_cpumask_var(covered_cpus); |
9011bff4 | 721 | return retval; |
3b2d9942 VP |
722 | } |
723 | EXPORT_SYMBOL(acpi_processor_preregister_performance); | |
724 | ||
1da177e4 | 725 | int |
4be44fcd LB |
726 | acpi_processor_register_performance(struct acpi_processor_performance |
727 | *performance, unsigned int cpu) | |
1da177e4 LT |
728 | { |
729 | struct acpi_processor *pr; | |
730 | ||
d15ce412 | 731 | if (!acpi_processor_cpufreq_init) |
d550d98d | 732 | return -EINVAL; |
1da177e4 | 733 | |
65c19bbd | 734 | mutex_lock(&performance_mutex); |
1da177e4 | 735 | |
706546d0 | 736 | pr = per_cpu(processors, cpu); |
1da177e4 | 737 | if (!pr) { |
65c19bbd | 738 | mutex_unlock(&performance_mutex); |
d550d98d | 739 | return -ENODEV; |
1da177e4 LT |
740 | } |
741 | ||
742 | if (pr->performance) { | |
65c19bbd | 743 | mutex_unlock(&performance_mutex); |
d550d98d | 744 | return -EBUSY; |
1da177e4 LT |
745 | } |
746 | ||
a913f507 AM |
747 | WARN_ON(!performance); |
748 | ||
1da177e4 LT |
749 | pr->performance = performance; |
750 | ||
751 | if (acpi_processor_get_performance_info(pr)) { | |
752 | pr->performance = NULL; | |
65c19bbd | 753 | mutex_unlock(&performance_mutex); |
d550d98d | 754 | return -EIO; |
1da177e4 LT |
755 | } |
756 | ||
65c19bbd | 757 | mutex_unlock(&performance_mutex); |
d550d98d | 758 | return 0; |
1da177e4 | 759 | } |
1da177e4 | 760 | |
4be44fcd | 761 | EXPORT_SYMBOL(acpi_processor_register_performance); |
1da177e4 | 762 | |
b2f8dc4c | 763 | void acpi_processor_unregister_performance(unsigned int cpu) |
1da177e4 LT |
764 | { |
765 | struct acpi_processor *pr; | |
766 | ||
65c19bbd | 767 | mutex_lock(&performance_mutex); |
1da177e4 | 768 | |
706546d0 | 769 | pr = per_cpu(processors, cpu); |
1da177e4 | 770 | if (!pr) { |
65c19bbd | 771 | mutex_unlock(&performance_mutex); |
d550d98d | 772 | return; |
1da177e4 LT |
773 | } |
774 | ||
a913f507 AM |
775 | if (pr->performance) |
776 | kfree(pr->performance->states); | |
1da177e4 LT |
777 | pr->performance = NULL; |
778 | ||
65c19bbd | 779 | mutex_unlock(&performance_mutex); |
1da177e4 | 780 | |
d550d98d | 781 | return; |
1da177e4 | 782 | } |
4be44fcd | 783 | |
1da177e4 | 784 | EXPORT_SYMBOL(acpi_processor_unregister_performance); |