1 /*- 2 * Copyright (c) 2001 Tamotsu Hattori. 3 * Copyright (c) 2001 Mitsuru IWASAKI. 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. All advertising materials mentioning features or use of this software 15 * must display the following acknowledgement: 16 * This product includes software developed by the University of 17 * California, Berkeley and its contributors. 18 * 4. Neither the name of the University nor the names of its contributors 19 * may be used to endorse or promote products derived from this software 20 * without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 * 34 */ 35 36 #include <sys/cdefs.h> 37 __FBSDID("$FreeBSD$"); 38 39 #include "opt_cpu.h" 40 41 #include <sys/param.h> 42 #include <sys/systm.h> 43 #include <sys/kernel.h> 44 #include <sys/conf.h> 45 #include <sys/power.h> 46 #include <sys/sysctl.h> 47 #include <sys/types.h> 48 49 #include <machine/cputypes.h> 50 #include <machine/md_var.h> 51 #include <machine/specialreg.h> 52 53 /* 54 * Transmeta Crusoe LongRun Support by Tamotsu Hattori. 55 */ 56 57 #define MSR_TMx86_LONGRUN 0x80868010 58 #define MSR_TMx86_LONGRUN_FLAGS 0x80868011 59 60 #define LONGRUN_MODE_MASK(x) ((x) & 0x000000007f) 61 #define LONGRUN_MODE_RESERVED(x) ((x) & 0xffffff80) 62 #define LONGRUN_MODE_WRITE(x, y) (LONGRUN_MODE_RESERVED(x) | LONGRUN_MODE_MASK(y)) 63 64 #define LONGRUN_MODE_MINFREQUENCY 0x00 65 #define LONGRUN_MODE_ECONOMY 0x01 66 #define LONGRUN_MODE_PERFORMANCE 0x02 67 #define LONGRUN_MODE_MAXFREQUENCY 0x03 68 #define LONGRUN_MODE_UNKNOWN 0x04 69 #define LONGRUN_MODE_MAX 0x04 70 71 union msrinfo { 72 u_int64_t msr; 73 u_int32_t regs[2]; 74 }; 75 76 static u_int32_t longrun_modes[LONGRUN_MODE_MAX][3] = { 77 /* MSR low, MSR high, flags bit0 */ 78 { 0, 0, 0}, /* LONGRUN_MODE_MINFREQUENCY */ 79 { 0, 100, 0}, /* LONGRUN_MODE_ECONOMY */ 80 { 0, 100, 1}, /* LONGRUN_MODE_PERFORMANCE */ 81 { 100, 100, 1}, /* LONGRUN_MODE_MAXFREQUENCY */ 82 }; 83 84 static u_int 85 tmx86_get_longrun_mode(void) 86 { 87 register_t saveintr; 88 union msrinfo msrinfo; 89 u_int low, high, flags, mode; 90 91 saveintr = intr_disable(); 92 93 msrinfo.msr = rdmsr(MSR_TMx86_LONGRUN); 94 low = LONGRUN_MODE_MASK(msrinfo.regs[0]); 95 high = LONGRUN_MODE_MASK(msrinfo.regs[1]); 96 flags = rdmsr(MSR_TMx86_LONGRUN_FLAGS) & 0x01; 97 98 for (mode = 0; mode < LONGRUN_MODE_MAX; mode++) { 99 if (low == longrun_modes[mode][0] && 100 high == longrun_modes[mode][1] && 101 flags == longrun_modes[mode][2]) { 102 goto out; 103 } 104 } 105 mode = LONGRUN_MODE_UNKNOWN; 106 out: 107 intr_restore(saveintr); 108 return (mode); 109 } 110 111 static u_int 112 tmx86_get_longrun_status(u_int * frequency, u_int * voltage, u_int * percentage) 113 { 114 register_t saveintr; 115 u_int regs[4]; 116 117 saveintr = intr_disable(); 118 119 do_cpuid(0x80860007, regs); 120 *frequency = regs[0]; 121 *voltage = regs[1]; 122 *percentage = regs[2]; 123 124 intr_restore(saveintr); 125 return (1); 126 } 127 128 static u_int 129 tmx86_set_longrun_mode(u_int mode) 130 { 131 register_t saveintr; 132 union msrinfo msrinfo; 133 134 if (mode >= LONGRUN_MODE_UNKNOWN) { 135 return (0); 136 } 137 138 saveintr = intr_disable(); 139 140 /* Write LongRun mode values to Model Specific Register. */ 141 msrinfo.msr = rdmsr(MSR_TMx86_LONGRUN); 142 msrinfo.regs[0] = LONGRUN_MODE_WRITE(msrinfo.regs[0], 143 longrun_modes[mode][0]); 144 msrinfo.regs[1] = LONGRUN_MODE_WRITE(msrinfo.regs[1], 145 longrun_modes[mode][1]); 146 wrmsr(MSR_TMx86_LONGRUN, msrinfo.msr); 147 148 /* Write LongRun mode flags to Model Specific Register. */ 149 msrinfo.msr = rdmsr(MSR_TMx86_LONGRUN_FLAGS); 150 msrinfo.regs[0] = (msrinfo.regs[0] & ~0x01) | longrun_modes[mode][2]; 151 wrmsr(MSR_TMx86_LONGRUN_FLAGS, msrinfo.msr); 152 153 intr_restore(saveintr); 154 return (1); 155 } 156 157 static u_int crusoe_longrun; 158 static u_int crusoe_frequency; 159 static u_int crusoe_voltage; 160 static u_int crusoe_percentage; 161 static u_int crusoe_performance_longrun = LONGRUN_MODE_PERFORMANCE; 162 static u_int crusoe_economy_longrun = LONGRUN_MODE_ECONOMY; 163 static struct sysctl_ctx_list crusoe_sysctl_ctx; 164 static struct sysctl_oid *crusoe_sysctl_tree; 165 166 static void 167 tmx86_longrun_power_profile(void *arg) 168 { 169 int state; 170 u_int new; 171 172 state = power_profile_get_state(); 173 if (state != POWER_PROFILE_PERFORMANCE && 174 state != POWER_PROFILE_ECONOMY) { 175 return; 176 } 177 178 switch (state) { 179 case POWER_PROFILE_PERFORMANCE: 180 new =crusoe_performance_longrun; 181 break; 182 case POWER_PROFILE_ECONOMY: 183 new = crusoe_economy_longrun; 184 break; 185 default: 186 new = tmx86_get_longrun_mode(); 187 break; 188 } 189 190 if (tmx86_get_longrun_mode() != new) { 191 tmx86_set_longrun_mode(new); 192 } 193 } 194 195 static int 196 tmx86_longrun_sysctl(SYSCTL_HANDLER_ARGS) 197 { 198 u_int mode; 199 int error; 200 201 crusoe_longrun = tmx86_get_longrun_mode(); 202 mode = crusoe_longrun; 203 error = sysctl_handle_int(oidp, &mode, 0, req); 204 if (error || !req->newptr) { 205 return (error); 206 } 207 if (mode >= LONGRUN_MODE_UNKNOWN) { 208 error = EINVAL; 209 return (error); 210 } 211 if (crusoe_longrun != mode) { 212 crusoe_longrun = mode; 213 tmx86_set_longrun_mode(crusoe_longrun); 214 } 215 216 return (error); 217 } 218 219 static int 220 tmx86_status_sysctl(SYSCTL_HANDLER_ARGS) 221 { 222 u_int val; 223 int error; 224 225 tmx86_get_longrun_status(&crusoe_frequency, 226 &crusoe_voltage, &crusoe_percentage); 227 val = *(u_int *)oidp->oid_arg1; 228 error = sysctl_handle_int(oidp, &val, 0, req); 229 return (error); 230 } 231 232 static int 233 tmx86_longrun_profile_sysctl(SYSCTL_HANDLER_ARGS) 234 { 235 u_int32_t *argp; 236 u_int32_t arg; 237 int error; 238 239 argp = (u_int32_t *)oidp->oid_arg1; 240 arg = *argp; 241 error = sysctl_handle_int(oidp, &arg, 0, req); 242 243 /* error or no new value */ 244 if ((error != 0) || (req->newptr == NULL)) 245 return (error); 246 247 /* range check */ 248 if (arg >= LONGRUN_MODE_UNKNOWN) 249 return (EINVAL); 250 251 /* set new value and possibly switch */ 252 *argp = arg; 253 254 tmx86_longrun_power_profile(NULL); 255 256 return (0); 257 258 } 259 260 static void 261 setup_tmx86_longrun(void *dummy __unused) 262 { 263 264 if (cpu_vendor_id != CPU_VENDOR_TRANSMETA) 265 return; 266 267 crusoe_longrun = tmx86_get_longrun_mode(); 268 tmx86_get_longrun_status(&crusoe_frequency, 269 &crusoe_voltage, &crusoe_percentage); 270 printf("Crusoe LongRun support enabled, current mode: %d " 271 "<%dMHz %dmV %d%%>\n", crusoe_longrun, crusoe_frequency, 272 crusoe_voltage, crusoe_percentage); 273 274 sysctl_ctx_init(&crusoe_sysctl_ctx); 275 crusoe_sysctl_tree = SYSCTL_ADD_NODE(&crusoe_sysctl_ctx, 276 SYSCTL_STATIC_CHILDREN(_hw), OID_AUTO, 277 "crusoe", CTLFLAG_RD, 0, 278 "Transmeta Crusoe LongRun support"); 279 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 280 OID_AUTO, "longrun", CTLTYPE_INT | CTLFLAG_RW, 281 &crusoe_longrun, 0, tmx86_longrun_sysctl, "I", 282 "LongRun mode [0-3]"); 283 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 284 OID_AUTO, "frequency", CTLTYPE_INT | CTLFLAG_RD, 285 &crusoe_frequency, 0, tmx86_status_sysctl, "I", 286 "Current frequency (MHz)"); 287 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 288 OID_AUTO, "voltage", CTLTYPE_INT | CTLFLAG_RD, 289 &crusoe_voltage, 0, tmx86_status_sysctl, "I", 290 "Current voltage (mV)"); 291 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 292 OID_AUTO, "percentage", CTLTYPE_INT | CTLFLAG_RD, 293 &crusoe_percentage, 0, tmx86_status_sysctl, "I", 294 "Processing performance (%)"); 295 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 296 OID_AUTO, "performance_longrun", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_RW, 297 &crusoe_performance_longrun, 0, tmx86_longrun_profile_sysctl, "I", ""); 298 SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree), 299 OID_AUTO, "economy_longrun", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_RW, 300 &crusoe_economy_longrun, 0, tmx86_longrun_profile_sysctl, "I", ""); 301 302 /* register performance profile change handler */ 303 EVENTHANDLER_REGISTER(power_profile_change, tmx86_longrun_power_profile, NULL, 0); 304 } 305 SYSINIT(setup_tmx86_longrun, SI_SUB_CPU, SI_ORDER_ANY, setup_tmx86_longrun, 306 NULL); 307