speedstep-centrino.c revision 4e57b6817880946a3a78d5d8cad1ace363f7e449
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * cpufreq driver for Enhanced SpeedStep, as found in Intel's Pentium 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * M (part of the Centrino chipset). 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Despite the "SpeedStep" in the name, this is almost entirely unlike 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * traditional SpeedStep. 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Modelled on speedstep.c 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2003 Jeremy Fitzhardinge <jeremy@goop.org> 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * WARNING WARNING WARNING 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This driver manipulates the PERF_CTL MSR, which is only somewhat 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * documented. While it seems to work on my laptop, it has not been 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * tested anywhere else, and it may not work for you, do strange 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * things or simply crash. 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/cpufreq.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/config.h> 254e57b6817880946a3a78d5d8cad1ace363f7e449Tim Schmielau#include <linux/sched.h> /* current */ 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/compiler.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_X86_SPEEDSTEP_CENTRINO_ACPI 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/acpi.h> 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <acpi/processor.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/msr.h> 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/processor.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/cpufeature.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "speedstep-est-common.h" 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define PFX "speedstep-centrino: " 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAINTAINER "Jeremy Fitzhardinge <jeremy@goop.org>" 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define dprintk(msg...) cpufreq_debug_printk(CPUFREQ_DEBUG_DRIVER, "speedstep-centrino", msg) 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct cpu_id 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u8 x86; /* CPU family */ 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u8 x86_model; /* model */ 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u8 x86_mask; /* stepping */ 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsenum { 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CPU_BANIAS, 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CPU_DOTHAN_A1, 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CPU_DOTHAN_A2, 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CPU_DOTHAN_B0, 588282864a96ef0a7b88ee9e4b357e08504131394dDave Jones CPU_MP4HT_D0, 598282864a96ef0a7b88ee9e4b357e08504131394dDave Jones CPU_MP4HT_E0, 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic const struct cpu_id cpu_ids[] = { 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds [CPU_BANIAS] = { 6, 9, 5 }, 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds [CPU_DOTHAN_A1] = { 6, 13, 1 }, 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds [CPU_DOTHAN_A2] = { 6, 13, 2 }, 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds [CPU_DOTHAN_B0] = { 6, 13, 6 }, 678282864a96ef0a7b88ee9e4b357e08504131394dDave Jones [CPU_MP4HT_D0] = {15, 3, 4 }, 688282864a96ef0a7b88ee9e4b357e08504131394dDave Jones [CPU_MP4HT_E0] = {15, 4, 1 }, 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define N_IDS (sizeof(cpu_ids)/sizeof(cpu_ids[0])) 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct cpu_model 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds const struct cpu_id *cpu_id; 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds const char *model_name; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned max_freq; /* max clock in kHz */ 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpufreq_frequency_table *op_points; /* clock/voltage pairs */ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_verify_cpu_id(const struct cpuinfo_x86 *c, const struct cpu_id *x); 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Operating points for current CPU */ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpu_model *centrino_model[NR_CPUS]; 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic const struct cpu_id *centrino_cpu[NR_CPUS]; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_driver centrino_driver; 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_X86_SPEEDSTEP_CENTRINO_TABLE 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Computes the correct form for IA32_PERF_CTL MSR for a particular 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frequency/voltage operating point; frequency in MHz, volts in mV. 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds This is stored as "index" in the structure. */ 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define OP(mhz, mv) \ 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { \ 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .frequency = (mhz) * 1000, \ 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .index = (((mhz)/100) << 8) | ((mv - 700) / 16) \ 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * These voltage tables were derived from the Intel Pentium M 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * datasheet, document 25261202.pdf, Table 5. I have verified they 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * are consistent with my IBM ThinkPad X31, which has a 1.3GHz Pentium 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * M. 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Ultra Low Voltage Intel Pentium M processor 900MHz (Banias) */ 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_900[] = 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(600, 844), 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(800, 988), 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(900, 1004), 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Ultra Low Voltage Intel Pentium M processor 1000MHz (Banias) */ 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1000[] = 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(600, 844), 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(800, 972), 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(900, 988), 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1004), 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Low Voltage Intel Pentium M processor 1.10GHz (Banias) */ 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1100[] = 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1020), 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 900, 1100), 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1164), 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1100, 1180), 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Low Voltage Intel Pentium M processor 1.20GHz (Banias) */ 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1200[] = 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1004), 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 900, 1020), 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1100), 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1100, 1164), 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1180), 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Intel Pentium M processor 1.30GHz (Banias) */ 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1300[] = 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1260), 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1292), 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1356), 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1300, 1388), 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Intel Pentium M processor 1.40GHz (Banias) */ 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1400[] = 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1180), 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1308), 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1436), 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1400, 1484), 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Intel Pentium M processor 1.50GHz (Banias) */ 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1500[] = 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1116), 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1228), 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1356), 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1400, 1452), 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1500, 1484), 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Intel Pentium M processor 1.60GHz (Banias) */ 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1600[] = 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1036), 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1164), 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1276), 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1400, 1420), 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1600, 1484), 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Intel Pentium M processor 1.70GHz (Banias) */ 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_frequency_table banias_1700[] = 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 600, 956), 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP( 800, 1004), 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1000, 1116), 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1200, 1228), 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1400, 1308), 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OP(1700, 1484), 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { .frequency = CPUFREQ_TABLE_END } 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef OP 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define _BANIAS(cpuid, max, name) \ 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ .cpu_id = cpuid, \ 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .model_name = "Intel(R) Pentium(R) M processor " name "MHz", \ 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .max_freq = (max)*1000, \ 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .op_points = banias_##max, \ 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define BANIAS(max) _BANIAS(&cpu_ids[CPU_BANIAS], max, #max) 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* CPU models, their operating frequency range, and freq/voltage 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds operating points */ 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpu_model models[] = 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds _BANIAS(&cpu_ids[CPU_BANIAS], 900, " 900"), 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1000), 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1100), 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1200), 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1300), 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1400), 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1500), 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1600), 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BANIAS(1700), 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* NULL model_name is a wildcard */ 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { &cpu_ids[CPU_DOTHAN_A1], NULL, 0, NULL }, 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { &cpu_ids[CPU_DOTHAN_A2], NULL, 0, NULL }, 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { &cpu_ids[CPU_DOTHAN_B0], NULL, 0, NULL }, 2348282864a96ef0a7b88ee9e4b357e08504131394dDave Jones { &cpu_ids[CPU_MP4HT_D0], NULL, 0, NULL }, 2358282864a96ef0a7b88ee9e4b357e08504131394dDave Jones { &cpu_ids[CPU_MP4HT_E0], NULL, 0, NULL }, 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { NULL, } 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef _BANIAS 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef BANIAS 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_cpu_init_table(struct cpufreq_policy *policy) 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpuinfo_x86 *cpu = &cpu_data[policy->cpu]; 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpu_model *model; 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for(model = models; model->cpu_id != NULL; model++) 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (centrino_verify_cpu_id(cpu, model->cpu_id) && 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (model->model_name == NULL || 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds strcmp(cpu->x86_model_id, model->model_name) == 0)) 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (model->cpu_id == NULL) { 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* No match at all */ 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk(KERN_INFO PFX "no support for CPU model \"%s\": " 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "send /proc/cpuinfo to " MAINTAINER "\n", 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpu->x86_model_id); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOENT; 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (model->op_points == NULL) { 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Matched a non-match */ 26352c18fd2dc5c6d96cec4f48c69fc17b00edd9860Dave Jones dprintk(KERN_INFO PFX "no table support for CPU model \"%s\"\n", 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpu->x86_model_id); 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef CONFIG_X86_SPEEDSTEP_CENTRINO_ACPI 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk(KERN_INFO PFX "try compiling with CONFIG_X86_SPEEDSTEP_CENTRINO_ACPI enabled\n"); 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOENT; 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[policy->cpu] = model; 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("found \"%s\": max frequency: %dkHz\n", 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds model->model_name, model->max_freq); 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int centrino_cpu_init_table(struct cpufreq_policy *policy) { return -ENODEV; } 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif /* CONFIG_X86_SPEEDSTEP_CENTRINO_TABLE */ 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_verify_cpu_id(const struct cpuinfo_x86 *c, const struct cpu_id *x) 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((c->x86 == x->x86) && 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (c->x86_model == x->x86_model) && 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (c->x86_mask == x->x86_mask)) 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* To be called only after centrino_model is initialized */ 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned extract_clock(unsigned msr, unsigned int cpu, int failsafe) 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Extract clock in kHz from PERF_CTL value 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for centrino, as some DSDTs are buggy. 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Ideally, this can be done using the acpi_data structure. 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((centrino_cpu[cpu] == &cpu_ids[CPU_BANIAS]) || 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (centrino_cpu[cpu] == &cpu_ids[CPU_DOTHAN_A1]) || 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (centrino_cpu[cpu] == &cpu_ids[CPU_DOTHAN_B0])) { 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msr = (msr >> 8) & 0xff; 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return msr * 100000; 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((!centrino_model[cpu]) || (!centrino_model[cpu]->op_points)) 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msr &= 0xffff; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i=0;centrino_model[cpu]->op_points[i].frequency != CPUFREQ_TABLE_END; i++) { 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msr == centrino_model[cpu]->op_points[i].index) 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return centrino_model[cpu]->op_points[i].frequency; 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (failsafe) 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return centrino_model[cpu]->op_points[i-1].frequency; 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Return the current CPU frequency in kHz */ 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int get_cur_freq(unsigned int cpu) 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned l, h; 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned clock_freq; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpumask_t saved_mask; 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saved_mask = current->cpus_allowed; 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_cpus_allowed(current, cpumask_of_cpu(cpu)); 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (smp_processor_id() != cpu) 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rdmsr(MSR_IA32_PERF_STATUS, l, h); 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clock_freq = extract_clock(l, cpu, 0); 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (unlikely(clock_freq == 0)) { 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * On some CPUs, we can see transient MSR values (which are 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * not present in _PSS), while CPU is doing some automatic 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * P-state transition (like TM2). Get the last freq set 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in PERF_CTL. 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rdmsr(MSR_IA32_PERF_CTL, l, h); 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clock_freq = extract_clock(l, cpu, 1); 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_cpus_allowed(current, saved_mask); 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return clock_freq; 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_X86_SPEEDSTEP_CENTRINO_ACPI 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct acpi_processor_performance p; 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * centrino_cpu_init_acpi - register with ACPI P-States library 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Register with the ACPI P-States library (part of drivers/acpi/processor.c) 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in order to determine correct frequency and voltage pairings by reading 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the _PSS of the ACPI DSDT or SSDT tables. 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_cpu_init_acpi(struct cpufreq_policy *policy) 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds union acpi_object arg0 = {ACPI_TYPE_BUFFER}; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 arg0_buf[3]; 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct acpi_object_list arg_list = {1, &arg0}; 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long cur_freq; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int result = 0, i; 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int cpu = policy->cpu; 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* _PDC settings */ 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds arg0.buffer.length = 12; 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds arg0.buffer.pointer = (u8 *) arg0_buf; 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds arg0_buf[0] = ACPI_PDC_REVISION_ID; 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds arg0_buf[1] = 1; 37902df8b9385c21fdba165bd380f60eca1d3b0578bVenkatesh Pallipadi arg0_buf[2] = ACPI_PDC_EST_CAPABILITY_SMP_MSR; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.pdc = &arg_list; 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* register with ACPI core */ 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (acpi_processor_register_performance(&p, cpu)) { 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk(KERN_INFO PFX "obtaining ACPI data failed\n"); 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* verify the acpi_data */ 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (p.state_count <= 1) { 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("No P-States\n"); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -ENODEV; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_unreg; 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((p.control_register.space_id != ACPI_ADR_SPACE_FIXED_HARDWARE) || 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (p.status_register.space_id != ACPI_ADR_SPACE_FIXED_HARDWARE)) { 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("Invalid control/status registers (%x - %x)\n", 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.control_register.space_id, p.status_register.space_id); 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -EIO; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_unreg; 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i=0; i<p.state_count; i++) { 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (p.states[i].control != p.states[i].status) { 406123411f2d0da5c42eb9ee0912b6e824cbe88a411Mika Kukkonen dprintk("Different control (%llu) and status values (%llu)\n", 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.states[i].control, p.states[i].status); 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -EINVAL; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_unreg; 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!p.states[i].core_frequency) { 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("Zero core frequency for state %u\n", i); 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -EINVAL; 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_unreg; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (p.states[i].core_frequency > p.states[0].core_frequency) { 419123411f2d0da5c42eb9ee0912b6e824cbe88a411Mika Kukkonen dprintk("P%u has larger frequency (%llu) than P0 (%llu), skipping\n", i, 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.states[i].core_frequency, p.states[0].core_frequency); 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.states[i].core_frequency = 0; 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu] = kmalloc(sizeof(struct cpu_model), GFP_KERNEL); 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!centrino_model[cpu]) { 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -ENOMEM; 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_unreg; 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(centrino_model[cpu], 0, sizeof(struct cpu_model)); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->model_name=NULL; 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->max_freq = p.states[0].core_frequency * 1000; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points = kmalloc(sizeof(struct cpufreq_frequency_table) * 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (p.state_count + 1), GFP_KERNEL); 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!centrino_model[cpu]->op_points) { 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -ENOMEM; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_kfree; 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i=0; i<p.state_count; i++) { 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points[i].index = p.states[i].control; 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points[i].frequency = p.states[i].core_frequency * 1000; 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("adding state %i with frequency %u and control value %04x\n", 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i, centrino_model[cpu]->op_points[i].frequency, centrino_model[cpu]->op_points[i].index); 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points[p.state_count].frequency = CPUFREQ_TABLE_END; 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cur_freq = get_cur_freq(cpu); 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i=0; i<p.state_count; i++) { 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!p.states[i].core_frequency) { 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("skipping state %u\n", i); 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points[i].frequency = CPUFREQ_ENTRY_INVALID; 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (extract_clock(centrino_model[cpu]->op_points[i].index, cpu, 0) != 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (centrino_model[cpu]->op_points[i].frequency)) { 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("Invalid encoded frequency (%u vs. %u)\n", 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds extract_clock(centrino_model[cpu]->op_points[i].index, cpu, 0), 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu]->op_points[i].frequency); 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds result = -EINVAL; 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto err_kfree_all; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cur_freq == centrino_model[cpu]->op_points[i].frequency) 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p.state = i; 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* notify BIOS that we exist */ 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_processor_notify_smm(THIS_MODULE); 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err_kfree_all: 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(centrino_model[cpu]->op_points); 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err_kfree: 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(centrino_model[cpu]); 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err_unreg: 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_processor_unregister_performance(&p, cpu); 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk(KERN_INFO PFX "invalid ACPI data\n"); 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (result); 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int centrino_cpu_init_acpi(struct cpufreq_policy *policy) { return -ENODEV; } 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_cpu_init(struct cpufreq_policy *policy) 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpuinfo_x86 *cpu = &cpu_data[policy->cpu]; 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned freq; 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned l, h; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Only Intel makes Enhanced Speedstep-capable CPUs */ 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cpu->x86_vendor != X86_VENDOR_INTEL || !cpu_has(cpu, X86_FEATURE_EST)) 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (is_const_loops_cpu(policy->cpu)) { 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_driver.flags |= CPUFREQ_CONST_LOOPS; 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (centrino_cpu_init_acpi(policy)) { 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (policy->cpu != 0) 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 510f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi for (i = 0; i < N_IDS; i++) 511f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi if (centrino_verify_cpu_id(cpu, &cpu_ids[i])) 512f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi break; 513f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi 514f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi if (i != N_IDS) 515f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi centrino_cpu[policy->cpu] = &cpu_ids[i]; 516f914be79ab2144efe291d9fc383661e0e23dca44Venkatesh Pallipadi 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!centrino_cpu[policy->cpu]) { 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk(KERN_INFO PFX "found unsupported CPU with " 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Enhanced SpeedStep: send /proc/cpuinfo to " 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MAINTAINER "\n"); 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (centrino_cpu_init_table(policy)) { 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check to see if Enhanced SpeedStep is enabled, and try to 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enable it if not. */ 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rdmsr(MSR_IA32_MISC_ENABLE, l, h); 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(l & (1<<16))) { 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds l |= (1<<16); 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("trying to enable Enhanced SpeedStep (%x)\n", l); 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wrmsr(MSR_IA32_MISC_ENABLE, l, h); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* check to see if it stuck */ 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rdmsr(MSR_IA32_MISC_ENABLE, l, h); 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(l & (1<<16))) { 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO PFX "couldn't enable Enhanced SpeedStep\n"); 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds freq = get_cur_freq(policy->cpu); 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds policy->governor = CPUFREQ_DEFAULT_GOVERNOR; 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds policy->cpuinfo.transition_latency = 10000; /* 10uS transition latency */ 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds policy->cur = freq; 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("centrino_cpu_init: cur=%dkHz\n", policy->cur); 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = cpufreq_frequency_table_cpuinfo(policy, centrino_model[policy->cpu]->op_points); 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (ret); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpufreq_frequency_table_get_attr(centrino_model[policy->cpu]->op_points, policy->cpu); 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_cpu_exit(struct cpufreq_policy *policy) 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int cpu = policy->cpu; 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!centrino_model[cpu]) 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpufreq_frequency_table_put_attr(cpu); 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_X86_SPEEDSTEP_CENTRINO_ACPI 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!centrino_model[cpu]->model_name) { 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("unregistering and freeing ACPI data\n"); 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds acpi_processor_unregister_performance(&p, cpu); 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(centrino_model[cpu]->op_points); 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(centrino_model[cpu]); 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds centrino_model[cpu] = NULL; 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/** 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * centrino_verify - verifies a new CPUFreq policy 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * @policy: new policy 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Limit must be within this model's frequency range at least one 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * border included. 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_verify (struct cpufreq_policy *policy) 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return cpufreq_frequency_table_verify(policy, centrino_model[policy->cpu]->op_points); 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/** 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * centrino_setpolicy - set a new CPUFreq policy 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * @policy: new policy 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * @target_freq: the target frequency 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * @relation: how that frequency relates to achieved frequency (CPUFREQ_RELATION_L or CPUFREQ_RELATION_H) 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Sets a new CPUFreq policy. 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int centrino_target (struct cpufreq_policy *policy, 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int target_freq, 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int relation) 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int newstate = 0; 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int msr, oldmsr, h, cpu = policy->cpu; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpufreq_freqs freqs; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpumask_t saved_mask; 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int retval; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (centrino_model[cpu] == NULL) 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Support for SMP systems. 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Make sure we are running on the CPU that wants to change frequency 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saved_mask = current->cpus_allowed; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_cpus_allowed(current, policy->cpus); 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!cpu_isset(smp_processor_id(), policy->cpus)) { 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("couldn't limit to CPUs in this domain\n"); 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return(-EAGAIN); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cpufreq_frequency_table_target(policy, centrino_model[cpu]->op_points, target_freq, 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds relation, &newstate)) { 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = -EINVAL; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto migrate_end; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msr = centrino_model[cpu]->op_points[newstate].index; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rdmsr(MSR_IA32_PERF_CTL, oldmsr, h); 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (msr == (oldmsr & 0xffff)) { 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = 0; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("no change needed - msr was and needs to be %x\n", oldmsr); 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto migrate_end; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds freqs.cpu = cpu; 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds freqs.old = extract_clock(oldmsr, cpu, 0); 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds freqs.new = extract_clock(msr, cpu, 0); 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("target=%dkHz old=%d new=%d msr=%04x\n", 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds target_freq, freqs.old, freqs.new, msr); 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE); 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* all but 16 LSB are "reserved", so treat them with 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds care */ 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds oldmsr &= ~0xffff; 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msr &= 0xffff; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds oldmsr |= msr; 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wrmsr(MSR_IA32_PERF_CTL, oldmsr, h); 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE); 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds retval = 0; 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmigrate_end: 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_cpus_allowed(current, saved_mask); 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (retval); 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct freq_attr* centrino_attr[] = { 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &cpufreq_freq_attr_scaling_available_freqs, 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds NULL, 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct cpufreq_driver centrino_driver = { 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "centrino", /* should be speedstep-centrino, 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds but there's a 16 char limit */ 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .init = centrino_cpu_init, 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .exit = centrino_cpu_exit, 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .verify = centrino_verify, 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .target = centrino_target, 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .get = get_cur_freq, 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .attr = centrino_attr, 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/** 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * centrino_init - initializes the Enhanced SpeedStep CPUFreq driver 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Initializes the Enhanced SpeedStep support. Returns -ENODEV on 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * unsupported devices, -ENOENT if there's no voltage table for this 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * particular CPU model, -EINVAL on problems during initiatization, 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * and zero on success. 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This is quite picky. Not only does the CPU have to advertise the 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * "est" flag in the cpuid capability flags, we look for a specific 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * CPU model and stepping, and we need to have the exact model name in 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * our voltage tables. That is, be paranoid about not releasing 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * someone's valuable magic smoke. 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init centrino_init(void) 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cpuinfo_x86 *cpu = cpu_data; 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!cpu_has(cpu, X86_FEATURE_EST)) 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return cpufreq_register_driver(¢rino_driver); 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit centrino_exit(void) 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cpufreq_unregister_driver(¢rino_driver); 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR ("Jeremy Fitzhardinge <jeremy@goop.org>"); 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION ("Enhanced SpeedStep driver for Intel Pentium M processors."); 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE ("GPL"); 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldslate_initcall(centrino_init); 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(centrino_exit); 723