longrun.c revision 138722 
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: head/sys/i386/i386/longrun.c 138722 2004-12-12 05:53:57Z njl $");
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
70union msrinfo {
71	u_int64_t	msr;
72	u_int32_t	regs[2];
73};
74
75static 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
83static u_int
84tmx86_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;
106out:
107	write_eflags(eflags);
108	return (mode);
109}
110
111static u_int
112tmx86_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
129static u_int
130tmx86_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
159static u_int			 crusoe_longrun;
160static u_int			 crusoe_frequency;
161static u_int	 		 crusoe_voltage;
162static u_int	 		 crusoe_percentage;
163static u_int	 		 crusoe_performance_longrun = LONGRUN_MODE_PERFORMANCE;
164static u_int	 		 crusoe_economy_longrun = LONGRUN_MODE_ECONOMY;
165static struct sysctl_ctx_list	 crusoe_sysctl_ctx;
166static struct sysctl_oid	*crusoe_sysctl_tree;
167
168static void
169tmx86_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
197static int
198tmx86_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
221static int
222tmx86_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
234static int
235tmx86_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
262static void
263setup_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}
307SYSINIT(setup_tmx86_longrun, SI_SUB_CPU, SI_ORDER_ANY, setup_tmx86_longrun,
308    NULL);
309