sys/i386/i386/longrun.c

   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/md_var.h>
  50 #include <machine/specialreg.h>
  51
  52 /*
  53  * Transmeta Crusoe LongRun Support by Tamotsu Hattori.
  54  */
  55
  56 #define MSR_TMx86_LONGRUN               0x80868010
  57 #define MSR_TMx86_LONGRUN_FLAGS         0x80868011
  58
  59 #define LONGRUN_MODE_MASK(x)            ((x) & 0x000000007f)
  60 #define LONGRUN_MODE_RESERVED(x)        ((x) & 0xffffff80)
  61 #define LONGRUN_MODE_WRITE(x, y)        (LONGRUN_MODE_RESERVED(x) | LONGRUN_MODE_MASK(y))
  62
  63 #define LONGRUN_MODE_MINFREQUENCY       0x00
  64 #define LONGRUN_MODE_ECONOMY            0x01
  65 #define LONGRUN_MODE_PERFORMANCE        0x02
  66 #define LONGRUN_MODE_MAXFREQUENCY       0x03
  67 #define LONGRUN_MODE_UNKNOWN            0x04
  68 #define LONGRUN_MODE_MAX                0x04
  69
  70 union msrinfo {
  71         u_int64_t       msr;
  72         u_int32_t       regs[2];
  73 };
  74
  75 static u_int32_t longrun_modes[LONGRUN_MODE_MAX][3] = {
  76         /*  MSR low, MSR high, flags bit0 */
  77         {         0,      0,            0},     /* LONGRUN_MODE_MINFREQUENCY */
  78         {         0,    100,            0},     /* LONGRUN_MODE_ECONOMY */
  79         {         0,    100,            1},     /* LONGRUN_MODE_PERFORMANCE */
  80         {       100,    100,            1},     /* LONGRUN_MODE_MAXFREQUENCY */
  81 };
  82
  83 static u_int
  84 tmx86_get_longrun_mode(void)
  85 {
  86         u_long          eflags;
  87         union msrinfo   msrinfo;
  88         u_int           low, high, flags, mode;
  89
  90         eflags = read_eflags();
  91         disable_intr();
  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         write_eflags(eflags);
 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         u_long          eflags;
 115         u_int           regs[4];
 116
 117         eflags = read_eflags();
 118         disable_intr();
 119
 120         do_cpuid(0x80860007, regs);
 121         *frequency = regs[0];
 122         *voltage = regs[1];
 123         *percentage = regs[2];
 124
 125         write_eflags(eflags);
 126         return (1);
 127 }
 128
 129 static u_int
 130 tmx86_set_longrun_mode(u_int mode)
 131 {
 132         u_long          eflags;
 133         union msrinfo   msrinfo;
 134
 135         if (mode >= LONGRUN_MODE_UNKNOWN) {
 136                 return (0);
 137         }
 138
 139         eflags = read_eflags();
 140         disable_intr();
 141
 142         /* Write LongRun mode values to Model Specific Register. */
 143         msrinfo.msr = rdmsr(MSR_TMx86_LONGRUN);
 144         msrinfo.regs[0] = LONGRUN_MODE_WRITE(msrinfo.regs[0],
 145                                              longrun_modes[mode][0]);
 146         msrinfo.regs[1] = LONGRUN_MODE_WRITE(msrinfo.regs[1],
 147                                              longrun_modes[mode][1]);
 148         wrmsr(MSR_TMx86_LONGRUN, msrinfo.msr);
 149
 150         /* Write LongRun mode flags to Model Specific Register. */
 151         msrinfo.msr = rdmsr(MSR_TMx86_LONGRUN_FLAGS);
 152         msrinfo.regs[0] = (msrinfo.regs[0] & ~0x01) | longrun_modes[mode][2];
 153         wrmsr(MSR_TMx86_LONGRUN_FLAGS, msrinfo.msr);
 154
 155         write_eflags(eflags);
 156         return (1);
 157 }
 158
 159 static u_int                     crusoe_longrun;
 160 static u_int                     crusoe_frequency;
 161 static u_int                     crusoe_voltage;
 162 static u_int                     crusoe_percentage;
 163 static u_int                     crusoe_performance_longrun = LONGRUN_MODE_PERFORMANCE;
 164 static u_int                     crusoe_economy_longrun = LONGRUN_MODE_ECONOMY;
 165 static struct sysctl_ctx_list    crusoe_sysctl_ctx;
 166 static struct sysctl_oid        *crusoe_sysctl_tree;
 167
 168 static void
 169 tmx86_longrun_power_profile(void *arg)
 170 {
 171         int     state;
 172         u_int   new;
 173
 174         state = power_profile_get_state();
 175         if (state != POWER_PROFILE_PERFORMANCE &&
 176             state != POWER_PROFILE_ECONOMY) {
 177                 return;
 178         }
 179
 180         switch (state) {
 181         case POWER_PROFILE_PERFORMANCE:
 182                 new =crusoe_performance_longrun;
 183                 break;
 184         case POWER_PROFILE_ECONOMY:
 185                 new = crusoe_economy_longrun;
 186                 break;
 187         default:
 188                 new = tmx86_get_longrun_mode();
 189                 break;
 190         }
 191
 192         if (tmx86_get_longrun_mode() != new) {
 193                 tmx86_set_longrun_mode(new);
 194         }
 195 }
 196
 197 static int
 198 tmx86_longrun_sysctl(SYSCTL_HANDLER_ARGS)
 199 {
 200         u_int   mode;
 201         int     error;
 202
 203         crusoe_longrun = tmx86_get_longrun_mode();
 204         mode = crusoe_longrun;
 205         error = sysctl_handle_int(oidp, &mode, 0, req);
 206         if (error || !req->newptr) {
 207                 return (error);
 208         }
 209         if (mode >= LONGRUN_MODE_UNKNOWN) {
 210                 error = EINVAL;
 211                 return (error);
 212         }
 213         if (crusoe_longrun != mode) {
 214                 crusoe_longrun = mode;
 215                 tmx86_set_longrun_mode(crusoe_longrun);
 216         }
 217
 218         return (error);
 219 }
 220
 221 static int
 222 tmx86_status_sysctl(SYSCTL_HANDLER_ARGS)
 223 {
 224         u_int   val;
 225         int     error;
 226
 227         tmx86_get_longrun_status(&crusoe_frequency,
 228                                  &crusoe_voltage, &crusoe_percentage);
 229         val = *(u_int *)oidp->oid_arg1;
 230         error = sysctl_handle_int(oidp, &val, 0, req);
 231         return (error);
 232 }
 233
 234 static int
 235 tmx86_longrun_profile_sysctl(SYSCTL_HANDLER_ARGS)
 236 {
 237         u_int32_t *argp;
 238         u_int32_t arg;
 239         int     error;
 240
 241         argp = (u_int32_t *)oidp->oid_arg1;
 242         arg = *argp;
 243         error = sysctl_handle_int(oidp, &arg, 0, req);
 244
 245         /* error or no new value */
 246         if ((error != 0) || (req->newptr == NULL))
 247                 return (error);
 248
 249         /* range check */
 250         if (arg >= LONGRUN_MODE_UNKNOWN)
 251                 return (EINVAL);
 252
 253         /* set new value and possibly switch */
 254         *argp = arg;
 255
 256         tmx86_longrun_power_profile(NULL);
 257
 258         return (0);
 259
 260 }
 261
 262 static void
 263 setup_tmx86_longrun(void *dummy __unused)
 264 {
 265         if (strcmp(cpu_vendor, "GenuineTMx86") != 0 &&
 266             strcmp(cpu_vendor, "TransmetaCPU") != 0)
 267                 return;
 268
 269         crusoe_longrun = tmx86_get_longrun_mode();
 270         tmx86_get_longrun_status(&crusoe_frequency,
 271                                  &crusoe_voltage, &crusoe_percentage);
 272         printf("Crusoe LongRun support enabled, current mode: %d "
 273                "<%dMHz %dmV %d%%>\n", crusoe_longrun, crusoe_frequency,
 274                crusoe_voltage, crusoe_percentage);
 275
 276         sysctl_ctx_init(&crusoe_sysctl_ctx);
 277         crusoe_sysctl_tree = SYSCTL_ADD_NODE(&crusoe_sysctl_ctx,
 278                                 SYSCTL_STATIC_CHILDREN(_hw), OID_AUTO,
 279                                 "crusoe", CTLFLAG_RD, 0,
 280                                 "Transmeta Crusoe LongRun support");
 281         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 282                 OID_AUTO, "longrun", CTLTYPE_INT | CTLFLAG_RW,
 283                 &crusoe_longrun, 0, tmx86_longrun_sysctl, "I",
 284                 "LongRun mode [0-3]");
 285         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 286                 OID_AUTO, "frequency", CTLTYPE_INT | CTLFLAG_RD,
 287                 &crusoe_frequency, 0, tmx86_status_sysctl, "I",
 288                 "Current frequency (MHz)");
 289         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 290                 OID_AUTO, "voltage", CTLTYPE_INT | CTLFLAG_RD,
 291                 &crusoe_voltage, 0, tmx86_status_sysctl, "I",
 292                 "Current voltage (mV)");
 293         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 294                 OID_AUTO, "percentage", CTLTYPE_INT | CTLFLAG_RD,
 295                 &crusoe_percentage, 0, tmx86_status_sysctl, "I",
 296                 "Processing performance (%)");
 297         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 298                 OID_AUTO, "performance_longrun", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_RW,
 299                 &crusoe_performance_longrun, 0, tmx86_longrun_profile_sysctl, "I", "");
 300         SYSCTL_ADD_PROC(&crusoe_sysctl_ctx, SYSCTL_CHILDREN(crusoe_sysctl_tree),
 301                 OID_AUTO, "economy_longrun", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_RW,
 302                 &crusoe_economy_longrun, 0, tmx86_longrun_profile_sysctl, "I", "");
 303
 304         /* register performance profile change handler */
 305         EVENTHANDLER_REGISTER(power_profile_change, tmx86_longrun_power_profile, NULL, 0);
 306 }
 307 SYSINIT(setup_tmx86_longrun, SI_SUB_CPU, SI_ORDER_ANY, setup_tmx86_longrun,
 308     NULL);