processor_throttling.c 21.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44
/*
 * processor_throttling.c - Throttling submodule of the ACPI processor driver
 *
 *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
 *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
 *  Copyright (C) 2004       Dominik Brodowski <linux@brodo.de>
 *  Copyright (C) 2004  Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com>
 *  			- Added processor hotplug support
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/cpufreq.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>

#include <asm/io.h>
#include <asm/uaccess.h>

#include <acpi/acpi_bus.h>
#include <acpi/processor.h>

#define ACPI_PROCESSOR_COMPONENT        0x01000000
#define ACPI_PROCESSOR_CLASS            "processor"
#define _COMPONENT              ACPI_PROCESSOR_COMPONENT
45
ACPI_MODULE_NAME("processor_throttling");
L
Linus Torvalds 已提交
46

47 48
static int acpi_processor_get_throttling(struct acpi_processor *pr);
int acpi_processor_set_throttling(struct acpi_processor *pr, int state);
49

50 51 52
/*
 * _TPC - Throttling Present Capabilities
 */
53 54 55 56 57
static int acpi_processor_get_platform_limit(struct acpi_processor *pr)
{
	acpi_status status = 0;
	unsigned long tpc = 0;

58
	if (!pr)
59 60
		return -EINVAL;
	status = acpi_evaluate_integer(pr->handle, "_TPC", NULL, &tpc);
61 62 63 64
	if (ACPI_FAILURE(status)) {
		if (status != AE_NOT_FOUND) {
			ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TPC"));
		}
65 66 67 68 69 70 71 72
		return -ENODEV;
	}
	pr->throttling_platform_limit = (int)tpc;
	return 0;
}

int acpi_processor_tstate_has_changed(struct acpi_processor *pr)
{
73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121
	int result = 0;
	int throttling_limit;
	int current_state;
	struct acpi_processor_limit *limit;
	int target_state;

	result = acpi_processor_get_platform_limit(pr);
	if (result) {
		/* Throttling Limit is unsupported */
		return result;
	}

	throttling_limit = pr->throttling_platform_limit;
	if (throttling_limit >= pr->throttling.state_count) {
		/* Uncorrect Throttling Limit */
		return -EINVAL;
	}

	current_state = pr->throttling.state;
	if (current_state > throttling_limit) {
		/*
		 * The current state can meet the requirement of
		 * _TPC limit. But it is reasonable that OSPM changes
		 * t-states from high to low for better performance.
		 * Of course the limit condition of thermal
		 * and user should be considered.
		 */
		limit = &pr->limit;
		target_state = throttling_limit;
		if (limit->thermal.tx > target_state)
			target_state = limit->thermal.tx;
		if (limit->user.tx > target_state)
			target_state = limit->user.tx;
	} else if (current_state == throttling_limit) {
		/*
		 * Unnecessary to change the throttling state
		 */
		return 0;
	} else {
		/*
		 * If the current state is lower than the limit of _TPC, it
		 * will be forced to switch to the throttling state defined
		 * by throttling_platfor_limit.
		 * Because the previous state meets with the limit condition
		 * of thermal and user, it is unnecessary to check it again.
		 */
		target_state = throttling_limit;
	}
	return acpi_processor_set_throttling(pr, target_state);
122 123
}

124 125 126
/*
 * _PTC - Processor Throttling Control (and status) register location
 */
