p4tcc.c revision 177294
1/*- 2 * Copyright (c) 2005 Nate Lawson 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 19 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 20 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 21 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 22 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27/* 28 * Throttle clock frequency by using the thermal control circuit. This 29 * operates independently of SpeedStep and ACPI throttling and is supported 30 * on Pentium 4 and later models (feature TM). 31 * 32 * Reference: Intel Developer's manual v.3 #245472-012 33 * 34 * The original version of this driver was written by Ted Unangst for 35 * OpenBSD and imported by Maxim Sobolev. It was rewritten by Nate Lawson 36 * for use with the cpufreq framework. 37 */ 38 39#include <sys/cdefs.h> 40__FBSDID("$FreeBSD: head/sys/i386/cpufreq/p4tcc.c 177294 2008-03-17 08:38:38Z phk $"); 41 42#include <sys/param.h> 43#include <sys/systm.h> 44#include <sys/bus.h> 45#include <sys/cpu.h> 46#include <sys/kernel.h> 47#include <sys/module.h> 48 49#include <machine/md_var.h> 50#include <machine/specialreg.h> 51 52#include "cpufreq_if.h" 53 54#include <contrib/dev/acpica/acpi.h> 55#include <dev/acpica/acpivar.h> 56#include "acpi_if.h" 57 58struct p4tcc_softc { 59 device_t dev; 60 int set_count; 61 int lowest_val; 62 int auto_mode; 63}; 64 65#define TCC_NUM_SETTINGS 8 66 67#define TCC_ENABLE_ONDEMAND (1<<4) 68#define TCC_REG_OFFSET 1 69#define TCC_SPEED_PERCENT(x) ((10000 * (x)) / TCC_NUM_SETTINGS) 70 71static int p4tcc_features(driver_t *driver, u_int *features); 72static void p4tcc_identify(driver_t *driver, device_t parent); 73static int p4tcc_probe(device_t dev); 74static int p4tcc_attach(device_t dev); 75static int p4tcc_settings(device_t dev, struct cf_setting *sets, 76 int *count); 77static int p4tcc_set(device_t dev, const struct cf_setting *set); 78static int p4tcc_get(device_t dev, struct cf_setting *set); 79static int p4tcc_type(device_t dev, int *type); 80 81static device_method_t p4tcc_methods[] = { 82 /* Device interface */ 83 DEVMETHOD(device_identify, p4tcc_identify), 84 DEVMETHOD(device_probe, p4tcc_probe), 85 DEVMETHOD(device_attach, p4tcc_attach), 86 87 /* cpufreq interface */ 88 DEVMETHOD(cpufreq_drv_set, p4tcc_set), 89 DEVMETHOD(cpufreq_drv_get, p4tcc_get), 90 DEVMETHOD(cpufreq_drv_type, p4tcc_type), 91 DEVMETHOD(cpufreq_drv_settings, p4tcc_settings), 92 93 /* ACPI interface */ 94 DEVMETHOD(acpi_get_features, p4tcc_features), 95 96 {0, 0} 97}; 98 99static driver_t p4tcc_driver = { 100 "p4tcc", 101 p4tcc_methods, 102 sizeof(struct p4tcc_softc), 103}; 104 105static devclass_t p4tcc_devclass; 106DRIVER_MODULE(p4tcc, cpu, p4tcc_driver, p4tcc_devclass, 0, 0); 107 108static int 109p4tcc_features(driver_t *driver, u_int *features) 110{ 111 112 /* Notify the ACPI CPU that we support direct access to MSRs */ 113 *features = ACPI_CAP_THR_MSRS; 114 return (0); 115} 116 117static void 118p4tcc_identify(driver_t *driver, device_t parent) 119{ 120 121 if ((cpu_feature & (CPUID_ACPI | CPUID_TM)) != (CPUID_ACPI | CPUID_TM)) 122 return; 123 124 /* Make sure we're not being doubly invoked. */ 125 if (device_find_child(parent, "p4tcc", -1) != NULL) 126 return; 127 128 /* 129 * We attach a p4tcc child for every CPU since settings need to 130 * be performed on every CPU in the SMP case. See section 13.15.3 131 * of the IA32 Intel Architecture Software Developer's Manual, 132 * Volume 3, for more info. 133 */ 134 if (BUS_ADD_CHILD(parent, 0, "p4tcc", -1) == NULL) 135 device_printf(parent, "add p4tcc child failed\n"); 136} 137 138static int 139p4tcc_probe(device_t dev) 140{ 141 142 if (resource_disabled("p4tcc", 0)) 143 return (ENXIO); 144 145 device_set_desc(dev, "CPU Frequency Thermal Control"); 146 return (0); 147} 148 149static int 150p4tcc_attach(device_t dev) 151{ 152 struct p4tcc_softc *sc; 153 struct cf_setting set; 154 unsigned cpu_match; 155 156 sc = device_get_softc(dev); 157 sc->dev = dev; 158 sc->set_count = TCC_NUM_SETTINGS; 159 160 /* 161 * On boot, the TCC is usually in Automatic mode where reading the 162 * current performance level is likely to produce bogus results. 163 * We record that state here and don't trust the contents of the 164 * status MSR until we've set it ourselves. 165 */ 166 sc->auto_mode = TRUE; 167 168 cpu_match = cpu_id & 0xfff; 169 cpu_match |= (cpu_procinfo & 0xff) << 12; 170 switch (cpu_match) { 171 case 0x0ef22: /* Xeon MP O50(A0) */ 172 case 0x0ef25: /* Xeon MP O50(B0) */ 173 case 0x0ef26: /* Xeon MP O50(C0) */ 174 case 0x0bf22: /* Xeon MP O50(A0) */ 175 case 0x0bf25: /* Xeon MP O50(B0) */ 176 case 0x0bf26: /* Xeon MP O50(C0) */ 177 case 0x0ef29: /* P4 Mobile/533 Z19(D1) */ 178 case 0x0ff29: /* P4 Mobile/533 Z19(D1) */ 179 case 0x0ef24: /* Xeon P44(B0) */ 180 case 0x0ef25: /* Xeon P44(M0) */ 181 case 0x0ef27: /* Xeon P44(C1) */ 182 case 0x0ef29: /* Xeon P44(L0+D1) */ 183 case 0x12695: /* Celeron W7(B-1) */ 184 case 0x0d 185 case 0xf22: /* O50(A0) */ 186 case 0xf24: /* P44 */ 187 case 0xf25: /* P44 O50(B0)*/ 188 case 0xf26: /* O50(C0)*/ 189 case 0xf27: /* P44 */ 190 case 0xf29: /* P44 Z19(D1) */ 191 sc->set_count -= 1; 192 break; 193 case 0x22: 194 /* 195 * These CPU models hang when set to 12.5%. 196 * See Errata O50, P44, and Z21. 197 */ 198 sc->set_count -= 1; 199 break; 200 case 0x07: /* errata N44 and P18 */ 201 case 0x0a: 202 case 0x12: 203 case 0x13: 204 /* 205 * These CPU models hang when set to 12.5% or 25%. 206 * See Errata N44 and P18l. 207 */ 208 sc->set_count -= 2; 209 break; 210 } 211 sc->lowest_val = TCC_NUM_SETTINGS - sc->set_count + 1; 212 213 /* 214 * Before we finish attach, switch to 100%. It's possible the BIOS 215 * set us to a lower rate. The user can override this after boot. 216 */ 217 set.freq = 10000; 218 p4tcc_set(dev, &set); 219 220 cpufreq_register(dev); 221 return (0); 222} 223 224static int 225p4tcc_settings(device_t dev, struct cf_setting *sets, int *count) 226{ 227 struct p4tcc_softc *sc; 228 int i, val; 229 230 sc = device_get_softc(dev); 231 if (sets == NULL || count == NULL) 232 return (EINVAL); 233 if (*count < sc->set_count) 234 return (E2BIG); 235 236 /* Return a list of valid settings for this driver. */ 237 memset(sets, CPUFREQ_VAL_UNKNOWN, sizeof(*sets) * sc->set_count); 238 val = TCC_NUM_SETTINGS; 239 for (i = 0; i < sc->set_count; i++, val--) { 240 sets[i].freq = TCC_SPEED_PERCENT(val); 241 sets[i].dev = dev; 242 } 243 *count = sc->set_count; 244 245 return (0); 246} 247 248static int 249p4tcc_set(device_t dev, const struct cf_setting *set) 250{ 251 struct p4tcc_softc *sc; 252 uint64_t mask, msr; 253 int val; 254 255 if (set == NULL) 256 return (EINVAL); 257 sc = device_get_softc(dev); 258 259 /* 260 * Validate requested state converts to a setting that is an integer 261 * from [sc->lowest_val .. TCC_NUM_SETTINGS]. 262 */ 263 val = set->freq * TCC_NUM_SETTINGS / 10000; 264 if (val * 10000 != set->freq * TCC_NUM_SETTINGS || 265 val < sc->lowest_val || val > TCC_NUM_SETTINGS) 266 return (EINVAL); 267 268 /* 269 * Read the current register and mask off the old setting and 270 * On-Demand bit. If the new val is < 100%, set it and the On-Demand 271 * bit, otherwise just return to Automatic mode. 272 */ 273 msr = rdmsr(MSR_THERM_CONTROL); 274 mask = (TCC_NUM_SETTINGS - 1) << TCC_REG_OFFSET; 275 msr &= ~(mask | TCC_ENABLE_ONDEMAND); 276 if (val < TCC_NUM_SETTINGS) 277 msr |= (val << TCC_REG_OFFSET) | TCC_ENABLE_ONDEMAND; 278 wrmsr(MSR_THERM_CONTROL, msr); 279 280 /* 281 * Record whether we're now in Automatic or On-Demand mode. We have 282 * to cache this since there is no reliable way to check if TCC is in 283 * Automatic mode (i.e., at 100% or possibly 50%). Reading bit 4 of 284 * the ACPI Thermal Monitor Control Register produces 0 no matter 285 * what the current mode. 286 */ 287 if (msr & TCC_ENABLE_ONDEMAND) 288 sc->auto_mode = TRUE; 289 else 290 sc->auto_mode = FALSE; 291 292 return (0); 293} 294 295static int 296p4tcc_get(device_t dev, struct cf_setting *set) 297{ 298 struct p4tcc_softc *sc; 299 uint64_t msr; 300 int val; 301 302 if (set == NULL) 303 return (EINVAL); 304 sc = device_get_softc(dev); 305 306 /* 307 * Read the current register and extract the current setting. If 308 * in automatic mode, assume we're at TCC_NUM_SETTINGS (100%). 309 * 310 * XXX This is not completely reliable since at high temperatures 311 * the CPU may be automatically throttling to 50% but it's the best 312 * we can do. 313 */ 314 if (!sc->auto_mode) { 315 msr = rdmsr(MSR_THERM_CONTROL); 316 val = (msr >> TCC_REG_OFFSET) & (TCC_NUM_SETTINGS - 1); 317 } else 318 val = TCC_NUM_SETTINGS; 319 320 memset(set, CPUFREQ_VAL_UNKNOWN, sizeof(*set)); 321 set->freq = TCC_SPEED_PERCENT(val); 322 set->dev = dev; 323 324 return (0); 325} 326 327static int 328p4tcc_type(device_t dev, int *type) 329{ 330 331 if (type == NULL) 332 return (EINVAL); 333 334 *type = CPUFREQ_TYPE_RELATIVE; 335 return (0); 336} 337