blob: a79b6ef8122a0f471bb08c52aad6a1174b4dd735 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * processor_perflib.c - ACPI Processor P-States Library ($Revision: 71 $)
3 *
4 * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
5 * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
6 * Copyright (C) 2004 Dominik Brodowski <linux@brodo.de>
7 * Copyright (C) 2004 Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com>
8 * - Added processor hotplug support
9 *
10 *
11 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or (at
16 * your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful, but
19 * WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
21 * General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License along
24 * with this program; if not, write to the Free Software Foundation, Inc.,
25 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
26 *
27 */
28
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/kernel.h>
30#include <linux/module.h>
31#include <linux/init.h>
32#include <linux/cpufreq.h>
33
34#ifdef CONFIG_X86_ACPI_CPUFREQ_PROC_INTF
35#include <linux/proc_fs.h>
36#include <linux/seq_file.h>
Arjan van de Ven65c19bb2006-04-27 05:25:00 -040037#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
39#include <asm/uaccess.h>
40#endif
41
42#include <acpi/acpi_bus.h>
43#include <acpi/processor.h>
44
Linus Torvalds1da177e2005-04-16 15:20:36 -070045#define ACPI_PROCESSOR_COMPONENT 0x01000000
46#define ACPI_PROCESSOR_CLASS "processor"
47#define ACPI_PROCESSOR_DRIVER_NAME "ACPI Processor Driver"
48#define ACPI_PROCESSOR_FILE_PERFORMANCE "performance"
49#define _COMPONENT ACPI_PROCESSOR_COMPONENT
Len Brown4be44fc2005-08-05 00:44:28 -040050ACPI_MODULE_NAME("acpi_processor")
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
Arjan van de Ven65c19bb2006-04-27 05:25:00 -040052static DEFINE_MUTEX(performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
54/*
55 * _PPC support is implemented as a CPUfreq policy notifier:
56 * This means each time a CPUfreq driver registered also with
57 * the ACPI core is asked to change the speed policy, the maximum
58 * value is adjusted so that it is within the platform limit.
59 *
60 * Also, when a new platform limit value is detected, the CPUfreq
61 * policy is adjusted accordingly.
62 */
63
64#define PPC_REGISTERED 1
65#define PPC_IN_USE 2
66
67static int acpi_processor_ppc_status = 0;
68
69static int acpi_processor_ppc_notifier(struct notifier_block *nb,
Len Brown4be44fc2005-08-05 00:44:28 -040070 unsigned long event, void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -070071{
72 struct cpufreq_policy *policy = data;
73 struct acpi_processor *pr;
74 unsigned int ppc = 0;
75
Arjan van de Ven65c19bb2006-04-27 05:25:00 -040076 mutex_lock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
78 if (event != CPUFREQ_INCOMPATIBLE)
79 goto out;
80
81 pr = processors[policy->cpu];
82 if (!pr || !pr->performance)
83 goto out;
84
Len Brown4be44fc2005-08-05 00:44:28 -040085 ppc = (unsigned int)pr->performance_platform_limit;
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 if (!ppc)
87 goto out;
88
89 if (ppc > pr->performance->state_count)
90 goto out;
91
92 cpufreq_verify_within_limits(policy, 0,
Len Brown4be44fc2005-08-05 00:44:28 -040093 pr->performance->states[ppc].
94 core_frequency * 1000);
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Len Brown4be44fc2005-08-05 00:44:28 -040096 out:
Arjan van de Ven65c19bb2006-04-27 05:25:00 -040097 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
99 return 0;
100}
101
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102static struct notifier_block acpi_ppc_notifier_block = {
103 .notifier_call = acpi_processor_ppc_notifier,
104};
105
Len Brown4be44fc2005-08-05 00:44:28 -0400106static int acpi_processor_get_platform_limit(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107{
Len Brown4be44fc2005-08-05 00:44:28 -0400108 acpi_status status = 0;
109 unsigned long ppc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110
111 ACPI_FUNCTION_TRACE("acpi_processor_get_platform_limit");
112
113 if (!pr)
114 return_VALUE(-EINVAL);
115
116 /*
117 * _PPC indicates the maximum state currently supported by the platform
118 * (e.g. 0 = states 0..n; 1 = states 1..n; etc.
119 */
120 status = acpi_evaluate_integer(pr->handle, "_PPC", NULL, &ppc);
121
122 if (status != AE_NOT_FOUND)
123 acpi_processor_ppc_status |= PPC_IN_USE;
124
Len Brown4be44fc2005-08-05 00:44:28 -0400125 if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400126 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PPC"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 return_VALUE(-ENODEV);
128 }
129
Len Brown4be44fc2005-08-05 00:44:28 -0400130 pr->performance_platform_limit = (int)ppc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131
132 return_VALUE(0);
133}
134
Len Brown4be44fc2005-08-05 00:44:28 -0400135int acpi_processor_ppc_has_changed(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136{
137 int ret = acpi_processor_get_platform_limit(pr);
138 if (ret < 0)
139 return (ret);
140 else
141 return cpufreq_update_policy(pr->id);
142}
143
Len Brown4be44fc2005-08-05 00:44:28 -0400144void acpi_processor_ppc_init(void)
145{
146 if (!cpufreq_register_notifier
147 (&acpi_ppc_notifier_block, CPUFREQ_POLICY_NOTIFIER))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 acpi_processor_ppc_status |= PPC_REGISTERED;
149 else
Len Brown4be44fc2005-08-05 00:44:28 -0400150 printk(KERN_DEBUG
151 "Warning: Processor Platform Limit not supported.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152}
153
Len Brown4be44fc2005-08-05 00:44:28 -0400154void acpi_processor_ppc_exit(void)
155{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156 if (acpi_processor_ppc_status & PPC_REGISTERED)
Len Brown4be44fc2005-08-05 00:44:28 -0400157 cpufreq_unregister_notifier(&acpi_ppc_notifier_block,
158 CPUFREQ_POLICY_NOTIFIER);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159
160 acpi_processor_ppc_status &= ~PPC_REGISTERED;
161}
162
Len Brown4be44fc2005-08-05 00:44:28 -0400163static int acpi_processor_get_performance_control(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164{
Len Brown4be44fc2005-08-05 00:44:28 -0400165 int result = 0;
166 acpi_status status = 0;
167 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
168 union acpi_object *pct = NULL;
169 union acpi_object obj = { 0 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170
171 ACPI_FUNCTION_TRACE("acpi_processor_get_performance_control");
172
173 status = acpi_evaluate_object(pr->handle, "_PCT", NULL, &buffer);
Len Brown4be44fc2005-08-05 00:44:28 -0400174 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400175 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PCT"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 return_VALUE(-ENODEV);
177 }
178
Len Brown4be44fc2005-08-05 00:44:28 -0400179 pct = (union acpi_object *)buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180 if (!pct || (pct->type != ACPI_TYPE_PACKAGE)
Len Brown4be44fc2005-08-05 00:44:28 -0400181 || (pct->package.count != 2)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400182 ACPI_ERROR((AE_INFO, "Invalid _PCT data"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 result = -EFAULT;
184 goto end;
185 }
186
187 /*
188 * control_register
189 */
190
191 obj = pct->package.elements[0];
192
193 if ((obj.type != ACPI_TYPE_BUFFER)
Len Brown4be44fc2005-08-05 00:44:28 -0400194 || (obj.buffer.length < sizeof(struct acpi_pct_register))
195 || (obj.buffer.pointer == NULL)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400196 ACPI_ERROR((AE_INFO, "Invalid _PCT data (control_register)"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 result = -EFAULT;
198 goto end;
199 }
Len Brown4be44fc2005-08-05 00:44:28 -0400200 memcpy(&pr->performance->control_register, obj.buffer.pointer,
201 sizeof(struct acpi_pct_register));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202
203 /*
204 * status_register
205 */
206
207 obj = pct->package.elements[1];
208
209 if ((obj.type != ACPI_TYPE_BUFFER)
Len Brown4be44fc2005-08-05 00:44:28 -0400210 || (obj.buffer.length < sizeof(struct acpi_pct_register))
211 || (obj.buffer.pointer == NULL)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400212 ACPI_ERROR((AE_INFO, "Invalid _PCT data (status_register)"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 result = -EFAULT;
214 goto end;
215 }
216
Len Brown4be44fc2005-08-05 00:44:28 -0400217 memcpy(&pr->performance->status_register, obj.buffer.pointer,
218 sizeof(struct acpi_pct_register));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219
Len Brown4be44fc2005-08-05 00:44:28 -0400220 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 acpi_os_free(buffer.pointer);
222
223 return_VALUE(result);
224}
225
Len Brown4be44fc2005-08-05 00:44:28 -0400226static int acpi_processor_get_performance_states(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700227{
Len Brown4be44fc2005-08-05 00:44:28 -0400228 int result = 0;
229 acpi_status status = AE_OK;
230 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
231 struct acpi_buffer format = { sizeof("NNNNNN"), "NNNNNN" };
232 struct acpi_buffer state = { 0, NULL };
233 union acpi_object *pss = NULL;
234 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235
236 ACPI_FUNCTION_TRACE("acpi_processor_get_performance_states");
237
238 status = acpi_evaluate_object(pr->handle, "_PSS", NULL, &buffer);
Len Brown4be44fc2005-08-05 00:44:28 -0400239 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400240 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PSS"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 return_VALUE(-ENODEV);
242 }
243
Len Brown4be44fc2005-08-05 00:44:28 -0400244 pss = (union acpi_object *)buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 if (!pss || (pss->type != ACPI_TYPE_PACKAGE)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400246 ACPI_ERROR((AE_INFO, "Invalid _PSS data"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247 result = -EFAULT;
248 goto end;
249 }
250
251 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d performance states\n",
Len Brown4be44fc2005-08-05 00:44:28 -0400252 pss->package.count));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253
254 pr->performance->state_count = pss->package.count;
Len Brown4be44fc2005-08-05 00:44:28 -0400255 pr->performance->states =
256 kmalloc(sizeof(struct acpi_processor_px) * pss->package.count,
257 GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 if (!pr->performance->states) {
259 result = -ENOMEM;
260 goto end;
261 }
262
263 for (i = 0; i < pr->performance->state_count; i++) {
264
265 struct acpi_processor_px *px = &(pr->performance->states[i]);
266
267 state.length = sizeof(struct acpi_processor_px);
268 state.pointer = px;
269
270 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i));
271
272 status = acpi_extract_package(&(pss->package.elements[i]),
Len Brown4be44fc2005-08-05 00:44:28 -0400273 &format, &state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400275 ACPI_EXCEPTION((AE_INFO, status, "Invalid _PSS data"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 result = -EFAULT;
277 kfree(pr->performance->states);
278 goto end;
279 }
280
281 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400282 "State [%d]: core_frequency[%d] power[%d] transition_latency[%d] bus_master_latency[%d] control[0x%x] status[0x%x]\n",
283 i,
284 (u32) px->core_frequency,
285 (u32) px->power,
286 (u32) px->transition_latency,
287 (u32) px->bus_master_latency,
288 (u32) px->control, (u32) px->status));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289
290 if (!px->core_frequency) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400291 ACPI_ERROR((AE_INFO,
292 "Invalid _PSS data: freq is zero"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 result = -EFAULT;
294 kfree(pr->performance->states);
295 goto end;
296 }
297 }
298
Len Brown4be44fc2005-08-05 00:44:28 -0400299 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 acpi_os_free(buffer.pointer);
301
302 return_VALUE(result);
303}
304
Len Brown4be44fc2005-08-05 00:44:28 -0400305static int acpi_processor_get_performance_info(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306{
Len Brown4be44fc2005-08-05 00:44:28 -0400307 int result = 0;
308 acpi_status status = AE_OK;
309 acpi_handle handle = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
311 ACPI_FUNCTION_TRACE("acpi_processor_get_performance_info");
312
313 if (!pr || !pr->performance || !pr->handle)
314 return_VALUE(-EINVAL);
315
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 status = acpi_get_handle(pr->handle, "_PCT", &handle);
317 if (ACPI_FAILURE(status)) {
318 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400319 "ACPI-based processor performance control unavailable\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 return_VALUE(-ENODEV);
321 }
322
323 result = acpi_processor_get_performance_control(pr);
324 if (result)
325 return_VALUE(result);
326
327 result = acpi_processor_get_performance_states(pr);
328 if (result)
329 return_VALUE(result);
330
331 result = acpi_processor_get_platform_limit(pr);
332 if (result)
333 return_VALUE(result);
334
335 return_VALUE(0);
336}
337
Len Brown4be44fc2005-08-05 00:44:28 -0400338int acpi_processor_notify_smm(struct module *calling_module)
339{
340 acpi_status status;
341 static int is_done = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342
343 ACPI_FUNCTION_TRACE("acpi_processor_notify_smm");
344
345 if (!(acpi_processor_ppc_status & PPC_REGISTERED))
346 return_VALUE(-EBUSY);
347
348 if (!try_module_get(calling_module))
349 return_VALUE(-EINVAL);
350
351 /* is_done is set to negative if an error occured,
352 * and to postitive if _no_ error occured, but SMM
353 * was already notified. This avoids double notification
354 * which might lead to unexpected results...
355 */
356 if (is_done > 0) {
357 module_put(calling_module);
358 return_VALUE(0);
Len Brown4be44fc2005-08-05 00:44:28 -0400359 } else if (is_done < 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 module_put(calling_module);
361 return_VALUE(is_done);
362 }
363
364 is_done = -EIO;
365
366 /* Can't write pstate_cnt to smi_cmd if either value is zero */
Len Brown4be44fc2005-08-05 00:44:28 -0400367 if ((!acpi_fadt.smi_cmd) || (!acpi_fadt.pstate_cnt)) {
368 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No SMI port or pstate_cnt\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 module_put(calling_module);
370 return_VALUE(0);
371 }
372
Len Brown4be44fc2005-08-05 00:44:28 -0400373 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
374 "Writing pstate_cnt [0x%x] to smi_cmd [0x%x]\n",
375 acpi_fadt.pstate_cnt, acpi_fadt.smi_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
377 /* FADT v1 doesn't support pstate_cnt, many BIOS vendors use
378 * it anyway, so we need to support it... */
379 if (acpi_fadt_is_v1) {
Len Brown4be44fc2005-08-05 00:44:28 -0400380 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
381 "Using v1.0 FADT reserved value for pstate_cnt\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382 }
383
Len Brown4be44fc2005-08-05 00:44:28 -0400384 status = acpi_os_write_port(acpi_fadt.smi_cmd,
385 (u32) acpi_fadt.pstate_cnt, 8);
386 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -0400387 ACPI_EXCEPTION((AE_INFO, status,
388 "Failed to write pstate_cnt [0x%x] to "
389 "smi_cmd [0x%x]", acpi_fadt.pstate_cnt,
390 acpi_fadt.smi_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 module_put(calling_module);
392 return_VALUE(status);
393 }
394
395 /* Success. If there's no _PPC, we need to fear nothing, so
396 * we can allow the cpufreq driver to be rmmod'ed. */
397 is_done = 1;
398
399 if (!(acpi_processor_ppc_status & PPC_IN_USE))
400 module_put(calling_module);
401
402 return_VALUE(0);
403}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404
Len Brown4be44fc2005-08-05 00:44:28 -0400405EXPORT_SYMBOL(acpi_processor_notify_smm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406
407#ifdef CONFIG_X86_ACPI_CPUFREQ_PROC_INTF
408/* /proc/acpi/processor/../performance interface (DEPRECATED) */
409
410static int acpi_processor_perf_open_fs(struct inode *inode, struct file *file);
411static struct file_operations acpi_processor_perf_fops = {
Len Brown4be44fc2005-08-05 00:44:28 -0400412 .open = acpi_processor_perf_open_fs,
413 .read = seq_read,
414 .llseek = seq_lseek,
415 .release = single_release,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416};
417
418static int acpi_processor_perf_seq_show(struct seq_file *seq, void *offset)
419{
Len Brown4be44fc2005-08-05 00:44:28 -0400420 struct acpi_processor *pr = (struct acpi_processor *)seq->private;
421 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422
423 ACPI_FUNCTION_TRACE("acpi_processor_perf_seq_show");
424
425 if (!pr)
426 goto end;
427
428 if (!pr->performance) {
429 seq_puts(seq, "<not supported>\n");
430 goto end;
431 }
432
433 seq_printf(seq, "state count: %d\n"
Len Brown4be44fc2005-08-05 00:44:28 -0400434 "active state: P%d\n",
435 pr->performance->state_count, pr->performance->state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436
437 seq_puts(seq, "states:\n");
438 for (i = 0; i < pr->performance->state_count; i++)
Len Brown4be44fc2005-08-05 00:44:28 -0400439 seq_printf(seq,
440 " %cP%d: %d MHz, %d mW, %d uS\n",
441 (i == pr->performance->state ? '*' : ' '), i,
442 (u32) pr->performance->states[i].core_frequency,
443 (u32) pr->performance->states[i].power,
444 (u32) pr->performance->states[i].transition_latency);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445
Len Brown4be44fc2005-08-05 00:44:28 -0400446 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 return_VALUE(0);
448}
449
450static int acpi_processor_perf_open_fs(struct inode *inode, struct file *file)
451{
452 return single_open(file, acpi_processor_perf_seq_show,
Len Brown4be44fc2005-08-05 00:44:28 -0400453 PDE(inode)->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454}
455
456static ssize_t
Len Brown4be44fc2005-08-05 00:44:28 -0400457acpi_processor_write_performance(struct file *file,
458 const char __user * buffer,
459 size_t count, loff_t * data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460{
Len Brown4be44fc2005-08-05 00:44:28 -0400461 int result = 0;
462 struct seq_file *m = (struct seq_file *)file->private_data;
463 struct acpi_processor *pr = (struct acpi_processor *)m->private;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464 struct acpi_processor_performance *perf;
Len Brown4be44fc2005-08-05 00:44:28 -0400465 char state_string[12] = { '\0' };
466 unsigned int new_state = 0;
467 struct cpufreq_policy policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468
469 ACPI_FUNCTION_TRACE("acpi_processor_write_performance");
470
471 if (!pr || (count > sizeof(state_string) - 1))
472 return_VALUE(-EINVAL);
473
474 perf = pr->performance;
475 if (!perf)
476 return_VALUE(-EINVAL);
477
478 if (copy_from_user(state_string, buffer, count))
479 return_VALUE(-EFAULT);
480
481 state_string[count] = '\0';
482 new_state = simple_strtoul(state_string, NULL, 0);
483
484 if (new_state >= perf->state_count)
485 return_VALUE(-EINVAL);
486
487 cpufreq_get_policy(&policy, pr->id);
488
489 policy.cpu = pr->id;
490 policy.min = perf->states[new_state].core_frequency * 1000;
491 policy.max = perf->states[new_state].core_frequency * 1000;
492
493 result = cpufreq_set_policy(&policy);
494 if (result)
495 return_VALUE(result);
496
497 return_VALUE(count);
498}
499
Len Brown4be44fc2005-08-05 00:44:28 -0400500static void acpi_cpufreq_add_file(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501{
Len Brown4be44fc2005-08-05 00:44:28 -0400502 struct proc_dir_entry *entry = NULL;
503 struct acpi_device *device = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504
505 ACPI_FUNCTION_TRACE("acpi_cpufreq_addfile");
506
507 if (acpi_bus_get_device(pr->handle, &device))
508 return_VOID;
509
510 /* add file 'performance' [R/W] */
511 entry = create_proc_entry(ACPI_PROCESSOR_FILE_PERFORMANCE,
Len Brown4be44fc2005-08-05 00:44:28 -0400512 S_IFREG | S_IRUGO | S_IWUSR,
513 acpi_device_dir(device));
Thomas Renningera6fc6722006-06-26 23:58:43 -0400514 if (entry){
Arjan van de Vend479e902006-01-06 16:47:00 -0500515 acpi_processor_perf_fops.write = acpi_processor_write_performance;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 entry->proc_fops = &acpi_processor_perf_fops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 entry->data = acpi_driver_data(device);
518 entry->owner = THIS_MODULE;
519 }
520 return_VOID;
521}
522
Len Brown4be44fc2005-08-05 00:44:28 -0400523static void acpi_cpufreq_remove_file(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524{
Len Brown4be44fc2005-08-05 00:44:28 -0400525 struct acpi_device *device = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526
527 ACPI_FUNCTION_TRACE("acpi_cpufreq_addfile");
528
529 if (acpi_bus_get_device(pr->handle, &device))
530 return_VOID;
531
532 /* remove file 'performance' */
533 remove_proc_entry(ACPI_PROCESSOR_FILE_PERFORMANCE,
Len Brown4be44fc2005-08-05 00:44:28 -0400534 acpi_device_dir(device));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535
536 return_VOID;
537}
538
539#else
Len Brown4be44fc2005-08-05 00:44:28 -0400540static void acpi_cpufreq_add_file(struct acpi_processor *pr)
541{
542 return;
543}
544static void acpi_cpufreq_remove_file(struct acpi_processor *pr)
545{
546 return;
547}
548#endif /* CONFIG_X86_ACPI_CPUFREQ_PROC_INTF */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500550static int acpi_processor_get_psd(struct acpi_processor *pr)
551{
552 int result = 0;
553 acpi_status status = AE_OK;
554 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
555 struct acpi_buffer format = {sizeof("NNNNN"), "NNNNN"};
556 struct acpi_buffer state = {0, NULL};
557 union acpi_object *psd = NULL;
558 struct acpi_psd_package *pdomain;
559
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500560 status = acpi_evaluate_object(pr->handle, "_PSD", NULL, &buffer);
561 if (ACPI_FAILURE(status)) {
Len Brown9011bff42006-05-11 00:28:12 -0400562 return -ENODEV;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500563 }
564
565 psd = (union acpi_object *) buffer.pointer;
566 if (!psd || (psd->type != ACPI_TYPE_PACKAGE)) {
567 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
568 result = -EFAULT;
569 goto end;
570 }
571
572 if (psd->package.count != 1) {
573 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
574 result = -EFAULT;
575 goto end;
576 }
577
578 pdomain = &(pr->performance->domain_info);
579
580 state.length = sizeof(struct acpi_psd_package);
581 state.pointer = pdomain;
582
583 status = acpi_extract_package(&(psd->package.elements[0]),
584 &format, &state);
585 if (ACPI_FAILURE(status)) {
586 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
587 result = -EFAULT;
588 goto end;
589 }
590
591 if (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES) {
592 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _PSD:num_entries\n"));
593 result = -EFAULT;
594 goto end;
595 }
596
597 if (pdomain->revision != ACPI_PSD_REV0_REVISION) {
598 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _PSD:revision\n"));
599 result = -EFAULT;
600 goto end;
601 }
602
603end:
604 acpi_os_free(buffer.pointer);
Len Brown9011bff42006-05-11 00:28:12 -0400605 return result;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500606}
607
608int acpi_processor_preregister_performance(
609 struct acpi_processor_performance **performance)
610{
611 int count, count_target;
612 int retval = 0;
613 unsigned int i, j;
614 cpumask_t covered_cpus;
615 struct acpi_processor *pr;
616 struct acpi_psd_package *pdomain;
617 struct acpi_processor *match_pr;
618 struct acpi_psd_package *match_pdomain;
619
Len Brown785fccc2006-06-15 22:19:31 -0400620 mutex_lock(&performance_mutex);
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500621
622 retval = 0;
623
624 /* Call _PSD for all CPUs */
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400625 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500626 pr = processors[i];
627 if (!pr) {
628 /* Look only at processors in ACPI namespace */
629 continue;
630 }
631
632 if (pr->performance) {
633 retval = -EBUSY;
634 continue;
635 }
636
637 if (!performance || !performance[i]) {
638 retval = -EINVAL;
639 continue;
640 }
641
642 pr->performance = performance[i];
643 cpu_set(i, pr->performance->shared_cpu_map);
644 if (acpi_processor_get_psd(pr)) {
645 retval = -EINVAL;
646 continue;
647 }
648 }
649 if (retval)
650 goto err_ret;
651
652 /*
653 * Now that we have _PSD data from all CPUs, lets setup P-state
654 * domain info.
655 */
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400656 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500657 pr = processors[i];
658 if (!pr)
659 continue;
660
661 /* Basic validity check for domain info */
662 pdomain = &(pr->performance->domain_info);
663 if ((pdomain->revision != ACPI_PSD_REV0_REVISION) ||
664 (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES)) {
665 retval = -EINVAL;
666 goto err_ret;
667 }
668 if (pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ALL &&
669 pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ANY &&
670 pdomain->coord_type != DOMAIN_COORD_TYPE_HW_ALL) {
671 retval = -EINVAL;
672 goto err_ret;
673 }
674 }
675
676 cpus_clear(covered_cpus);
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400677 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500678 pr = processors[i];
679 if (!pr)
680 continue;
681
682 if (cpu_isset(i, covered_cpus))
683 continue;
684
685 pdomain = &(pr->performance->domain_info);
686 cpu_set(i, pr->performance->shared_cpu_map);
687 cpu_set(i, covered_cpus);
688 if (pdomain->num_processors <= 1)
689 continue;
690
691 /* Validate the Domain info */
692 count_target = pdomain->num_processors;
693 count = 1;
694 if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ALL ||
695 pdomain->coord_type == DOMAIN_COORD_TYPE_HW_ALL) {
696 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL;
697 } else if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ANY) {
698 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ANY;
699 }
700
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400701 for_each_possible_cpu(j) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500702 if (i == j)
703 continue;
704
705 match_pr = processors[j];
706 if (!match_pr)
707 continue;
708
709 match_pdomain = &(match_pr->performance->domain_info);
710 if (match_pdomain->domain != pdomain->domain)
711 continue;
712
713 /* Here i and j are in the same domain */
714
715 if (match_pdomain->num_processors != count_target) {
716 retval = -EINVAL;
717 goto err_ret;
718 }
719
720 if (pdomain->coord_type != match_pdomain->coord_type) {
721 retval = -EINVAL;
722 goto err_ret;
723 }
724
725 cpu_set(j, covered_cpus);
726 cpu_set(j, pr->performance->shared_cpu_map);
727 count++;
728 }
729
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400730 for_each_possible_cpu(j) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500731 if (i == j)
732 continue;
733
734 match_pr = processors[j];
735 if (!match_pr)
736 continue;
737
738 match_pdomain = &(match_pr->performance->domain_info);
739 if (match_pdomain->domain != pdomain->domain)
740 continue;
741
742 match_pr->performance->shared_type =
743 pr->performance->shared_type;
744 match_pr->performance->shared_cpu_map =
745 pr->performance->shared_cpu_map;
746 }
747 }
748
749err_ret:
750 if (retval) {
751 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Error while parsing _PSD domain information. Assuming no coordination\n"));
752 }
753
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400754 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500755 pr = processors[i];
756 if (!pr || !pr->performance)
757 continue;
758
759 /* Assume no coordination on any error parsing domain info */
760 if (retval) {
761 cpus_clear(pr->performance->shared_cpu_map);
762 cpu_set(i, pr->performance->shared_cpu_map);
763 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL;
764 }
765 pr->performance = NULL; /* Will be set for real in register */
766 }
767
Len Brown785fccc2006-06-15 22:19:31 -0400768 mutex_unlock(&performance_mutex);
Len Brown9011bff42006-05-11 00:28:12 -0400769 return retval;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500770}
771EXPORT_SYMBOL(acpi_processor_preregister_performance);
772
773
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774int
Len Brown4be44fc2005-08-05 00:44:28 -0400775acpi_processor_register_performance(struct acpi_processor_performance
776 *performance, unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777{
778 struct acpi_processor *pr;
779
780 ACPI_FUNCTION_TRACE("acpi_processor_register_performance");
781
782 if (!(acpi_processor_ppc_status & PPC_REGISTERED))
783 return_VALUE(-EINVAL);
784
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400785 mutex_lock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786
787 pr = processors[cpu];
788 if (!pr) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400789 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700790 return_VALUE(-ENODEV);
791 }
792
793 if (pr->performance) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400794 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 return_VALUE(-EBUSY);
796 }
797
Andrew Mortona913f502006-06-10 09:54:13 -0700798 WARN_ON(!performance);
799
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800 pr->performance = performance;
801
802 if (acpi_processor_get_performance_info(pr)) {
803 pr->performance = NULL;
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400804 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805 return_VALUE(-EIO);
806 }
807
808 acpi_cpufreq_add_file(pr);
809
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400810 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 return_VALUE(0);
812}
Len Brown4be44fc2005-08-05 00:44:28 -0400813
Linus Torvalds1da177e2005-04-16 15:20:36 -0700814EXPORT_SYMBOL(acpi_processor_register_performance);
815
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816void
Len Brown4be44fc2005-08-05 00:44:28 -0400817acpi_processor_unregister_performance(struct acpi_processor_performance
818 *performance, unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819{
820 struct acpi_processor *pr;
821
822 ACPI_FUNCTION_TRACE("acpi_processor_unregister_performance");
823
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400824 mutex_lock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
826 pr = processors[cpu];
827 if (!pr) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400828 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 return_VOID;
830 }
831
Andrew Mortona913f502006-06-10 09:54:13 -0700832 if (pr->performance)
833 kfree(pr->performance->states);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834 pr->performance = NULL;
835
836 acpi_cpufreq_remove_file(pr);
837
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400838 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839
840 return_VOID;
841}
Len Brown4be44fc2005-08-05 00:44:28 -0400842
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843EXPORT_SYMBOL(acpi_processor_unregister_performance);