127 128 129 130 131 132 133
static int acpi_processor_get_throttling_control(struct acpi_processor *pr)
{
	int result = 0;
	acpi_status status = 0;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *ptc = NULL;
	union acpi_object obj = { 0 };
134
	struct acpi_processor_throttling *throttling;
135 136 137

	status = acpi_evaluate_object(pr->handle, "_PTC", NULL, &buffer);
	if (ACPI_FAILURE(status)) {
138 139 140
		if (status != AE_NOT_FOUND) {
			ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PTC"));
		}
141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160
		return -ENODEV;
	}

	ptc = (union acpi_object *)buffer.pointer;
	if (!ptc || (ptc->type != ACPI_TYPE_PACKAGE)
	    || (ptc->package.count != 2)) {
		printk(KERN_ERR PREFIX "Invalid _PTC data\n");
		result = -EFAULT;
		goto end;
	}

	/*
	 * control_register
	 */

	obj = ptc->package.elements[0];

	if ((obj.type != ACPI_TYPE_BUFFER)
	    || (obj.buffer.length < sizeof(struct acpi_ptc_register))
	    || (obj.buffer.pointer == NULL)) {
161 162
		printk(KERN_ERR PREFIX
		       "Invalid _PTC data (control_register)\n");
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183
		result = -EFAULT;
		goto end;
	}
	memcpy(&pr->throttling.control_register, obj.buffer.pointer,
	       sizeof(struct acpi_ptc_register));

	/*
	 * status_register
	 */

	obj = ptc->package.elements[1];

	if ((obj.type != ACPI_TYPE_BUFFER)
	    || (obj.buffer.length < sizeof(struct acpi_ptc_register))
	    || (obj.buffer.pointer == NULL)) {
		printk(KERN_ERR PREFIX "Invalid _PTC data (status_register)\n");
		result = -EFAULT;
		goto end;
	}

	memcpy(&pr->throttling.status_register, obj.buffer.pointer,
184
	       sizeof(struct acpi_ptc_register));
185

186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201
	throttling = &pr->throttling;

	if ((throttling->control_register.bit_width +
		throttling->control_register.bit_offset) > 32) {
		printk(KERN_ERR PREFIX "Invalid _PTC control register\n");
		result = -EFAULT;
		goto end;
	}

	if ((throttling->status_register.bit_width +
		throttling->status_register.bit_offset) > 32) {
		printk(KERN_ERR PREFIX "Invalid _PTC status register\n");
		result = -EFAULT;
		goto end;
	}

202
      end:
203 204 205 206
	kfree(buffer.pointer);

	return result;
}
207 208 209 210

/*
 * _TSS - Throttling Supported States
 */
211 212 213 214 215 216 217 218 219 220 221 222
static int acpi_processor_get_throttling_states(struct acpi_processor *pr)
{
	int result = 0;
	acpi_status status = AE_OK;
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
	struct acpi_buffer state = { 0, NULL };
	union acpi_object *tss = NULL;
	int i;

	status = acpi_evaluate_object(pr->handle, "_TSS", NULL, &buffer);
	if (ACPI_FAILURE(status)) {
223 224 225
		if (status != AE_NOT_FOUND) {
			ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TSS"));
		}
226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
		return -ENODEV;
	}

	tss = buffer.pointer;
	if (!tss || (tss->type != ACPI_TYPE_PACKAGE)) {
		printk(KERN_ERR PREFIX "Invalid _TSS data\n");
		result = -EFAULT;
		goto end;
	}

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d throttling states\n",
			  tss->package.count));

	pr->throttling.state_count = tss->package.count;
	pr->throttling.states_tss =
	    kmalloc(sizeof(struct acpi_processor_tx_tss) * tss->package.count,
		    GFP_KERNEL);
	if (!pr->throttling.states_tss) {
		result = -ENOMEM;
		goto end;
	}

	for (i = 0; i < pr->throttling.state_count; i++) {

250 251 252
		struct acpi_processor_tx_tss *tx =
		    (struct acpi_processor_tx_tss *)&(pr->throttling.
						      states_tss[i]);
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269

		state.length = sizeof(struct acpi_processor_tx_tss);
		state.pointer = tx;

		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i));

		status = acpi_extract_package(&(tss->package.elements[i]),
					      &format, &state);
		if (ACPI_FAILURE(status)) {
			ACPI_EXCEPTION((AE_INFO, status, "Invalid _TSS data"));
			result = -EFAULT;
			kfree(pr->throttling.states_tss);
			goto end;
		}

		if (!tx->freqpercentage) {
			printk(KERN_ERR PREFIX
270
			       "Invalid _TSS data: freq is zero\n");
271 272 273 274 275 276 277 278 279 280 281
			result = -EFAULT;
			kfree(pr->throttling.states_tss);
			goto end;
		}
	}

      end:
	kfree(buffer.pointer);

	return result;
}
282 283 284 285

