blob: f02c5ea9084f7b82475c86bcb7cb685835e576b1 [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) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Error evaluating _PPC\n"));
127 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)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Error evaluating _PCT\n"));
176 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)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PCT data\n"));
183 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)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
Len Brown4be44fc2005-08-05 00:44:28 -0400197 "Invalid _PCT data (control_register)\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 result = -EFAULT;
199 goto end;
200 }
Len Brown4be44fc2005-08-05 00:44:28 -0400201 memcpy(&pr->performance->control_register, obj.buffer.pointer,
202 sizeof(struct acpi_pct_register));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203
204 /*
205 * status_register
206 */
207
208 obj = pct->package.elements[1];
209
210 if ((obj.type != ACPI_TYPE_BUFFER)
Len Brown4be44fc2005-08-05 00:44:28 -0400211 || (obj.buffer.length < sizeof(struct acpi_pct_register))
212 || (obj.buffer.pointer == NULL)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
Len Brown4be44fc2005-08-05 00:44:28 -0400214 "Invalid _PCT data (status_register)\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 result = -EFAULT;
216 goto end;
217 }
218
Len Brown4be44fc2005-08-05 00:44:28 -0400219 memcpy(&pr->performance->status_register, obj.buffer.pointer,
220 sizeof(struct acpi_pct_register));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221
Len Brown4be44fc2005-08-05 00:44:28 -0400222 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 acpi_os_free(buffer.pointer);
224
225 return_VALUE(result);
226}
227
Len Brown4be44fc2005-08-05 00:44:28 -0400228static int acpi_processor_get_performance_states(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229{
Len Brown4be44fc2005-08-05 00:44:28 -0400230 int result = 0;
231 acpi_status status = AE_OK;
232 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
233 struct acpi_buffer format = { sizeof("NNNNNN"), "NNNNNN" };
234 struct acpi_buffer state = { 0, NULL };
235 union acpi_object *pss = NULL;
236 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237
238 ACPI_FUNCTION_TRACE("acpi_processor_get_performance_states");
239
240 status = acpi_evaluate_object(pr->handle, "_PSS", NULL, &buffer);
Len Brown4be44fc2005-08-05 00:44:28 -0400241 if (ACPI_FAILURE(status)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Error evaluating _PSS\n"));
243 return_VALUE(-ENODEV);
244 }
245
Len Brown4be44fc2005-08-05 00:44:28 -0400246 pss = (union acpi_object *)buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247 if (!pss || (pss->type != ACPI_TYPE_PACKAGE)) {
248 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSS data\n"));
249 result = -EFAULT;
250 goto end;
251 }
252
253 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d performance states\n",
Len Brown4be44fc2005-08-05 00:44:28 -0400254 pss->package.count));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255
256 pr->performance->state_count = pss->package.count;
Len Brown4be44fc2005-08-05 00:44:28 -0400257 pr->performance->states =
258 kmalloc(sizeof(struct acpi_processor_px) * pss->package.count,
259 GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260 if (!pr->performance->states) {
261 result = -ENOMEM;
262 goto end;
263 }
264
265 for (i = 0; i < pr->performance->state_count; i++) {
266
267 struct acpi_processor_px *px = &(pr->performance->states[i]);
268
269 state.length = sizeof(struct acpi_processor_px);
270 state.pointer = px;
271
272 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i));
273
274 status = acpi_extract_package(&(pss->package.elements[i]),
Len Brown4be44fc2005-08-05 00:44:28 -0400275 &format, &state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276 if (ACPI_FAILURE(status)) {
Len Brown4be44fc2005-08-05 00:44:28 -0400277 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
278 "Invalid _PSS data\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 result = -EFAULT;
280 kfree(pr->performance->states);
281 goto end;
282 }
283
284 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400285 "State [%d]: core_frequency[%d] power[%d] transition_latency[%d] bus_master_latency[%d] control[0x%x] status[0x%x]\n",
286 i,
287 (u32) px->core_frequency,
288 (u32) px->power,
289 (u32) px->transition_latency,
290 (u32) px->bus_master_latency,
291 (u32) px->control, (u32) px->status));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292
293 if (!px->core_frequency) {
Len Brown4be44fc2005-08-05 00:44:28 -0400294 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
295 "Invalid _PSS data: freq is zero\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 result = -EFAULT;
297 kfree(pr->performance->states);
298 goto end;
299 }
300 }
301
Len Brown4be44fc2005-08-05 00:44:28 -0400302 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 acpi_os_free(buffer.pointer);
304
305 return_VALUE(result);
306}
307
Len Brown4be44fc2005-08-05 00:44:28 -0400308static int acpi_processor_get_performance_info(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309{
Len Brown4be44fc2005-08-05 00:44:28 -0400310 int result = 0;
311 acpi_status status = AE_OK;
312 acpi_handle handle = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313
314 ACPI_FUNCTION_TRACE("acpi_processor_get_performance_info");
315
316 if (!pr || !pr->performance || !pr->handle)
317 return_VALUE(-EINVAL);
318
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 status = acpi_get_handle(pr->handle, "_PCT", &handle);
320 if (ACPI_FAILURE(status)) {
321 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400322 "ACPI-based processor performance control unavailable\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323 return_VALUE(-ENODEV);
324 }
325
326 result = acpi_processor_get_performance_control(pr);
327 if (result)
328 return_VALUE(result);
329
330 result = acpi_processor_get_performance_states(pr);
331 if (result)
332 return_VALUE(result);
333
334 result = acpi_processor_get_platform_limit(pr);
335 if (result)
336 return_VALUE(result);
337
338 return_VALUE(0);
339}
340
Len Brown4be44fc2005-08-05 00:44:28 -0400341int acpi_processor_notify_smm(struct module *calling_module)
342{
343 acpi_status status;
344 static int is_done = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345
346 ACPI_FUNCTION_TRACE("acpi_processor_notify_smm");
347
348 if (!(acpi_processor_ppc_status & PPC_REGISTERED))
349 return_VALUE(-EBUSY);
350
351 if (!try_module_get(calling_module))
352 return_VALUE(-EINVAL);
353
354 /* is_done is set to negative if an error occured,
355 * and to postitive if _no_ error occured, but SMM
356 * was already notified. This avoids double notification
357 * which might lead to unexpected results...
358 */
359 if (is_done > 0) {
360 module_put(calling_module);
361 return_VALUE(0);
Len Brown4be44fc2005-08-05 00:44:28 -0400362 } else if (is_done < 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 module_put(calling_module);
364 return_VALUE(is_done);
365 }
366
367 is_done = -EIO;
368
369 /* Can't write pstate_cnt to smi_cmd if either value is zero */
Len Brown4be44fc2005-08-05 00:44:28 -0400370 if ((!acpi_fadt.smi_cmd) || (!acpi_fadt.pstate_cnt)) {
371 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No SMI port or pstate_cnt\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 module_put(calling_module);
373 return_VALUE(0);
374 }
375
Len Brown4be44fc2005-08-05 00:44:28 -0400376 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
377 "Writing pstate_cnt [0x%x] to smi_cmd [0x%x]\n",
378 acpi_fadt.pstate_cnt, acpi_fadt.smi_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379
380 /* FADT v1 doesn't support pstate_cnt, many BIOS vendors use
381 * it anyway, so we need to support it... */
382 if (acpi_fadt_is_v1) {
Len Brown4be44fc2005-08-05 00:44:28 -0400383 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
384 "Using v1.0 FADT reserved value for pstate_cnt\n"));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385 }
386
Len Brown4be44fc2005-08-05 00:44:28 -0400387 status = acpi_os_write_port(acpi_fadt.smi_cmd,
388 (u32) acpi_fadt.pstate_cnt, 8);
389 if (ACPI_FAILURE(status)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
391 "Failed to write pstate_cnt [0x%x] to "
Len Brown4be44fc2005-08-05 00:44:28 -0400392 "smi_cmd [0x%x]\n", acpi_fadt.pstate_cnt,
393 acpi_fadt.smi_cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394 module_put(calling_module);
395 return_VALUE(status);
396 }
397
398 /* Success. If there's no _PPC, we need to fear nothing, so
399 * we can allow the cpufreq driver to be rmmod'ed. */
400 is_done = 1;
401
402 if (!(acpi_processor_ppc_status & PPC_IN_USE))
403 module_put(calling_module);
404
405 return_VALUE(0);
406}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Len Brown4be44fc2005-08-05 00:44:28 -0400408EXPORT_SYMBOL(acpi_processor_notify_smm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409
410#ifdef CONFIG_X86_ACPI_CPUFREQ_PROC_INTF
411/* /proc/acpi/processor/../performance interface (DEPRECATED) */
412
413static int acpi_processor_perf_open_fs(struct inode *inode, struct file *file);
414static struct file_operations acpi_processor_perf_fops = {
Len Brown4be44fc2005-08-05 00:44:28 -0400415 .open = acpi_processor_perf_open_fs,
416 .read = seq_read,
417 .llseek = seq_lseek,
418 .release = single_release,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419};
420
421static int acpi_processor_perf_seq_show(struct seq_file *seq, void *offset)
422{
Len Brown4be44fc2005-08-05 00:44:28 -0400423 struct acpi_processor *pr = (struct acpi_processor *)seq->private;
424 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425
426 ACPI_FUNCTION_TRACE("acpi_processor_perf_seq_show");
427
428 if (!pr)
429 goto end;
430
431 if (!pr->performance) {
432 seq_puts(seq, "<not supported>\n");
433 goto end;
434 }
435
436 seq_printf(seq, "state count: %d\n"
Len Brown4be44fc2005-08-05 00:44:28 -0400437 "active state: P%d\n",
438 pr->performance->state_count, pr->performance->state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439
440 seq_puts(seq, "states:\n");
441 for (i = 0; i < pr->performance->state_count; i++)
Len Brown4be44fc2005-08-05 00:44:28 -0400442 seq_printf(seq,
443 " %cP%d: %d MHz, %d mW, %d uS\n",
444 (i == pr->performance->state ? '*' : ' '), i,
445 (u32) pr->performance->states[i].core_frequency,
446 (u32) pr->performance->states[i].power,
447 (u32) pr->performance->states[i].transition_latency);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448
Len Brown4be44fc2005-08-05 00:44:28 -0400449 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 return_VALUE(0);
451}
452
453static int acpi_processor_perf_open_fs(struct inode *inode, struct file *file)
454{
455 return single_open(file, acpi_processor_perf_seq_show,
Len Brown4be44fc2005-08-05 00:44:28 -0400456 PDE(inode)->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457}
458
459static ssize_t
Len Brown4be44fc2005-08-05 00:44:28 -0400460acpi_processor_write_performance(struct file *file,
461 const char __user * buffer,
462 size_t count, loff_t * data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463{
Len Brown4be44fc2005-08-05 00:44:28 -0400464 int result = 0;
465 struct seq_file *m = (struct seq_file *)file->private_data;
466 struct acpi_processor *pr = (struct acpi_processor *)m->private;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467 struct acpi_processor_performance *perf;
Len Brown4be44fc2005-08-05 00:44:28 -0400468 char state_string[12] = { '\0' };
469 unsigned int new_state = 0;
470 struct cpufreq_policy policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471
472 ACPI_FUNCTION_TRACE("acpi_processor_write_performance");
473
474 if (!pr || (count > sizeof(state_string) - 1))
475 return_VALUE(-EINVAL);
476
477 perf = pr->performance;
478 if (!perf)
479 return_VALUE(-EINVAL);
480
481 if (copy_from_user(state_string, buffer, count))
482 return_VALUE(-EFAULT);
483
484 state_string[count] = '\0';
485 new_state = simple_strtoul(state_string, NULL, 0);
486
487 if (new_state >= perf->state_count)
488 return_VALUE(-EINVAL);
489
490 cpufreq_get_policy(&policy, pr->id);
491
492 policy.cpu = pr->id;
493 policy.min = perf->states[new_state].core_frequency * 1000;
494 policy.max = perf->states[new_state].core_frequency * 1000;
495
496 result = cpufreq_set_policy(&policy);
497 if (result)
498 return_VALUE(result);
499
500 return_VALUE(count);
501}
502
Len Brown4be44fc2005-08-05 00:44:28 -0400503static void acpi_cpufreq_add_file(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504{
Len Brown4be44fc2005-08-05 00:44:28 -0400505 struct proc_dir_entry *entry = NULL;
506 struct acpi_device *device = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507
508 ACPI_FUNCTION_TRACE("acpi_cpufreq_addfile");
509
510 if (acpi_bus_get_device(pr->handle, &device))
511 return_VOID;
512
513 /* add file 'performance' [R/W] */
514 entry = create_proc_entry(ACPI_PROCESSOR_FILE_PERFORMANCE,
Len Brown4be44fc2005-08-05 00:44:28 -0400515 S_IFREG | S_IRUGO | S_IWUSR,
516 acpi_device_dir(device));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 if (!entry)
518 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
Len Brown4be44fc2005-08-05 00:44:28 -0400519 "Unable to create '%s' fs entry\n",
520 ACPI_PROCESSOR_FILE_PERFORMANCE));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 else {
Arjan van de Vend479e902006-01-06 16:47:00 -0500522 acpi_processor_perf_fops.write = acpi_processor_write_performance;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 entry->proc_fops = &acpi_processor_perf_fops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 entry->data = acpi_driver_data(device);
525 entry->owner = THIS_MODULE;
526 }
527 return_VOID;
528}
529
Len Brown4be44fc2005-08-05 00:44:28 -0400530static void acpi_cpufreq_remove_file(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531{
Len Brown4be44fc2005-08-05 00:44:28 -0400532 struct acpi_device *device = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533
534 ACPI_FUNCTION_TRACE("acpi_cpufreq_addfile");
535
536 if (acpi_bus_get_device(pr->handle, &device))
537 return_VOID;
538
539 /* remove file 'performance' */
540 remove_proc_entry(ACPI_PROCESSOR_FILE_PERFORMANCE,
Len Brown4be44fc2005-08-05 00:44:28 -0400541 acpi_device_dir(device));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542
543 return_VOID;
544}
545
546#else
Len Brown4be44fc2005-08-05 00:44:28 -0400547static void acpi_cpufreq_add_file(struct acpi_processor *pr)
548{
549 return;
550}
551static void acpi_cpufreq_remove_file(struct acpi_processor *pr)
552{
553 return;
554}
555#endif /* CONFIG_X86_ACPI_CPUFREQ_PROC_INTF */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500557static int acpi_processor_get_psd(struct acpi_processor *pr)
558{
559 int result = 0;
560 acpi_status status = AE_OK;
561 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
562 struct acpi_buffer format = {sizeof("NNNNN"), "NNNNN"};
563 struct acpi_buffer state = {0, NULL};
564 union acpi_object *psd = NULL;
565 struct acpi_psd_package *pdomain;
566
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500567 status = acpi_evaluate_object(pr->handle, "_PSD", NULL, &buffer);
568 if (ACPI_FAILURE(status)) {
Len Brown9011bff2006-05-11 00:28:12 -0400569 return -ENODEV;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500570 }
571
572 psd = (union acpi_object *) buffer.pointer;
573 if (!psd || (psd->type != ACPI_TYPE_PACKAGE)) {
574 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
575 result = -EFAULT;
576 goto end;
577 }
578
579 if (psd->package.count != 1) {
580 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
581 result = -EFAULT;
582 goto end;
583 }
584
585 pdomain = &(pr->performance->domain_info);
586
587 state.length = sizeof(struct acpi_psd_package);
588 state.pointer = pdomain;
589
590 status = acpi_extract_package(&(psd->package.elements[0]),
591 &format, &state);
592 if (ACPI_FAILURE(status)) {
593 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _PSD data\n"));
594 result = -EFAULT;
595 goto end;
596 }
597
598 if (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES) {
599 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _PSD:num_entries\n"));
600 result = -EFAULT;
601 goto end;
602 }
603
604 if (pdomain->revision != ACPI_PSD_REV0_REVISION) {
605 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _PSD:revision\n"));
606 result = -EFAULT;
607 goto end;
608 }
609
610end:
611 acpi_os_free(buffer.pointer);
Len Brown9011bff2006-05-11 00:28:12 -0400612 return result;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500613}
614
615int acpi_processor_preregister_performance(
616 struct acpi_processor_performance **performance)
617{
618 int count, count_target;
619 int retval = 0;
620 unsigned int i, j;
621 cpumask_t covered_cpus;
622 struct acpi_processor *pr;
623 struct acpi_psd_package *pdomain;
624 struct acpi_processor *match_pr;
625 struct acpi_psd_package *match_pdomain;
626
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500627 down(&performance_sem);
628
629 retval = 0;
630
631 /* Call _PSD for all CPUs */
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400632 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500633 pr = processors[i];
634 if (!pr) {
635 /* Look only at processors in ACPI namespace */
636 continue;
637 }
638
639 if (pr->performance) {
640 retval = -EBUSY;
641 continue;
642 }
643
644 if (!performance || !performance[i]) {
645 retval = -EINVAL;
646 continue;
647 }
648
649 pr->performance = performance[i];
650 cpu_set(i, pr->performance->shared_cpu_map);
651 if (acpi_processor_get_psd(pr)) {
652 retval = -EINVAL;
653 continue;
654 }
655 }
656 if (retval)
657 goto err_ret;
658
659 /*
660 * Now that we have _PSD data from all CPUs, lets setup P-state
661 * domain info.
662 */
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400663 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500664 pr = processors[i];
665 if (!pr)
666 continue;
667
668 /* Basic validity check for domain info */
669 pdomain = &(pr->performance->domain_info);
670 if ((pdomain->revision != ACPI_PSD_REV0_REVISION) ||
671 (pdomain->num_entries != ACPI_PSD_REV0_ENTRIES)) {
672 retval = -EINVAL;
673 goto err_ret;
674 }
675 if (pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ALL &&
676 pdomain->coord_type != DOMAIN_COORD_TYPE_SW_ANY &&
677 pdomain->coord_type != DOMAIN_COORD_TYPE_HW_ALL) {
678 retval = -EINVAL;
679 goto err_ret;
680 }
681 }
682
683 cpus_clear(covered_cpus);
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400684 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500685 pr = processors[i];
686 if (!pr)
687 continue;
688
689 if (cpu_isset(i, covered_cpus))
690 continue;
691
692 pdomain = &(pr->performance->domain_info);
693 cpu_set(i, pr->performance->shared_cpu_map);
694 cpu_set(i, covered_cpus);
695 if (pdomain->num_processors <= 1)
696 continue;
697
698 /* Validate the Domain info */
699 count_target = pdomain->num_processors;
700 count = 1;
701 if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ALL ||
702 pdomain->coord_type == DOMAIN_COORD_TYPE_HW_ALL) {
703 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL;
704 } else if (pdomain->coord_type == DOMAIN_COORD_TYPE_SW_ANY) {
705 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ANY;
706 }
707
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400708 for_each_possible_cpu(j) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500709 if (i == j)
710 continue;
711
712 match_pr = processors[j];
713 if (!match_pr)
714 continue;
715
716 match_pdomain = &(match_pr->performance->domain_info);
717 if (match_pdomain->domain != pdomain->domain)
718 continue;
719
720 /* Here i and j are in the same domain */
721
722 if (match_pdomain->num_processors != count_target) {
723 retval = -EINVAL;
724 goto err_ret;
725 }
726
727 if (pdomain->coord_type != match_pdomain->coord_type) {
728 retval = -EINVAL;
729 goto err_ret;
730 }
731
732 cpu_set(j, covered_cpus);
733 cpu_set(j, pr->performance->shared_cpu_map);
734 count++;
735 }
736
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400737 for_each_possible_cpu(j) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500738 if (i == j)
739 continue;
740
741 match_pr = processors[j];
742 if (!match_pr)
743 continue;
744
745 match_pdomain = &(match_pr->performance->domain_info);
746 if (match_pdomain->domain != pdomain->domain)
747 continue;
748
749 match_pr->performance->shared_type =
750 pr->performance->shared_type;
751 match_pr->performance->shared_cpu_map =
752 pr->performance->shared_cpu_map;
753 }
754 }
755
756err_ret:
757 if (retval) {
758 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Error while parsing _PSD domain information. Assuming no coordination\n"));
759 }
760
KAMEZAWA Hiroyuki193de0c2006-04-27 05:25:00 -0400761 for_each_possible_cpu(i) {
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500762 pr = processors[i];
763 if (!pr || !pr->performance)
764 continue;
765
766 /* Assume no coordination on any error parsing domain info */
767 if (retval) {
768 cpus_clear(pr->performance->shared_cpu_map);
769 cpu_set(i, pr->performance->shared_cpu_map);
770 pr->performance->shared_type = CPUFREQ_SHARED_TYPE_ALL;
771 }
772 pr->performance = NULL; /* Will be set for real in register */
773 }
774
775 up(&performance_sem);
Len Brown9011bff2006-05-11 00:28:12 -0400776 return retval;
Venkatesh Pallipadi3b2d9942005-12-14 15:05:00 -0500777}
778EXPORT_SYMBOL(acpi_processor_preregister_performance);
779
780
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781int
Len Brown4be44fc2005-08-05 00:44:28 -0400782acpi_processor_register_performance(struct acpi_processor_performance
783 *performance, unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700784{
785 struct acpi_processor *pr;
786
787 ACPI_FUNCTION_TRACE("acpi_processor_register_performance");
788
789 if (!(acpi_processor_ppc_status & PPC_REGISTERED))
790 return_VALUE(-EINVAL);
791
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400792 mutex_lock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793
794 pr = processors[cpu];
795 if (!pr) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400796 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797 return_VALUE(-ENODEV);
798 }
799
800 if (pr->performance) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400801 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802 return_VALUE(-EBUSY);
803 }
804
Andrew Mortona913f502006-06-10 09:54:13 -0700805 WARN_ON(!performance);
806
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807 pr->performance = performance;
808
809 if (acpi_processor_get_performance_info(pr)) {
810 pr->performance = NULL;
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400811 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 return_VALUE(-EIO);
813 }
814
815 acpi_cpufreq_add_file(pr);
816
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400817 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818 return_VALUE(0);
819}
Len Brown4be44fc2005-08-05 00:44:28 -0400820
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821EXPORT_SYMBOL(acpi_processor_register_performance);
822
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823void
Len Brown4be44fc2005-08-05 00:44:28 -0400824acpi_processor_unregister_performance(struct acpi_processor_performance
825 *performance, unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826{
827 struct acpi_processor *pr;
828
829 ACPI_FUNCTION_TRACE("acpi_processor_unregister_performance");
830
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400831 mutex_lock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832
833 pr = processors[cpu];
834 if (!pr) {
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400835 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 return_VOID;
837 }
838
Andrew Mortona913f502006-06-10 09:54:13 -0700839 if (pr->performance)
840 kfree(pr->performance->states);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841 pr->performance = NULL;
842
843 acpi_cpufreq_remove_file(pr);
844
Arjan van de Ven65c19bb2006-04-27 05:25:00 -0400845 mutex_unlock(&performance_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700846
847 return_VOID;
848}
Len Brown4be44fc2005-08-05 00:44:28 -0400849
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850EXPORT_SYMBOL(acpi_processor_unregister_performance);