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