/*
 * _TSD - T-State Dependencies
 */
286
static int acpi_processor_get_tsd(struct acpi_processor *pr)
287 288 289
{
	int result = 0;
	acpi_status status = AE_OK;
290 291 292 293
	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
	struct acpi_buffer format = { sizeof("NNNNN"), "NNNNN" };
	struct acpi_buffer state = { 0, NULL };
	union acpi_object *tsd = NULL;
294 295 296 297
	struct acpi_tsd_package *pdomain;

	status = acpi_evaluate_object(pr->handle, "_TSD", NULL, &buffer);
	if (ACPI_FAILURE(status)) {
298 299 300
		if (status != AE_NOT_FOUND) {
			ACPI_EXCEPTION((AE_INFO, status, "Evaluating _TSD"));
		}
301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322
		return -ENODEV;
	}

	tsd = buffer.pointer;
	if (!tsd || (tsd->type != ACPI_TYPE_PACKAGE)) {
		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
		result = -EFAULT;
		goto end;
	}

	if (tsd->package.count != 1) {
		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
		result = -EFAULT;
		goto end;
	}

	pdomain = &(pr->throttling.domain_info);

	state.length = sizeof(struct acpi_tsd_package);
	state.pointer = pdomain;

	status = acpi_extract_package(&(tsd->package.elements[0]),
323
				      &format, &state);
324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
	if (ACPI_FAILURE(status)) {
		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Invalid _TSD data\n"));
		result = -EFAULT;
		goto end;
	}

	if (pdomain->num_entries != ACPI_TSD_REV0_ENTRIES) {
		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _TSD:num_entries\n"));
		result = -EFAULT;
		goto end;
	}

	if (pdomain->revision != ACPI_TSD_REV0_REVISION) {
		ACPI_DEBUG_PRINT((ACPI_DB_ERROR, "Unknown _TSD:revision\n"));
		result = -EFAULT;
		goto end;
	}

342
      end:
343 344 345 346
	kfree(buffer.pointer);
	return result;
}

L
Linus Torvalds 已提交
347 348 349
/* --------------------------------------------------------------------------
                              Throttling Control
   -------------------------------------------------------------------------- */
350
static int acpi_processor_get_throttling_fadt(struct acpi_processor *pr)
L
Linus Torvalds 已提交
351
{
L
Len Brown 已提交
352 353 354 355
	int state = 0;
	u32 value = 0;
	u32 duty_mask = 0;
	u32 duty_value = 0;
L
Linus Torvalds 已提交
356 357

	if (!pr)
358
		return -EINVAL;
L
Linus Torvalds 已提交
359 360

	if (!pr->flags.throttling)
361
		return -ENODEV;
L
Linus Torvalds 已提交
362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381

	pr->throttling.state = 0;

	duty_mask = pr->throttling.state_count - 1;

	duty_mask <<= pr->throttling.duty_offset;

	local_irq_disable();

	value = inl(pr->throttling.address);

	/*
	 * Compute the current throttling state when throttling is enabled
	 * (bit 4 is on).
	 */
	if (value & 0x10) {
		duty_value = value & duty_mask;
		duty_value >>= pr->throttling.duty_offset;

		if (duty_value)
L
Len Brown 已提交
382
			state = pr->throttling.state_count - duty_value;
L
Linus Torvalds 已提交
383 384 385 386 387 388 389
	}

	pr->throttling.state = state;

	local_irq_enable();

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
390 391
			  "Throttling state is T%d (%d%% throttling applied)\n",
			  state, pr->throttling.states[state].performance));
L
Linus Torvalds 已提交
392

393
	return 0;
L
Linus Torvalds 已提交
394 395
}

396 397
static int acpi_read_throttling_status(struct acpi_processor *pr,
					acpi_integer *value)
