/* * processor_perflib.c - ACPI Processor P-States Library ($Revision: 71 $) * *  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/slab.h> #ifdef CONFIG_X86#include <asm/cpufeature.h>#endif #include <acpi/acpi_bus.h>#include <acpi/acpi_drivers.h>#include <acpi/processor.h> #define PREFIX "ACPI: " #define ACPI_PROCESSOR_CLASS		"processor"#define ACPI_PROCESSOR_FILE_PERFORMANCE	"performance"#define _COMPONENT		ACPI_PROCESSOR_COMPONENTACPI_MODULE_NAME("processor_perflib"); static DEFINE_MUTEX(performance_mutex); /* * _PPC support is implemented as a CPUfreq policy notifier: * This means each time a CPUfreq driver registered also with * the ACPI core is asked to change the speed policy, the maximum * value is adjusted so that it is within the platform limit. * * Also, when a new platform limit value is detected, the CPUfreq * policy is adjusted accordingly. */ /* ignore_ppc: * -1 -> cpufreq low level drivers not initialized -> _PSS, etc. not called yet *       ignore _PPC *  0 -> cpufreq low level drivers initialized -> consider _PPC values *  1 -> ignore _PPC totally -> forced by user through boot param */static int ignore_ppc = -1;module_param(ignore_ppc, int, 0644);MODULE_PARM_DESC(ignore_ppc, "If the frequency of your machine gets wrongly" \		 "limited by BIOS, this should help"); #define PPC_REGISTERED   1#define PPC_IN_USE       2 static int acpi_processor_ppc_status; static int acpi_processor_ppc_notifier(struct notifier_block *nb,				       unsigned long event, void *data){	struct cpufreq_policy *policy = data;	struct acpi_processor *pr;	unsigned int ppc = 0; 	if (event == CPUFREQ_START && ignore_ppc <= 0) {		ignore_ppc = 0;		return 0;	} 	if (ignore_ppc)		return 0; 	if (event != CPUFREQ_INCOMPATIBLE)		return 0; 	mutex_lock(&performance_mutex); 	pr = per_cpu(processors, policy->cpu);	if (!pr || !pr->performance)		goto out; 	ppc = (unsigned int)pr->performance_platform_limit; 	if (ppc >= pr->performance->state_count)		goto out; 	cpufreq_verify_within_limits(policy, 0,				     pr->performance->states[ppc].				     core_frequency * 1000);       out:	mutex_unlock(&performance_mutex); 	return 0;} static struct notifier_block acpi_ppc_notifier_block = {	.notifier_call = acpi_processor_ppc_notifier,}; static int acpi_processor_get_platform_limit(struct acpi_processor *pr){	acpi_status status = 0;	unsigned long long ppc = 0;  	if (!pr)		return -EINVAL; 	/*	 * _PPC indicates the maximum state currently supported by the platform	 * (e.g. 0 = states 0..n; 1 = states 1..n; etc.	 */	status = acpi_evaluate_integer(pr->handle, "_PPC", NULL, &ppc); 	if (status != AE_NOT_FOUND)		acpi_processor_ppc_status |= PPC_IN_USE; 	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PPC"));		return -ENODEV;	} 	pr_debug("CPU %d: _PPC is %d - frequency %s limited\n", pr->id,		       (int)ppc, ppc ? "" : "not"); 	pr->performance_platform_limit = (int)ppc; 	return 0;} #define ACPI_PROCESSOR_NOTIFY_PERFORMANCE	0x80/* * acpi_processor_ppc_ost: Notify firmware the _PPC evaluation status * @handle: ACPI processor handle * @status: the status code of _PPC evaluation *	0: success. OSPM is now using the performance state specificed. *	1: failure. OSPM has not changed the number of P-states in use */static void acpi_processor_ppc_ost(acpi_handle handle, int status){	union acpi_object params[2] = {		{.type = ACPI_TYPE_INTEGER,},		{.type = ACPI_TYPE_INTEGER,},	};	struct acpi_object_list arg_list = {2, params}; 	if (acpi_has_method(handle, "_OST")) {		params[0].integer.value = ACPI_PROCESSOR_NOTIFY_PERFORMANCE;		params[1].integer.value =  status;		acpi_evaluate_object(handle, "_OST", &arg_list, NULL);	}} int acpi_processor_ppc_has_changed(struct acpi_processor *pr, int event_flag){	int ret; 	if (ignore_ppc) {		/*		 * Only when it is notification event, the _OST object		 * will be evaluated. Otherwise it is skipped.		 */		if (event_flag)			acpi_processor_ppc_ost(pr->handle, 1);		return 0;	} 	ret = acpi_processor_get_platform_limit(pr);	/*	 * Only when it is notification event, the _OST object	 * will be evaluated. Otherwise it is skipped.	 */	if (event_flag) {		if (ret < 0)			acpi_processor_ppc_ost(pr->handle, 1);		else			acpi_processor_ppc_ost(pr->handle, 0);	}	if (ret < 0)		return (ret);	else		return cpufreq_update_policy(pr->id);} int acpi_processor_get_bios_limit(int cpu, unsigned int *limit){	struct acpi_processor *pr; 	pr = per_cpu(processors, cpu);	if (!pr || !pr->performance || !pr->performance->state_count)		return -ENODEV;	*limit = pr->performance->states[pr->performance_platform_limit].		core_frequency * 1000;	return 0;}EXPORT_SYMBOL(acpi_processor_get_bios_limit); void acpi_processor_ppc_init(void){	if (!cpufreq_register_notifier	    (&acpi_ppc_notifier_block, CPUFREQ_POLICY_NOTIFIER))		acpi_processor_ppc_status |= PPC_REGISTERED;	else		printk(KERN_DEBUG		       "Warning: Processor Platform Limit not supported.\n");} void acpi_processor_ppc_exit(void){	if (acpi_processor_ppc_status & PPC_REGISTERED)		cpufreq_unregister_notifier(&acpi_ppc_notifier_block,					    CPUFREQ_POLICY_NOTIFIER); 	acpi_processor_ppc_status &= ~PPC_REGISTERED;} static int acpi_processor_get_performance_control(struct acpi_processor *pr){	int result = 0;	acpi_status status = 0;	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };	union acpi_object *pct = NULL;	union acpi_object obj = { 0 };  	status = acpi_evaluate_object(pr->handle, "_PCT", NULL, &buffer);	if (ACPI_FAILURE(status)) {		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PCT"));		return -ENODEV;	} 	pct = (union acpi_object *)buffer.pointer;	if (!pct || (pct->type != ACPI_TYPE_PACKAGE)	    || (pct->package.count != 2)) {		printk(KERN_ERR PREFIX "Invalid _PCT data\n");		result = -EFAULT;		goto end;	} 	/*	 * control_register	 */ 	obj = pct->package.elements[0]; 	if ((obj.type != ACPI_TYPE_BUFFER)	    || (obj.buffer.length < sizeof(struct acpi_pct_register))	    || (obj.buffer.pointer == NULL)) {		printk(KERN_ERR PREFIX "Invalid _PCT data (control_register)\n");		result = -EFAULT;		goto end;	}	memcpy(&pr->performance->control_register, obj.buffer.pointer,	       sizeof(struct acpi_pct_register)); 	/*	 * status_register	 */ 	obj = pct->package.elements[1]; 	if ((obj.type != ACPI_TYPE_BUFFER)	    || (obj.buffer.length < sizeof(struct acpi_pct_register))	    || (obj.buffer.pointer == NULL)) {		printk(KERN_ERR PREFIX "Invalid _PCT data (status_register)\n");		result = -EFAULT;		goto end;	} 	memcpy(&pr->performance->status_register, obj.buffer.pointer,	       sizeof(struct acpi_pct_register));       end:	kfree(buffer.pointer); 	return result;} #ifdef CONFIG_X86/* * Some AMDs have 50MHz frequency multiples, but only provide 100MHz rounding * in their ACPI data. Calculate the real values and fix up the _PSS data. */static void amd_fixup_frequency(struct acpi_processor_px *px, int i){	u32 hi, lo, fid, did;	int index = px->control & 0x00000007; 	if (boot_cpu_data.x86_vendor != X86_VENDOR_AMD)		return; 	if ((boot_cpu_data.x86 == 0x10 && boot_cpu_data.x86_model < 10)	    || boot_cpu_data.x86 == 0x11) {		rdmsr(MSR_AMD_PSTATE_DEF_BASE + index, lo, hi);		/*		 * MSR C001_0064+:		 * Bit 63: PstateEn. Read-write. If set, the P-state is valid.		 */		if (!(hi & BIT(31)))			return; 		fid = lo & 0x3f;		did = (lo >> 6) & 7;		if (boot_cpu_data.x86 == 0x10)			px->core_frequency = (100 * (fid + 0x10)) >> did;		else			px->core_frequency = (100 * (fid + 8)) >> did;	}}#elsestatic void amd_fixup_frequency(struct acpi_processor_px *px, int i) {};#endif static int acpi_processor_get_performance_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("NNNNNN"), "NNNNNN" };	struct acpi_buffer state = { 0, NULL };	union acpi_object *pss = NULL;	int i;	int last_invalid = -1;  	status = acpi_evaluate_object(pr->handle, "_PSS", NULL, &buffer);	if (ACPI_FAILURE(status)) {		ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PSS"));		return -ENODEV;	} 	pss = buffer.pointer;	if (!pss || (pss->type != ACPI_TYPE_PACKAGE)) {		printk(KERN_ERR PREFIX "Invalid _PSS data\n");		result = -EFAULT;		goto end;	} 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d performance states\n",			  pss->package.count)); 	pr->performance->state_count = pss->package.count;	pr->performance->states =	    kmalloc(sizeof(struct acpi_processor_px) * pss->package.count,		    GFP_KERNEL);	if (!pr->performance->states) {		result = -ENOMEM;		goto end;	} 	for (i = 0; i < pr->performance->state_count; i++) { 		struct acpi_processor_px *px = &(pr->performance->states[i]); 		state.length = sizeof(struct acpi_processor_px);		state.pointer = px; 		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Extracting state %d\n", i)); 		status = acpi_extract_package(&(pss->package.elements[i]),					      &format, &state);		if (ACPI_FAILURE(status)) {			ACPI_EXCEPTION((AE_INFO, status, "Invalid _PSS data"));			result = -EFAULT;			kfree(pr->performance->states);			goto end;		} 		amd_fixup_frequency(px, i); 		ACPI_DEBUG_PRINT((ACPI_DB_INFO,				  "State [%d]: core_frequency[%d] power[%d] transition_latency[%d] bus_master_latency[%d] control[0x%x] status[0x%x]\n",				  i,				  (u32) px->core_frequency,				  (u32) px->power,				  (u32) px->transition_latency,				  (u32) px->bus_master_latency,				  (u32) px->control, (u32) px->status)); 		/* 		 * Check that ACPI's u64 MHz will be valid as u32 KHz in cpufreq		 */		if (!px->core_frequency ||		    ((u32)(px->core_frequency * 1000) !=		     (px->core_frequency * 1000))) {			printk(KERN_ERR FW_BUG PREFIX			       "Invalid BIOS _PSS frequency found for processor %d: 0x%llx MHz\n",			       pr->id, px->core_frequency);			if (last_invalid == -1)				last_invalid = i;		} else {			if (last_invalid != -1) {				/*				 * Copy this valid entry over last_invalid entry				 */				memcpy(&(pr->performance->states[last_invalid]),				       px, sizeof(struct acpi_processor_px));				++last_invalid;			}		}	} 	if (last_invalid == 0) {		printk(KERN_ERR FW_BUG PREFIX		       "No valid BIOS _PSS frequency found for processor %d\n", pr->id);		result = -EFAULT;		kfree(pr->performance->states);		pr->performance->states = NULL;	} 	if (last_invalid > 0)		pr->performance->state_count = last_invalid;       end:	kfree(buffer.pointer); 	return result;} int acpi_processor_get_performance_info(struct acpi_processor *pr){	int result = 0; 	if (!pr || !pr->performance || !pr->handle)		return -EINVAL; 	if (!acpi_has_method(pr->handle, "_PCT")) {		ACPI_DEBUG_PRINT((ACPI_DB_INFO,				  "ACPI-based processor performance control unavailable\n"));		return -ENODEV;	} 	result = acpi_processor_get_performance_control(pr);	if (result)		goto update_bios; 	result = acpi_processor_get_performance_states(pr);	if (result)		goto update_bios; 	/* We need to call _PPC once when cpufreq starts */	if (ignore_ppc != 1)		result = acpi_processor_get_platform_limit(pr); 	return result; 	/*	 * Having _PPC but missing frequencies (_PSS, _PCT) is a very good hint that	 * the BIOS is older than the CPU and does not know its frequencies	 */ update_bios:#ifdef CONFIG_X86	if (acpi_has_method(pr->handle, "_PPC")) {		if(boot_cpu_has(X86_FEATURE_EST))			printk(KERN_WARNING FW_BUG "BIOS needs update for CPU "			       "frequency support\n");	}#endif	return result;}EXPORT_SYMBOL_GPL(acpi_processor_get_performance_info);int acpi_processor_notify_smm(struct module *calling_module){	acpi_status status;	static int is_done = 0;  	if (!(acpi_processor_ppc_status & PPC_REGISTERED))		return -EBUSY; 	if (!try_module_get(calling_module))		return -EINVAL; 	/* is_done is set to negative if an error occurred,	 * and to postitive if _no_ error occurred, but SMM	 * was already notified. This avoids double notification	 * which might lead to unexpected results...	 */	if (is_done > 0) {

Lines 1–500 of 821. Load more