blob: 1685b40abda7c2dba944939917a4993f8a4a5f3d [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * processor_throttling.c - Throttling submodule of the ACPI processor driver
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 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or (at
15 * your option) any later version.
16 *
17 * This program is distributed in the hope that it will be useful, but
18 * WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
20 * General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License along
23 * with this program; if not, write to the Free Software Foundation, Inc.,
24 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
25 *
26 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
27 */
28
29#include <linux/kernel.h>
30#include <linux/module.h>
31#include <linux/init.h>
Zhao Yakui357dc4c2007-11-29 16:22:43 +080032#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/cpufreq.h>
34#include <linux/proc_fs.h>
35#include <linux/seq_file.h>
36
37#include <asm/io.h>
38#include <asm/uaccess.h>
39
40#include <acpi/acpi_bus.h>
41#include <acpi/processor.h>
42
43#define ACPI_PROCESSOR_COMPONENT 0x01000000
44#define ACPI_PROCESSOR_CLASS "processor"
Linus Torvalds1da177e2005-04-16 15:20:36 -070045#define _COMPONENT ACPI_PROCESSOR_COMPONENT
Len Brownf52fd662007-02-12 22:42:12 -050046ACPI_MODULE_NAME("processor_throttling");
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Len Brownff55a9c2007-06-02 00:15:25 -040048static int acpi_processor_get_throttling(struct acpi_processor *pr);
49int acpi_processor_set_throttling(struct acpi_processor *pr, int state);
Luming Yu01854e62007-05-26 22:49:58 +080050
Len Brownc30c6202007-07-25 00:57:46 -040051/*
52 * _TPC - Throttling Present Capabilities
53 */
Luming Yu01854e62007-05-26 22:49:58 +080054static int acpi_processor_get_platform_limit(struct acpi_processor *pr)
55{
56 acpi_status status = 0;
57 unsigned long tpc = 0;
58
Len Brownff55a9c2007-06-02 00:15:25 -040059 if (!pr)
Luming Yu01854e62007-05-26 22:49:58 +080060 return -EINVAL;
61 status = acpi_evaluate_integer(pr->handle, "_TPC", NULL, &tpc);
Len Brownc30c6202007-07-25 00:57:46 -040062 if (ACPI_FAILURE(status)) {
63 if (status != AE_NOT_FOUND) {
64 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TPC"));
65 }
Luming Yu01854e62007-05-26 22:49:58 +080066 return -ENODEV;
67 }
68 pr->throttling_platform_limit = (int)tpc;
69 return 0;
70}
71
72int acpi_processor_tstate_has_changed(struct acpi_processor *pr)
73{
Zhao Yakuief54d5a2007-11-15 16:59:30 +080074 int result = 0;
75 int throttling_limit;
76 int current_state;
77 struct acpi_processor_limit *limit;
78 int target_state;
79
80 result = acpi_processor_get_platform_limit(pr);
81 if (result) {
82 /* Throttling Limit is unsupported */
83 return result;
84 }
85
86 throttling_limit = pr->throttling_platform_limit;
87 if (throttling_limit >= pr->throttling.state_count) {
88 /* Uncorrect Throttling Limit */
89 return -EINVAL;
90 }
91
92 current_state = pr->throttling.state;
93 if (current_state > throttling_limit) {
94 /*
95 * The current state can meet the requirement of
96 * _TPC limit. But it is reasonable that OSPM changes
97 * t-states from high to low for better performance.
98 * Of course the limit condition of thermal
99 * and user should be considered.
100 */
101 limit = &pr->limit;
102 target_state = throttling_limit;
103 if (limit->thermal.tx > target_state)
104 target_state = limit->thermal.tx;
105 if (limit->user.tx > target_state)
106 target_state = limit->user.tx;
107 } else if (current_state == throttling_limit) {
108 /*
109 * Unnecessary to change the throttling state
110 */
111 return 0;
112 } else {
113 /*
114 * If the current state is lower than the limit of _TPC, it
115 * will be forced to switch to the throttling state defined
116 * by throttling_platfor_limit.
117 * Because the previous state meets with the limit condition
118 * of thermal and user, it is unnecessary to check it again.
119 */
120 target_state = throttling_limit;
121 }
122 return acpi_processor_set_throttling(pr, target_state);
Luming Yu01854e62007-05-26 22:49:58 +0800123}
124
Len Brownc30c6202007-07-25 00:57:46 -0400125/*
126 * _PTC - Processor Throttling Control (and status) register location
127 */
Luming Yu01854e62007-05-26 22:49:58 +0800128static int acpi_processor_get_throttling_control(struct acpi_processor *pr)
129{
130 int result = 0;
131 acpi_status status = 0;
132 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
133 union acpi_object *ptc = NULL;
134 union acpi_object obj = { 0 };
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800135 struct acpi_processor_throttling *throttling;
Luming Yu01854e62007-05-26 22:49:58 +0800136
137 status = acpi_evaluate_object(pr->handle, "_PTC", NULL, &buffer);
138 if (ACPI_FAILURE(status)) {
Len Brownc30c6202007-07-25 00:57:46 -0400139 if (status != AE_NOT_FOUND) {
140 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PTC"));
141 }
Luming Yu01854e62007-05-26 22:49:58 +0800142 return -ENODEV;
143 }
144
145 ptc = (union acpi_object *)buffer.pointer;
146 if (!ptc || (ptc->type != ACPI_TYPE_PACKAGE)
147 || (ptc->package.count != 2)) {
148 printk(KERN_ERR PREFIX "Invalid _PTC data\n");
149 result = -EFAULT;
150 goto end;
151 }
152
153 /*
154 * control_register
155 */
156
157 obj = ptc->package.elements[0];
158
159 if ((obj.type != ACPI_TYPE_BUFFER)
160 || (obj.buffer.length < sizeof(struct acpi_ptc_register))
161 || (obj.buffer.pointer == NULL)) {
Len Brownff55a9c2007-06-02 00:15:25 -0400162 printk(KERN_ERR PREFIX
163 "Invalid _PTC data (control_register)\n");
Luming Yu01854e62007-05-26 22:49:58 +0800164 result = -EFAULT;
165 goto end;
166 }
167 memcpy(&pr->throttling.control_register, obj.buffer.pointer,
168 sizeof(struct acpi_ptc_register));
169
170 /*
171 * status_register
172 */
173
174 obj = ptc->package.elements[1];
175
176 if ((obj.type != ACPI_TYPE_BUFFER)
177 || (obj.buffer.length < sizeof(struct acpi_ptc_register))
178 || (obj.buffer.pointer == NULL)) {
179 printk(KERN_ERR PREFIX "Invalid _PTC data (status_register)\n");
180 result = -EFAULT;
181 goto end;
182 }
183
184 memcpy(&pr->throttling.status_register, obj.buffer.pointer,
Len Brownff55a9c2007-06-02 00:15:25 -0400185 sizeof(struct acpi_ptc_register));
Luming Yu01854e62007-05-26 22:49:58 +0800186
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800187 throttling = &pr->throttling;
188
189 if ((throttling->control_register.bit_width +
190 throttling->control_register.bit_offset) > 32) {
191 printk(KERN_ERR PREFIX "Invalid _PTC control register\n");
192 result = -EFAULT;
193 goto end;
194 }
195
196 if ((throttling->status_register.bit_width +
197 throttling->status_register.bit_offset) > 32) {
198 printk(KERN_ERR PREFIX "Invalid _PTC status register\n");
199 result = -EFAULT;
200 goto end;
201 }
202
Len Brownff55a9c2007-06-02 00:15:25 -0400203 end:
Luming Yu01854e62007-05-26 22:49:58 +0800204 kfree(buffer.pointer);
205
206 return result;
207}
Len Brownc30c6202007-07-25 00:57:46 -0400208
209/*
210 * _TSS - Throttling Supported States
211 */
Luming Yu01854e62007-05-26 22:49:58 +0800212static int acpi_processor_get_throttling_states(struct acpi_processor *pr)
213{
214 int result = 0;
215 acpi_status status = AE_OK;
216 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
217 struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
218 struct acpi_buffer state = { 0, NULL };
219 union acpi_object *tss = NULL;
220 int i;
221
222 status = acpi_evaluate_object(pr->handle, "_TSS", NULL, &buffer);
223 if (ACPI_FAILURE(status)) {
Len Brownc30c6202007-07-25 00:57:46 -0400224 if (status != AE_NOT_FOUND) {
225 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TSS"));
226 }
Luming Yu01854e62007-05-26 22:49:58 +0800227 return -ENODEV;
228 }
229
230 tss = buffer.pointer;
231 if (!tss || (tss->type != ACPI_TYPE_PACKAGE)) {
232 printk(KERN_ERR PREFIX "Invalid _TSS data\n");
233 result = -EFAULT;
234 goto end;
235 }
236
237 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d throttling states\n",
238 tss->package.count));
239
240 pr->throttling.state_count = tss->package.count;
241 pr->throttling.states_tss =
242 kmalloc(sizeof(struct acpi_processor_tx_tss) * tss->package.count,
243 GFP_KERNEL);
244 if (!pr->throttling.states_tss) {
245 result = -ENOMEM;
246 goto end;
247 }
248
249 for (i = 0; i < pr->throttling.state_count; i++) {
250
Len Brownff55a9c2007-06-02 00:15:25 -0400251 struct acpi_processor_tx_tss *tx =
252 (struct acpi_processor_tx_tss *)&(pr->throttling.
253 states_tss[i]);
Luming Yu01854e62007-05-26 22:49:58 +0800254
255 state.length = sizeof(struct acpi_processor_tx_tss);
256 state.pointer = tx;
257
258 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i));
259
260 status = acpi_extract_package(&(tss->package.elements[i]),
261 &format, &state);
262 if (ACPI_FAILURE(status)) {
263 ACPI_EXCEPTION((AE_INFO, status, "Invalid _TSS data"));
264 result = -EFAULT;
265 kfree(pr->throttling.states_tss);
266 goto end;
267 }
268
269 if (!tx->freqpercentage) {
270 printk(KERN_ERR PREFIX
Len Brownff55a9c2007-06-02 00:15:25 -0400271 "Invalid _TSS data: freq is zero\n");
Luming Yu01854e62007-05-26 22:49:58 +0800272 result = -EFAULT;
273 kfree(pr->throttling.states_tss);
274 goto end;
275 }
276 }
277
278 end:
279 kfree(buffer.pointer);
280
281 return result;
282}
Len Brownc30c6202007-07-25 00:57:46 -0400283
284/*
285 * _TSD - T-State Dependencies
286 */
Len Brownff55a9c2007-06-02 00:15:25 -0400287static int acpi_processor_get_tsd(struct acpi_processor *pr)
Luming Yu01854e62007-05-26 22:49:58 +0800288{
289 int result = 0;
290 acpi_status status = AE_OK;
Len Brownff55a9c2007-06-02 00:15:25 -0400291 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
292 struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
293 struct acpi_buffer state = { 0, NULL };
294 union acpi_object *tsd = NULL;
Luming Yu01854e62007-05-26 22:49:58 +0800295 struct acpi_tsd_package *pdomain;
296
297 status = acpi_evaluate_object(pr->handle, "_TSD", NULL, &buffer);
298 if (ACPI_FAILURE(status)) {
Len Brownc30c6202007-07-25 00:57:46 -0400299 if (status != AE_NOT_FOUND) {
300 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TSD"));
301 }
Luming Yu01854e62007-05-26 22:49:58 +0800302 return -ENODEV;
303 }
304
305 tsd = buffer.pointer;
306 if (!tsd || (tsd->type != ACPI_TYPE_PACKAGE)) {
307 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
308 result = -EFAULT;
309 goto end;
310 }
311
312 if (tsd->package.count != 1) {
313 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
314 result = -EFAULT;
315 goto end;
316 }
317
318 pdomain = &(pr->throttling.domain_info);
319
320 state.length = sizeof(struct acpi_tsd_package);
321 state.pointer = pdomain;
322
323 status = acpi_extract_package(&(tsd->package.elements[0]),
Len Brownff55a9c2007-06-02 00:15:25 -0400324 &format, &state);
Luming Yu01854e62007-05-26 22:49:58 +0800325 if (ACPI_FAILURE(status)) {
326 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
327 result = -EFAULT;
328 goto end;
329 }
330
331 if (pdomain->num_entries != ACPI_TSD_REV0_ENTRIES) {
332 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _TSD:num_entries\n"));
333 result = -EFAULT;
334 goto end;
335 }
336
337 if (pdomain->revision != ACPI_TSD_REV0_REVISION) {
338 ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _TSD:revision\n"));
339 result = -EFAULT;
340 goto end;
341 }
342
Len Brownff55a9c2007-06-02 00:15:25 -0400343 end:
Luming Yu01854e62007-05-26 22:49:58 +0800344 kfree(buffer.pointer);
345 return result;
346}
347
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348/* --------------------------------------------------------------------------
349 Throttling Control
350 -------------------------------------------------------------------------- */
Luming Yu01854e62007-05-26 22:49:58 +0800351static int acpi_processor_get_throttling_fadt(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352{
Len Brown4be44fc2005-08-05 00:44:28 -0400353 int state = 0;
354 u32 value = 0;
355 u32 duty_mask = 0;
356 u32 duty_value = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -0400359 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360
361 if (!pr->flags.throttling)
Patrick Mocheld550d982006-06-27 00:41:40 -0400362 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363
364 pr->throttling.state = 0;
365
366 duty_mask = pr->throttling.state_count - 1;
367
368 duty_mask <<= pr->throttling.duty_offset;
369
370 local_irq_disable();
371
372 value = inl(pr->throttling.address);
373
374 /*
375 * Compute the current throttling state when throttling is enabled
376 * (bit 4 is on).
377 */
378 if (value & 0x10) {
379 duty_value = value & duty_mask;
380 duty_value >>= pr->throttling.duty_offset;
381
382 if (duty_value)
Len Brown4be44fc2005-08-05 00:44:28 -0400383 state = pr->throttling.state_count - duty_value;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 }
385
386 pr->throttling.state = state;
387
388 local_irq_enable();
389
390 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400391 "Throttling state is T%d (%d%% throttling applied)\n",
392 state, pr->throttling.states[state].performance));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393
Patrick Mocheld550d982006-06-27 00:41:40 -0400394 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395}
396
Zhao Yakuif79f06a2007-11-15 17:06:36 +0800397#ifdef CONFIG_X86
398static int acpi_throttling_rdmsr(struct acpi_processor *pr,
399 acpi_integer * value)
400{
401 struct cpuinfo_x86 *c;
402 u64 msr_high, msr_low;
403 unsigned int cpu;
404 u64 msr = 0;
405 int ret = -1;
406
407 cpu = pr->id;
408 c = &cpu_data(cpu);
409
410 if ((c->x86_vendor != X86_VENDOR_INTEL) ||
411 !cpu_has(c, X86_FEATURE_ACPI)) {
412 printk(KERN_ERR PREFIX
413 "HARDWARE addr space,NOT supported yet\n");
414 } else {
415 msr_low = 0;
416 msr_high = 0;
Zhao Yakui357dc4c2007-11-29 16:22:43 +0800417 rdmsr_safe(MSR_IA32_THERM_CONTROL,
Zhao Yakuif79f06a2007-11-15 17:06:36 +0800418 (u32 *)&msr_low , (u32 *) &msr_high);
419 msr = (msr_high << 32) | msr_low;
420 *value = (acpi_integer) msr;
421 ret = 0;
422 }
423 return ret;
424}
425
426static int acpi_throttling_wrmsr(struct acpi_processor *pr, acpi_integer value)
427{
428 struct cpuinfo_x86 *c;
429 unsigned int cpu;
430 int ret = -1;
431 u64 msr;
432
433 cpu = pr->id;
434 c = &cpu_data(cpu);
435
436 if ((c->x86_vendor != X86_VENDOR_INTEL) ||
437 !cpu_has(c, X86_FEATURE_ACPI)) {
438 printk(KERN_ERR PREFIX
439 "HARDWARE addr space,NOT supported yet\n");
440 } else {
441 msr = value;
Zhao Yakui357dc4c2007-11-29 16:22:43 +0800442 wrmsr_safe(MSR_IA32_THERM_CONTROL,
Zhao Yakuif79f06a2007-11-15 17:06:36 +0800443 msr & 0xffffffff, msr >> 32);
444 ret = 0;
445 }
446 return ret;
447}
448#else
449static int acpi_throttling_rdmsr(struct acpi_processor *pr,
450 acpi_integer * value)
451{
452 printk(KERN_ERR PREFIX
453 "HARDWARE addr space,NOT supported yet\n");
454 return -1;
455}
456
457static int acpi_throttling_wrmsr(struct acpi_processor *pr, acpi_integer value)
458{
459 printk(KERN_ERR PREFIX
460 "HARDWARE addr space,NOT supported yet\n");
461 return -1;
462}
463#endif
464
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800465static int acpi_read_throttling_status(struct acpi_processor *pr,
466 acpi_integer *value)
Luming Yu01854e62007-05-26 22:49:58 +0800467{
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800468 u32 bit_width, bit_offset;
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800469 u64 ptc_value;
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800470 u64 ptc_mask;
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800471 struct acpi_processor_throttling *throttling;
472 int ret = -1;
473
474 throttling = &pr->throttling;
Luming Yu01854e62007-05-26 22:49:58 +0800475 switch (throttling->status_register.space_id) {
476 case ACPI_ADR_SPACE_SYSTEM_IO:
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800477 ptc_value = 0;
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800478 bit_width = throttling->status_register.bit_width;
479 bit_offset = throttling->status_register.bit_offset;
480
Len Brownff55a9c2007-06-02 00:15:25 -0400481 acpi_os_read_port((acpi_io_address) throttling->status_register.
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800482 address, (u32 *) &ptc_value,
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800483 (u32) (bit_width + bit_offset));
484 ptc_mask = (1 << bit_width) - 1;
485 *value = (acpi_integer) ((ptc_value >> bit_offset) & ptc_mask);
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800486 ret = 0;
Luming Yu01854e62007-05-26 22:49:58 +0800487 break;
488 case ACPI_ADR_SPACE_FIXED_HARDWARE:
Zhao Yakuif79f06a2007-11-15 17:06:36 +0800489 ret = acpi_throttling_rdmsr(pr, value);
Luming Yu01854e62007-05-26 22:49:58 +0800490 break;
491 default:
492 printk(KERN_ERR PREFIX "Unknown addr space %d\n",
Len Brownff55a9c2007-06-02 00:15:25 -0400493 (u32) (throttling->status_register.space_id));
Luming Yu01854e62007-05-26 22:49:58 +0800494 }
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800495 return ret;
Luming Yu01854e62007-05-26 22:49:58 +0800496}
497
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800498static int acpi_write_throttling_state(struct acpi_processor *pr,
499 acpi_integer value)
Luming Yu01854e62007-05-26 22:49:58 +0800500{
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800501 u32 bit_width, bit_offset;
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800502 u64 ptc_value;
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800503 u64 ptc_mask;
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800504 struct acpi_processor_throttling *throttling;
Luming Yu01854e62007-05-26 22:49:58 +0800505 int ret = -1;
506
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800507 throttling = &pr->throttling;
Luming Yu01854e62007-05-26 22:49:58 +0800508 switch (throttling->control_register.space_id) {
509 case ACPI_ADR_SPACE_SYSTEM_IO:
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800510 bit_width = throttling->control_register.bit_width;
511 bit_offset = throttling->control_register.bit_offset;
512 ptc_mask = (1 << bit_width) - 1;
513 ptc_value = value & ptc_mask;
514
Len Brownff55a9c2007-06-02 00:15:25 -0400515 acpi_os_write_port((acpi_io_address) throttling->
Zhao Yakui9bcb2722007-11-15 17:05:05 +0800516 control_register.address,
517 (u32) (ptc_value << bit_offset),
518 (u32) (bit_width + bit_offset));
Luming Yu01854e62007-05-26 22:49:58 +0800519 ret = 0;
520 break;
521 case ACPI_ADR_SPACE_FIXED_HARDWARE:
Zhao Yakuif79f06a2007-11-15 17:06:36 +0800522 ret = acpi_throttling_wrmsr(pr, value);
Luming Yu01854e62007-05-26 22:49:58 +0800523 break;
524 default:
525 printk(KERN_ERR PREFIX "Unknown addr space %d\n",
Len Brownff55a9c2007-06-02 00:15:25 -0400526 (u32) (throttling->control_register.space_id));
Luming Yu01854e62007-05-26 22:49:58 +0800527 }
528 return ret;
529}
530
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800531static int acpi_get_throttling_state(struct acpi_processor *pr,
532 acpi_integer value)
Luming Yu01854e62007-05-26 22:49:58 +0800533{
534 int i;
535
536 for (i = 0; i < pr->throttling.state_count; i++) {
Len Brownff55a9c2007-06-02 00:15:25 -0400537 struct acpi_processor_tx_tss *tx =
538 (struct acpi_processor_tx_tss *)&(pr->throttling.
539 states_tss[i]);
540 if (tx->control == value)
Luming Yu01854e62007-05-26 22:49:58 +0800541 break;
542 }
Len Brownff55a9c2007-06-02 00:15:25 -0400543 if (i > pr->throttling.state_count)
544 i = -1;
Luming Yu01854e62007-05-26 22:49:58 +0800545 return i;
546}
547
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800548static int acpi_get_throttling_value(struct acpi_processor *pr,
549 int state, acpi_integer *value)
Luming Yu01854e62007-05-26 22:49:58 +0800550{
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800551 int ret = -1;
552
Len Brownff55a9c2007-06-02 00:15:25 -0400553 if (state >= 0 && state <= pr->throttling.state_count) {
554 struct acpi_processor_tx_tss *tx =
555 (struct acpi_processor_tx_tss *)&(pr->throttling.
556 states_tss[state]);
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800557 *value = tx->control;
558 ret = 0;
Luming Yu01854e62007-05-26 22:49:58 +0800559 }
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800560 return ret;
Luming Yu01854e62007-05-26 22:49:58 +0800561}
562
563static int acpi_processor_get_throttling_ptc(struct acpi_processor *pr)
564{
565 int state = 0;
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800566 int ret;
567 acpi_integer value;
Luming Yu01854e62007-05-26 22:49:58 +0800568
Luming Yu01854e62007-05-26 22:49:58 +0800569 if (!pr)
570 return -EINVAL;
571
572 if (!pr->flags.throttling)
573 return -ENODEV;
574
575 pr->throttling.state = 0;
Zhao Yakui357dc4c2007-11-29 16:22:43 +0800576
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800577 value = 0;
578 ret = acpi_read_throttling_status(pr, &value);
579 if (ret >= 0) {
Len Brownff55a9c2007-06-02 00:15:25 -0400580 state = acpi_get_throttling_state(pr, value);
Luming Yu01854e62007-05-26 22:49:58 +0800581 pr->throttling.state = state;
582 }
Luming Yu01854e62007-05-26 22:49:58 +0800583
584 return 0;
585}
586
Luming Yu01854e62007-05-26 22:49:58 +0800587static int acpi_processor_get_throttling(struct acpi_processor *pr)
588{
Zhao Yakui357dc4c2007-11-29 16:22:43 +0800589 cpumask_t saved_mask;
590 int ret;
591
592 /*
593 * Migrate task to the cpu pointed by pr.
594 */
595 saved_mask = current->cpus_allowed;
596 set_cpus_allowed(current, cpumask_of_cpu(pr->id));
597 ret = pr->throttling.acpi_processor_get_throttling(pr);
598 /* restore the previous state */
599 set_cpus_allowed(current, saved_mask);
600
601 return ret;
Luming Yu01854e62007-05-26 22:49:58 +0800602}
603
Zhao Yakui22cc5012007-11-15 17:02:03 +0800604static int acpi_processor_get_fadt_info(struct acpi_processor *pr)
605{
606 int i, step;
607
608 if (!pr->throttling.address) {
609 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No throttling register\n"));
610 return -EINVAL;
611 } else if (!pr->throttling.duty_width) {
612 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No throttling states\n"));
613 return -EINVAL;
614 }
615 /* TBD: Support duty_cycle values that span bit 4. */
616 else if ((pr->throttling.duty_offset + pr->throttling.duty_width) > 4) {
617 printk(KERN_WARNING PREFIX "duty_cycle spans bit 4\n");
618 return -EINVAL;
619 }
620
621 pr->throttling.state_count = 1 << acpi_gbl_FADT.duty_width;
622
623 /*
624 * Compute state values. Note that throttling displays a linear power
625 * performance relationship (at 50% performance the CPU will consume
626 * 50% power). Values are in 1/10th of a percent to preserve accuracy.
627 */
628
629 step = (1000 / pr->throttling.state_count);
630
631 for (i = 0; i < pr->throttling.state_count; i++) {
632 pr->throttling.states[i].performance = 1000 - step * i;
633 pr->throttling.states[i].power = 1000 - step * i;
634 }
635 return 0;
636}
637
Adrian Bunk6c5cf8a2007-07-03 00:53:12 -0400638static int acpi_processor_set_throttling_fadt(struct acpi_processor *pr,
639 int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640{
Len Brown4be44fc2005-08-05 00:44:28 -0400641 u32 value = 0;
642 u32 duty_mask = 0;
643 u32 duty_value = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644
Linus Torvalds1da177e2005-04-16 15:20:36 -0700645 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -0400646 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647
648 if ((state < 0) || (state > (pr->throttling.state_count - 1)))
Patrick Mocheld550d982006-06-27 00:41:40 -0400649 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650
651 if (!pr->flags.throttling)
Patrick Mocheld550d982006-06-27 00:41:40 -0400652 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653
654 if (state == pr->throttling.state)
Patrick Mocheld550d982006-06-27 00:41:40 -0400655 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656
Luming Yu01854e62007-05-26 22:49:58 +0800657 if (state < pr->throttling_platform_limit)
658 return -EPERM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 /*
660 * Calculate the duty_value and duty_mask.
661 */
662 if (state) {
663 duty_value = pr->throttling.state_count - state;
664
665 duty_value <<= pr->throttling.duty_offset;
666
667 /* Used to clear all duty_value bits */
668 duty_mask = pr->throttling.state_count - 1;
669
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300670 duty_mask <<= acpi_gbl_FADT.duty_offset;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671 duty_mask = ~duty_mask;
672 }
673
674 local_irq_disable();
675
676 /*
677 * Disable throttling by writing a 0 to bit 4. Note that we must
678 * turn it off before you can change the duty_value.
679 */
680 value = inl(pr->throttling.address);
681 if (value & 0x10) {
682 value &= 0xFFFFFFEF;
683 outl(value, pr->throttling.address);
684 }
685
686 /*
687 * Write the new duty_value and then enable throttling. Note
688 * that a state value of 0 leaves throttling disabled.
689 */
690 if (state) {
691 value &= duty_mask;
692 value |= duty_value;
693 outl(value, pr->throttling.address);
694
695 value |= 0x00000010;
696 outl(value, pr->throttling.address);
697 }
698
699 pr->throttling.state = state;
700
701 local_irq_enable();
702
703 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400704 "Throttling state set to T%d (%d%%)\n", state,
705 (pr->throttling.states[state].performance ? pr->
706 throttling.states[state].performance / 10 : 0)));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707
Patrick Mocheld550d982006-06-27 00:41:40 -0400708 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709}
710
Adrian Bunk6c5cf8a2007-07-03 00:53:12 -0400711static int acpi_processor_set_throttling_ptc(struct acpi_processor *pr,
712 int state)
Luming Yu01854e62007-05-26 22:49:58 +0800713{
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800714 int ret;
715 acpi_integer value;
Luming Yu01854e62007-05-26 22:49:58 +0800716
717 if (!pr)
718 return -EINVAL;
719
720 if ((state < 0) || (state > (pr->throttling.state_count - 1)))
721 return -EINVAL;
722
723 if (!pr->flags.throttling)
724 return -ENODEV;
725
726 if (state == pr->throttling.state)
727 return 0;
728
729 if (state < pr->throttling_platform_limit)
730 return -EPERM;
731
Zhao Yakui0753f6e2007-11-15 17:03:46 +0800732 value = 0;
733 ret = acpi_get_throttling_value(pr, state, &value);
734 if (ret >= 0) {
735 acpi_write_throttling_state(pr, value);
Luming Yu01854e62007-05-26 22:49:58 +0800736 pr->throttling.state = state;
737 }
Luming Yu01854e62007-05-26 22:49:58 +0800738
739 return 0;
740}
741
742int acpi_processor_set_throttling(struct acpi_processor *pr, int state)
743{
Zhao Yakui357dc4c2007-11-29 16:22:43 +0800744 cpumask_t saved_mask;
745 int ret;
746 /*
747 * Migrate task to the cpu pointed by pr.
748 */
749 saved_mask = current->cpus_allowed;
750 set_cpus_allowed(current, cpumask_of_cpu(pr->id));
751 ret = pr->throttling.acpi_processor_set_throttling(pr, state);
752 /* restore the previous state */
753 set_cpus_allowed(current, saved_mask);
754 return ret;
Luming Yu01854e62007-05-26 22:49:58 +0800755}
756
Len Brown4be44fc2005-08-05 00:44:28 -0400757int acpi_processor_get_throttling_info(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758{
Len Brown4be44fc2005-08-05 00:44:28 -0400759 int result = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400762 "pblk_address[0x%08x] duty_offset[%d] duty_width[%d]\n",
763 pr->throttling.address,
764 pr->throttling.duty_offset,
765 pr->throttling.duty_width));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766
767 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -0400768 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769
Len Brownc30c6202007-07-25 00:57:46 -0400770 /*
771 * Evaluate _PTC, _TSS and _TPC
772 * They must all be present or none of them can be used.
773 */
774 if (acpi_processor_get_throttling_control(pr) ||
775 acpi_processor_get_throttling_states(pr) ||
776 acpi_processor_get_platform_limit(pr))
777 {
Len Brownff55a9c2007-06-02 00:15:25 -0400778 pr->throttling.acpi_processor_get_throttling =
779 &acpi_processor_get_throttling_fadt;
780 pr->throttling.acpi_processor_set_throttling =
781 &acpi_processor_set_throttling_fadt;
Alexey Starikovskiyd1154be2008-01-15 00:47:47 -0500782 if (acpi_processor_get_fadt_info(pr))
783 return 0;
Luming Yu01854e62007-05-26 22:49:58 +0800784 } else {
Len Brownff55a9c2007-06-02 00:15:25 -0400785 pr->throttling.acpi_processor_get_throttling =
786 &acpi_processor_get_throttling_ptc;
787 pr->throttling.acpi_processor_set_throttling =
788 &acpi_processor_set_throttling_ptc;
Luming Yu01854e62007-05-26 22:49:58 +0800789 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700790
Len Brownc30c6202007-07-25 00:57:46 -0400791 acpi_processor_get_tsd(pr);
792
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793 /*
794 * PIIX4 Errata: We don't support throttling on the original PIIX4.
795 * This shouldn't be an issue as few (if any) mobile systems ever
796 * used this part.
797 */
798 if (errata.piix4.throttle) {
799 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400800 "Throttling not supported on PIIX4 A- or B-step\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400801 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802 }
803
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d throttling states\n",
Len Brown4be44fc2005-08-05 00:44:28 -0400805 pr->throttling.state_count));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806
807 pr->flags.throttling = 1;
808
809 /*
810 * Disable throttling (if enabled). We'll let subsequent policy (e.g.
811 * thermal) decide to lower performance if it so chooses, but for now
812 * we'll crank up the speed.
813 */
814
815 result = acpi_processor_get_throttling(pr);
816 if (result)
817 goto end;
818
819 if (pr->throttling.state) {
Len Brown4be44fc2005-08-05 00:44:28 -0400820 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
821 "Disabling throttling (was T%d)\n",
822 pr->throttling.state));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823 result = acpi_processor_set_throttling(pr, 0);
824 if (result)
825 goto end;
826 }
827
Len Brown4be44fc2005-08-05 00:44:28 -0400828 end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 if (result)
830 pr->flags.throttling = 0;
831
Patrick Mocheld550d982006-06-27 00:41:40 -0400832 return result;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833}
834
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835/* proc interface */
836
Len Brown4be44fc2005-08-05 00:44:28 -0400837static int acpi_processor_throttling_seq_show(struct seq_file *seq,
838 void *offset)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839{
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200840 struct acpi_processor *pr = seq->private;
Len Brown4be44fc2005-08-05 00:44:28 -0400841 int i = 0;
842 int result = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 if (!pr)
845 goto end;
846
847 if (!(pr->throttling.state_count > 0)) {
848 seq_puts(seq, "<not supported>\n");
849 goto end;
850 }
851
852 result = acpi_processor_get_throttling(pr);
853
854 if (result) {
Len Brown4be44fc2005-08-05 00:44:28 -0400855 seq_puts(seq,
856 "Could not determine current throttling state.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857 goto end;
858 }
859
860 seq_printf(seq, "state count: %d\n"
Luming Yu01854e62007-05-26 22:49:58 +0800861 "active state: T%d\n"
Len Brownff55a9c2007-06-02 00:15:25 -0400862 "state available: T%d to T%d\n",
Luming Yu01854e62007-05-26 22:49:58 +0800863 pr->throttling.state_count, pr->throttling.state,
Len Brownff55a9c2007-06-02 00:15:25 -0400864 pr->throttling_platform_limit,
865 pr->throttling.state_count - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700866
867 seq_puts(seq, "states:\n");
Luming Yu3cc26492007-07-23 12:39:28 -0400868 if (pr->throttling.acpi_processor_get_throttling ==
869 acpi_processor_get_throttling_fadt) {
Luming Yu01854e62007-05-26 22:49:58 +0800870 for (i = 0; i < pr->throttling.state_count; i++)
871 seq_printf(seq, " %cT%d: %02d%%\n",
Len Brownff55a9c2007-06-02 00:15:25 -0400872 (i == pr->throttling.state ? '*' : ' '), i,
873 (pr->throttling.states[i].performance ? pr->
874 throttling.states[i].performance / 10 : 0));
Luming Yu3cc26492007-07-23 12:39:28 -0400875 } else {
Luming Yu01854e62007-05-26 22:49:58 +0800876 for (i = 0; i < pr->throttling.state_count; i++)
877 seq_printf(seq, " %cT%d: %02d%%\n",
Len Brownff55a9c2007-06-02 00:15:25 -0400878 (i == pr->throttling.state ? '*' : ' '), i,
879 (int)pr->throttling.states_tss[i].
880 freqpercentage);
Luming Yu3cc26492007-07-23 12:39:28 -0400881 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882
Len Brown4be44fc2005-08-05 00:44:28 -0400883 end:
Patrick Mocheld550d982006-06-27 00:41:40 -0400884 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885}
886
Len Brown4be44fc2005-08-05 00:44:28 -0400887static int acpi_processor_throttling_open_fs(struct inode *inode,
888 struct file *file)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889{
890 return single_open(file, acpi_processor_throttling_seq_show,
Len Brown4be44fc2005-08-05 00:44:28 -0400891 PDE(inode)->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892}
893
Len Brownff55a9c2007-06-02 00:15:25 -0400894static ssize_t acpi_processor_write_throttling(struct file *file,
Adrian Bunk757b1862006-01-07 13:19:00 -0500895 const char __user * buffer,
896 size_t count, loff_t * data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700897{
Len Brown4be44fc2005-08-05 00:44:28 -0400898 int result = 0;
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200899 struct seq_file *m = file->private_data;
900 struct acpi_processor *pr = m->private;
Len Brown4be44fc2005-08-05 00:44:28 -0400901 char state_string[12] = { '\0' };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903 if (!pr || (count > sizeof(state_string) - 1))
Patrick Mocheld550d982006-06-27 00:41:40 -0400904 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905
906 if (copy_from_user(state_string, buffer, count))
Patrick Mocheld550d982006-06-27 00:41:40 -0400907 return -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908
909 state_string[count] = '\0';
910
911 result = acpi_processor_set_throttling(pr,
Len Brown4be44fc2005-08-05 00:44:28 -0400912 simple_strtoul(state_string,
913 NULL, 0));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 if (result)
Patrick Mocheld550d982006-06-27 00:41:40 -0400915 return result;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916
Patrick Mocheld550d982006-06-27 00:41:40 -0400917 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918}
919
920struct file_operations acpi_processor_throttling_fops = {
Len Brown4be44fc2005-08-05 00:44:28 -0400921 .open = acpi_processor_throttling_open_fs,
922 .read = seq_read,
Arjan van de Vend479e902006-01-06 16:47:00 -0500923 .write = acpi_processor_write_throttling,
Len Brown4be44fc2005-08-05 00:44:28 -0400924 .llseek = seq_lseek,
925 .release = single_release,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926};