398
{
399
	u32 bit_width, bit_offset;
400
	u64 ptc_value;
401
	u64 ptc_mask;
402 403 404 405
	struct acpi_processor_throttling *throttling;
	int ret = -1;

	throttling = &pr->throttling;
406 407
	switch (throttling->status_register.space_id) {
	case ACPI_ADR_SPACE_SYSTEM_IO:
408
		ptc_value = 0;
409 410 411
		bit_width = throttling->status_register.bit_width;
		bit_offset = throttling->status_register.bit_offset;

412
		acpi_os_read_port((acpi_io_address) throttling->status_register.
413
				  address, (u32 *) &ptc_value,
414 415 416
				  (u32) (bit_width + bit_offset));
		ptc_mask = (1 << bit_width) - 1;
		*value = (acpi_integer) ((ptc_value >> bit_offset) & ptc_mask);
417
		ret = 0;
418 419
		break;
	case ACPI_ADR_SPACE_FIXED_HARDWARE:
420 421
		printk(KERN_ERR PREFIX
		       "HARDWARE addr space,NOT supported yet\n");
422 423 424
		break;
	default:
		printk(KERN_ERR PREFIX "Unknown addr space %d\n",
425
		       (u32) (throttling->status_register.space_id));
426
	}
427
	return ret;
428 429
}

430 431
static int acpi_write_throttling_state(struct acpi_processor *pr,
				acpi_integer value)
432
{
433
	u32 bit_width, bit_offset;
434
	u64 ptc_value;
435
	u64 ptc_mask;
436
	struct acpi_processor_throttling *throttling;
437 438
	int ret = -1;

439
	throttling = &pr->throttling;
440 441
	switch (throttling->control_register.space_id) {
	case ACPI_ADR_SPACE_SYSTEM_IO:
442 443 444 445 446
		bit_width = throttling->control_register.bit_width;
		bit_offset = throttling->control_register.bit_offset;
		ptc_mask = (1 << bit_width) - 1;
		ptc_value = value & ptc_mask;

447
		acpi_os_write_port((acpi_io_address) throttling->
448 449 450
					control_register.address,
					(u32) (ptc_value << bit_offset),
					(u32) (bit_width + bit_offset));
451 452 453
		ret = 0;
		break;
	case ACPI_ADR_SPACE_FIXED_HARDWARE:
454 455
		printk(KERN_ERR PREFIX
		       "HARDWARE addr space,NOT supported yet\n");
456 457 458
		break;
	default:
		printk(KERN_ERR PREFIX "Unknown addr space %d\n",
459
		       (u32) (throttling->control_register.space_id));
460 461 462 463
	}
	return ret;
}

464 465
static int acpi_get_throttling_state(struct acpi_processor *pr,
				acpi_integer value)
466 467 468 469
{
	int i;

	for (i = 0; i < pr->throttling.state_count; i++) {
470 471 472 473
		struct acpi_processor_tx_tss *tx =
		    (struct acpi_processor_tx_tss *)&(pr->throttling.
						      states_tss[i]);
		if (tx->control == value)
474 475
			break;
	}
476 477
	if (i > pr->throttling.state_count)
		i = -1;
478 479 480
	return i;
}

481 482
static int acpi_get_throttling_value(struct acpi_processor *pr,
			int state, acpi_integer *value)
483
{
484 485
	int ret = -1;

486 487 488 489
	if (state >= 0 && state <= pr->throttling.state_count) {
		struct acpi_processor_tx_tss *tx =
		    (struct acpi_processor_tx_tss *)&(pr->throttling.
						      states_tss[state]);
490 491
		*value = tx->control;
		ret = 0;
492
	}
493
	return ret;
494 495 496 497 498
}

static int acpi_processor_get_throttling_ptc(struct acpi_processor *pr)
{
	int state = 0;
499 500
	int ret;
	acpi_integer value;
501 502 503 504 505 506 507 508 509

	if (!pr)
		return -EINVAL;

	if (!pr->flags.throttling)
		return -ENODEV;

	pr->throttling.state = 0;
	local_irq_disable();
510 511 512
	value = 0;
	ret = acpi_read_throttling_status(pr, &value);
	if (ret >= 0) {
513
		state = acpi_get_throttling_state(pr, value);
514 515 516 517 518 519 520 521 522 523 524 525
		pr->throttling.state = state;
	}
	local_irq_enable();

	return 0;
}

static int acpi_processor_get_throttling(struct acpi_processor *pr)
{
	return pr->throttling.acpi_processor_get_throttling(pr);
}

526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559
static int acpi_processor_get_fadt_info(struct acpi_processor *pr)
{
	int i, step;

	if (!pr->throttling.address) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No throttling register\n"));
		return -EINVAL;
	} else if (!pr->throttling.duty_width) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No throttling states\n"));
		return -EINVAL;
	}
	/* TBD: Support duty_cycle values that span bit 4. */
	else if ((pr->throttling.duty_offset + pr->throttling.duty_width) > 4) {
		printk(KERN_WARNING PREFIX "duty_cycle spans bit 4\n");
		return -EINVAL;
	}

	pr->throttling.state_count = 1 << acpi_gbl_FADT.duty_width;

	/*
	 * Compute state values. Note that throttling displays a linear power
	 * performance relationship (at 50% performance the CPU will consume
	 * 50% power).  Values are in 1/10th of a percent to preserve accuracy.
	 */

	step = (1000 / pr->throttling.state_count);

	for (i = 0; i < pr->throttling.state_count; i++) {
		pr->throttling.states[i].performance = 1000 - step * i;
		pr->throttling.states[i].power = 1000 - step * i;
	}
	return 0;
}

A
Adrian Bunk 已提交
560 561
static int acpi_processor_set_throttling_fadt(struct acpi_processor *pr,
					      int state)
L
Linus Torvalds 已提交
562
{
L
Len Brown 已提交
563 564 565
	u32 value = 0;
	u32 duty_mask = 0;
	u32 duty_value = 0;
L
Linus Torvalds 已提交
566 567

	if (!pr)
568
		return -EINVAL;
L
Linus Torvalds 已提交
569 570

	if ((state < 0) || (state > (pr->throttling.state_count - 1)))
571
		return -EINVAL;
L
Linus Torvalds 已提交
572 573

	if (!pr->flags.throttling)
574
		return -ENODEV;
L
Linus Torvalds 已提交
575 576

	if (state == pr->throttling.state)
577
		return 0;
L
Linus Torvalds 已提交
578

579 580
	if (state < pr->throttling_platform_limit)
		return -EPERM;
L
Linus Torvalds 已提交
581 582 583 584 585 586 587 588 589 590 591
	/*
	 * Calculate the duty_value and duty_mask.
	 */
	if (state) {
		duty_value = pr->throttling.state_count - state;

		duty_value <<= pr->throttling.duty_offset;

		/* Used to clear all duty_value bits */
		duty_mask = pr->throttling.state_count - 1;

592
		duty_mask <<= acpi_gbl_FADT.duty_offset;
L
Linus Torvalds 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625
		duty_mask = ~duty_mask;
	}

	local_irq_disable();

	/*
	 * Disable throttling by writing a 0 to bit 4.  Note that we must
	 * turn it off before you can change the duty_value.
	 */
	value = inl(pr->throttling.address);
	if (value & 0x10) {
		value &= 0xFFFFFFEF;
		outl(value, pr->throttling.address);
	}

	/*
	 * Write the new duty_value and then enable throttling.  Note
	 * that a state value of 0 leaves throttling disabled.
	 */
	if (state) {
		value &= duty_mask;
		value |= duty_value;
		outl(value, pr->throttling.address);

		value |= 0x00000010;
		outl(value, pr->throttling.address);
	}

	pr->throttling.state = state;

	local_irq_enable();

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
626 627 628
			  "Throttling state set to T%d (%d%%)\n", state,
			  (pr->throttling.states[state].performance ? pr->
			   throttling.states[state].performance / 10 : 0)));
L
Linus Torvalds 已提交
629

630
	return 0;
L
Linus Torvalds 已提交
631 632
}

A
Adrian Bunk 已提交
633 634
static int acpi_processor_set_throttling_ptc(struct acpi_processor *pr,
					     int state)
635
{
636 637
	int ret;
	acpi_integer value;
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654

	if (!pr)
		return -EINVAL;

	if ((state < 0) || (state > (pr->throttling.state_count - 1)))
		return -EINVAL;

	if (!pr->flags.throttling)
		return -ENODEV;

	if (state == pr->throttling.state)
		return 0;

	if (state < pr->throttling_platform_limit)
		return -EPERM;

	local_irq_disable();
655 656 657 658
	value = 0;
	ret = acpi_get_throttling_value(pr, state, &value);
	if (ret >= 0) {
		acpi_write_throttling_state(pr, value);
659 660 661 662 663 664 665 666 667
		pr->throttling.state = state;
	}
	local_irq_enable();

	return 0;
}

int acpi_processor_set_throttling(struct acpi_processor *pr, int state)
{
668
	return pr->throttling.acpi_processor_set_throttling(pr, state);
669 670
}

L
Len Brown 已提交
671
int acpi_processor_get_throttling_info(struct acpi_processor *pr)
L
Linus Torvalds 已提交
672
{
L
Len Brown 已提交
673
	int result = 0;
L
Linus Torvalds 已提交
674 675

	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
676 677 678 679
			  "pblk_address[0x%08x] duty_offset[%d] duty_width[%d]\n",
			  pr->throttling.address,
			  pr->throttling.duty_offset,
			  pr->throttling.duty_width));
L
Linus Torvalds 已提交
680 681

	if (!pr)
682
		return -EINVAL;
L
Linus Torvalds 已提交
683

684 685 686 687 688 689 690 691
	/*
	 * Evaluate _PTC, _TSS and _TPC
	 * They must all be present or none of them can be used.
	 */
	if (acpi_processor_get_throttling_control(pr) ||
		acpi_processor_get_throttling_states(pr) ||
		acpi_processor_get_platform_limit(pr))
	{
692 693
		if (acpi_processor_get_fadt_info(pr))
			return 0;
694 695 696 697
		pr->throttling.acpi_processor_get_throttling =
		    &acpi_processor_get_throttling_fadt;
		pr->throttling.acpi_processor_set_throttling =
		    &acpi_processor_set_throttling_fadt;
698
	} else {
699 700 701 702
		pr->throttling.acpi_processor_get_throttling =
		    &acpi_processor_get_throttling_ptc;
		pr->throttling.acpi_processor_set_throttling =
		    &acpi_processor_set_throttling_ptc;
703
	}
L
Linus Torvalds 已提交
704

705 706
	acpi_processor_get_tsd(pr);

L
Linus Torvalds 已提交
707 708 709 710 711 712 713
	/*
	 * PIIX4 Errata: We don't support throttling on the original PIIX4.
	 * This shouldn't be an issue as few (if any) mobile systems ever
	 * used this part.
	 */
	if (errata.piix4.throttle) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
714
				  "Throttling not supported on PIIX4 A- or B-step\n"));
715
		return 0;
L
Linus Torvalds 已提交
716 717 718
	}

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d throttling states\n",
L
Len Brown 已提交
719
			  pr->throttling.state_count));
L
Linus Torvalds 已提交
720 721 722 723 724 725 726 727 728 729 730 731 732 733

	pr->flags.throttling = 1;

	/*
	 * Disable throttling (if enabled).  We'll let subsequent policy (e.g.
	 * thermal) decide to lower performance if it so chooses, but for now
	 * we'll crank up the speed.
	 */

	result = acpi_processor_get_throttling(pr);
	if (result)
		goto end;

	if (pr->throttling.state) {
L
Len Brown 已提交
734 735 736
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Disabling throttling (was T%d)\n",
				  pr->throttling.state));
L
Linus Torvalds 已提交
737 738 739 740 741
		result = acpi_processor_set_throttling(pr, 0);
		if (result)
			goto end;
	}

L
Len Brown 已提交
742
      end:
L
Linus Torvalds 已提交
743 744 745
	if (result)
		pr->flags.throttling = 0;

746
	return result;
L
Linus Torvalds 已提交
747 748 749 750
}

/* proc interface */

L
Len Brown 已提交
751 752
static int acpi_processor_throttling_seq_show(struct seq_file *seq,
					      void *offset)
L
Linus Torvalds 已提交
753
{
754
	struct acpi_processor *pr = seq->private;
L
Len Brown 已提交
755 756
	int i = 0;
	int result = 0;
L
Linus Torvalds 已提交
757 758 759 760 761 762 763 764 765 766 767 768

	if (!pr)
		goto end;

	if (!(pr->throttling.state_count > 0)) {
		seq_puts(seq, "<not supported>\n");
		goto end;
	}

	result = acpi_processor_get_throttling(pr);

	if (result) {
L
Len Brown 已提交
769 770
		seq_puts(seq,
			 "Could not determine current throttling state.\n");
L
Linus Torvalds 已提交
771 772 773 774
		goto end;
	}

	seq_printf(seq, "state count:             %d\n"
775
		   "active state:            T%d\n"
776
		   "state available: T%d to T%d\n",
777
		   pr->throttling.state_count, pr->throttling.state,
778 779
		   pr->throttling_platform_limit,
		   pr->throttling.state_count - 1);
L
Linus Torvalds 已提交
780 781

	seq_puts(seq, "states:\n");
782 783
	if (pr->throttling.acpi_processor_get_throttling ==
			acpi_processor_get_throttling_fadt) {
784 785
		for (i = 0; i < pr->throttling.state_count; i++)
			seq_printf(seq, "   %cT%d:                  %02d%%\n",
786 787 788
				   (i == pr->throttling.state ? '*' : ' '), i,
				   (pr->throttling.states[i].performance ? pr->
				    throttling.states[i].performance / 10 : 0));
789
	} else {
790 791
		for (i = 0; i < pr->throttling.state_count; i++)
			seq_printf(seq, "   %cT%d:                  %02d%%\n",
792 793 794
				   (i == pr->throttling.state ? '*' : ' '), i,
				   (int)pr->throttling.states_tss[i].
				   freqpercentage);
795
	}
L
Linus Torvalds 已提交
796

L
Len Brown 已提交
797
      end:
798
	return 0;
L
Linus Torvalds 已提交
799 800
}

L
Len Brown 已提交
801 802
static int acpi_processor_throttling_open_fs(struct inode *inode,
					     struct file *file)
L
Linus Torvalds 已提交
803 804
{
	return single_open(file, acpi_processor_throttling_seq_show,
L
Len Brown 已提交
805
			   PDE(inode)->data);
L
Linus Torvalds 已提交
806 807
}

808
static ssize_t acpi_processor_write_throttling(struct file *file,
809 810
					       const char __user * buffer,
					       size_t count, loff_t * data)
L
Linus Torvalds 已提交
811
{
L
Len Brown 已提交
812
	int result = 0;
813 814
	struct seq_file *m = file->private_data;
	struct acpi_processor *pr = m->private;
L
Len Brown 已提交
815
	char state_string[12] = { '\0' };
L
Linus Torvalds 已提交
816 817

	if (!pr || (count > sizeof(state_string) - 1))
818
		return -EINVAL;
L
Linus Torvalds 已提交
819 820

	if (copy_from_user(state_string, buffer, count))
821
		return -EFAULT;
L
Linus Torvalds 已提交
822 823 824 825

	state_string[count] = '\0';

	result = acpi_processor_set_throttling(pr,
L
Len Brown 已提交
826 827
					       simple_strtoul(state_string,
							      NULL, 0));
L
Linus Torvalds 已提交
828
	if (result)
829
		return result;
L
Linus Torvalds 已提交
830

831
	return count;
L
Linus Torvalds 已提交
832 833 834
}

struct file_operations acpi_processor_throttling_fops = {
L
Len Brown 已提交
835 836
	.open = acpi_processor_throttling_open_fs,
	.read = seq_read,
837
	.write = acpi_processor_write_throttling,
L
Len Brown 已提交
838 839
	.llseek = seq_lseek,
	.release = single_release,
L
Linus Torvalds 已提交
840
};